Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 1 | /* |
| 2 | * drivers/base/power/clock_ops.c - Generic clock manipulation PM callbacks |
| 3 | * |
| 4 | * Copyright (c) 2011 Rafael J. Wysocki <rjw@sisk.pl>, Renesas Electronics Corp. |
| 5 | * |
| 6 | * This file is released under the GPLv2. |
| 7 | */ |
| 8 | |
| 9 | #include <linux/init.h> |
| 10 | #include <linux/kernel.h> |
Paul Gortmaker | 51990e8 | 2012-01-22 11:23:42 -0500 | [diff] [blame] | 11 | #include <linux/device.h> |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 12 | #include <linux/io.h> |
| 13 | #include <linux/pm.h> |
Rafael J. Wysocki | b5e8d26 | 2011-08-25 15:34:19 +0200 | [diff] [blame] | 14 | #include <linux/pm_clock.h> |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 15 | #include <linux/clk.h> |
| 16 | #include <linux/slab.h> |
| 17 | #include <linux/err.h> |
| 18 | |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 19 | #ifdef CONFIG_PM |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 20 | |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 21 | enum pce_status { |
| 22 | PCE_STATUS_NONE = 0, |
| 23 | PCE_STATUS_ACQUIRED, |
| 24 | PCE_STATUS_ENABLED, |
| 25 | PCE_STATUS_ERROR, |
| 26 | }; |
| 27 | |
| 28 | struct pm_clock_entry { |
| 29 | struct list_head node; |
| 30 | char *con_id; |
| 31 | struct clk *clk; |
| 32 | enum pce_status status; |
| 33 | }; |
| 34 | |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 35 | /** |
Rafael J. Wysocki | e8b364b | 2011-09-26 19:40:23 +0200 | [diff] [blame] | 36 | * pm_clk_acquire - Acquire a device clock. |
| 37 | * @dev: Device whose clock is to be acquired. |
| 38 | * @ce: PM clock entry corresponding to the clock. |
| 39 | */ |
| 40 | static void pm_clk_acquire(struct device *dev, struct pm_clock_entry *ce) |
| 41 | { |
| 42 | ce->clk = clk_get(dev, ce->con_id); |
| 43 | if (IS_ERR(ce->clk)) { |
| 44 | ce->status = PCE_STATUS_ERROR; |
| 45 | } else { |
| 46 | ce->status = PCE_STATUS_ACQUIRED; |
| 47 | dev_dbg(dev, "Clock %s managed by runtime PM.\n", ce->con_id); |
| 48 | } |
| 49 | } |
| 50 | |
| 51 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 52 | * pm_clk_add - Start using a device clock for power management. |
| 53 | * @dev: Device whose clock is going to be used for power management. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 54 | * @con_id: Connection ID of the clock. |
| 55 | * |
| 56 | * Add the clock represented by @con_id to the list of clocks used for |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 57 | * the power management of @dev. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 58 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 59 | int pm_clk_add(struct device *dev, const char *con_id) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 60 | { |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 61 | struct pm_subsys_data *psd = dev_to_psd(dev); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 62 | struct pm_clock_entry *ce; |
| 63 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 64 | if (!psd) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 65 | return -EINVAL; |
| 66 | |
| 67 | ce = kzalloc(sizeof(*ce), GFP_KERNEL); |
| 68 | if (!ce) { |
| 69 | dev_err(dev, "Not enough memory for clock entry.\n"); |
| 70 | return -ENOMEM; |
| 71 | } |
| 72 | |
| 73 | if (con_id) { |
| 74 | ce->con_id = kstrdup(con_id, GFP_KERNEL); |
| 75 | if (!ce->con_id) { |
| 76 | dev_err(dev, |
| 77 | "Not enough memory for clock connection ID.\n"); |
| 78 | kfree(ce); |
| 79 | return -ENOMEM; |
| 80 | } |
| 81 | } |
| 82 | |
Rafael J. Wysocki | e8b364b | 2011-09-26 19:40:23 +0200 | [diff] [blame] | 83 | pm_clk_acquire(dev, ce); |
| 84 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 85 | spin_lock_irq(&psd->lock); |
| 86 | list_add_tail(&ce->node, &psd->clock_list); |
| 87 | spin_unlock_irq(&psd->lock); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 88 | return 0; |
| 89 | } |
| 90 | |
| 91 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 92 | * __pm_clk_remove - Destroy PM clock entry. |
| 93 | * @ce: PM clock entry to destroy. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 94 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 95 | static void __pm_clk_remove(struct pm_clock_entry *ce) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 96 | { |
| 97 | if (!ce) |
| 98 | return; |
| 99 | |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 100 | if (ce->status < PCE_STATUS_ERROR) { |
| 101 | if (ce->status == PCE_STATUS_ENABLED) |
Murali Karicheri | c122f27 | 2012-10-23 01:18:40 +0200 | [diff] [blame] | 102 | clk_disable_unprepare(ce->clk); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 103 | |
| 104 | if (ce->status >= PCE_STATUS_ACQUIRED) |
| 105 | clk_put(ce->clk); |
| 106 | } |
| 107 | |
Jonghwan Choi | 0ab1e79 | 2011-10-22 00:22:54 +0200 | [diff] [blame] | 108 | kfree(ce->con_id); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 109 | kfree(ce); |
| 110 | } |
| 111 | |
| 112 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 113 | * pm_clk_remove - Stop using a device clock for power management. |
| 114 | * @dev: Device whose clock should not be used for PM any more. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 115 | * @con_id: Connection ID of the clock. |
| 116 | * |
| 117 | * Remove the clock represented by @con_id from the list of clocks used for |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 118 | * the power management of @dev. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 119 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 120 | void pm_clk_remove(struct device *dev, const char *con_id) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 121 | { |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 122 | struct pm_subsys_data *psd = dev_to_psd(dev); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 123 | struct pm_clock_entry *ce; |
| 124 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 125 | if (!psd) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 126 | return; |
| 127 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 128 | spin_lock_irq(&psd->lock); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 129 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 130 | list_for_each_entry(ce, &psd->clock_list, node) { |
Rafael J. Wysocki | e8b364b | 2011-09-26 19:40:23 +0200 | [diff] [blame] | 131 | if (!con_id && !ce->con_id) |
| 132 | goto remove; |
| 133 | else if (!con_id || !ce->con_id) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 134 | continue; |
Rafael J. Wysocki | e8b364b | 2011-09-26 19:40:23 +0200 | [diff] [blame] | 135 | else if (!strcmp(con_id, ce->con_id)) |
| 136 | goto remove; |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 137 | } |
| 138 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 139 | spin_unlock_irq(&psd->lock); |
Rafael J. Wysocki | e8b364b | 2011-09-26 19:40:23 +0200 | [diff] [blame] | 140 | return; |
| 141 | |
| 142 | remove: |
| 143 | list_del(&ce->node); |
Rafael J. Wysocki | 0d41da2 | 2011-09-26 20:12:45 +0200 | [diff] [blame] | 144 | spin_unlock_irq(&psd->lock); |
Rafael J. Wysocki | e8b364b | 2011-09-26 19:40:23 +0200 | [diff] [blame] | 145 | |
| 146 | __pm_clk_remove(ce); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 147 | } |
| 148 | |
| 149 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 150 | * pm_clk_init - Initialize a device's list of power management clocks. |
| 151 | * @dev: Device to initialize the list of PM clocks for. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 152 | * |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 153 | * Initialize the lock and clock_list members of the device's pm_subsys_data |
| 154 | * object. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 155 | */ |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 156 | void pm_clk_init(struct device *dev) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 157 | { |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 158 | struct pm_subsys_data *psd = dev_to_psd(dev); |
Rafael J. Wysocki | ef27bed | 2011-08-25 15:34:01 +0200 | [diff] [blame] | 159 | if (psd) |
| 160 | INIT_LIST_HEAD(&psd->clock_list); |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 161 | } |
| 162 | |
| 163 | /** |
| 164 | * pm_clk_create - Create and initialize a device's list of PM clocks. |
| 165 | * @dev: Device to create and initialize the list of PM clocks for. |
| 166 | * |
| 167 | * Allocate a struct pm_subsys_data object, initialize its lock and clock_list |
| 168 | * members and make the @dev's power.subsys_data field point to it. |
| 169 | */ |
| 170 | int pm_clk_create(struct device *dev) |
| 171 | { |
Rafael J. Wysocki | 7725495 | 2012-08-07 13:50:14 +0200 | [diff] [blame] | 172 | return dev_pm_get_subsys_data(dev); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 173 | } |
| 174 | |
| 175 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 176 | * pm_clk_destroy - Destroy a device's list of power management clocks. |
| 177 | * @dev: Device to destroy the list of PM clocks for. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 178 | * |
| 179 | * Clear the @dev's power.subsys_data field, remove the list of clock entries |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 180 | * from the struct pm_subsys_data object pointed to by it before and free |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 181 | * that object. |
| 182 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 183 | void pm_clk_destroy(struct device *dev) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 184 | { |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 185 | struct pm_subsys_data *psd = dev_to_psd(dev); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 186 | struct pm_clock_entry *ce, *c; |
Rafael J. Wysocki | e8b364b | 2011-09-26 19:40:23 +0200 | [diff] [blame] | 187 | struct list_head list; |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 188 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 189 | if (!psd) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 190 | return; |
| 191 | |
Rafael J. Wysocki | e8b364b | 2011-09-26 19:40:23 +0200 | [diff] [blame] | 192 | INIT_LIST_HEAD(&list); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 193 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 194 | spin_lock_irq(&psd->lock); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 195 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 196 | list_for_each_entry_safe_reverse(ce, c, &psd->clock_list, node) |
Rafael J. Wysocki | e8b364b | 2011-09-26 19:40:23 +0200 | [diff] [blame] | 197 | list_move(&ce->node, &list); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 198 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 199 | spin_unlock_irq(&psd->lock); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 200 | |
Rafael J. Wysocki | ef27bed | 2011-08-25 15:34:01 +0200 | [diff] [blame] | 201 | dev_pm_put_subsys_data(dev); |
Rafael J. Wysocki | e8b364b | 2011-09-26 19:40:23 +0200 | [diff] [blame] | 202 | |
| 203 | list_for_each_entry_safe_reverse(ce, c, &list, node) { |
| 204 | list_del(&ce->node); |
| 205 | __pm_clk_remove(ce); |
| 206 | } |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 207 | } |
| 208 | |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 209 | #endif /* CONFIG_PM */ |
| 210 | |
| 211 | #ifdef CONFIG_PM_RUNTIME |
| 212 | |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 213 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 214 | * pm_clk_suspend - Disable clocks in a device's PM clock list. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 215 | * @dev: Device to disable the clocks for. |
| 216 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 217 | int pm_clk_suspend(struct device *dev) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 218 | { |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 219 | struct pm_subsys_data *psd = dev_to_psd(dev); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 220 | struct pm_clock_entry *ce; |
Rafael J. Wysocki | b7ab83e | 2011-08-24 21:40:56 +0200 | [diff] [blame] | 221 | unsigned long flags; |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 222 | |
| 223 | dev_dbg(dev, "%s()\n", __func__); |
| 224 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 225 | if (!psd) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 226 | return 0; |
| 227 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 228 | spin_lock_irqsave(&psd->lock, flags); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 229 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 230 | list_for_each_entry_reverse(ce, &psd->clock_list, node) { |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 231 | if (ce->status < PCE_STATUS_ERROR) { |
Magnus Damm | 2405095 | 2011-11-10 00:44:10 +0100 | [diff] [blame] | 232 | if (ce->status == PCE_STATUS_ENABLED) |
| 233 | clk_disable(ce->clk); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 234 | ce->status = PCE_STATUS_ACQUIRED; |
| 235 | } |
| 236 | } |
| 237 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 238 | spin_unlock_irqrestore(&psd->lock, flags); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 239 | |
| 240 | return 0; |
| 241 | } |
| 242 | |
| 243 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 244 | * pm_clk_resume - Enable clocks in a device's PM clock list. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 245 | * @dev: Device to enable the clocks for. |
| 246 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 247 | int pm_clk_resume(struct device *dev) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 248 | { |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 249 | struct pm_subsys_data *psd = dev_to_psd(dev); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 250 | struct pm_clock_entry *ce; |
Rafael J. Wysocki | b7ab83e | 2011-08-24 21:40:56 +0200 | [diff] [blame] | 251 | unsigned long flags; |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 252 | |
| 253 | dev_dbg(dev, "%s()\n", __func__); |
| 254 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 255 | if (!psd) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 256 | return 0; |
| 257 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 258 | spin_lock_irqsave(&psd->lock, flags); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 259 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 260 | list_for_each_entry(ce, &psd->clock_list, node) { |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 261 | if (ce->status < PCE_STATUS_ERROR) { |
| 262 | clk_enable(ce->clk); |
| 263 | ce->status = PCE_STATUS_ENABLED; |
| 264 | } |
| 265 | } |
| 266 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 267 | spin_unlock_irqrestore(&psd->lock, flags); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 268 | |
| 269 | return 0; |
| 270 | } |
| 271 | |
| 272 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 273 | * pm_clk_notify - Notify routine for device addition and removal. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 274 | * @nb: Notifier block object this function is a member of. |
| 275 | * @action: Operation being carried out by the caller. |
| 276 | * @data: Device the routine is being run for. |
| 277 | * |
| 278 | * For this function to work, @nb must be a member of an object of type |
| 279 | * struct pm_clk_notifier_block containing all of the requisite data. |
Rafael J. Wysocki | 564b905 | 2011-06-23 01:52:55 +0200 | [diff] [blame] | 280 | * Specifically, the pm_domain member of that object is copied to the device's |
| 281 | * pm_domain field and its con_ids member is used to populate the device's list |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 282 | * of PM clocks, depending on @action. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 283 | * |
Rafael J. Wysocki | 564b905 | 2011-06-23 01:52:55 +0200 | [diff] [blame] | 284 | * If the device's pm_domain field is already populated with a value different |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 285 | * from the one stored in the struct pm_clk_notifier_block object, the function |
| 286 | * does nothing. |
| 287 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 288 | static int pm_clk_notify(struct notifier_block *nb, |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 289 | unsigned long action, void *data) |
| 290 | { |
| 291 | struct pm_clk_notifier_block *clknb; |
| 292 | struct device *dev = data; |
Rafael J. Wysocki | 3b3eca3 | 2011-06-07 23:34:58 +0200 | [diff] [blame] | 293 | char **con_id; |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 294 | int error; |
| 295 | |
| 296 | dev_dbg(dev, "%s() %ld\n", __func__, action); |
| 297 | |
| 298 | clknb = container_of(nb, struct pm_clk_notifier_block, nb); |
| 299 | |
| 300 | switch (action) { |
| 301 | case BUS_NOTIFY_ADD_DEVICE: |
Rafael J. Wysocki | 564b905 | 2011-06-23 01:52:55 +0200 | [diff] [blame] | 302 | if (dev->pm_domain) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 303 | break; |
| 304 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 305 | error = pm_clk_create(dev); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 306 | if (error) |
| 307 | break; |
| 308 | |
Rafael J. Wysocki | 564b905 | 2011-06-23 01:52:55 +0200 | [diff] [blame] | 309 | dev->pm_domain = clknb->pm_domain; |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 310 | if (clknb->con_ids[0]) { |
Rafael J. Wysocki | 3b3eca3 | 2011-06-07 23:34:58 +0200 | [diff] [blame] | 311 | for (con_id = clknb->con_ids; *con_id; con_id++) |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 312 | pm_clk_add(dev, *con_id); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 313 | } else { |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 314 | pm_clk_add(dev, NULL); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 315 | } |
| 316 | |
| 317 | break; |
| 318 | case BUS_NOTIFY_DEL_DEVICE: |
Rafael J. Wysocki | 564b905 | 2011-06-23 01:52:55 +0200 | [diff] [blame] | 319 | if (dev->pm_domain != clknb->pm_domain) |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 320 | break; |
| 321 | |
Rafael J. Wysocki | 564b905 | 2011-06-23 01:52:55 +0200 | [diff] [blame] | 322 | dev->pm_domain = NULL; |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 323 | pm_clk_destroy(dev); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 324 | break; |
| 325 | } |
| 326 | |
| 327 | return 0; |
| 328 | } |
| 329 | |
| 330 | #else /* !CONFIG_PM_RUNTIME */ |
| 331 | |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 332 | #ifdef CONFIG_PM |
| 333 | |
| 334 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 335 | * pm_clk_suspend - Disable clocks in a device's PM clock list. |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 336 | * @dev: Device to disable the clocks for. |
| 337 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 338 | int pm_clk_suspend(struct device *dev) |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 339 | { |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 340 | struct pm_subsys_data *psd = dev_to_psd(dev); |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 341 | struct pm_clock_entry *ce; |
Rafael J. Wysocki | b7ab83e | 2011-08-24 21:40:56 +0200 | [diff] [blame] | 342 | unsigned long flags; |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 343 | |
| 344 | dev_dbg(dev, "%s()\n", __func__); |
| 345 | |
| 346 | /* If there is no driver, the clocks are already disabled. */ |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 347 | if (!psd || !dev->driver) |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 348 | return 0; |
| 349 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 350 | spin_lock_irqsave(&psd->lock, flags); |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 351 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 352 | list_for_each_entry_reverse(ce, &psd->clock_list, node) |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 353 | clk_disable(ce->clk); |
| 354 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 355 | spin_unlock_irqrestore(&psd->lock, flags); |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 356 | |
| 357 | return 0; |
| 358 | } |
| 359 | |
| 360 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 361 | * pm_clk_resume - Enable clocks in a device's PM clock list. |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 362 | * @dev: Device to enable the clocks for. |
| 363 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 364 | int pm_clk_resume(struct device *dev) |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 365 | { |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 366 | struct pm_subsys_data *psd = dev_to_psd(dev); |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 367 | struct pm_clock_entry *ce; |
Rafael J. Wysocki | b7ab83e | 2011-08-24 21:40:56 +0200 | [diff] [blame] | 368 | unsigned long flags; |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 369 | |
| 370 | dev_dbg(dev, "%s()\n", __func__); |
| 371 | |
| 372 | /* If there is no driver, the clocks should remain disabled. */ |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 373 | if (!psd || !dev->driver) |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 374 | return 0; |
| 375 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 376 | spin_lock_irqsave(&psd->lock, flags); |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 377 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 378 | list_for_each_entry(ce, &psd->clock_list, node) |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 379 | clk_enable(ce->clk); |
| 380 | |
Rafael J. Wysocki | 5c095a0 | 2011-08-25 15:33:50 +0200 | [diff] [blame] | 381 | spin_unlock_irqrestore(&psd->lock, flags); |
Rafael J. Wysocki | b7b9592 | 2011-07-01 22:13:37 +0200 | [diff] [blame] | 382 | |
| 383 | return 0; |
| 384 | } |
| 385 | |
| 386 | #endif /* CONFIG_PM */ |
| 387 | |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 388 | /** |
| 389 | * enable_clock - Enable a device clock. |
| 390 | * @dev: Device whose clock is to be enabled. |
| 391 | * @con_id: Connection ID of the clock. |
| 392 | */ |
| 393 | static void enable_clock(struct device *dev, const char *con_id) |
| 394 | { |
| 395 | struct clk *clk; |
| 396 | |
| 397 | clk = clk_get(dev, con_id); |
| 398 | if (!IS_ERR(clk)) { |
Murali Karicheri | c122f27 | 2012-10-23 01:18:40 +0200 | [diff] [blame] | 399 | clk_prepare_enable(clk); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 400 | clk_put(clk); |
| 401 | dev_info(dev, "Runtime PM disabled, clock forced on.\n"); |
| 402 | } |
| 403 | } |
| 404 | |
| 405 | /** |
| 406 | * disable_clock - Disable a device clock. |
| 407 | * @dev: Device whose clock is to be disabled. |
| 408 | * @con_id: Connection ID of the clock. |
| 409 | */ |
| 410 | static void disable_clock(struct device *dev, const char *con_id) |
| 411 | { |
| 412 | struct clk *clk; |
| 413 | |
| 414 | clk = clk_get(dev, con_id); |
| 415 | if (!IS_ERR(clk)) { |
Murali Karicheri | c122f27 | 2012-10-23 01:18:40 +0200 | [diff] [blame] | 416 | clk_disable_unprepare(clk); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 417 | clk_put(clk); |
| 418 | dev_info(dev, "Runtime PM disabled, clock forced off.\n"); |
| 419 | } |
| 420 | } |
| 421 | |
| 422 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 423 | * pm_clk_notify - Notify routine for device addition and removal. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 424 | * @nb: Notifier block object this function is a member of. |
| 425 | * @action: Operation being carried out by the caller. |
| 426 | * @data: Device the routine is being run for. |
| 427 | * |
| 428 | * For this function to work, @nb must be a member of an object of type |
| 429 | * struct pm_clk_notifier_block containing all of the requisite data. |
| 430 | * Specifically, the con_ids member of that object is used to enable or disable |
| 431 | * the device's clocks, depending on @action. |
| 432 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 433 | static int pm_clk_notify(struct notifier_block *nb, |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 434 | unsigned long action, void *data) |
| 435 | { |
| 436 | struct pm_clk_notifier_block *clknb; |
| 437 | struct device *dev = data; |
Rafael J. Wysocki | 3b3eca3 | 2011-06-07 23:34:58 +0200 | [diff] [blame] | 438 | char **con_id; |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 439 | |
| 440 | dev_dbg(dev, "%s() %ld\n", __func__, action); |
| 441 | |
| 442 | clknb = container_of(nb, struct pm_clk_notifier_block, nb); |
| 443 | |
| 444 | switch (action) { |
Rafael J. Wysocki | 4d1518f | 2011-06-21 23:24:33 +0200 | [diff] [blame] | 445 | case BUS_NOTIFY_BIND_DRIVER: |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 446 | if (clknb->con_ids[0]) { |
Rafael J. Wysocki | 3b3eca3 | 2011-06-07 23:34:58 +0200 | [diff] [blame] | 447 | for (con_id = clknb->con_ids; *con_id; con_id++) |
| 448 | enable_clock(dev, *con_id); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 449 | } else { |
| 450 | enable_clock(dev, NULL); |
| 451 | } |
| 452 | break; |
Rafael J. Wysocki | 4d1518f | 2011-06-21 23:24:33 +0200 | [diff] [blame] | 453 | case BUS_NOTIFY_UNBOUND_DRIVER: |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 454 | if (clknb->con_ids[0]) { |
Rafael J. Wysocki | 3b3eca3 | 2011-06-07 23:34:58 +0200 | [diff] [blame] | 455 | for (con_id = clknb->con_ids; *con_id; con_id++) |
| 456 | disable_clock(dev, *con_id); |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 457 | } else { |
| 458 | disable_clock(dev, NULL); |
| 459 | } |
| 460 | break; |
| 461 | } |
| 462 | |
| 463 | return 0; |
| 464 | } |
| 465 | |
| 466 | #endif /* !CONFIG_PM_RUNTIME */ |
| 467 | |
| 468 | /** |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 469 | * pm_clk_add_notifier - Add bus type notifier for power management clocks. |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 470 | * @bus: Bus type to add the notifier to. |
| 471 | * @clknb: Notifier to be added to the given bus type. |
| 472 | * |
| 473 | * The nb member of @clknb is not expected to be initialized and its |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 474 | * notifier_call member will be replaced with pm_clk_notify(). However, |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 475 | * the remaining members of @clknb should be populated prior to calling this |
| 476 | * routine. |
| 477 | */ |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 478 | void pm_clk_add_notifier(struct bus_type *bus, |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 479 | struct pm_clk_notifier_block *clknb) |
| 480 | { |
| 481 | if (!bus || !clknb) |
| 482 | return; |
| 483 | |
Rafael J. Wysocki | 3d5c303 | 2011-07-01 22:13:44 +0200 | [diff] [blame] | 484 | clknb->nb.notifier_call = pm_clk_notify; |
Rafael J. Wysocki | 85eb8c8 | 2011-04-30 00:25:44 +0200 | [diff] [blame] | 485 | bus_register_notifier(bus, &clknb->nb); |
| 486 | } |