Commit | Line | Data |
---|---|---|
71348bca PW |
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> | |
71348bca PW |
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 | ||
4e65331c | 21 | #include "common.h" |
6f8b7ff5 | 22 | |
71348bca | 23 | #include "cm.h" |
59fb659b | 24 | #include "cm2xxx_3xxx.h" |
71348bca PW |
25 | #include "cm-regbits-24xx.h" |
26 | #include "cm-regbits-34xx.h" | |
27 | ||
92618ff8 | 28 | /* CM_AUTOIDLE_PLL.AUTO_* bit values for DPLLs */ |
0fd0c21b PW |
29 | #define DPLL_AUTOIDLE_DISABLE 0x0 |
30 | #define OMAP2XXX_DPLL_AUTOIDLE_LOW_POWER_STOP 0x3 | |
31 | ||
92618ff8 PW |
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 | ||
71348bca PW |
36 | static const u8 cm_idlest_offs[] = { |
37 | CM_IDLEST1, CM_IDLEST2, OMAP2430_CM_IDLEST3 | |
38 | }; | |
39 | ||
c4d7e58f | 40 | u32 omap2_cm_read_mod_reg(s16 module, u16 idx) |
59fb659b PW |
41 | { |
42 | return __raw_readl(cm_base + module + idx); | |
43 | } | |
44 | ||
c4d7e58f | 45 | void omap2_cm_write_mod_reg(u32 val, s16 module, u16 idx) |
59fb659b PW |
46 | { |
47 | __raw_writel(val, cm_base + module + idx); | |
48 | } | |
49 | ||
50 | /* Read-modify-write a register in a CM module. Caller must lock */ | |
c4d7e58f | 51 | u32 omap2_cm_rmw_mod_reg_bits(u32 mask, u32 bits, s16 module, s16 idx) |
59fb659b PW |
52 | { |
53 | u32 v; | |
54 | ||
c4d7e58f | 55 | v = omap2_cm_read_mod_reg(module, idx); |
59fb659b PW |
56 | v &= ~mask; |
57 | v |= bits; | |
c4d7e58f | 58 | omap2_cm_write_mod_reg(v, module, idx); |
59fb659b PW |
59 | |
60 | return v; | |
61 | } | |
62 | ||
c4d7e58f | 63 | u32 omap2_cm_set_mod_reg_bits(u32 bits, s16 module, s16 idx) |
59fb659b | 64 | { |
c4d7e58f | 65 | return omap2_cm_rmw_mod_reg_bits(bits, bits, module, idx); |
59fb659b PW |
66 | } |
67 | ||
c4d7e58f | 68 | u32 omap2_cm_clear_mod_reg_bits(u32 bits, s16 module, s16 idx) |
59fb659b | 69 | { |
c4d7e58f | 70 | return omap2_cm_rmw_mod_reg_bits(bits, 0x0, module, idx); |
59fb659b PW |
71 | } |
72 | ||
55ae3507 PW |
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 | ||
0fd0c21b PW |
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 | } | |
55ae3507 | 159 | |
92618ff8 PW |
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 | ||
55ae3507 PW |
198 | /* |
199 | * | |
200 | */ | |
201 | ||
71348bca PW |
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 | ||
64056167 KH |
221 | mask = 1 << idlest_shift; |
222 | ||
71348bca | 223 | if (cpu_is_omap24xx()) |
64056167 | 224 | ena = mask; |
71348bca PW |
225 | else if (cpu_is_omap34xx()) |
226 | ena = 0; | |
227 | else | |
228 | BUG(); | |
229 | ||
c4d7e58f | 230 | omap_test_timeout(((omap2_cm_read_mod_reg(prcm_mod, cm_idlest_reg) & mask) == ena), |
6f8b7ff5 | 231 | MAX_MODULE_READY_TIME, i); |
71348bca PW |
232 | |
233 | return (i < MAX_MODULE_READY_TIME) ? 0 : -EBUSY; | |
234 | } | |
235 | ||
f0611a5c PW |
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; | |
a8ae645c | 250 | u32 pll_cm_autoidle; |
f0611a5c PW |
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 = | |
c4d7e58f | 307 | omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_CLKSEL1); |
f0611a5c | 308 | cm_context.iva2_cm_clksel2 = |
c4d7e58f | 309 | omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_CLKSEL2); |
f0611a5c PW |
310 | cm_context.cm_sysconfig = __raw_readl(OMAP3430_CM_SYSCONFIG); |
311 | cm_context.sgx_cm_clksel = | |
c4d7e58f | 312 | omap2_cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_CLKSEL); |
f0611a5c | 313 | cm_context.dss_cm_clksel = |
c4d7e58f | 314 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, CM_CLKSEL); |
f0611a5c | 315 | cm_context.cam_cm_clksel = |
c4d7e58f | 316 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, CM_CLKSEL); |
f0611a5c | 317 | cm_context.per_cm_clksel = |
c4d7e58f | 318 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, CM_CLKSEL); |
f0611a5c | 319 | cm_context.emu_cm_clksel = |
c4d7e58f | 320 | omap2_cm_read_mod_reg(OMAP3430_EMU_MOD, CM_CLKSEL1); |
f0611a5c | 321 | cm_context.emu_cm_clkstctrl = |
c4d7e58f | 322 | omap2_cm_read_mod_reg(OMAP3430_EMU_MOD, OMAP2_CM_CLKSTCTRL); |
a8ae645c EV |
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); | |
f0611a5c | 332 | cm_context.pll_cm_autoidle2 = |
c4d7e58f | 333 | omap2_cm_read_mod_reg(PLL_MOD, CM_AUTOIDLE2); |
f0611a5c | 334 | cm_context.pll_cm_clksel4 = |
c4d7e58f | 335 | omap2_cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKSEL4); |
f0611a5c | 336 | cm_context.pll_cm_clksel5 = |
c4d7e58f | 337 | omap2_cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKSEL5); |
f0611a5c | 338 | cm_context.pll_cm_clken2 = |
c4d7e58f | 339 | omap2_cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKEN2); |
f0611a5c PW |
340 | cm_context.cm_polctrl = __raw_readl(OMAP3430_CM_POLCTRL); |
341 | cm_context.iva2_cm_fclken = | |
c4d7e58f PW |
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); | |
f0611a5c | 345 | cm_context.core_cm_fclken1 = |
c4d7e58f | 346 | omap2_cm_read_mod_reg(CORE_MOD, CM_FCLKEN1); |
f0611a5c | 347 | cm_context.core_cm_fclken3 = |
c4d7e58f | 348 | omap2_cm_read_mod_reg(CORE_MOD, OMAP3430ES2_CM_FCLKEN3); |
f0611a5c | 349 | cm_context.sgx_cm_fclken = |
c4d7e58f | 350 | omap2_cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_FCLKEN); |
f0611a5c | 351 | cm_context.wkup_cm_fclken = |
c4d7e58f | 352 | omap2_cm_read_mod_reg(WKUP_MOD, CM_FCLKEN); |
f0611a5c | 353 | cm_context.dss_cm_fclken = |
c4d7e58f | 354 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, CM_FCLKEN); |
f0611a5c | 355 | cm_context.cam_cm_fclken = |
c4d7e58f | 356 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, CM_FCLKEN); |
f0611a5c | 357 | cm_context.per_cm_fclken = |
c4d7e58f | 358 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, CM_FCLKEN); |
f0611a5c | 359 | cm_context.usbhost_cm_fclken = |
c4d7e58f | 360 | omap2_cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, CM_FCLKEN); |
f0611a5c | 361 | cm_context.core_cm_iclken1 = |
c4d7e58f | 362 | omap2_cm_read_mod_reg(CORE_MOD, CM_ICLKEN1); |
f0611a5c | 363 | cm_context.core_cm_iclken2 = |
c4d7e58f | 364 | omap2_cm_read_mod_reg(CORE_MOD, CM_ICLKEN2); |
f0611a5c | 365 | cm_context.core_cm_iclken3 = |
c4d7e58f | 366 | omap2_cm_read_mod_reg(CORE_MOD, CM_ICLKEN3); |
f0611a5c | 367 | cm_context.sgx_cm_iclken = |
c4d7e58f | 368 | omap2_cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_ICLKEN); |
f0611a5c | 369 | cm_context.wkup_cm_iclken = |
c4d7e58f | 370 | omap2_cm_read_mod_reg(WKUP_MOD, CM_ICLKEN); |
f0611a5c | 371 | cm_context.dss_cm_iclken = |
c4d7e58f | 372 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, CM_ICLKEN); |
f0611a5c | 373 | cm_context.cam_cm_iclken = |
c4d7e58f | 374 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, CM_ICLKEN); |
f0611a5c | 375 | cm_context.per_cm_iclken = |
c4d7e58f | 376 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, CM_ICLKEN); |
f0611a5c | 377 | cm_context.usbhost_cm_iclken = |
c4d7e58f | 378 | omap2_cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, CM_ICLKEN); |
f0611a5c | 379 | cm_context.iva2_cm_autoidle2 = |
c4d7e58f | 380 | omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_AUTOIDLE2); |
f0611a5c | 381 | cm_context.mpu_cm_autoidle2 = |
c4d7e58f | 382 | omap2_cm_read_mod_reg(MPU_MOD, CM_AUTOIDLE2); |
f0611a5c | 383 | cm_context.iva2_cm_clkstctrl = |
c4d7e58f | 384 | omap2_cm_read_mod_reg(OMAP3430_IVA2_MOD, OMAP2_CM_CLKSTCTRL); |
f0611a5c | 385 | cm_context.mpu_cm_clkstctrl = |
c4d7e58f | 386 | omap2_cm_read_mod_reg(MPU_MOD, OMAP2_CM_CLKSTCTRL); |
f0611a5c | 387 | cm_context.core_cm_clkstctrl = |
c4d7e58f | 388 | omap2_cm_read_mod_reg(CORE_MOD, OMAP2_CM_CLKSTCTRL); |
f0611a5c | 389 | cm_context.sgx_cm_clkstctrl = |
c4d7e58f | 390 | omap2_cm_read_mod_reg(OMAP3430ES2_SGX_MOD, OMAP2_CM_CLKSTCTRL); |
f0611a5c | 391 | cm_context.dss_cm_clkstctrl = |
c4d7e58f | 392 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, OMAP2_CM_CLKSTCTRL); |
f0611a5c | 393 | cm_context.cam_cm_clkstctrl = |
c4d7e58f | 394 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, OMAP2_CM_CLKSTCTRL); |
f0611a5c | 395 | cm_context.per_cm_clkstctrl = |
c4d7e58f | 396 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, OMAP2_CM_CLKSTCTRL); |
f0611a5c | 397 | cm_context.neon_cm_clkstctrl = |
c4d7e58f | 398 | omap2_cm_read_mod_reg(OMAP3430_NEON_MOD, OMAP2_CM_CLKSTCTRL); |
f0611a5c | 399 | cm_context.usbhost_cm_clkstctrl = |
c4d7e58f PW |
400 | omap2_cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, |
401 | OMAP2_CM_CLKSTCTRL); | |
f0611a5c | 402 | cm_context.core_cm_autoidle1 = |
c4d7e58f | 403 | omap2_cm_read_mod_reg(CORE_MOD, CM_AUTOIDLE1); |
f0611a5c | 404 | cm_context.core_cm_autoidle2 = |
c4d7e58f | 405 | omap2_cm_read_mod_reg(CORE_MOD, CM_AUTOIDLE2); |
f0611a5c | 406 | cm_context.core_cm_autoidle3 = |
c4d7e58f | 407 | omap2_cm_read_mod_reg(CORE_MOD, CM_AUTOIDLE3); |
f0611a5c | 408 | cm_context.wkup_cm_autoidle = |
c4d7e58f | 409 | omap2_cm_read_mod_reg(WKUP_MOD, CM_AUTOIDLE); |
f0611a5c | 410 | cm_context.dss_cm_autoidle = |
c4d7e58f | 411 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, CM_AUTOIDLE); |
f0611a5c | 412 | cm_context.cam_cm_autoidle = |
c4d7e58f | 413 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, CM_AUTOIDLE); |
f0611a5c | 414 | cm_context.per_cm_autoidle = |
c4d7e58f | 415 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, CM_AUTOIDLE); |
f0611a5c | 416 | cm_context.usbhost_cm_autoidle = |
c4d7e58f | 417 | omap2_cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, CM_AUTOIDLE); |
f0611a5c | 418 | cm_context.sgx_cm_sleepdep = |
c4d7e58f PW |
419 | omap2_cm_read_mod_reg(OMAP3430ES2_SGX_MOD, |
420 | OMAP3430_CM_SLEEPDEP); | |
f0611a5c | 421 | cm_context.dss_cm_sleepdep = |
c4d7e58f | 422 | omap2_cm_read_mod_reg(OMAP3430_DSS_MOD, OMAP3430_CM_SLEEPDEP); |
f0611a5c | 423 | cm_context.cam_cm_sleepdep = |
c4d7e58f | 424 | omap2_cm_read_mod_reg(OMAP3430_CAM_MOD, OMAP3430_CM_SLEEPDEP); |
f0611a5c | 425 | cm_context.per_cm_sleepdep = |
c4d7e58f | 426 | omap2_cm_read_mod_reg(OMAP3430_PER_MOD, OMAP3430_CM_SLEEPDEP); |
f0611a5c | 427 | cm_context.usbhost_cm_sleepdep = |
c4d7e58f PW |
428 | omap2_cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, |
429 | OMAP3430_CM_SLEEPDEP); | |
f0611a5c | 430 | cm_context.cm_clkout_ctrl = |
c4d7e58f PW |
431 | omap2_cm_read_mod_reg(OMAP3430_CCR_MOD, |
432 | OMAP3_CM_CLKOUT_CTRL_OFFSET); | |
f0611a5c PW |
433 | } |
434 | ||
435 | void omap3_cm_restore_context(void) | |
436 | { | |
c4d7e58f PW |
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); | |
f0611a5c | 441 | __raw_writel(cm_context.cm_sysconfig, OMAP3430_CM_SYSCONFIG); |
c4d7e58f PW |
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); | |
a8ae645c EV |
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); | |
c4d7e58f PW |
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); | |
f0611a5c | 469 | __raw_writel(cm_context.cm_polctrl, OMAP3430_CM_POLCTRL); |
c4d7e58f PW |
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); | |
f0611a5c PW |
556 | } |
557 | #endif |