prcm.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618
  1. /*
  2. * linux/arch/arm/mach-omap2/prcm.c
  3. *
  4. * OMAP 24xx Power Reset and Clock Management (PRCM) functions
  5. *
  6. * Copyright (C) 2005 Nokia Corporation
  7. *
  8. * Written by Tony Lindgren <tony.lindgren@nokia.com>
  9. *
  10. * Copyright (C) 2007 Texas Instruments, Inc.
  11. * Rajendra Nayak <rnayak@ti.com>
  12. *
  13. * Some pieces of code Copyright (C) 2005 Texas Instruments, Inc.
  14. * Upgraded with OMAP4 support by Abhijit Pagare <abhijitpagare@ti.com>
  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. #include <linux/module.h>
  21. #include <linux/init.h>
  22. #include <linux/clk.h>
  23. #include <linux/io.h>
  24. #include <linux/delay.h>
  25. #include <plat/common.h>
  26. #include <plat/prcm.h>
  27. #include <plat/irqs.h>
  28. #include "clock.h"
  29. #include "clock2xxx.h"
  30. #include "cm.h"
  31. #include "prm.h"
  32. #include "prm-regbits-24xx.h"
  33. #include "prm-regbits-44xx.h"
  34. #include "control.h"
  35. static void __iomem *prm_base;
  36. static void __iomem *cm_base;
  37. static void __iomem *cm2_base;
  38. #define MAX_MODULE_ENABLE_WAIT 100000
  39. struct omap3_prcm_regs {
  40. u32 control_padconf_sys_nirq;
  41. u32 iva2_cm_clksel1;
  42. u32 iva2_cm_clksel2;
  43. u32 cm_sysconfig;
  44. u32 sgx_cm_clksel;
  45. u32 dss_cm_clksel;
  46. u32 cam_cm_clksel;
  47. u32 per_cm_clksel;
  48. u32 emu_cm_clksel;
  49. u32 emu_cm_clkstctrl;
  50. u32 pll_cm_autoidle2;
  51. u32 pll_cm_clksel4;
  52. u32 pll_cm_clksel5;
  53. u32 pll_cm_clken2;
  54. u32 cm_polctrl;
  55. u32 iva2_cm_fclken;
  56. u32 iva2_cm_clken_pll;
  57. u32 core_cm_fclken1;
  58. u32 core_cm_fclken3;
  59. u32 sgx_cm_fclken;
  60. u32 wkup_cm_fclken;
  61. u32 dss_cm_fclken;
  62. u32 cam_cm_fclken;
  63. u32 per_cm_fclken;
  64. u32 usbhost_cm_fclken;
  65. u32 core_cm_iclken1;
  66. u32 core_cm_iclken2;
  67. u32 core_cm_iclken3;
  68. u32 sgx_cm_iclken;
  69. u32 wkup_cm_iclken;
  70. u32 dss_cm_iclken;
  71. u32 cam_cm_iclken;
  72. u32 per_cm_iclken;
  73. u32 usbhost_cm_iclken;
  74. u32 iva2_cm_autiidle2;
  75. u32 mpu_cm_autoidle2;
  76. u32 iva2_cm_clkstctrl;
  77. u32 mpu_cm_clkstctrl;
  78. u32 core_cm_clkstctrl;
  79. u32 sgx_cm_clkstctrl;
  80. u32 dss_cm_clkstctrl;
  81. u32 cam_cm_clkstctrl;
  82. u32 per_cm_clkstctrl;
  83. u32 neon_cm_clkstctrl;
  84. u32 usbhost_cm_clkstctrl;
  85. u32 core_cm_autoidle1;
  86. u32 core_cm_autoidle2;
  87. u32 core_cm_autoidle3;
  88. u32 wkup_cm_autoidle;
  89. u32 dss_cm_autoidle;
  90. u32 cam_cm_autoidle;
  91. u32 per_cm_autoidle;
  92. u32 usbhost_cm_autoidle;
  93. u32 sgx_cm_sleepdep;
  94. u32 dss_cm_sleepdep;
  95. u32 cam_cm_sleepdep;
  96. u32 per_cm_sleepdep;
  97. u32 usbhost_cm_sleepdep;
  98. u32 cm_clkout_ctrl;
  99. u32 prm_clkout_ctrl;
  100. u32 sgx_pm_wkdep;
  101. u32 dss_pm_wkdep;
  102. u32 cam_pm_wkdep;
  103. u32 per_pm_wkdep;
  104. u32 neon_pm_wkdep;
  105. u32 usbhost_pm_wkdep;
  106. u32 core_pm_mpugrpsel1;
  107. u32 iva2_pm_ivagrpsel1;
  108. u32 core_pm_mpugrpsel3;
  109. u32 core_pm_ivagrpsel3;
  110. u32 wkup_pm_mpugrpsel;
  111. u32 wkup_pm_ivagrpsel;
  112. u32 per_pm_mpugrpsel;
  113. u32 per_pm_ivagrpsel;
  114. u32 wkup_pm_wken;
  115. };
  116. static struct omap3_prcm_regs prcm_context;
  117. u32 omap_prcm_get_reset_sources(void)
  118. {
  119. /* XXX This presumably needs modification for 34XX */
  120. if (cpu_is_omap24xx() || cpu_is_omap34xx())
  121. return prm_read_mod_reg(WKUP_MOD, OMAP2_RM_RSTST) & 0x7f;
  122. if (cpu_is_omap44xx())
  123. return prm_read_mod_reg(WKUP_MOD, OMAP4_RM_RSTST) & 0x7f;
  124. return 0;
  125. }
  126. EXPORT_SYMBOL(omap_prcm_get_reset_sources);
  127. /* Resets clock rates and reboots the system. Only called from system.h */
  128. void omap_prcm_arch_reset(char mode, const char *cmd)
  129. {
  130. s16 prcm_offs = 0;
  131. if (cpu_is_omap24xx()) {
  132. omap2xxx_clk_prepare_for_reboot();
  133. prcm_offs = WKUP_MOD;
  134. } else if (cpu_is_omap34xx()) {
  135. u32 l;
  136. prcm_offs = OMAP3430_GR_MOD;
  137. l = ('B' << 24) | ('M' << 16) | (cmd ? (u8)*cmd : 0);
  138. /* Reserve the first word in scratchpad for communicating
  139. * with the boot ROM. A pointer to a data structure
  140. * describing the boot process can be stored there,
  141. * cf. OMAP34xx TRM, Initialization / Software Booting
  142. * Configuration. */
  143. omap_writel(l, OMAP343X_SCRATCHPAD + 4);
  144. } else if (cpu_is_omap44xx())
  145. prcm_offs = OMAP4430_PRM_DEVICE_MOD;
  146. else
  147. WARN_ON(1);
  148. if (cpu_is_omap24xx() || cpu_is_omap34xx())
  149. prm_set_mod_reg_bits(OMAP_RST_DPLL3_MASK, prcm_offs,
  150. OMAP2_RM_RSTCTRL);
  151. if (cpu_is_omap44xx())
  152. prm_set_mod_reg_bits(OMAP4430_RST_GLOBAL_WARM_SW_MASK,
  153. prcm_offs, OMAP4_RM_RSTCTRL);
  154. }
  155. static inline u32 __omap_prcm_read(void __iomem *base, s16 module, u16 reg)
  156. {
  157. BUG_ON(!base);
  158. return __raw_readl(base + module + reg);
  159. }
  160. static inline void __omap_prcm_write(u32 value, void __iomem *base,
  161. s16 module, u16 reg)
  162. {
  163. BUG_ON(!base);
  164. __raw_writel(value, base + module + reg);
  165. }
  166. /* Read a register in a PRM module */
  167. u32 prm_read_mod_reg(s16 module, u16 idx)
  168. {
  169. return __omap_prcm_read(prm_base, module, idx);
  170. }
  171. /* Write into a register in a PRM module */
  172. void prm_write_mod_reg(u32 val, s16 module, u16 idx)
  173. {
  174. __omap_prcm_write(val, prm_base, module, idx);
  175. }
  176. /* Read-modify-write a register in a PRM module. Caller must lock */
  177. u32 prm_rmw_mod_reg_bits(u32 mask, u32 bits, s16 module, s16 idx)
  178. {
  179. u32 v;
  180. v = prm_read_mod_reg(module, idx);
  181. v &= ~mask;
  182. v |= bits;
  183. prm_write_mod_reg(v, module, idx);
  184. return v;
  185. }
  186. /* Read a PRM register, AND it, and shift the result down to bit 0 */
  187. u32 prm_read_mod_bits_shift(s16 domain, s16 idx, u32 mask)
  188. {
  189. u32 v;
  190. v = prm_read_mod_reg(domain, idx);
  191. v &= mask;
  192. v >>= __ffs(mask);
  193. return v;
  194. }
  195. /* Read a PRM register, AND it, and shift the result down to bit 0 */
  196. u32 omap4_prm_read_bits_shift(void __iomem *reg, u32 mask)
  197. {
  198. u32 v;
  199. v = __raw_readl(reg);
  200. v &= mask;
  201. v >>= __ffs(mask);
  202. return v;
  203. }
  204. /* Read-modify-write a register in a PRM module. Caller must lock */
  205. u32 omap4_prm_rmw_reg_bits(u32 mask, u32 bits, void __iomem *reg)
  206. {
  207. u32 v;
  208. v = __raw_readl(reg);
  209. v &= ~mask;
  210. v |= bits;
  211. __raw_writel(v, reg);
  212. return v;
  213. }
  214. /* Read a register in a CM module */
  215. u32 cm_read_mod_reg(s16 module, u16 idx)
  216. {
  217. return __omap_prcm_read(cm_base, module, idx);
  218. }
  219. /* Write into a register in a CM module */
  220. void cm_write_mod_reg(u32 val, s16 module, u16 idx)
  221. {
  222. __omap_prcm_write(val, cm_base, module, idx);
  223. }
  224. /* Read-modify-write a register in a CM module. Caller must lock */
  225. u32 cm_rmw_mod_reg_bits(u32 mask, u32 bits, s16 module, s16 idx)
  226. {
  227. u32 v;
  228. v = cm_read_mod_reg(module, idx);
  229. v &= ~mask;
  230. v |= bits;
  231. cm_write_mod_reg(v, module, idx);
  232. return v;
  233. }
  234. /**
  235. * omap2_cm_wait_idlest - wait for IDLEST bit to indicate module readiness
  236. * @reg: physical address of module IDLEST register
  237. * @mask: value to mask against to determine if the module is active
  238. * @idlest: idle state indicator (0 or 1) for the clock
  239. * @name: name of the clock (for printk)
  240. *
  241. * Returns 1 if the module indicated readiness in time, or 0 if it
  242. * failed to enable in roughly MAX_MODULE_ENABLE_WAIT microseconds.
  243. */
  244. int omap2_cm_wait_idlest(void __iomem *reg, u32 mask, u8 idlest,
  245. const char *name)
  246. {
  247. int i = 0;
  248. int ena = 0;
  249. if (idlest)
  250. ena = 0;
  251. else
  252. ena = mask;
  253. /* Wait for lock */
  254. omap_test_timeout(((__raw_readl(reg) & mask) == ena),
  255. MAX_MODULE_ENABLE_WAIT, i);
  256. if (i < MAX_MODULE_ENABLE_WAIT)
  257. pr_debug("cm: Module associated with clock %s ready after %d "
  258. "loops\n", name, i);
  259. else
  260. pr_err("cm: Module associated with clock %s didn't enable in "
  261. "%d tries\n", name, MAX_MODULE_ENABLE_WAIT);
  262. return (i < MAX_MODULE_ENABLE_WAIT) ? 1 : 0;
  263. };
  264. void __init omap2_set_globals_prcm(struct omap_globals *omap2_globals)
  265. {
  266. /* Static mapping, never released */
  267. if (omap2_globals->prm) {
  268. prm_base = ioremap(omap2_globals->prm, SZ_8K);
  269. WARN_ON(!prm_base);
  270. }
  271. if (omap2_globals->cm) {
  272. cm_base = ioremap(omap2_globals->cm, SZ_8K);
  273. WARN_ON(!cm_base);
  274. }
  275. if (omap2_globals->cm2) {
  276. cm2_base = ioremap(omap2_globals->cm2, SZ_8K);
  277. WARN_ON(!cm2_base);
  278. }
  279. }
  280. #ifdef CONFIG_ARCH_OMAP3
  281. void omap3_prcm_save_context(void)
  282. {
  283. prcm_context.control_padconf_sys_nirq =
  284. omap_ctrl_readl(OMAP343X_CONTROL_PADCONF_SYSNIRQ);
  285. prcm_context.iva2_cm_clksel1 =
  286. cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_CLKSEL1);
  287. prcm_context.iva2_cm_clksel2 =
  288. cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_CLKSEL2);
  289. prcm_context.cm_sysconfig = __raw_readl(OMAP3430_CM_SYSCONFIG);
  290. prcm_context.sgx_cm_clksel =
  291. cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_CLKSEL);
  292. prcm_context.dss_cm_clksel =
  293. cm_read_mod_reg(OMAP3430_DSS_MOD, CM_CLKSEL);
  294. prcm_context.cam_cm_clksel =
  295. cm_read_mod_reg(OMAP3430_CAM_MOD, CM_CLKSEL);
  296. prcm_context.per_cm_clksel =
  297. cm_read_mod_reg(OMAP3430_PER_MOD, CM_CLKSEL);
  298. prcm_context.emu_cm_clksel =
  299. cm_read_mod_reg(OMAP3430_EMU_MOD, CM_CLKSEL1);
  300. prcm_context.emu_cm_clkstctrl =
  301. cm_read_mod_reg(OMAP3430_EMU_MOD, OMAP2_CM_CLKSTCTRL);
  302. prcm_context.pll_cm_autoidle2 =
  303. cm_read_mod_reg(PLL_MOD, CM_AUTOIDLE2);
  304. prcm_context.pll_cm_clksel4 =
  305. cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKSEL4);
  306. prcm_context.pll_cm_clksel5 =
  307. cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKSEL5);
  308. prcm_context.pll_cm_clken2 =
  309. cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKEN2);
  310. prcm_context.cm_polctrl = __raw_readl(OMAP3430_CM_POLCTRL);
  311. prcm_context.iva2_cm_fclken =
  312. cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_FCLKEN);
  313. prcm_context.iva2_cm_clken_pll = cm_read_mod_reg(OMAP3430_IVA2_MOD,
  314. OMAP3430_CM_CLKEN_PLL);
  315. prcm_context.core_cm_fclken1 =
  316. cm_read_mod_reg(CORE_MOD, CM_FCLKEN1);
  317. prcm_context.core_cm_fclken3 =
  318. cm_read_mod_reg(CORE_MOD, OMAP3430ES2_CM_FCLKEN3);
  319. prcm_context.sgx_cm_fclken =
  320. cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_FCLKEN);
  321. prcm_context.wkup_cm_fclken =
  322. cm_read_mod_reg(WKUP_MOD, CM_FCLKEN);
  323. prcm_context.dss_cm_fclken =
  324. cm_read_mod_reg(OMAP3430_DSS_MOD, CM_FCLKEN);
  325. prcm_context.cam_cm_fclken =
  326. cm_read_mod_reg(OMAP3430_CAM_MOD, CM_FCLKEN);
  327. prcm_context.per_cm_fclken =
  328. cm_read_mod_reg(OMAP3430_PER_MOD, CM_FCLKEN);
  329. prcm_context.usbhost_cm_fclken =
  330. cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, CM_FCLKEN);
  331. prcm_context.core_cm_iclken1 =
  332. cm_read_mod_reg(CORE_MOD, CM_ICLKEN1);
  333. prcm_context.core_cm_iclken2 =
  334. cm_read_mod_reg(CORE_MOD, CM_ICLKEN2);
  335. prcm_context.core_cm_iclken3 =
  336. cm_read_mod_reg(CORE_MOD, CM_ICLKEN3);
  337. prcm_context.sgx_cm_iclken =
  338. cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_ICLKEN);
  339. prcm_context.wkup_cm_iclken =
  340. cm_read_mod_reg(WKUP_MOD, CM_ICLKEN);
  341. prcm_context.dss_cm_iclken =
  342. cm_read_mod_reg(OMAP3430_DSS_MOD, CM_ICLKEN);
  343. prcm_context.cam_cm_iclken =
  344. cm_read_mod_reg(OMAP3430_CAM_MOD, CM_ICLKEN);
  345. prcm_context.per_cm_iclken =
  346. cm_read_mod_reg(OMAP3430_PER_MOD, CM_ICLKEN);
  347. prcm_context.usbhost_cm_iclken =
  348. cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, CM_ICLKEN);
  349. prcm_context.iva2_cm_autiidle2 =
  350. cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_AUTOIDLE2);
  351. prcm_context.mpu_cm_autoidle2 =
  352. cm_read_mod_reg(MPU_MOD, CM_AUTOIDLE2);
  353. prcm_context.iva2_cm_clkstctrl =
  354. cm_read_mod_reg(OMAP3430_IVA2_MOD, OMAP2_CM_CLKSTCTRL);
  355. prcm_context.mpu_cm_clkstctrl =
  356. cm_read_mod_reg(MPU_MOD, OMAP2_CM_CLKSTCTRL);
  357. prcm_context.core_cm_clkstctrl =
  358. cm_read_mod_reg(CORE_MOD, OMAP2_CM_CLKSTCTRL);
  359. prcm_context.sgx_cm_clkstctrl =
  360. cm_read_mod_reg(OMAP3430ES2_SGX_MOD,
  361. OMAP2_CM_CLKSTCTRL);
  362. prcm_context.dss_cm_clkstctrl =
  363. cm_read_mod_reg(OMAP3430_DSS_MOD, OMAP2_CM_CLKSTCTRL);
  364. prcm_context.cam_cm_clkstctrl =
  365. cm_read_mod_reg(OMAP3430_CAM_MOD, OMAP2_CM_CLKSTCTRL);
  366. prcm_context.per_cm_clkstctrl =
  367. cm_read_mod_reg(OMAP3430_PER_MOD, OMAP2_CM_CLKSTCTRL);
  368. prcm_context.neon_cm_clkstctrl =
  369. cm_read_mod_reg(OMAP3430_NEON_MOD, OMAP2_CM_CLKSTCTRL);
  370. prcm_context.usbhost_cm_clkstctrl =
  371. cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD,
  372. OMAP2_CM_CLKSTCTRL);
  373. prcm_context.core_cm_autoidle1 =
  374. cm_read_mod_reg(CORE_MOD, CM_AUTOIDLE1);
  375. prcm_context.core_cm_autoidle2 =
  376. cm_read_mod_reg(CORE_MOD, CM_AUTOIDLE2);
  377. prcm_context.core_cm_autoidle3 =
  378. cm_read_mod_reg(CORE_MOD, CM_AUTOIDLE3);
  379. prcm_context.wkup_cm_autoidle =
  380. cm_read_mod_reg(WKUP_MOD, CM_AUTOIDLE);
  381. prcm_context.dss_cm_autoidle =
  382. cm_read_mod_reg(OMAP3430_DSS_MOD, CM_AUTOIDLE);
  383. prcm_context.cam_cm_autoidle =
  384. cm_read_mod_reg(OMAP3430_CAM_MOD, CM_AUTOIDLE);
  385. prcm_context.per_cm_autoidle =
  386. cm_read_mod_reg(OMAP3430_PER_MOD, CM_AUTOIDLE);
  387. prcm_context.usbhost_cm_autoidle =
  388. cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, CM_AUTOIDLE);
  389. prcm_context.sgx_cm_sleepdep =
  390. cm_read_mod_reg(OMAP3430ES2_SGX_MOD, OMAP3430_CM_SLEEPDEP);
  391. prcm_context.dss_cm_sleepdep =
  392. cm_read_mod_reg(OMAP3430_DSS_MOD, OMAP3430_CM_SLEEPDEP);
  393. prcm_context.cam_cm_sleepdep =
  394. cm_read_mod_reg(OMAP3430_CAM_MOD, OMAP3430_CM_SLEEPDEP);
  395. prcm_context.per_cm_sleepdep =
  396. cm_read_mod_reg(OMAP3430_PER_MOD, OMAP3430_CM_SLEEPDEP);
  397. prcm_context.usbhost_cm_sleepdep =
  398. cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, OMAP3430_CM_SLEEPDEP);
  399. prcm_context.cm_clkout_ctrl = cm_read_mod_reg(OMAP3430_CCR_MOD,
  400. OMAP3_CM_CLKOUT_CTRL_OFFSET);
  401. prcm_context.prm_clkout_ctrl = prm_read_mod_reg(OMAP3430_CCR_MOD,
  402. OMAP3_PRM_CLKOUT_CTRL_OFFSET);
  403. prcm_context.sgx_pm_wkdep =
  404. prm_read_mod_reg(OMAP3430ES2_SGX_MOD, PM_WKDEP);
  405. prcm_context.dss_pm_wkdep =
  406. prm_read_mod_reg(OMAP3430_DSS_MOD, PM_WKDEP);
  407. prcm_context.cam_pm_wkdep =
  408. prm_read_mod_reg(OMAP3430_CAM_MOD, PM_WKDEP);
  409. prcm_context.per_pm_wkdep =
  410. prm_read_mod_reg(OMAP3430_PER_MOD, PM_WKDEP);
  411. prcm_context.neon_pm_wkdep =
  412. prm_read_mod_reg(OMAP3430_NEON_MOD, PM_WKDEP);
  413. prcm_context.usbhost_pm_wkdep =
  414. prm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, PM_WKDEP);
  415. prcm_context.core_pm_mpugrpsel1 =
  416. prm_read_mod_reg(CORE_MOD, OMAP3430_PM_MPUGRPSEL1);
  417. prcm_context.iva2_pm_ivagrpsel1 =
  418. prm_read_mod_reg(OMAP3430_IVA2_MOD, OMAP3430_PM_IVAGRPSEL1);
  419. prcm_context.core_pm_mpugrpsel3 =
  420. prm_read_mod_reg(CORE_MOD, OMAP3430ES2_PM_MPUGRPSEL3);
  421. prcm_context.core_pm_ivagrpsel3 =
  422. prm_read_mod_reg(CORE_MOD, OMAP3430ES2_PM_IVAGRPSEL3);
  423. prcm_context.wkup_pm_mpugrpsel =
  424. prm_read_mod_reg(WKUP_MOD, OMAP3430_PM_MPUGRPSEL);
  425. prcm_context.wkup_pm_ivagrpsel =
  426. prm_read_mod_reg(WKUP_MOD, OMAP3430_PM_IVAGRPSEL);
  427. prcm_context.per_pm_mpugrpsel =
  428. prm_read_mod_reg(OMAP3430_PER_MOD, OMAP3430_PM_MPUGRPSEL);
  429. prcm_context.per_pm_ivagrpsel =
  430. prm_read_mod_reg(OMAP3430_PER_MOD, OMAP3430_PM_IVAGRPSEL);
  431. prcm_context.wkup_pm_wken = prm_read_mod_reg(WKUP_MOD, PM_WKEN);
  432. return;
  433. }
  434. void omap3_prcm_restore_context(void)
  435. {
  436. omap_ctrl_writel(prcm_context.control_padconf_sys_nirq,
  437. OMAP343X_CONTROL_PADCONF_SYSNIRQ);
  438. cm_write_mod_reg(prcm_context.iva2_cm_clksel1, OMAP3430_IVA2_MOD,
  439. CM_CLKSEL1);
  440. cm_write_mod_reg(prcm_context.iva2_cm_clksel2, OMAP3430_IVA2_MOD,
  441. CM_CLKSEL2);
  442. __raw_writel(prcm_context.cm_sysconfig, OMAP3430_CM_SYSCONFIG);
  443. cm_write_mod_reg(prcm_context.sgx_cm_clksel, OMAP3430ES2_SGX_MOD,
  444. CM_CLKSEL);
  445. cm_write_mod_reg(prcm_context.dss_cm_clksel, OMAP3430_DSS_MOD,
  446. CM_CLKSEL);
  447. cm_write_mod_reg(prcm_context.cam_cm_clksel, OMAP3430_CAM_MOD,
  448. CM_CLKSEL);
  449. cm_write_mod_reg(prcm_context.per_cm_clksel, OMAP3430_PER_MOD,
  450. CM_CLKSEL);
  451. cm_write_mod_reg(prcm_context.emu_cm_clksel, OMAP3430_EMU_MOD,
  452. CM_CLKSEL1);
  453. cm_write_mod_reg(prcm_context.emu_cm_clkstctrl, OMAP3430_EMU_MOD,
  454. OMAP2_CM_CLKSTCTRL);
  455. cm_write_mod_reg(prcm_context.pll_cm_autoidle2, PLL_MOD,
  456. CM_AUTOIDLE2);
  457. cm_write_mod_reg(prcm_context.pll_cm_clksel4, PLL_MOD,
  458. OMAP3430ES2_CM_CLKSEL4);
  459. cm_write_mod_reg(prcm_context.pll_cm_clksel5, PLL_MOD,
  460. OMAP3430ES2_CM_CLKSEL5);
  461. cm_write_mod_reg(prcm_context.pll_cm_clken2, PLL_MOD,
  462. OMAP3430ES2_CM_CLKEN2);
  463. __raw_writel(prcm_context.cm_polctrl, OMAP3430_CM_POLCTRL);
  464. cm_write_mod_reg(prcm_context.iva2_cm_fclken, OMAP3430_IVA2_MOD,
  465. CM_FCLKEN);
  466. cm_write_mod_reg(prcm_context.iva2_cm_clken_pll, OMAP3430_IVA2_MOD,
  467. OMAP3430_CM_CLKEN_PLL);
  468. cm_write_mod_reg(prcm_context.core_cm_fclken1, CORE_MOD, CM_FCLKEN1);
  469. cm_write_mod_reg(prcm_context.core_cm_fclken3, CORE_MOD,
  470. OMAP3430ES2_CM_FCLKEN3);
  471. cm_write_mod_reg(prcm_context.sgx_cm_fclken, OMAP3430ES2_SGX_MOD,
  472. CM_FCLKEN);
  473. cm_write_mod_reg(prcm_context.wkup_cm_fclken, WKUP_MOD, CM_FCLKEN);
  474. cm_write_mod_reg(prcm_context.dss_cm_fclken, OMAP3430_DSS_MOD,
  475. CM_FCLKEN);
  476. cm_write_mod_reg(prcm_context.cam_cm_fclken, OMAP3430_CAM_MOD,
  477. CM_FCLKEN);
  478. cm_write_mod_reg(prcm_context.per_cm_fclken, OMAP3430_PER_MOD,
  479. CM_FCLKEN);
  480. cm_write_mod_reg(prcm_context.usbhost_cm_fclken,
  481. OMAP3430ES2_USBHOST_MOD, CM_FCLKEN);
  482. cm_write_mod_reg(prcm_context.core_cm_iclken1, CORE_MOD, CM_ICLKEN1);
  483. cm_write_mod_reg(prcm_context.core_cm_iclken2, CORE_MOD, CM_ICLKEN2);
  484. cm_write_mod_reg(prcm_context.core_cm_iclken3, CORE_MOD, CM_ICLKEN3);
  485. cm_write_mod_reg(prcm_context.sgx_cm_iclken, OMAP3430ES2_SGX_MOD,
  486. CM_ICLKEN);
  487. cm_write_mod_reg(prcm_context.wkup_cm_iclken, WKUP_MOD, CM_ICLKEN);
  488. cm_write_mod_reg(prcm_context.dss_cm_iclken, OMAP3430_DSS_MOD,
  489. CM_ICLKEN);
  490. cm_write_mod_reg(prcm_context.cam_cm_iclken, OMAP3430_CAM_MOD,
  491. CM_ICLKEN);
  492. cm_write_mod_reg(prcm_context.per_cm_iclken, OMAP3430_PER_MOD,
  493. CM_ICLKEN);
  494. cm_write_mod_reg(prcm_context.usbhost_cm_iclken,
  495. OMAP3430ES2_USBHOST_MOD, CM_ICLKEN);
  496. cm_write_mod_reg(prcm_context.iva2_cm_autiidle2, OMAP3430_IVA2_MOD,
  497. CM_AUTOIDLE2);
  498. cm_write_mod_reg(prcm_context.mpu_cm_autoidle2, MPU_MOD, CM_AUTOIDLE2);
  499. cm_write_mod_reg(prcm_context.iva2_cm_clkstctrl, OMAP3430_IVA2_MOD,
  500. OMAP2_CM_CLKSTCTRL);
  501. cm_write_mod_reg(prcm_context.mpu_cm_clkstctrl, MPU_MOD,
  502. OMAP2_CM_CLKSTCTRL);
  503. cm_write_mod_reg(prcm_context.core_cm_clkstctrl, CORE_MOD,
  504. OMAP2_CM_CLKSTCTRL);
  505. cm_write_mod_reg(prcm_context.sgx_cm_clkstctrl, OMAP3430ES2_SGX_MOD,
  506. OMAP2_CM_CLKSTCTRL);
  507. cm_write_mod_reg(prcm_context.dss_cm_clkstctrl, OMAP3430_DSS_MOD,
  508. OMAP2_CM_CLKSTCTRL);
  509. cm_write_mod_reg(prcm_context.cam_cm_clkstctrl, OMAP3430_CAM_MOD,
  510. OMAP2_CM_CLKSTCTRL);
  511. cm_write_mod_reg(prcm_context.per_cm_clkstctrl, OMAP3430_PER_MOD,
  512. OMAP2_CM_CLKSTCTRL);
  513. cm_write_mod_reg(prcm_context.neon_cm_clkstctrl, OMAP3430_NEON_MOD,
  514. OMAP2_CM_CLKSTCTRL);
  515. cm_write_mod_reg(prcm_context.usbhost_cm_clkstctrl,
  516. OMAP3430ES2_USBHOST_MOD, OMAP2_CM_CLKSTCTRL);
  517. cm_write_mod_reg(prcm_context.core_cm_autoidle1, CORE_MOD,
  518. CM_AUTOIDLE1);
  519. cm_write_mod_reg(prcm_context.core_cm_autoidle2, CORE_MOD,
  520. CM_AUTOIDLE2);
  521. cm_write_mod_reg(prcm_context.core_cm_autoidle3, CORE_MOD,
  522. CM_AUTOIDLE3);
  523. cm_write_mod_reg(prcm_context.wkup_cm_autoidle, WKUP_MOD, CM_AUTOIDLE);
  524. cm_write_mod_reg(prcm_context.dss_cm_autoidle, OMAP3430_DSS_MOD,
  525. CM_AUTOIDLE);
  526. cm_write_mod_reg(prcm_context.cam_cm_autoidle, OMAP3430_CAM_MOD,
  527. CM_AUTOIDLE);
  528. cm_write_mod_reg(prcm_context.per_cm_autoidle, OMAP3430_PER_MOD,
  529. CM_AUTOIDLE);
  530. cm_write_mod_reg(prcm_context.usbhost_cm_autoidle,
  531. OMAP3430ES2_USBHOST_MOD, CM_AUTOIDLE);
  532. cm_write_mod_reg(prcm_context.sgx_cm_sleepdep, OMAP3430ES2_SGX_MOD,
  533. OMAP3430_CM_SLEEPDEP);
  534. cm_write_mod_reg(prcm_context.dss_cm_sleepdep, OMAP3430_DSS_MOD,
  535. OMAP3430_CM_SLEEPDEP);
  536. cm_write_mod_reg(prcm_context.cam_cm_sleepdep, OMAP3430_CAM_MOD,
  537. OMAP3430_CM_SLEEPDEP);
  538. cm_write_mod_reg(prcm_context.per_cm_sleepdep, OMAP3430_PER_MOD,
  539. OMAP3430_CM_SLEEPDEP);
  540. cm_write_mod_reg(prcm_context.usbhost_cm_sleepdep,
  541. OMAP3430ES2_USBHOST_MOD, OMAP3430_CM_SLEEPDEP);
  542. cm_write_mod_reg(prcm_context.cm_clkout_ctrl, OMAP3430_CCR_MOD,
  543. OMAP3_CM_CLKOUT_CTRL_OFFSET);
  544. prm_write_mod_reg(prcm_context.prm_clkout_ctrl, OMAP3430_CCR_MOD,
  545. OMAP3_PRM_CLKOUT_CTRL_OFFSET);
  546. prm_write_mod_reg(prcm_context.sgx_pm_wkdep, OMAP3430ES2_SGX_MOD,
  547. PM_WKDEP);
  548. prm_write_mod_reg(prcm_context.dss_pm_wkdep, OMAP3430_DSS_MOD,
  549. PM_WKDEP);
  550. prm_write_mod_reg(prcm_context.cam_pm_wkdep, OMAP3430_CAM_MOD,
  551. PM_WKDEP);
  552. prm_write_mod_reg(prcm_context.per_pm_wkdep, OMAP3430_PER_MOD,
  553. PM_WKDEP);
  554. prm_write_mod_reg(prcm_context.neon_pm_wkdep, OMAP3430_NEON_MOD,
  555. PM_WKDEP);
  556. prm_write_mod_reg(prcm_context.usbhost_pm_wkdep,
  557. OMAP3430ES2_USBHOST_MOD, PM_WKDEP);
  558. prm_write_mod_reg(prcm_context.core_pm_mpugrpsel1, CORE_MOD,
  559. OMAP3430_PM_MPUGRPSEL1);
  560. prm_write_mod_reg(prcm_context.iva2_pm_ivagrpsel1, OMAP3430_IVA2_MOD,
  561. OMAP3430_PM_IVAGRPSEL1);
  562. prm_write_mod_reg(prcm_context.core_pm_mpugrpsel3, CORE_MOD,
  563. OMAP3430ES2_PM_MPUGRPSEL3);
  564. prm_write_mod_reg(prcm_context.core_pm_ivagrpsel3, CORE_MOD,
  565. OMAP3430ES2_PM_IVAGRPSEL3);
  566. prm_write_mod_reg(prcm_context.wkup_pm_mpugrpsel, WKUP_MOD,
  567. OMAP3430_PM_MPUGRPSEL);
  568. prm_write_mod_reg(prcm_context.wkup_pm_ivagrpsel, WKUP_MOD,
  569. OMAP3430_PM_IVAGRPSEL);
  570. prm_write_mod_reg(prcm_context.per_pm_mpugrpsel, OMAP3430_PER_MOD,
  571. OMAP3430_PM_MPUGRPSEL);
  572. prm_write_mod_reg(prcm_context.per_pm_ivagrpsel, OMAP3430_PER_MOD,
  573. OMAP3430_PM_IVAGRPSEL);
  574. prm_write_mod_reg(prcm_context.wkup_pm_wken, WKUP_MOD, PM_WKEN);
  575. return;
  576. }
  577. #endif