prcm.c 19 KB

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