diff options
Diffstat (limited to 'arch/arm/mach-omap2/cm2xxx_3xxx.c')
-rw-r--r-- | arch/arm/mach-omap2/cm2xxx_3xxx.c | 557 |
1 files changed, 557 insertions, 0 deletions
diff --git a/arch/arm/mach-omap2/cm2xxx_3xxx.c b/arch/arm/mach-omap2/cm2xxx_3xxx.c new file mode 100644 index 00000000000..38830d8d478 --- /dev/null +++ b/arch/arm/mach-omap2/cm2xxx_3xxx.c | |||
@@ -0,0 +1,557 @@ | |||
1 | /* | ||
2 | * OMAP2/3 CM module functions | ||
3 | * | ||
4 | * Copyright (C) 2009 Nokia Corporation | ||
5 | * Paul Walmsley | ||
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/types.h> | ||
14 | #include <linux/delay.h> | ||
15 | #include <linux/spinlock.h> | ||
16 | #include <linux/list.h> | ||
17 | #include <linux/errno.h> | ||
18 | #include <linux/err.h> | ||
19 | #include <linux/io.h> | ||
20 | |||
21 | #include <plat/common.h> | ||
22 | |||
23 | #include "cm.h" | ||
24 | #include "cm2xxx_3xxx.h" | ||
25 | #include "cm-regbits-24xx.h" | ||
26 | #include "cm-regbits-34xx.h" | ||
27 | |||
28 | /* CM_AUTOIDLE_PLL.AUTO_* bit values for DPLLs */ | ||
29 | #define DPLL_AUTOIDLE_DISABLE 0x0 | ||
30 | #define OMAP2XXX_DPLL_AUTOIDLE_LOW_POWER_STOP 0x3 | ||
31 | |||
32 | /* CM_AUTOIDLE_PLL.AUTO_* bit values for APLLs (OMAP2xxx only) */ | ||
33 | #define OMAP2XXX_APLL_AUTOIDLE_DISABLE 0x0 | ||
34 | #define OMAP2XXX_APLL_AUTOIDLE_LOW_POWER_STOP 0x3 | ||
35 | |||
36 | static const u8 cm_idlest_offs[] = { | ||
37 | CM_IDLEST1, CM_IDLEST2, OMAP2430_CM_IDLEST3 | ||
38 | }; | ||
39 | |||
40 | u32 omap2_cm_read_mod_reg(s16 module, u16 idx) | ||
41 | { | ||
42 | return __raw_readl(cm_base + module + idx); | ||
43 | } | ||
44 | |||
45 | void omap2_cm_write_mod_reg(u32 val, s16 module, u16 idx) | ||
46 | { | ||
47 | __raw_writel(val, cm_base + module + idx); | ||
48 | } | ||
49 | |||
50 | /* Read-modify-write a register in a CM module. Caller must lock */ | ||
51 | u32 omap2_cm_rmw_mod_reg_bits(u32 mask, u32 bits, s16 module, s16 idx) | ||
52 | { | ||
53 | u32 v; | ||
54 | |||
55 | v = omap2_cm_read_mod_reg(module, idx); | ||
56 | v &= ~mask; | ||
57 | v |= bits; | ||
58 | omap2_cm_write_mod_reg(v, module, idx); | ||
59 | |||
60 | return v; | ||
61 | } | ||
62 | |||
63 | u32 omap2_cm_set_mod_reg_bits(u32 bits, s16 module, s16 idx) | ||
64 | { | ||
65 | return omap2_cm_rmw_mod_reg_bits(bits, bits, module, idx); | ||
66 | } | ||
67 | |||
68 | u32 omap2_cm_clear_mod_reg_bits(u32 bits, s16 module, s16 idx) | ||
69 | { | ||
70 | return omap2_cm_rmw_mod_reg_bits(bits, 0x0, module, idx); | ||
71 | } | ||
72 | |||
73 | /* | ||
74 | * | ||
75 | */ | ||
76 | |||
77 | static void _write_clktrctrl(u8 c, s16 module, u32 mask) | ||
78 | { | ||
79 | u32 v; | ||
80 | |||
81 | v = omap2_cm_read_mod_reg(module, OMAP2_CM_CLKSTCTRL); | ||
82 | v &= ~mask; | ||
83 | v |= c << __ffs(mask); | ||
84 | omap2_cm_write_mod_reg(v, module, OMAP2_CM_CLKSTCTRL); | ||
85 | } | ||
86 | |||
87 | bool omap2_cm_is_clkdm_in_hwsup(s16 module, u32 mask) | ||
88 | { | ||
89 | u32 v; | ||
90 | bool ret = 0; | ||
91 | |||
92 | BUG_ON(!cpu_is_omap24xx() && !cpu_is_omap34xx()); | ||
93 | |||
94 | v = omap2_cm_read_mod_reg(module, OMAP2_CM_CLKSTCTRL); | ||
95 | v &= mask; | ||
96 | v >>= __ffs(mask); | ||
97 | |||
98 | if (cpu_is_omap24xx()) | ||
99 | ret = (v == OMAP24XX_CLKSTCTRL_ENABLE_AUTO) ? 1 : 0; | ||
100 | else | ||
101 | ret = (v == OMAP34XX_CLKSTCTRL_ENABLE_AUTO) ? 1 : 0; | ||
102 | |||
103 | return ret; | ||
104 | } | ||
105 | |||
106 | void omap2xxx_cm_clkdm_enable_hwsup(s16 module, u32 mask) | ||
107 | { | ||
108 | _write_clktrctrl(OMAP24XX_CLKSTCTRL_ENABLE_AUTO, module, mask); | ||
109 | } | ||
110 | |||
111 | void omap2xxx_cm_clkdm_disable_hwsup(s16 module, u32 mask) | ||
112 | { | ||
113 | _write_clktrctrl(OMAP24XX_CLKSTCTRL_DISABLE_AUTO, module, mask); | ||
114 | } | ||
115 | |||
116 | void omap3xxx_cm_clkdm_enable_hwsup(s16 module, u32 mask) | ||
117 | { | ||
118 | _write_clktrctrl(OMAP34XX_CLKSTCTRL_ENABLE_AUTO, module, mask); | ||
119 | } | ||
120 | |||
121 | void omap3xxx_cm_clkdm_disable_hwsup(s16 module, u32 mask) | ||
122 | { | ||
123 | _write_clktrctrl(OMAP34XX_CLKSTCTRL_DISABLE_AUTO, module, mask); | ||
124 | } | ||
125 | |||
126 | void omap3xxx_cm_clkdm_force_sleep(s16 module, u32 mask) | ||
127 | { | ||
128 | _write_clktrctrl(OMAP34XX_CLKSTCTRL_FORCE_SLEEP, module, mask); | ||
129 | } | ||
130 | |||
131 | void omap3xxx_cm_clkdm_force_wakeup(s16 module, u32 mask) | ||
132 | { | ||
133 | _write_clktrctrl(OMAP34XX_CLKSTCTRL_FORCE_WAKEUP, module, mask); | ||
134 | } | ||
135 | |||
136 | /* | ||
137 | * DPLL autoidle control | ||
138 | */ | ||
139 | |||
140 | static void _omap2xxx_set_dpll_autoidle(u8 m) | ||
141 | { | ||
142 | u32 v; | ||
143 | |||
144 | v = omap2_cm_read_mod_reg(PLL_MOD, CM_AUTOIDLE); | ||
145 | v &= ~OMAP24XX_AUTO_DPLL_MASK; | ||
146 | v |= m << OMAP24XX_AUTO_DPLL_SHIFT; | ||
147 | omap2_cm_write_mod_reg(v, PLL_MOD, CM_AUTOIDLE); | ||
148 | } | ||
149 | |||
150 | void omap2xxx_cm_set_dpll_disable_autoidle(void) | ||
151 | { | ||
152 | _omap2xxx_set_dpll_autoidle(OMAP2XXX_DPLL_AUTOIDLE_LOW_POWER_STOP); | ||
153 | } | ||
154 | |||
155 | void omap2xxx_cm_set_dpll_auto_low_power_stop(void) | ||
156 | { | ||
157 | _omap2xxx_set_dpll_autoidle(DPLL_AUTOIDLE_DISABLE); | ||
158 | } | ||
159 | |||
160 | /* | ||
161 | * APLL autoidle control | ||
162 | */ | ||
163 | |||
164 | static void _omap2xxx_set_apll_autoidle(u8 m, u32 mask) | ||
165 | { | ||
166 | u32 v; | ||
167 | |||
168 | v = omap2_cm_read_mod_reg(PLL_MOD, CM_AUTOIDLE); | ||
169 | v &= ~mask; | ||
170 | v |= m << __ffs(mask); | ||
171 | omap2_cm_write_mod_reg(v, PLL_MOD, CM_AUTOIDLE); | ||
172 | } | ||
173 | |||
174 | void omap2xxx_cm_set_apll54_disable_autoidle(void) | ||
175 | { | ||
176 | _omap2xxx_set_apll_autoidle(OMAP2XXX_APLL_AUTOIDLE_LOW_POWER_STOP, | ||
177 | OMAP24XX_AUTO_54M_MASK); | ||
178 | } | ||
179 | |||
180 | void omap2xxx_cm_set_apll54_auto_low_power_stop(void) | ||
181 | { | ||
182 | _omap2xxx_set_apll_autoidle(OMAP2XXX_APLL_AUTOIDLE_DISABLE, | ||
183 | OMAP24XX_AUTO_54M_MASK); | ||
184 | } | ||
185 | |||
186 | void omap2xxx_cm_set_apll96_disable_autoidle(void) | ||
187 | { | ||
188 | _omap2xxx_set_apll_autoidle(OMAP2XXX_APLL_AUTOIDLE_LOW_POWER_STOP, | ||
189 | OMAP24XX_AUTO_96M_MASK); | ||
190 | } | ||
191 | |||
192 | void omap2xxx_cm_set_apll96_auto_low_power_stop(void) | ||
193 | { | ||
194 | _omap2xxx_set_apll_autoidle(OMAP2XXX_APLL_AUTOIDLE_DISABLE, | ||
195 | OMAP24XX_AUTO_96M_MASK); | ||
196 | } | ||
197 | |||
198 | /* | ||
199 | * | ||
200 | */ | ||
201 | |||
202 | /** | ||
203 | * omap2_cm_wait_idlest_ready - wait for a module to leave idle or standby | ||
204 | * @prcm_mod: PRCM module offset | ||
205 | * @idlest_id: CM_IDLESTx register ID (i.e., x = 1, 2, 3) | ||
206 | * @idlest_shift: shift of the bit in the CM_IDLEST* register to check | ||
207 | * | ||
208 | * XXX document | ||
209 | */ | ||
210 | int omap2_cm_wait_module_ready(s16 prcm_mod, u8 idlest_id, u8 idlest_shift) | ||
211 | { | ||
212 | int ena = 0, i = 0; | ||
213 | u8 cm_idlest_reg; | ||
214 | u32 mask; | ||
215 | |||
216 | if (!idlest_id || (idlest_id > ARRAY_SIZE(cm_idlest_offs))) | ||
217 | return -EINVAL; | ||
218 | |||
219 | cm_idlest_reg = cm_idlest_offs[idlest_id - 1]; | ||
220 | |||
221 | mask = 1 << idlest_shift; | ||
222 | |||
223 | if (cpu_is_omap24xx()) | ||
224 | ena = mask; | ||
225 | else if (cpu_is_omap34xx()) | ||
226 | ena = 0; | ||
227 | else | ||
228 | BUG(); | ||
229 | |||
230 | omap_test_timeout(((omap2_cm_read_mod_reg(prcm_mod, cm_idlest_reg) & mask) == ena), | ||
231 | MAX_MODULE_READY_TIME, i); | ||
232 | |||
233 | return (i < MAX_MODULE_READY_TIME) ? 0 : -EBUSY; | ||
234 | } | ||
235 | |||
236 | /* | ||
237 | * Context save/restore code - OMAP3 only | ||
238 | */ | ||
239 | #ifdef CONFIG_ARCH_OMAP3 | ||
240 | struct omap3_cm_regs { | ||
241 | u32 iva2_cm_clksel1; | ||
242 | u32 iva2_cm_clksel2; | ||
243 | u32 cm_sysconfig; | ||
244 | u32 sgx_cm_clksel; | ||
245 | u32 dss_cm_clksel; | ||
246 | u32 cam_cm_clksel; | ||
247 | u32 per_cm_clksel; | ||
248 | u32 emu_cm_clksel; | ||
249 | u32 emu_cm_clkstctrl; | ||
250 | u32 pll_cm_autoidle; | ||
251 | u32 pll_cm_autoidle2; | ||
252 | u32 pll_cm_clksel4; | ||
253 | u32 pll_cm_clksel5; | ||
254 | u32 pll_cm_clken2; | ||
255 | u32 cm_polctrl; | ||
256 | u32 iva2_cm_fclken; | ||
257 | u32 iva2_cm_clken_pll; | ||
258 | u32 core_cm_fclken1; | ||
259 | u32 core_cm_fclken3; | ||
260 | u32 sgx_cm_fclken; | ||
261 | u32 wkup_cm_fclken; | ||
262 | u32 dss_cm_fclken; | ||
263 | u32 cam_cm_fclken; | ||
264 | u32 per_cm_fclken; | ||
265 | u32 usbhost_cm_fclken; | ||
266 | u32 core_cm_iclken1; | ||
267 | u32 core_cm_iclken2; | ||
268 | u32 core_cm_iclken3; | ||
269 | u32 sgx_cm_iclken; | ||
270 | u32 wkup_cm_iclken; | ||
271 | u32 dss_cm_iclken; | ||
272 | u32 cam_cm_iclken; | ||
273 | u32 per_cm_iclken; | ||
274 | u32 usbhost_cm_iclken; | ||
275 | u32 iva2_cm_autoidle2; | ||
276 | u32 mpu_cm_autoidle2; | ||
277 | u32 iva2_cm_clkstctrl; | ||
278 | u32 mpu_cm_clkstctrl; | ||
279 | u32 core_cm_clkstctrl; | ||
280 | u32 sgx_cm_clkstctrl; | ||
281 | u32 dss_cm_clkstctrl; | ||
282 | u32 cam_cm_clkstctrl; | ||
283 | u32 per_cm_clkstctrl; | ||
284 | u32 neon_cm_clkstctrl; | ||
285 | u32 usbhost_cm_clkstctrl; | ||
286 | u32 core_cm_autoidle1; | ||
287 | u32 core_cm_autoidle2; | ||
288 | u32 core_cm_autoidle3; | ||
289 | u32 wkup_cm_autoidle; | ||
290 | u32 dss_cm_autoidle; | ||
291 | u32 cam_cm_autoidle; | ||
292 | u32 per_cm_autoidle; | ||
293 | u32 usbhost_cm_autoidle; | ||
294 | u32 sgx_cm_sleepdep; | ||
295 | u32 dss_cm_sleepdep; | ||
296 | u32 cam_cm_sleepdep; | ||
297 | u32 per_cm_sleepdep; | ||
298 | u32 usbhost_cm_sleepdep; | ||
299 | u32 cm_clkout_ctrl; | ||
300 | }; | ||
301 | |||
302 | static struct omap3_cm_regs cm_context; | ||
303 | |||
304 | void omap3_cm_save_context(void) | ||
305 | { | ||
306 | cm_context.iva2_cm_clksel1 = | ||
307 | omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_CLKSEL1); | ||
308 | cm_context.iva2_cm_clksel2 = | ||
309 | omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_CLKSEL2); | ||
310 | cm_context.cm_sysconfig = __raw_readl(OMAP3430_CM_SYSCONFIG); | ||
311 | cm_context.sgx_cm_clksel = | ||
312 | omap2_cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_CLKSEL); | ||
313 | cm_context.dss_cm_clksel = | ||
314 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, CM_CLKSEL); | ||
315 | cm_context.cam_cm_clksel = | ||
316 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, CM_CLKSEL); | ||
317 | cm_context.per_cm_clksel = | ||
318 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, CM_CLKSEL); | ||
319 | cm_context.emu_cm_clksel = | ||
320 | omap2_cm_read_mod_reg(OMAP3430_EMU_MOD, CM_CLKSEL1); | ||
321 | cm_context.emu_cm_clkstctrl = | ||
322 | omap2_cm_read_mod_reg(OMAP3430_EMU_MOD, OMAP2_CM_CLKSTCTRL); | ||
323 | /* | ||
324 | * As per erratum i671, ROM code does not respect the PER DPLL | ||
325 | * programming scheme if CM_AUTOIDLE_PLL.AUTO_PERIPH_DPLL == 1. | ||
326 | * In this case, even though this register has been saved in | ||
327 | * scratchpad contents, we need to restore AUTO_PERIPH_DPLL | ||
328 | * by ourselves. So, we need to save it anyway. | ||
329 | */ | ||
330 | cm_context.pll_cm_autoidle = | ||
331 | omap2_cm_read_mod_reg(PLL_MOD, CM_AUTOIDLE); | ||
332 | cm_context.pll_cm_autoidle2 = | ||
333 | omap2_cm_read_mod_reg(PLL_MOD, CM_AUTOIDLE2); | ||
334 | cm_context.pll_cm_clksel4 = | ||
335 | omap2_cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKSEL4); | ||
336 | cm_context.pll_cm_clksel5 = | ||
337 | omap2_cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKSEL5); | ||
338 | cm_context.pll_cm_clken2 = | ||
339 | omap2_cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKEN2); | ||
340 | cm_context.cm_polctrl = __raw_readl(OMAP3430_CM_POLCTRL); | ||
341 | cm_context.iva2_cm_fclken = | ||
342 | omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_FCLKEN); | ||
343 | cm_context.iva2_cm_clken_pll = | ||
344 | omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, OMAP3430_CM_CLKEN_PLL); | ||
345 | cm_context.core_cm_fclken1 = | ||
346 | omap2_cm_read_mod_reg(CORE_MOD, CM_FCLKEN1); | ||
347 | cm_context.core_cm_fclken3 = | ||
348 | omap2_cm_read_mod_reg(CORE_MOD, OMAP3430ES2_CM_FCLKEN3); | ||
349 | cm_context.sgx_cm_fclken = | ||
350 | omap2_cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_FCLKEN); | ||
351 | cm_context.wkup_cm_fclken = | ||
352 | omap2_cm_read_mod_reg(WKUP_MOD, CM_FCLKEN); | ||
353 | cm_context.dss_cm_fclken = | ||
354 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, CM_FCLKEN); | ||
355 | cm_context.cam_cm_fclken = | ||
356 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, CM_FCLKEN); | ||
357 | cm_context.per_cm_fclken = | ||
358 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, CM_FCLKEN); | ||
359 | cm_context.usbhost_cm_fclken = | ||
360 | omap2_cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, CM_FCLKEN); | ||
361 | cm_context.core_cm_iclken1 = | ||
362 | omap2_cm_read_mod_reg(CORE_MOD, CM_ICLKEN1); | ||
363 | cm_context.core_cm_iclken2 = | ||
364 | omap2_cm_read_mod_reg(CORE_MOD, CM_ICLKEN2); | ||
365 | cm_context.core_cm_iclken3 = | ||
366 | omap2_cm_read_mod_reg(CORE_MOD, CM_ICLKEN3); | ||
367 | cm_context.sgx_cm_iclken = | ||
368 | omap2_cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_ICLKEN); | ||
369 | cm_context.wkup_cm_iclken = | ||
370 | omap2_cm_read_mod_reg(WKUP_MOD, CM_ICLKEN); | ||
371 | cm_context.dss_cm_iclken = | ||
372 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, CM_ICLKEN); | ||
373 | cm_context.cam_cm_iclken = | ||
374 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, CM_ICLKEN); | ||
375 | cm_context.per_cm_iclken = | ||
376 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, CM_ICLKEN); | ||
377 | cm_context.usbhost_cm_iclken = | ||
378 | omap2_cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, CM_ICLKEN); | ||
379 | cm_context.iva2_cm_autoidle2 = | ||
380 | omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_AUTOIDLE2); | ||
381 | cm_context.mpu_cm_autoidle2 = | ||
382 | omap2_cm_read_mod_reg(MPU_MOD, CM_AUTOIDLE2); | ||
383 | cm_context.iva2_cm_clkstctrl = | ||
384 | omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, OMAP2_CM_CLKSTCTRL); | ||
385 | cm_context.mpu_cm_clkstctrl = | ||
386 | omap2_cm_read_mod_reg(MPU_MOD, OMAP2_CM_CLKSTCTRL); | ||
387 | cm_context.core_cm_clkstctrl = | ||
388 | omap2_cm_read_mod_reg(CORE_MOD, OMAP2_CM_CLKSTCTRL); | ||
389 | cm_context.sgx_cm_clkstctrl = | ||
390 | omap2_cm_read_mod_reg(OMAP3430ES2_SGX_MOD, OMAP2_CM_CLKSTCTRL); | ||
391 | cm_context.dss_cm_clkstctrl = | ||
392 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, OMAP2_CM_CLKSTCTRL); | ||
393 | cm_context.cam_cm_clkstctrl = | ||
394 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, OMAP2_CM_CLKSTCTRL); | ||
395 | cm_context.per_cm_clkstctrl = | ||
396 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, OMAP2_CM_CLKSTCTRL); | ||
397 | cm_context.neon_cm_clkstctrl = | ||
398 | omap2_cm_read_mod_reg(OMAP3430_NEON_MOD, OMAP2_CM_CLKSTCTRL); | ||
399 | cm_context.usbhost_cm_clkstctrl = | ||
400 | omap2_cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, | ||
401 | OMAP2_CM_CLKSTCTRL); | ||
402 | cm_context.core_cm_autoidle1 = | ||
403 | omap2_cm_read_mod_reg(CORE_MOD, CM_AUTOIDLE1); | ||
404 | cm_context.core_cm_autoidle2 = | ||
405 | omap2_cm_read_mod_reg(CORE_MOD, CM_AUTOIDLE2); | ||
406 | cm_context.core_cm_autoidle3 = | ||
407 | omap2_cm_read_mod_reg(CORE_MOD, CM_AUTOIDLE3); | ||
408 | cm_context.wkup_cm_autoidle = | ||
409 | omap2_cm_read_mod_reg(WKUP_MOD, CM_AUTOIDLE); | ||
410 | cm_context.dss_cm_autoidle = | ||
411 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, CM_AUTOIDLE); | ||
412 | cm_context.cam_cm_autoidle = | ||
413 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, CM_AUTOIDLE); | ||
414 | cm_context.per_cm_autoidle = | ||
415 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, CM_AUTOIDLE); | ||
416 | cm_context.usbhost_cm_autoidle = | ||
417 | omap2_cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, CM_AUTOIDLE); | ||
418 | cm_context.sgx_cm_sleepdep = | ||
419 | omap2_cm_read_mod_reg(OMAP3430ES2_SGX_MOD, | ||
420 | OMAP3430_CM_SLEEPDEP); | ||
421 | cm_context.dss_cm_sleepdep = | ||
422 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, OMAP3430_CM_SLEEPDEP); | ||
423 | cm_context.cam_cm_sleepdep = | ||
424 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, OMAP3430_CM_SLEEPDEP); | ||
425 | cm_context.per_cm_sleepdep = | ||
426 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, OMAP3430_CM_SLEEPDEP); | ||
427 | cm_context.usbhost_cm_sleepdep = | ||
428 | omap2_cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, | ||
429 | OMAP3430_CM_SLEEPDEP); | ||
430 | cm_context.cm_clkout_ctrl = | ||
431 | omap2_cm_read_mod_reg(OMAP3430_CCR_MOD, | ||
432 | OMAP3_CM_CLKOUT_CTRL_OFFSET); | ||
433 | } | ||
434 | |||
435 | void omap3_cm_restore_context(void) | ||
436 | { | ||
437 | omap2_cm_write_mod_reg(cm_context.iva2_cm_clksel1, OMAP3430_IVA2_MOD, | ||
438 | CM_CLKSEL1); | ||
439 | omap2_cm_write_mod_reg(cm_context.iva2_cm_clksel2, OMAP3430_IVA2_MOD, | ||
440 | CM_CLKSEL2); | ||
441 | __raw_writel(cm_context.cm_sysconfig, OMAP3430_CM_SYSCONFIG); | ||
442 | omap2_cm_write_mod_reg(cm_context.sgx_cm_clksel, OMAP3430ES2_SGX_MOD, | ||
443 | CM_CLKSEL); | ||
444 | omap2_cm_write_mod_reg(cm_context.dss_cm_clksel, OMAP3430_DSS_MOD, | ||
445 | CM_CLKSEL); | ||
446 | omap2_cm_write_mod_reg(cm_context.cam_cm_clksel, OMAP3430_CAM_MOD, | ||
447 | CM_CLKSEL); | ||
448 | omap2_cm_write_mod_reg(cm_context.per_cm_clksel, OMAP3430_PER_MOD, | ||
449 | CM_CLKSEL); | ||
450 | omap2_cm_write_mod_reg(cm_context.emu_cm_clksel, OMAP3430_EMU_MOD, | ||
451 | CM_CLKSEL1); | ||
452 | omap2_cm_write_mod_reg(cm_context.emu_cm_clkstctrl, OMAP3430_EMU_MOD, | ||
453 | OMAP2_CM_CLKSTCTRL); | ||
454 | /* | ||
455 | * As per erratum i671, ROM code does not respect the PER DPLL | ||
456 | * programming scheme if CM_AUTOIDLE_PLL.AUTO_PERIPH_DPLL == 1. | ||
457 | * In this case, we need to restore AUTO_PERIPH_DPLL by ourselves. | ||
458 | */ | ||
459 | omap2_cm_write_mod_reg(cm_context.pll_cm_autoidle, PLL_MOD, | ||
460 | CM_AUTOIDLE); | ||
461 | omap2_cm_write_mod_reg(cm_context.pll_cm_autoidle2, PLL_MOD, | ||
462 | CM_AUTOIDLE2); | ||
463 | omap2_cm_write_mod_reg(cm_context.pll_cm_clksel4, PLL_MOD, | ||
464 | OMAP3430ES2_CM_CLKSEL4); | ||
465 | omap2_cm_write_mod_reg(cm_context.pll_cm_clksel5, PLL_MOD, | ||
466 | OMAP3430ES2_CM_CLKSEL5); | ||
467 | omap2_cm_write_mod_reg(cm_context.pll_cm_clken2, PLL_MOD, | ||
468 | OMAP3430ES2_CM_CLKEN2); | ||
469 | __raw_writel(cm_context.cm_polctrl, OMAP3430_CM_POLCTRL); | ||
470 | omap2_cm_write_mod_reg(cm_context.iva2_cm_fclken, OMAP3430_IVA2_MOD, | ||
471 | CM_FCLKEN); | ||
472 | omap2_cm_write_mod_reg(cm_context.iva2_cm_clken_pll, OMAP3430_IVA2_MOD, | ||
473 | OMAP3430_CM_CLKEN_PLL); | ||
474 | omap2_cm_write_mod_reg(cm_context.core_cm_fclken1, CORE_MOD, | ||
475 | CM_FCLKEN1); | ||
476 | omap2_cm_write_mod_reg(cm_context.core_cm_fclken3, CORE_MOD, | ||
477 | OMAP3430ES2_CM_FCLKEN3); | ||
478 | omap2_cm_write_mod_reg(cm_context.sgx_cm_fclken, OMAP3430ES2_SGX_MOD, | ||
479 | CM_FCLKEN); | ||
480 | omap2_cm_write_mod_reg(cm_context.wkup_cm_fclken, WKUP_MOD, CM_FCLKEN); | ||
481 | omap2_cm_write_mod_reg(cm_context.dss_cm_fclken, OMAP3430_DSS_MOD, | ||
482 | CM_FCLKEN); | ||
483 | omap2_cm_write_mod_reg(cm_context.cam_cm_fclken, OMAP3430_CAM_MOD, | ||
484 | CM_FCLKEN); | ||
485 | omap2_cm_write_mod_reg(cm_context.per_cm_fclken, OMAP3430_PER_MOD, | ||
486 | CM_FCLKEN); | ||
487 | omap2_cm_write_mod_reg(cm_context.usbhost_cm_fclken, | ||
488 | OMAP3430ES2_USBHOST_MOD, CM_FCLKEN); | ||
489 | omap2_cm_write_mod_reg(cm_context.core_cm_iclken1, CORE_MOD, | ||
490 | CM_ICLKEN1); | ||
491 | omap2_cm_write_mod_reg(cm_context.core_cm_iclken2, CORE_MOD, | ||
492 | CM_ICLKEN2); | ||
493 | omap2_cm_write_mod_reg(cm_context.core_cm_iclken3, CORE_MOD, | ||
494 | CM_ICLKEN3); | ||
495 | omap2_cm_write_mod_reg(cm_context.sgx_cm_iclken, OMAP3430ES2_SGX_MOD, | ||
496 | CM_ICLKEN); | ||
497 | omap2_cm_write_mod_reg(cm_context.wkup_cm_iclken, WKUP_MOD, CM_ICLKEN); | ||
498 | omap2_cm_write_mod_reg(cm_context.dss_cm_iclken, OMAP3430_DSS_MOD, | ||
499 | CM_ICLKEN); | ||
500 | omap2_cm_write_mod_reg(cm_context.cam_cm_iclken, OMAP3430_CAM_MOD, | ||
501 | CM_ICLKEN); | ||
502 | omap2_cm_write_mod_reg(cm_context.per_cm_iclken, OMAP3430_PER_MOD, | ||
503 | CM_ICLKEN); | ||
504 | omap2_cm_write_mod_reg(cm_context.usbhost_cm_iclken, | ||
505 | OMAP3430ES2_USBHOST_MOD, CM_ICLKEN); | ||
506 | omap2_cm_write_mod_reg(cm_context.iva2_cm_autoidle2, OMAP3430_IVA2_MOD, | ||
507 | CM_AUTOIDLE2); | ||
508 | omap2_cm_write_mod_reg(cm_context.mpu_cm_autoidle2, MPU_MOD, | ||
509 | CM_AUTOIDLE2); | ||
510 | omap2_cm_write_mod_reg(cm_context.iva2_cm_clkstctrl, OMAP3430_IVA2_MOD, | ||
511 | OMAP2_CM_CLKSTCTRL); | ||
512 | omap2_cm_write_mod_reg(cm_context.mpu_cm_clkstctrl, MPU_MOD, | ||
513 | OMAP2_CM_CLKSTCTRL); | ||
514 | omap2_cm_write_mod_reg(cm_context.core_cm_clkstctrl, CORE_MOD, | ||
515 | OMAP2_CM_CLKSTCTRL); | ||
516 | omap2_cm_write_mod_reg(cm_context.sgx_cm_clkstctrl, OMAP3430ES2_SGX_MOD, | ||
517 | OMAP2_CM_CLKSTCTRL); | ||
518 | omap2_cm_write_mod_reg(cm_context.dss_cm_clkstctrl, OMAP3430_DSS_MOD, | ||
519 | OMAP2_CM_CLKSTCTRL); | ||
520 | omap2_cm_write_mod_reg(cm_context.cam_cm_clkstctrl, OMAP3430_CAM_MOD, | ||
521 | OMAP2_CM_CLKSTCTRL); | ||
522 | omap2_cm_write_mod_reg(cm_context.per_cm_clkstctrl, OMAP3430_PER_MOD, | ||
523 | OMAP2_CM_CLKSTCTRL); | ||
524 | omap2_cm_write_mod_reg(cm_context.neon_cm_clkstctrl, OMAP3430_NEON_MOD, | ||
525 | OMAP2_CM_CLKSTCTRL); | ||
526 | omap2_cm_write_mod_reg(cm_context.usbhost_cm_clkstctrl, | ||
527 | OMAP3430ES2_USBHOST_MOD, OMAP2_CM_CLKSTCTRL); | ||
528 | omap2_cm_write_mod_reg(cm_context.core_cm_autoidle1, CORE_MOD, | ||
529 | CM_AUTOIDLE1); | ||
530 | omap2_cm_write_mod_reg(cm_context.core_cm_autoidle2, CORE_MOD, | ||
531 | CM_AUTOIDLE2); | ||
532 | omap2_cm_write_mod_reg(cm_context.core_cm_autoidle3, CORE_MOD, | ||
533 | CM_AUTOIDLE3); | ||
534 | omap2_cm_write_mod_reg(cm_context.wkup_cm_autoidle, WKUP_MOD, | ||
535 | CM_AUTOIDLE); | ||
536 | omap2_cm_write_mod_reg(cm_context.dss_cm_autoidle, OMAP3430_DSS_MOD, | ||
537 | CM_AUTOIDLE); | ||
538 | omap2_cm_write_mod_reg(cm_context.cam_cm_autoidle, OMAP3430_CAM_MOD, | ||
539 | CM_AUTOIDLE); | ||
540 | omap2_cm_write_mod_reg(cm_context.per_cm_autoidle, OMAP3430_PER_MOD, | ||
541 | CM_AUTOIDLE); | ||
542 | omap2_cm_write_mod_reg(cm_context.usbhost_cm_autoidle, | ||
543 | OMAP3430ES2_USBHOST_MOD, CM_AUTOIDLE); | ||
544 | omap2_cm_write_mod_reg(cm_context.sgx_cm_sleepdep, OMAP3430ES2_SGX_MOD, | ||
545 | OMAP3430_CM_SLEEPDEP); | ||
546 | omap2_cm_write_mod_reg(cm_context.dss_cm_sleepdep, OMAP3430_DSS_MOD, | ||
547 | OMAP3430_CM_SLEEPDEP); | ||
548 | omap2_cm_write_mod_reg(cm_context.cam_cm_sleepdep, OMAP3430_CAM_MOD, | ||
549 | OMAP3430_CM_SLEEPDEP); | ||
550 | omap2_cm_write_mod_reg(cm_context.per_cm_sleepdep, OMAP3430_PER_MOD, | ||
551 | OMAP3430_CM_SLEEPDEP); | ||
552 | omap2_cm_write_mod_reg(cm_context.usbhost_cm_sleepdep, | ||
553 | OMAP3430ES2_USBHOST_MOD, OMAP3430_CM_SLEEPDEP); | ||
554 | omap2_cm_write_mod_reg(cm_context.cm_clkout_ctrl, OMAP3430_CCR_MOD, | ||
555 | OMAP3_CM_CLKOUT_CTRL_OFFSET); | ||
556 | } | ||
557 | #endif | ||