pm.c revision 0f7aa005c85917f114c376e937d88f5d941fb389
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> 16#include <linux/opp.h> 17 18#include <plat/omap-pm.h> 19#include <plat/omap_device.h> 20#include <plat/common.h> 21 22#include "voltage.h" 23#include "powerdomain.h" 24#include "clockdomain.h" 25#include "pm.h" 26 27static struct omap_device_pm_latency *pm_lats; 28 29static struct device *mpu_dev; 30static struct device *iva_dev; 31static struct device *l3_dev; 32static struct device *dsp_dev; 33 34struct device *omap2_get_mpuss_device(void) 35{ 36 WARN_ON_ONCE(!mpu_dev); 37 return mpu_dev; 38} 39 40struct device *omap2_get_iva_device(void) 41{ 42 WARN_ON_ONCE(!iva_dev); 43 return iva_dev; 44} 45 46struct device *omap2_get_l3_device(void) 47{ 48 WARN_ON_ONCE(!l3_dev); 49 return l3_dev; 50} 51 52struct device *omap4_get_dsp_device(void) 53{ 54 WARN_ON_ONCE(!dsp_dev); 55 return dsp_dev; 56} 57EXPORT_SYMBOL(omap4_get_dsp_device); 58 59/* static int _init_omap_device(struct omap_hwmod *oh, void *user) */ 60static int _init_omap_device(char *name, struct device **new_dev) 61{ 62 struct omap_hwmod *oh; 63 struct platform_device *pdev; 64 65 oh = omap_hwmod_lookup(name); 66 if (WARN(!oh, "%s: could not find omap_hwmod for %s\n", 67 __func__, name)) 68 return -ENODEV; 69 70 pdev = omap_device_build(oh->name, 0, oh, NULL, 0, pm_lats, 0, false); 71 if (WARN(IS_ERR(pdev), "%s: could not build omap_device for %s\n", 72 __func__, name)) 73 return -ENODEV; 74 75 *new_dev = &pdev->dev; 76 77 return 0; 78} 79 80/* 81 * Build omap_devices for processors and bus. 82 */ 83static void omap2_init_processor_devices(void) 84{ 85 _init_omap_device("mpu", &mpu_dev); 86 if (omap3_has_iva()) 87 _init_omap_device("iva", &iva_dev); 88 89 if (cpu_is_omap44xx()) { 90 _init_omap_device("l3_main_1", &l3_dev); 91 _init_omap_device("dsp", &dsp_dev); 92 _init_omap_device("iva", &iva_dev); 93 } else { 94 _init_omap_device("l3_main", &l3_dev); 95 } 96} 97 98/* Types of sleep_switch used in omap_set_pwrdm_state */ 99#define FORCEWAKEUP_SWITCH 0 100#define LOWPOWERSTATE_SWITCH 1 101 102/* 103 * This sets pwrdm state (other than mpu & core. Currently only ON & 104 * RET are supported. 105 */ 106int omap_set_pwrdm_state(struct powerdomain *pwrdm, u32 state) 107{ 108 u32 cur_state; 109 int sleep_switch = -1; 110 int ret = 0; 111 int hwsup = 0; 112 113 if (pwrdm == NULL || IS_ERR(pwrdm)) 114 return -EINVAL; 115 116 while (!(pwrdm->pwrsts & (1 << state))) { 117 if (state == PWRDM_POWER_OFF) 118 return ret; 119 state--; 120 } 121 122 cur_state = pwrdm_read_next_pwrst(pwrdm); 123 if (cur_state == state) 124 return ret; 125 126 if (pwrdm_read_pwrst(pwrdm) < PWRDM_POWER_ON) { 127 if ((pwrdm_read_pwrst(pwrdm) > state) && 128 (pwrdm->flags & PWRDM_HAS_LOWPOWERSTATECHANGE)) { 129 sleep_switch = LOWPOWERSTATE_SWITCH; 130 } else { 131 hwsup = clkdm_in_hwsup(pwrdm->pwrdm_clkdms[0]); 132 clkdm_wakeup(pwrdm->pwrdm_clkdms[0]); 133 sleep_switch = FORCEWAKEUP_SWITCH; 134 } 135 } 136 137 ret = pwrdm_set_next_pwrst(pwrdm, state); 138 if (ret) { 139 pr_err("%s: unable to set state of powerdomain: %s\n", 140 __func__, pwrdm->name); 141 goto err; 142 } 143 144 switch (sleep_switch) { 145 case FORCEWAKEUP_SWITCH: 146 if (hwsup) 147 clkdm_allow_idle(pwrdm->pwrdm_clkdms[0]); 148 else 149 clkdm_sleep(pwrdm->pwrdm_clkdms[0]); 150 break; 151 case LOWPOWERSTATE_SWITCH: 152 pwrdm_set_lowpwrstchange(pwrdm); 153 break; 154 default: 155 return ret; 156 } 157 158 pwrdm_state_switch(pwrdm); 159err: 160 return ret; 161} 162 163/* 164 * This API is to be called during init to set the various voltage 165 * domains to the voltage as per the opp table. Typically we boot up 166 * at the nominal voltage. So this function finds out the rate of 167 * the clock associated with the voltage domain, finds out the correct 168 * opp entry and sets the voltage domain to the voltage specified 169 * in the opp entry 170 */ 171static int __init omap2_set_init_voltage(char *vdd_name, char *clk_name, 172 const char *oh_name) 173{ 174 struct voltagedomain *voltdm; 175 struct clk *clk; 176 struct opp *opp; 177 unsigned long freq, bootup_volt; 178 struct device *dev; 179 180 if (!vdd_name || !clk_name || !oh_name) { 181 pr_err("%s: invalid parameters\n", __func__); 182 goto exit; 183 } 184 185 dev = omap_device_get_by_hwmod_name(oh_name); 186 if (IS_ERR(dev)) { 187 pr_err("%s: Unable to get dev pointer for hwmod %s\n", 188 __func__, oh_name); 189 goto exit; 190 } 191 192 voltdm = voltdm_lookup(vdd_name); 193 if (IS_ERR(voltdm)) { 194 pr_err("%s: unable to get vdd pointer for vdd_%s\n", 195 __func__, vdd_name); 196 goto exit; 197 } 198 199 clk = clk_get(NULL, clk_name); 200 if (IS_ERR(clk)) { 201 pr_err("%s: unable to get clk %s\n", __func__, clk_name); 202 goto exit; 203 } 204 205 freq = clk->rate; 206 clk_put(clk); 207 208 opp = opp_find_freq_ceil(dev, &freq); 209 if (IS_ERR(opp)) { 210 pr_err("%s: unable to find boot up OPP for vdd_%s\n", 211 __func__, vdd_name); 212 goto exit; 213 } 214 215 bootup_volt = opp_get_voltage(opp); 216 if (!bootup_volt) { 217 pr_err("%s: unable to find voltage corresponding " 218 "to the bootup OPP for vdd_%s\n", __func__, vdd_name); 219 goto exit; 220 } 221 222 voltdm_scale(voltdm, bootup_volt); 223 return 0; 224 225exit: 226 pr_err("%s: unable to set vdd_%s\n", __func__, vdd_name); 227 return -EINVAL; 228} 229 230static void __init omap3_init_voltages(void) 231{ 232 if (!cpu_is_omap34xx()) 233 return; 234 235 omap2_set_init_voltage("mpu_iva", "dpll1_ck", "mpu"); 236 omap2_set_init_voltage("core", "l3_ick", "l3_main"); 237} 238 239static void __init omap4_init_voltages(void) 240{ 241 if (!cpu_is_omap44xx()) 242 return; 243 244 omap2_set_init_voltage("mpu", "dpll_mpu_ck", "mpu"); 245 omap2_set_init_voltage("core", "l3_div_ck", "l3_main_1"); 246 omap2_set_init_voltage("iva", "dpll_iva_m5x2_ck", "iva"); 247} 248 249static int __init omap2_common_pm_init(void) 250{ 251 omap2_init_processor_devices(); 252 omap_pm_if_init(); 253 254 return 0; 255} 256postcore_initcall(omap2_common_pm_init); 257 258static int __init omap2_common_pm_late_init(void) 259{ 260 /* Init the OMAP TWL parameters */ 261 omap3_twl_init(); 262 omap4_twl_init(); 263 264 /* Init the voltage layer */ 265 omap_voltage_late_init(); 266 267 /* Initialize the voltages */ 268 omap3_init_voltages(); 269 omap4_init_voltages(); 270 271 /* Smartreflex device init */ 272 omap_devinit_smartreflex(); 273 274 return 0; 275} 276late_initcall(omap2_common_pm_late_init); 277