Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 1 | /* |
| 2 | * pm.c - Common OMAP2+ power management-related code |
| 3 | * |
| 4 | * Copyright (C) 2010 Texas Instruments, Inc. |
| 5 | * Copyright (C) 2010 Nokia Corporation |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of the GNU General Public License version 2 as |
| 9 | * published by the Free Software Foundation. |
| 10 | */ |
| 11 | |
| 12 | #include <linux/kernel.h> |
| 13 | #include <linux/init.h> |
| 14 | #include <linux/io.h> |
| 15 | #include <linux/err.h> |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 16 | #include <linux/opp.h> |
Paul Gortmaker | dc28094 | 2011-07-31 16:17:29 -0400 | [diff] [blame] | 17 | #include <linux/export.h> |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 18 | |
| 19 | #include <plat/omap-pm.h> |
| 20 | #include <plat/omap_device.h> |
Tony Lindgren | 4e65331 | 2011-11-10 22:45:17 +0100 | [diff] [blame] | 21 | #include "common.h" |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 22 | |
Paul Walmsley | e1d6f47 | 2011-02-25 15:54:33 -0700 | [diff] [blame] | 23 | #include "voltage.h" |
Paul Walmsley | 72e06d0 | 2010-12-21 21:05:16 -0700 | [diff] [blame] | 24 | #include "powerdomain.h" |
Paul Walmsley | 1540f214 | 2010-12-21 21:05:15 -0700 | [diff] [blame] | 25 | #include "clockdomain.h" |
Thara Gopinath | 0c0a5d6 | 2010-05-29 22:02:23 +0530 | [diff] [blame] | 26 | #include "pm.h" |
Kevin Hilman | 46232a3 | 2011-11-23 14:43:01 -0800 | [diff] [blame] | 27 | #include "twl-common.h" |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 28 | |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 29 | static struct omap_device_pm_latency *pm_lats; |
| 30 | |
Benoit Cousson | 766e7af | 2011-08-16 15:03:59 +0200 | [diff] [blame] | 31 | static int _init_omap_device(char *name) |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 32 | { |
| 33 | struct omap_hwmod *oh; |
Kevin Hilman | 3528c58 | 2011-07-21 13:48:45 -0700 | [diff] [blame] | 34 | struct platform_device *pdev; |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 35 | |
| 36 | oh = omap_hwmod_lookup(name); |
| 37 | if (WARN(!oh, "%s: could not find omap_hwmod for %s\n", |
| 38 | __func__, name)) |
| 39 | return -ENODEV; |
| 40 | |
Kevin Hilman | 3528c58 | 2011-07-21 13:48:45 -0700 | [diff] [blame] | 41 | pdev = omap_device_build(oh->name, 0, oh, NULL, 0, pm_lats, 0, false); |
| 42 | if (WARN(IS_ERR(pdev), "%s: could not build omap_device for %s\n", |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 43 | __func__, name)) |
| 44 | return -ENODEV; |
| 45 | |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 46 | return 0; |
| 47 | } |
| 48 | |
| 49 | /* |
| 50 | * Build omap_devices for processors and bus. |
| 51 | */ |
| 52 | static void omap2_init_processor_devices(void) |
| 53 | { |
Benoit Cousson | 766e7af | 2011-08-16 15:03:59 +0200 | [diff] [blame] | 54 | _init_omap_device("mpu"); |
Sanjeev Premi | 2de0bae | 2011-02-25 18:57:20 +0530 | [diff] [blame] | 55 | if (omap3_has_iva()) |
Benoit Cousson | 766e7af | 2011-08-16 15:03:59 +0200 | [diff] [blame] | 56 | _init_omap_device("iva"); |
Sanjeev Premi | 2de0bae | 2011-02-25 18:57:20 +0530 | [diff] [blame] | 57 | |
Benoit Cousson | cbf2766 | 2010-08-05 15:22:35 +0200 | [diff] [blame] | 58 | if (cpu_is_omap44xx()) { |
Benoit Cousson | 766e7af | 2011-08-16 15:03:59 +0200 | [diff] [blame] | 59 | _init_omap_device("l3_main_1"); |
| 60 | _init_omap_device("dsp"); |
| 61 | _init_omap_device("iva"); |
Benoit Cousson | cbf2766 | 2010-08-05 15:22:35 +0200 | [diff] [blame] | 62 | } else { |
Benoit Cousson | 766e7af | 2011-08-16 15:03:59 +0200 | [diff] [blame] | 63 | _init_omap_device("l3_main"); |
Benoit Cousson | cbf2766 | 2010-08-05 15:22:35 +0200 | [diff] [blame] | 64 | } |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 65 | } |
| 66 | |
Rajendra Nayak | 71a488d | 2010-12-21 22:37:27 -0700 | [diff] [blame] | 67 | /* Types of sleep_switch used in omap_set_pwrdm_state */ |
| 68 | #define FORCEWAKEUP_SWITCH 0 |
| 69 | #define LOWPOWERSTATE_SWITCH 1 |
| 70 | |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 71 | /* |
| 72 | * This sets pwrdm state (other than mpu & core. Currently only ON & |
Rajendra Nayak | 33de32b | 2010-12-21 22:37:28 -0700 | [diff] [blame] | 73 | * RET are supported. |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 74 | */ |
| 75 | int omap_set_pwrdm_state(struct powerdomain *pwrdm, u32 state) |
| 76 | { |
| 77 | u32 cur_state; |
Rajendra Nayak | 6349b96 | 2011-07-09 20:42:11 -0600 | [diff] [blame] | 78 | int sleep_switch = -1; |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 79 | int ret = 0; |
Rajendra Nayak | b86cfb5 | 2011-07-10 05:56:54 -0600 | [diff] [blame] | 80 | int hwsup = 0; |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 81 | |
| 82 | if (pwrdm == NULL || IS_ERR(pwrdm)) |
| 83 | return -EINVAL; |
| 84 | |
| 85 | while (!(pwrdm->pwrsts & (1 << state))) { |
| 86 | if (state == PWRDM_POWER_OFF) |
| 87 | return ret; |
| 88 | state--; |
| 89 | } |
| 90 | |
| 91 | cur_state = pwrdm_read_next_pwrst(pwrdm); |
| 92 | if (cur_state == state) |
| 93 | return ret; |
| 94 | |
| 95 | if (pwrdm_read_pwrst(pwrdm) < PWRDM_POWER_ON) { |
Rajendra Nayak | 71a488d | 2010-12-21 22:37:27 -0700 | [diff] [blame] | 96 | if ((pwrdm_read_pwrst(pwrdm) > state) && |
| 97 | (pwrdm->flags & PWRDM_HAS_LOWPOWERSTATECHANGE)) { |
| 98 | sleep_switch = LOWPOWERSTATE_SWITCH; |
| 99 | } else { |
Rajendra Nayak | b86cfb5 | 2011-07-10 05:56:54 -0600 | [diff] [blame] | 100 | hwsup = clkdm_in_hwsup(pwrdm->pwrdm_clkdms[0]); |
Rajendra Nayak | 68b921a | 2011-02-25 16:06:47 -0700 | [diff] [blame] | 101 | clkdm_wakeup(pwrdm->pwrdm_clkdms[0]); |
Rajendra Nayak | 71a488d | 2010-12-21 22:37:27 -0700 | [diff] [blame] | 102 | sleep_switch = FORCEWAKEUP_SWITCH; |
| 103 | } |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 104 | } |
| 105 | |
| 106 | ret = pwrdm_set_next_pwrst(pwrdm, state); |
| 107 | if (ret) { |
Johan Hovold | e9a5190 | 2011-08-30 18:48:17 +0200 | [diff] [blame] | 108 | pr_err("%s: unable to set state of powerdomain: %s\n", |
| 109 | __func__, pwrdm->name); |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 110 | goto err; |
| 111 | } |
| 112 | |
Rajendra Nayak | 71a488d | 2010-12-21 22:37:27 -0700 | [diff] [blame] | 113 | switch (sleep_switch) { |
| 114 | case FORCEWAKEUP_SWITCH: |
Rajendra Nayak | b86cfb5 | 2011-07-10 05:56:54 -0600 | [diff] [blame] | 115 | if (hwsup) |
Rajendra Nayak | 5cd1937 | 2011-02-25 16:06:48 -0700 | [diff] [blame] | 116 | clkdm_allow_idle(pwrdm->pwrdm_clkdms[0]); |
Rajendra Nayak | 33de32b | 2010-12-21 22:37:28 -0700 | [diff] [blame] | 117 | else |
Rajendra Nayak | 68b921a | 2011-02-25 16:06:47 -0700 | [diff] [blame] | 118 | clkdm_sleep(pwrdm->pwrdm_clkdms[0]); |
Rajendra Nayak | 71a488d | 2010-12-21 22:37:27 -0700 | [diff] [blame] | 119 | break; |
| 120 | case LOWPOWERSTATE_SWITCH: |
| 121 | pwrdm_set_lowpwrstchange(pwrdm); |
| 122 | break; |
| 123 | default: |
| 124 | return ret; |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 125 | } |
| 126 | |
Rajendra Nayak | 71a488d | 2010-12-21 22:37:27 -0700 | [diff] [blame] | 127 | pwrdm_state_switch(pwrdm); |
Santosh Shilimkar | eb6a2c7 | 2010-09-15 01:04:01 +0530 | [diff] [blame] | 128 | err: |
| 129 | return ret; |
| 130 | } |
| 131 | |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 132 | /* |
Johan Hovold | 1e2d2df | 2011-08-30 18:48:16 +0200 | [diff] [blame] | 133 | * This API is to be called during init to set the various voltage |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 134 | * domains to the voltage as per the opp table. Typically we boot up |
| 135 | * at the nominal voltage. So this function finds out the rate of |
| 136 | * the clock associated with the voltage domain, finds out the correct |
Johan Hovold | 1e2d2df | 2011-08-30 18:48:16 +0200 | [diff] [blame] | 137 | * opp entry and sets the voltage domain to the voltage specified |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 138 | * in the opp entry |
| 139 | */ |
| 140 | static int __init omap2_set_init_voltage(char *vdd_name, char *clk_name, |
Benoit Cousson | 0f7aa00 | 2011-08-16 15:02:20 +0200 | [diff] [blame] | 141 | const char *oh_name) |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 142 | { |
| 143 | struct voltagedomain *voltdm; |
| 144 | struct clk *clk; |
| 145 | struct opp *opp; |
| 146 | unsigned long freq, bootup_volt; |
Benoit Cousson | 0f7aa00 | 2011-08-16 15:02:20 +0200 | [diff] [blame] | 147 | struct device *dev; |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 148 | |
Benoit Cousson | 0f7aa00 | 2011-08-16 15:02:20 +0200 | [diff] [blame] | 149 | if (!vdd_name || !clk_name || !oh_name) { |
Johan Hovold | e9a5190 | 2011-08-30 18:48:17 +0200 | [diff] [blame] | 150 | pr_err("%s: invalid parameters\n", __func__); |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 151 | goto exit; |
| 152 | } |
| 153 | |
Benoit Cousson | 0f7aa00 | 2011-08-16 15:02:20 +0200 | [diff] [blame] | 154 | dev = omap_device_get_by_hwmod_name(oh_name); |
| 155 | if (IS_ERR(dev)) { |
| 156 | pr_err("%s: Unable to get dev pointer for hwmod %s\n", |
| 157 | __func__, oh_name); |
| 158 | goto exit; |
| 159 | } |
| 160 | |
Kevin Hilman | 81a6048 | 2011-03-16 14:25:45 -0700 | [diff] [blame] | 161 | voltdm = voltdm_lookup(vdd_name); |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 162 | if (IS_ERR(voltdm)) { |
Johan Hovold | e9a5190 | 2011-08-30 18:48:17 +0200 | [diff] [blame] | 163 | pr_err("%s: unable to get vdd pointer for vdd_%s\n", |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 164 | __func__, vdd_name); |
| 165 | goto exit; |
| 166 | } |
| 167 | |
| 168 | clk = clk_get(NULL, clk_name); |
| 169 | if (IS_ERR(clk)) { |
Johan Hovold | e9a5190 | 2011-08-30 18:48:17 +0200 | [diff] [blame] | 170 | pr_err("%s: unable to get clk %s\n", __func__, clk_name); |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 171 | goto exit; |
| 172 | } |
| 173 | |
| 174 | freq = clk->rate; |
| 175 | clk_put(clk); |
| 176 | |
NeilBrown | 6369fd4 | 2012-01-09 13:14:12 +1100 | [diff] [blame] | 177 | rcu_read_lock(); |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 178 | opp = opp_find_freq_ceil(dev, &freq); |
| 179 | if (IS_ERR(opp)) { |
NeilBrown | 6369fd4 | 2012-01-09 13:14:12 +1100 | [diff] [blame] | 180 | rcu_read_unlock(); |
Johan Hovold | e9a5190 | 2011-08-30 18:48:17 +0200 | [diff] [blame] | 181 | pr_err("%s: unable to find boot up OPP for vdd_%s\n", |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 182 | __func__, vdd_name); |
| 183 | goto exit; |
| 184 | } |
| 185 | |
| 186 | bootup_volt = opp_get_voltage(opp); |
NeilBrown | 6369fd4 | 2012-01-09 13:14:12 +1100 | [diff] [blame] | 187 | rcu_read_unlock(); |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 188 | if (!bootup_volt) { |
Johan Hovold | e9a5190 | 2011-08-30 18:48:17 +0200 | [diff] [blame] | 189 | pr_err("%s: unable to find voltage corresponding " |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 190 | "to the bootup OPP for vdd_%s\n", __func__, vdd_name); |
| 191 | goto exit; |
| 192 | } |
| 193 | |
Kevin Hilman | 5e5651b | 2011-04-05 16:27:21 -0700 | [diff] [blame] | 194 | voltdm_scale(voltdm, bootup_volt); |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 195 | return 0; |
| 196 | |
| 197 | exit: |
Johan Hovold | e9a5190 | 2011-08-30 18:48:17 +0200 | [diff] [blame] | 198 | pr_err("%s: unable to set vdd_%s\n", __func__, vdd_name); |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 199 | return -EINVAL; |
| 200 | } |
| 201 | |
| 202 | static void __init omap3_init_voltages(void) |
| 203 | { |
| 204 | if (!cpu_is_omap34xx()) |
| 205 | return; |
| 206 | |
Benoit Cousson | 0f7aa00 | 2011-08-16 15:02:20 +0200 | [diff] [blame] | 207 | omap2_set_init_voltage("mpu_iva", "dpll1_ck", "mpu"); |
| 208 | omap2_set_init_voltage("core", "l3_ick", "l3_main"); |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 209 | } |
| 210 | |
Thara Gopinath | 1376ee1 | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 211 | static void __init omap4_init_voltages(void) |
| 212 | { |
| 213 | if (!cpu_is_omap44xx()) |
| 214 | return; |
| 215 | |
Benoit Cousson | 0f7aa00 | 2011-08-16 15:02:20 +0200 | [diff] [blame] | 216 | omap2_set_init_voltage("mpu", "dpll_mpu_ck", "mpu"); |
| 217 | omap2_set_init_voltage("core", "l3_div_ck", "l3_main_1"); |
| 218 | omap2_set_init_voltage("iva", "dpll_iva_m5x2_ck", "iva"); |
Thara Gopinath | 1376ee1 | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 219 | } |
| 220 | |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 221 | static int __init omap2_common_pm_init(void) |
| 222 | { |
Benoit Cousson | 476b679 | 2011-08-16 11:49:08 +0200 | [diff] [blame] | 223 | if (!of_have_populated_dt()) |
| 224 | omap2_init_processor_devices(); |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 225 | omap_pm_if_init(); |
| 226 | |
| 227 | return 0; |
| 228 | } |
Thara Gopinath | 1cbbe37 | 2010-12-20 21:17:21 +0530 | [diff] [blame] | 229 | postcore_initcall(omap2_common_pm_init); |
Kevin Hilman | 6f88e9b | 2010-07-26 16:34:31 -0600 | [diff] [blame] | 230 | |
Thara Gopinath | 2f34ce8 | 2010-05-29 22:02:21 +0530 | [diff] [blame] | 231 | static int __init omap2_common_pm_late_init(void) |
| 232 | { |
Thara Gopinath | fbc319f | 2010-12-10 22:51:05 +0530 | [diff] [blame] | 233 | /* Init the voltage layer */ |
Kevin Hilman | 46232a3 | 2011-11-23 14:43:01 -0800 | [diff] [blame] | 234 | omap_pmic_late_init(); |
Thara Gopinath | 2f34ce8 | 2010-05-29 22:02:21 +0530 | [diff] [blame] | 235 | omap_voltage_late_init(); |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 236 | |
| 237 | /* Initialize the voltages */ |
| 238 | omap3_init_voltages(); |
Thara Gopinath | 1376ee1 | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 239 | omap4_init_voltages(); |
Thara Gopinath | 1482d8b | 2010-05-29 22:02:25 +0530 | [diff] [blame] | 240 | |
Thara Gopinath | fbc319f | 2010-12-10 22:51:05 +0530 | [diff] [blame] | 241 | /* Smartreflex device init */ |
Thara Gopinath | 0c0a5d6 | 2010-05-29 22:02:23 +0530 | [diff] [blame] | 242 | omap_devinit_smartreflex(); |
Thara Gopinath | 2f34ce8 | 2010-05-29 22:02:21 +0530 | [diff] [blame] | 243 | |
| 244 | return 0; |
| 245 | } |
| 246 | late_initcall(omap2_common_pm_late_init); |