1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include <linux/suspend.h>
22#include <linux/sched.h>
23#include <linux/proc_fs.h>
24#include <linux/interrupt.h>
25#include <linux/sysfs.h>
26#include <linux/module.h>
27#include <linux/delay.h>
28#include <linux/clk.h>
29#include <linux/irq.h>
30#include <linux/time.h>
31#include <linux/gpio.h>
32
33#include <asm/mach/time.h>
34#include <asm/mach/irq.h>
35#include <asm/mach-types.h>
36#include <asm/system_misc.h>
37
38#include <plat/clock.h>
39#include <plat/sram.h>
40#include <plat/dma.h>
41#include <plat/board.h>
42
43#include <mach/irqs.h>
44
45#include "common.h"
46#include "prm2xxx_3xxx.h"
47#include "prm-regbits-24xx.h"
48#include "cm2xxx_3xxx.h"
49#include "cm-regbits-24xx.h"
50#include "sdrc.h"
51#include "pm.h"
52#include "control.h"
53#include "powerdomain.h"
54#include "clockdomain.h"
55
56static void (*omap2_sram_idle)(void);
57static void (*omap2_sram_suspend)(u32 dllctrl, void __iomem *sdrc_dlla_ctrl,
58 void __iomem *sdrc_power);
59
60static struct powerdomain *mpu_pwrdm, *core_pwrdm;
61static struct clockdomain *dsp_clkdm, *mpu_clkdm, *wkup_clkdm, *gfx_clkdm;
62
63static struct clk *osc_ck, *emul_ck;
64
65static int omap2_fclks_active(void)
66{
67 u32 f1, f2;
68
69 f1 = omap2_cm_read_mod_reg(CORE_MOD, CM_FCLKEN1);
70 f2 = omap2_cm_read_mod_reg(CORE_MOD, OMAP24XX_CM_FCLKEN2);
71
72 return (f1 | f2) ? 1 : 0;
73}
74
75static int omap2_enter_full_retention(void)
76{
77 u32 l;
78
79
80
81
82
83
84 clk_disable(osc_ck);
85
86
87
88 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, PM_WKST1);
89 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP24XX_PM_WKST2);
90 omap2_prm_write_mod_reg(0xffffffff, WKUP_MOD, PM_WKST);
91
92
93
94
95
96 pwrdm_set_logic_retst(mpu_pwrdm, PWRDM_POWER_RET);
97 pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_RET);
98
99
100 l = omap_ctrl_readl(OMAP2_CONTROL_DEVCONF0) | OMAP24XX_USBSTANDBYCTRL;
101 omap_ctrl_writel(l, OMAP2_CONTROL_DEVCONF0);
102
103 omap2_gpio_prepare_for_idle(0);
104
105
106
107 if (omap_irq_pending())
108 goto no_sleep;
109
110
111 omap2_sram_suspend(sdrc_read_reg(SDRC_DLLA_CTRL),
112 OMAP_SDRC_REGADDR(SDRC_DLLA_CTRL),
113 OMAP_SDRC_REGADDR(SDRC_POWER));
114
115no_sleep:
116 omap2_gpio_resume_after_idle();
117
118 clk_enable(osc_ck);
119
120
121 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, PM_WKST1);
122 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP24XX_PM_WKST2);
123
124
125 omap2_prm_clear_mod_reg_bits(0x4 | 0x1, WKUP_MOD, PM_WKST);
126
127
128 l = omap2_prm_read_mod_reg(OCP_MOD, OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
129 if (l & 0x01)
130 omap2_prm_write_mod_reg(0x01, OCP_MOD,
131 OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
132 if (l & 0x20)
133 omap2_prm_write_mod_reg(0x20, OCP_MOD,
134 OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
135
136
137 omap2_prm_write_mod_reg(0x0, OCP_MOD, OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
138
139 return 0;
140}
141
142static int omap2_i2c_active(void)
143{
144 u32 l;
145
146 l = omap2_cm_read_mod_reg(CORE_MOD, CM_FCLKEN1);
147 return l & (OMAP2420_EN_I2C2_MASK | OMAP2420_EN_I2C1_MASK);
148}
149
150static int sti_console_enabled;
151
152static int omap2_allow_mpu_retention(void)
153{
154 u32 l;
155
156
157 l = omap2_cm_read_mod_reg(CORE_MOD, CM_FCLKEN1);
158 if (l & (OMAP2420_EN_MMC_MASK | OMAP24XX_EN_UART2_MASK |
159 OMAP24XX_EN_UART1_MASK | OMAP24XX_EN_MCSPI2_MASK |
160 OMAP24XX_EN_MCSPI1_MASK | OMAP24XX_EN_DSS1_MASK))
161 return 0;
162
163 l = omap2_cm_read_mod_reg(CORE_MOD, OMAP24XX_CM_FCLKEN2);
164 if (l & OMAP24XX_EN_UART3_MASK)
165 return 0;
166 if (sti_console_enabled)
167 return 0;
168
169 return 1;
170}
171
172static void omap2_enter_mpu_retention(void)
173{
174
175
176 if (omap2_i2c_active())
177 return;
178
179
180
181 if (omap2_allow_mpu_retention()) {
182
183 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, PM_WKST1);
184 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP24XX_PM_WKST2);
185 omap2_prm_write_mod_reg(0xffffffff, WKUP_MOD, PM_WKST);
186
187
188 omap2_prm_write_mod_reg((0x01 << OMAP_POWERSTATE_SHIFT) |
189 OMAP_LOGICRETSTATE_MASK,
190 MPU_MOD, OMAP2_PM_PWSTCTRL);
191 } else {
192
193
194 omap2_prm_write_mod_reg(OMAP_LOGICRETSTATE_MASK, MPU_MOD,
195 OMAP2_PM_PWSTCTRL);
196 }
197
198 omap2_sram_idle();
199}
200
201static int omap2_can_sleep(void)
202{
203 if (omap2_fclks_active())
204 return 0;
205 if (osc_ck->usecount > 1)
206 return 0;
207 if (omap_dma_running())
208 return 0;
209
210 return 1;
211}
212
213static void omap2_pm_idle(void)
214{
215 local_fiq_disable();
216
217 if (!omap2_can_sleep()) {
218 if (omap_irq_pending())
219 goto out;
220 omap2_enter_mpu_retention();
221 goto out;
222 }
223
224 if (omap_irq_pending())
225 goto out;
226
227 omap2_enter_full_retention();
228
229out:
230 local_fiq_enable();
231}
232
233static void __init prcm_setup_regs(void)
234{
235 int i, num_mem_banks;
236 struct powerdomain *pwrdm;
237
238
239
240
241
242 omap2_prm_write_mod_reg(OMAP24XX_AUTOIDLE_MASK, OCP_MOD,
243 OMAP2_PRCM_SYSCONFIG_OFFSET);
244
245
246
247
248
249 num_mem_banks = pwrdm_get_mem_bank_count(core_pwrdm);
250 for (i = 0; i < num_mem_banks; i++)
251 pwrdm_set_mem_retst(core_pwrdm, i, PWRDM_POWER_RET);
252
253
254 pwrdm_set_next_pwrst(core_pwrdm, PWRDM_POWER_RET);
255
256
257
258
259
260 pwrdm_set_logic_retst(mpu_pwrdm, PWRDM_POWER_RET);
261 pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_RET);
262
263
264
265 pwrdm = clkdm_get_pwrdm(dsp_clkdm);
266 pwrdm_set_next_pwrst(pwrdm, PWRDM_POWER_OFF);
267 clkdm_sleep(dsp_clkdm);
268
269 pwrdm = clkdm_get_pwrdm(gfx_clkdm);
270 pwrdm_set_next_pwrst(pwrdm, PWRDM_POWER_OFF);
271 clkdm_sleep(gfx_clkdm);
272
273
274 clkdm_for_each(omap_pm_clkdms_setup, NULL);
275 clkdm_add_wkdep(mpu_clkdm, wkup_clkdm);
276
277#ifdef CONFIG_SUSPEND
278 omap_pm_suspend = omap2_enter_full_retention;
279#endif
280
281
282
283 omap2_prm_write_mod_reg(15 << OMAP_SETUP_TIME_SHIFT, OMAP24XX_GR_MOD,
284 OMAP2_PRCM_CLKSSETUP_OFFSET);
285
286
287 omap2_prm_write_mod_reg(2 << OMAP_SETUP_TIME_SHIFT, OMAP24XX_GR_MOD,
288 OMAP2_PRCM_VOLTSETUP_OFFSET);
289 omap2_prm_write_mod_reg(OMAP24XX_AUTO_EXTVOLT_MASK |
290 (0x1 << OMAP24XX_SETOFF_LEVEL_SHIFT) |
291 OMAP24XX_MEMRETCTRL_MASK |
292 (0x1 << OMAP24XX_SETRET_LEVEL_SHIFT) |
293 (0x0 << OMAP24XX_VOLT_LEVEL_SHIFT),
294 OMAP24XX_GR_MOD, OMAP2_PRCM_VOLTCTRL_OFFSET);
295
296
297 omap2_prm_write_mod_reg(OMAP24XX_EN_GPIOS_MASK | OMAP24XX_EN_GPT1_MASK,
298 WKUP_MOD, PM_WKEN);
299}
300
301int __init omap2_pm_init(void)
302{
303 u32 l;
304
305 printk(KERN_INFO "Power Management for OMAP2 initializing\n");
306 l = omap2_prm_read_mod_reg(OCP_MOD, OMAP2_PRCM_REVISION_OFFSET);
307 printk(KERN_INFO "PRCM revision %d.%d\n", (l >> 4) & 0x0f, l & 0x0f);
308
309
310
311 mpu_pwrdm = pwrdm_lookup("mpu_pwrdm");
312 if (!mpu_pwrdm)
313 pr_err("PM: mpu_pwrdm not found\n");
314
315 core_pwrdm = pwrdm_lookup("core_pwrdm");
316 if (!core_pwrdm)
317 pr_err("PM: core_pwrdm not found\n");
318
319
320
321 mpu_clkdm = clkdm_lookup("mpu_clkdm");
322 if (!mpu_clkdm)
323 pr_err("PM: mpu_clkdm not found\n");
324
325 wkup_clkdm = clkdm_lookup("wkup_clkdm");
326 if (!wkup_clkdm)
327 pr_err("PM: wkup_clkdm not found\n");
328
329 dsp_clkdm = clkdm_lookup("dsp_clkdm");
330 if (!dsp_clkdm)
331 pr_err("PM: dsp_clkdm not found\n");
332
333 gfx_clkdm = clkdm_lookup("gfx_clkdm");
334 if (!gfx_clkdm)
335 pr_err("PM: gfx_clkdm not found\n");
336
337
338 osc_ck = clk_get(NULL, "osc_ck");
339 if (IS_ERR(osc_ck)) {
340 printk(KERN_ERR "could not get osc_ck\n");
341 return -ENODEV;
342 }
343
344 if (cpu_is_omap242x()) {
345 emul_ck = clk_get(NULL, "emul_ck");
346 if (IS_ERR(emul_ck)) {
347 printk(KERN_ERR "could not get emul_ck\n");
348 clk_put(osc_ck);
349 return -ENODEV;
350 }
351 }
352
353 prcm_setup_regs();
354
355
356 {
357 const struct omap_sti_console_config *sti;
358
359 sti = omap_get_config(OMAP_TAG_STI_CONSOLE,
360 struct omap_sti_console_config);
361 if (sti != NULL && sti->enable)
362 sti_console_enabled = 1;
363 }
364
365
366
367
368
369
370 omap2_sram_idle = omap_sram_push(omap24xx_idle_loop_suspend,
371 omap24xx_idle_loop_suspend_sz);
372
373 omap2_sram_suspend = omap_sram_push(omap24xx_cpu_suspend,
374 omap24xx_cpu_suspend_sz);
375
376 arm_pm_idle = omap2_pm_idle;
377
378 return 0;
379}
380