Loading...
1/*
2 * OMAP2 Power Management Routines
3 *
4 * Copyright (C) 2005 Texas Instruments, Inc.
5 * Copyright (C) 2006-2008 Nokia Corporation
6 *
7 * Written by:
8 * Richard Woodruff <r-woodruff2@ti.com>
9 * Tony Lindgren
10 * Juha Yrjola
11 * Amit Kucheria <amit.kucheria@nokia.com>
12 * Igor Stoppa <igor.stoppa@nokia.com>
13 *
14 * Based on pm.c for omap1
15 *
16 * This program is free software; you can redistribute it and/or modify
17 * it under the terms of the GNU General Public License version 2 as
18 * published by the Free Software Foundation.
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 /* There is 1 reference hold for all children of the oscillator
80 * clock, the following will remove it. If no one else uses the
81 * oscillator itself it will be disabled if/when we enter retention
82 * mode.
83 */
84 clk_disable(osc_ck);
85
86 /* Clear old wake-up events */
87 /* REVISIT: These write to reserved bits? */
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 * Set MPU powerdomain's next power state to RETENTION;
94 * preserve logic state during retention
95 */
96 pwrdm_set_logic_retst(mpu_pwrdm, PWRDM_POWER_RET);
97 pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_RET);
98
99 /* Workaround to kill USB */
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 /* One last check for pending IRQs to avoid extra latency due
106 * to sleeping unnecessarily. */
107 if (omap_irq_pending())
108 goto no_sleep;
109
110 /* Jump to SRAM suspend code */
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 /* clear CORE wake-up events */
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 /* wakeup domain events - bit 1: GPT1, bit5 GPIO */
125 omap2_prm_clear_mod_reg_bits(0x4 | 0x1, WKUP_MOD, PM_WKST);
126
127 /* MPU domain wake events */
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 /* Mask future PRCM-to-MPU interrupts */
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 /* Check for MMC, UART2, UART1, McSPI2, McSPI1 and DSS1. */
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 /* Check for UART3. */
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 /* Putting MPU into the WFI state while a transfer is active
175 * seems to cause the I2C block to timeout. Why? Good question. */
176 if (omap2_i2c_active())
177 return;
178
179 /* The peripherals seem not to be able to wake up the MPU when
180 * it is in retention mode. */
181 if (omap2_allow_mpu_retention()) {
182 /* REVISIT: These write to reserved bits? */
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 /* Try to enter MPU retention */
188 omap2_prm_write_mod_reg((0x01 << OMAP_POWERSTATE_SHIFT) |
189 OMAP_LOGICRETSTATE_MASK,
190 MPU_MOD, OMAP2_PM_PWSTCTRL);
191 } else {
192 /* Block MPU retention */
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 * Enable autoidle
240 * XXX This should be handled by hwmod code or PRCM init code
241 */
242 omap2_prm_write_mod_reg(OMAP24XX_AUTOIDLE_MASK, OCP_MOD,
243 OMAP2_PRCM_SYSCONFIG_OFFSET);
244
245 /*
246 * Set CORE powerdomain memory banks to retain their contents
247 * during RETENTION
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 /* Set CORE powerdomain's next power state to RETENTION */
254 pwrdm_set_next_pwrst(core_pwrdm, PWRDM_POWER_RET);
255
256 /*
257 * Set MPU powerdomain's next power state to RETENTION;
258 * preserve logic state during retention
259 */
260 pwrdm_set_logic_retst(mpu_pwrdm, PWRDM_POWER_RET);
261 pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_RET);
262
263 /* Force-power down DSP, GFX powerdomains */
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 /* Enable hardware-supervised idle for all clkdms */
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 /* REVISIT: Configure number of 32 kHz clock cycles for sys_clk
282 * stabilisation */
283 omap2_prm_write_mod_reg(15 << OMAP_SETUP_TIME_SHIFT, OMAP24XX_GR_MOD,
284 OMAP2_PRCM_CLKSSETUP_OFFSET);
285
286 /* Configure automatic voltage transition */
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 /* Enable wake-up events */
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 /* Look up important powerdomains */
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 /* Look up important clockdomains */
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 /* Hack to prevent MPU retention when STI console is enabled. */
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 * We copy the assembler sleep/wakeup routines to SRAM.
367 * These routines need to be in SRAM as that's the only
368 * memory the MPU can see when it wakes up.
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}
1/*
2 * OMAP2 Power Management Routines
3 *
4 * Copyright (C) 2005 Texas Instruments, Inc.
5 * Copyright (C) 2006-2008 Nokia Corporation
6 *
7 * Written by:
8 * Richard Woodruff <r-woodruff2@ti.com>
9 * Tony Lindgren
10 * Juha Yrjola
11 * Amit Kucheria <amit.kucheria@nokia.com>
12 * Igor Stoppa <igor.stoppa@nokia.com>
13 *
14 * Based on pm.c for omap1
15 *
16 * This program is free software; you can redistribute it and/or modify
17 * it under the terms of the GNU General Public License version 2 as
18 * published by the Free Software Foundation.
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-provider.h>
29#include <linux/irq.h>
30#include <linux/time.h>
31#include <linux/gpio.h>
32#include <linux/platform_data/gpio-omap.h>
33
34#include <asm/fncpy.h>
35
36#include <asm/mach/time.h>
37#include <asm/mach/irq.h>
38#include <asm/mach-types.h>
39#include <asm/system_misc.h>
40
41#include <linux/omap-dma.h>
42
43#include "soc.h"
44#include "common.h"
45#include "clock.h"
46#include "prm2xxx.h"
47#include "prm-regbits-24xx.h"
48#include "cm2xxx.h"
49#include "cm-regbits-24xx.h"
50#include "sdrc.h"
51#include "sram.h"
52#include "pm.h"
53#include "control.h"
54#include "powerdomain.h"
55#include "clockdomain.h"
56
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_enter_full_retention(void)
66{
67 u32 l;
68
69 /* There is 1 reference hold for all children of the oscillator
70 * clock, the following will remove it. If no one else uses the
71 * oscillator itself it will be disabled if/when we enter retention
72 * mode.
73 */
74 clk_disable(osc_ck);
75
76 /* Clear old wake-up events */
77 /* REVISIT: These write to reserved bits? */
78 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, PM_WKST1);
79 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP24XX_PM_WKST2);
80 omap2_prm_write_mod_reg(0xffffffff, WKUP_MOD, PM_WKST);
81
82 pwrdm_set_next_pwrst(core_pwrdm, PWRDM_POWER_RET);
83 pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_RET);
84
85 /* Workaround to kill USB */
86 l = omap_ctrl_readl(OMAP2_CONTROL_DEVCONF0) | OMAP24XX_USBSTANDBYCTRL;
87 omap_ctrl_writel(l, OMAP2_CONTROL_DEVCONF0);
88
89 omap2_gpio_prepare_for_idle(0);
90
91 /* One last check for pending IRQs to avoid extra latency due
92 * to sleeping unnecessarily. */
93 if (omap_irq_pending())
94 goto no_sleep;
95
96 /* Jump to SRAM suspend code */
97 omap2_sram_suspend(sdrc_read_reg(SDRC_DLLA_CTRL),
98 OMAP_SDRC_REGADDR(SDRC_DLLA_CTRL),
99 OMAP_SDRC_REGADDR(SDRC_POWER));
100
101no_sleep:
102 omap2_gpio_resume_after_idle();
103
104 clk_enable(osc_ck);
105
106 /* clear CORE wake-up events */
107 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, PM_WKST1);
108 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP24XX_PM_WKST2);
109
110 /* wakeup domain events - bit 1: GPT1, bit5 GPIO */
111 omap2_prm_clear_mod_reg_bits(0x4 | 0x1, WKUP_MOD, PM_WKST);
112
113 /* MPU domain wake events */
114 l = omap2_prm_read_mod_reg(OCP_MOD, OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
115 if (l & 0x01)
116 omap2_prm_write_mod_reg(0x01, OCP_MOD,
117 OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
118 if (l & 0x20)
119 omap2_prm_write_mod_reg(0x20, OCP_MOD,
120 OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
121
122 /* Mask future PRCM-to-MPU interrupts */
123 omap2_prm_write_mod_reg(0x0, OCP_MOD, OMAP2_PRCM_IRQSTATUS_MPU_OFFSET);
124
125 pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_ON);
126 pwrdm_set_next_pwrst(core_pwrdm, PWRDM_POWER_ON);
127
128 return 0;
129}
130
131static int sti_console_enabled;
132
133static int omap2_allow_mpu_retention(void)
134{
135 if (!omap2xxx_cm_mpu_retention_allowed())
136 return 0;
137 if (sti_console_enabled)
138 return 0;
139
140 return 1;
141}
142
143static void omap2_enter_mpu_retention(void)
144{
145 const int zero = 0;
146
147 /* The peripherals seem not to be able to wake up the MPU when
148 * it is in retention mode. */
149 if (omap2_allow_mpu_retention()) {
150 /* REVISIT: These write to reserved bits? */
151 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, PM_WKST1);
152 omap2_prm_write_mod_reg(0xffffffff, CORE_MOD, OMAP24XX_PM_WKST2);
153 omap2_prm_write_mod_reg(0xffffffff, WKUP_MOD, PM_WKST);
154
155 /* Try to enter MPU retention */
156 pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_RET);
157
158 } else {
159 /* Block MPU retention */
160 pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_ON);
161 }
162
163 /* WFI */
164 asm("mcr p15, 0, %0, c7, c0, 4" : : "r" (zero) : "memory", "cc");
165
166 pwrdm_set_next_pwrst(mpu_pwrdm, PWRDM_POWER_ON);
167}
168
169static int omap2_can_sleep(void)
170{
171 if (omap2xxx_cm_fclks_active())
172 return 0;
173 if (__clk_is_enabled(osc_ck))
174 return 0;
175 if (omap_dma_running())
176 return 0;
177
178 return 1;
179}
180
181static void omap2_pm_idle(void)
182{
183 if (!omap2_can_sleep()) {
184 if (omap_irq_pending())
185 return;
186 omap2_enter_mpu_retention();
187 return;
188 }
189
190 if (omap_irq_pending())
191 return;
192
193 omap2_enter_full_retention();
194}
195
196static void __init prcm_setup_regs(void)
197{
198 int i, num_mem_banks;
199 struct powerdomain *pwrdm;
200
201 /*
202 * Enable autoidle
203 * XXX This should be handled by hwmod code or PRCM init code
204 */
205 omap2_prm_write_mod_reg(OMAP24XX_AUTOIDLE_MASK, OCP_MOD,
206 OMAP2_PRCM_SYSCONFIG_OFFSET);
207
208 /*
209 * Set CORE powerdomain memory banks to retain their contents
210 * during RETENTION
211 */
212 num_mem_banks = pwrdm_get_mem_bank_count(core_pwrdm);
213 for (i = 0; i < num_mem_banks; i++)
214 pwrdm_set_mem_retst(core_pwrdm, i, PWRDM_POWER_RET);
215
216 pwrdm_set_logic_retst(core_pwrdm, PWRDM_POWER_RET);
217
218 pwrdm_set_logic_retst(mpu_pwrdm, PWRDM_POWER_RET);
219
220 /* Force-power down DSP, GFX powerdomains */
221
222 pwrdm = clkdm_get_pwrdm(dsp_clkdm);
223 pwrdm_set_next_pwrst(pwrdm, PWRDM_POWER_OFF);
224
225 pwrdm = clkdm_get_pwrdm(gfx_clkdm);
226 pwrdm_set_next_pwrst(pwrdm, PWRDM_POWER_OFF);
227
228 /* Enable hardware-supervised idle for all clkdms */
229 clkdm_for_each(omap_pm_clkdms_setup, NULL);
230 clkdm_add_wkdep(mpu_clkdm, wkup_clkdm);
231
232#ifdef CONFIG_SUSPEND
233 omap_pm_suspend = omap2_enter_full_retention;
234#endif
235
236 /* REVISIT: Configure number of 32 kHz clock cycles for sys_clk
237 * stabilisation */
238 omap2_prm_write_mod_reg(15 << OMAP_SETUP_TIME_SHIFT, OMAP24XX_GR_MOD,
239 OMAP2_PRCM_CLKSSETUP_OFFSET);
240
241 /* Configure automatic voltage transition */
242 omap2_prm_write_mod_reg(2 << OMAP_SETUP_TIME_SHIFT, OMAP24XX_GR_MOD,
243 OMAP2_PRCM_VOLTSETUP_OFFSET);
244 omap2_prm_write_mod_reg(OMAP24XX_AUTO_EXTVOLT_MASK |
245 (0x1 << OMAP24XX_SETOFF_LEVEL_SHIFT) |
246 OMAP24XX_MEMRETCTRL_MASK |
247 (0x1 << OMAP24XX_SETRET_LEVEL_SHIFT) |
248 (0x0 << OMAP24XX_VOLT_LEVEL_SHIFT),
249 OMAP24XX_GR_MOD, OMAP2_PRCM_VOLTCTRL_OFFSET);
250
251 /* Enable wake-up events */
252 omap2_prm_write_mod_reg(OMAP24XX_EN_GPIOS_MASK | OMAP24XX_EN_GPT1_MASK,
253 WKUP_MOD, PM_WKEN);
254}
255
256int __init omap2_pm_init(void)
257{
258 u32 l;
259
260 printk(KERN_INFO "Power Management for OMAP2 initializing\n");
261 l = omap2_prm_read_mod_reg(OCP_MOD, OMAP2_PRCM_REVISION_OFFSET);
262 printk(KERN_INFO "PRCM revision %d.%d\n", (l >> 4) & 0x0f, l & 0x0f);
263
264 /* Look up important powerdomains */
265
266 mpu_pwrdm = pwrdm_lookup("mpu_pwrdm");
267 if (!mpu_pwrdm)
268 pr_err("PM: mpu_pwrdm not found\n");
269
270 core_pwrdm = pwrdm_lookup("core_pwrdm");
271 if (!core_pwrdm)
272 pr_err("PM: core_pwrdm not found\n");
273
274 /* Look up important clockdomains */
275
276 mpu_clkdm = clkdm_lookup("mpu_clkdm");
277 if (!mpu_clkdm)
278 pr_err("PM: mpu_clkdm not found\n");
279
280 wkup_clkdm = clkdm_lookup("wkup_clkdm");
281 if (!wkup_clkdm)
282 pr_err("PM: wkup_clkdm not found\n");
283
284 dsp_clkdm = clkdm_lookup("dsp_clkdm");
285 if (!dsp_clkdm)
286 pr_err("PM: dsp_clkdm not found\n");
287
288 gfx_clkdm = clkdm_lookup("gfx_clkdm");
289 if (!gfx_clkdm)
290 pr_err("PM: gfx_clkdm not found\n");
291
292
293 osc_ck = clk_get(NULL, "osc_ck");
294 if (IS_ERR(osc_ck)) {
295 printk(KERN_ERR "could not get osc_ck\n");
296 return -ENODEV;
297 }
298
299 if (cpu_is_omap242x()) {
300 emul_ck = clk_get(NULL, "emul_ck");
301 if (IS_ERR(emul_ck)) {
302 printk(KERN_ERR "could not get emul_ck\n");
303 clk_put(osc_ck);
304 return -ENODEV;
305 }
306 }
307
308 prcm_setup_regs();
309
310 /*
311 * We copy the assembler sleep/wakeup routines to SRAM.
312 * These routines need to be in SRAM as that's the only
313 * memory the MPU can see when it wakes up after the entire
314 * chip enters idle.
315 */
316 omap2_sram_suspend = omap_sram_push(omap24xx_cpu_suspend,
317 omap24xx_cpu_suspend_sz);
318
319 arm_pm_idle = omap2_pm_idle;
320
321 return 0;
322}