prm44xx.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645
  1. /*
  2. * OMAP4 PRM module functions
  3. *
  4. * Copyright (C) 2011-2012 Texas Instruments, Inc.
  5. * Copyright (C) 2010 Nokia Corporation
  6. * Benoît Cousson
  7. * Paul Walmsley
  8. * Rajendra Nayak <rnayak@ti.com>
  9. *
  10. * This program is free software; you can redistribute it and/or modify
  11. * it under the terms of the GNU General Public License version 2 as
  12. * published by the Free Software Foundation.
  13. */
  14. #include <linux/kernel.h>
  15. #include <linux/delay.h>
  16. #include <linux/errno.h>
  17. #include <linux/err.h>
  18. #include <linux/io.h>
  19. #include <plat/prcm.h>
  20. #include "soc.h"
  21. #include "iomap.h"
  22. #include "common.h"
  23. #include "vp.h"
  24. #include "prm44xx.h"
  25. #include "prm-regbits-44xx.h"
  26. #include "prcm44xx.h"
  27. #include "prminst44xx.h"
  28. #include "powerdomain.h"
  29. /* Static data */
  30. static const struct omap_prcm_irq omap4_prcm_irqs[] = {
  31. OMAP_PRCM_IRQ("wkup", 0, 0),
  32. OMAP_PRCM_IRQ("io", 9, 1),
  33. };
  34. static struct omap_prcm_irq_setup omap4_prcm_irq_setup = {
  35. .ack = OMAP4_PRM_IRQSTATUS_MPU_OFFSET,
  36. .mask = OMAP4_PRM_IRQENABLE_MPU_OFFSET,
  37. .nr_regs = 2,
  38. .irqs = omap4_prcm_irqs,
  39. .nr_irqs = ARRAY_SIZE(omap4_prcm_irqs),
  40. .irq = 11 + OMAP44XX_IRQ_GIC_START,
  41. .read_pending_irqs = &omap44xx_prm_read_pending_irqs,
  42. .ocp_barrier = &omap44xx_prm_ocp_barrier,
  43. .save_and_clear_irqen = &omap44xx_prm_save_and_clear_irqen,
  44. .restore_irqen = &omap44xx_prm_restore_irqen,
  45. };
  46. /*
  47. * omap44xx_prm_reset_src_map - map from bits in the PRM_RSTST
  48. * hardware register (which are specific to OMAP44xx SoCs) to reset
  49. * source ID bit shifts (which is an OMAP SoC-independent
  50. * enumeration)
  51. */
  52. static struct prm_reset_src_map omap44xx_prm_reset_src_map[] = {
  53. { OMAP4430_RST_GLOBAL_WARM_SW_SHIFT,
  54. OMAP_GLOBAL_WARM_RST_SRC_ID_SHIFT },
  55. { OMAP4430_RST_GLOBAL_COLD_SW_SHIFT,
  56. OMAP_GLOBAL_COLD_RST_SRC_ID_SHIFT },
  57. { OMAP4430_MPU_SECURITY_VIOL_RST_SHIFT,
  58. OMAP_SECU_VIOL_RST_SRC_ID_SHIFT },
  59. { OMAP4430_MPU_WDT_RST_SHIFT, OMAP_MPU_WD_RST_SRC_ID_SHIFT },
  60. { OMAP4430_SECURE_WDT_RST_SHIFT, OMAP_SECU_WD_RST_SRC_ID_SHIFT },
  61. { OMAP4430_EXTERNAL_WARM_RST_SHIFT, OMAP_EXTWARM_RST_SRC_ID_SHIFT },
  62. { OMAP4430_VDD_MPU_VOLT_MGR_RST_SHIFT,
  63. OMAP_VDD_MPU_VM_RST_SRC_ID_SHIFT },
  64. { OMAP4430_VDD_IVA_VOLT_MGR_RST_SHIFT,
  65. OMAP_VDD_IVA_VM_RST_SRC_ID_SHIFT },
  66. { OMAP4430_VDD_CORE_VOLT_MGR_RST_SHIFT,
  67. OMAP_VDD_CORE_VM_RST_SRC_ID_SHIFT },
  68. { OMAP4430_ICEPICK_RST_SHIFT, OMAP_ICEPICK_RST_SRC_ID_SHIFT },
  69. { OMAP4430_C2C_RST_SHIFT, OMAP_C2C_RST_SRC_ID_SHIFT },
  70. { -1, -1 },
  71. };
  72. /* PRM low-level functions */
  73. /* Read a register in a CM/PRM instance in the PRM module */
  74. u32 omap4_prm_read_inst_reg(s16 inst, u16 reg)
  75. {
  76. return __raw_readl(OMAP44XX_PRM_REGADDR(inst, reg));
  77. }
  78. /* Write into a register in a CM/PRM instance in the PRM module */
  79. void omap4_prm_write_inst_reg(u32 val, s16 inst, u16 reg)
  80. {
  81. __raw_writel(val, OMAP44XX_PRM_REGADDR(inst, reg));
  82. }
  83. /* Read-modify-write a register in a PRM module. Caller must lock */
  84. u32 omap4_prm_rmw_inst_reg_bits(u32 mask, u32 bits, s16 inst, s16 reg)
  85. {
  86. u32 v;
  87. v = omap4_prm_read_inst_reg(inst, reg);
  88. v &= ~mask;
  89. v |= bits;
  90. omap4_prm_write_inst_reg(v, inst, reg);
  91. return v;
  92. }
  93. /* PRM VP */
  94. /*
  95. * struct omap4_vp - OMAP4 VP register access description.
  96. * @irqstatus_mpu: offset to IRQSTATUS_MPU register for VP
  97. * @tranxdone_status: VP_TRANXDONE_ST bitmask in PRM_IRQSTATUS_MPU reg
  98. */
  99. struct omap4_vp {
  100. u32 irqstatus_mpu;
  101. u32 tranxdone_status;
  102. };
  103. static struct omap4_vp omap4_vp[] = {
  104. [OMAP4_VP_VDD_MPU_ID] = {
  105. .irqstatus_mpu = OMAP4_PRM_IRQSTATUS_MPU_2_OFFSET,
  106. .tranxdone_status = OMAP4430_VP_MPU_TRANXDONE_ST_MASK,
  107. },
  108. [OMAP4_VP_VDD_IVA_ID] = {
  109. .irqstatus_mpu = OMAP4_PRM_IRQSTATUS_MPU_OFFSET,
  110. .tranxdone_status = OMAP4430_VP_IVA_TRANXDONE_ST_MASK,
  111. },
  112. [OMAP4_VP_VDD_CORE_ID] = {
  113. .irqstatus_mpu = OMAP4_PRM_IRQSTATUS_MPU_OFFSET,
  114. .tranxdone_status = OMAP4430_VP_CORE_TRANXDONE_ST_MASK,
  115. },
  116. };
  117. u32 omap4_prm_vp_check_txdone(u8 vp_id)
  118. {
  119. struct omap4_vp *vp = &omap4_vp[vp_id];
  120. u32 irqstatus;
  121. irqstatus = omap4_prminst_read_inst_reg(OMAP4430_PRM_PARTITION,
  122. OMAP4430_PRM_OCP_SOCKET_INST,
  123. vp->irqstatus_mpu);
  124. return irqstatus & vp->tranxdone_status;
  125. }
  126. void omap4_prm_vp_clear_txdone(u8 vp_id)
  127. {
  128. struct omap4_vp *vp = &omap4_vp[vp_id];
  129. omap4_prminst_write_inst_reg(vp->tranxdone_status,
  130. OMAP4430_PRM_PARTITION,
  131. OMAP4430_PRM_OCP_SOCKET_INST,
  132. vp->irqstatus_mpu);
  133. };
  134. u32 omap4_prm_vcvp_read(u8 offset)
  135. {
  136. return omap4_prminst_read_inst_reg(OMAP4430_PRM_PARTITION,
  137. OMAP4430_PRM_DEVICE_INST, offset);
  138. }
  139. void omap4_prm_vcvp_write(u32 val, u8 offset)
  140. {
  141. omap4_prminst_write_inst_reg(val, OMAP4430_PRM_PARTITION,
  142. OMAP4430_PRM_DEVICE_INST, offset);
  143. }
  144. u32 omap4_prm_vcvp_rmw(u32 mask, u32 bits, u8 offset)
  145. {
  146. return omap4_prminst_rmw_inst_reg_bits(mask, bits,
  147. OMAP4430_PRM_PARTITION,
  148. OMAP4430_PRM_DEVICE_INST,
  149. offset);
  150. }
  151. static inline u32 _read_pending_irq_reg(u16 irqen_offs, u16 irqst_offs)
  152. {
  153. u32 mask, st;
  154. /* XXX read mask from RAM? */
  155. mask = omap4_prm_read_inst_reg(OMAP4430_PRM_OCP_SOCKET_INST,
  156. irqen_offs);
  157. st = omap4_prm_read_inst_reg(OMAP4430_PRM_OCP_SOCKET_INST, irqst_offs);
  158. return mask & st;
  159. }
  160. /**
  161. * omap44xx_prm_read_pending_irqs - read pending PRM MPU IRQs into @events
  162. * @events: ptr to two consecutive u32s, preallocated by caller
  163. *
  164. * Read PRM_IRQSTATUS_MPU* bits, AND'ed with the currently-enabled PRM
  165. * MPU IRQs, and store the result into the two u32s pointed to by @events.
  166. * No return value.
  167. */
  168. void omap44xx_prm_read_pending_irqs(unsigned long *events)
  169. {
  170. events[0] = _read_pending_irq_reg(OMAP4_PRM_IRQENABLE_MPU_OFFSET,
  171. OMAP4_PRM_IRQSTATUS_MPU_OFFSET);
  172. events[1] = _read_pending_irq_reg(OMAP4_PRM_IRQENABLE_MPU_2_OFFSET,
  173. OMAP4_PRM_IRQSTATUS_MPU_2_OFFSET);
  174. }
  175. /**
  176. * omap44xx_prm_ocp_barrier - force buffered MPU writes to the PRM to complete
  177. *
  178. * Force any buffered writes to the PRM IP block to complete. Needed
  179. * by the PRM IRQ handler, which reads and writes directly to the IP
  180. * block, to avoid race conditions after acknowledging or clearing IRQ
  181. * bits. No return value.
  182. */
  183. void omap44xx_prm_ocp_barrier(void)
  184. {
  185. omap4_prm_read_inst_reg(OMAP4430_PRM_OCP_SOCKET_INST,
  186. OMAP4_REVISION_PRM_OFFSET);
  187. }
  188. /**
  189. * omap44xx_prm_save_and_clear_irqen - save/clear PRM_IRQENABLE_MPU* regs
  190. * @saved_mask: ptr to a u32 array to save IRQENABLE bits
  191. *
  192. * Save the PRM_IRQENABLE_MPU and PRM_IRQENABLE_MPU_2 registers to
  193. * @saved_mask. @saved_mask must be allocated by the caller.
  194. * Intended to be used in the PRM interrupt handler suspend callback.
  195. * The OCP barrier is needed to ensure the write to disable PRM
  196. * interrupts reaches the PRM before returning; otherwise, spurious
  197. * interrupts might occur. No return value.
  198. */
  199. void omap44xx_prm_save_and_clear_irqen(u32 *saved_mask)
  200. {
  201. saved_mask[0] =
  202. omap4_prm_read_inst_reg(OMAP4430_PRM_OCP_SOCKET_INST,
  203. OMAP4_PRM_IRQSTATUS_MPU_OFFSET);
  204. saved_mask[1] =
  205. omap4_prm_read_inst_reg(OMAP4430_PRM_OCP_SOCKET_INST,
  206. OMAP4_PRM_IRQSTATUS_MPU_2_OFFSET);
  207. omap4_prm_write_inst_reg(0, OMAP4430_PRM_OCP_SOCKET_INST,
  208. OMAP4_PRM_IRQENABLE_MPU_OFFSET);
  209. omap4_prm_write_inst_reg(0, OMAP4430_PRM_OCP_SOCKET_INST,
  210. OMAP4_PRM_IRQENABLE_MPU_2_OFFSET);
  211. /* OCP barrier */
  212. omap4_prm_read_inst_reg(OMAP4430_PRM_OCP_SOCKET_INST,
  213. OMAP4_REVISION_PRM_OFFSET);
  214. }
  215. /**
  216. * omap44xx_prm_restore_irqen - set PRM_IRQENABLE_MPU* registers from args
  217. * @saved_mask: ptr to a u32 array of IRQENABLE bits saved previously
  218. *
  219. * Restore the PRM_IRQENABLE_MPU and PRM_IRQENABLE_MPU_2 registers from
  220. * @saved_mask. Intended to be used in the PRM interrupt handler resume
  221. * callback to restore values saved by omap44xx_prm_save_and_clear_irqen().
  222. * No OCP barrier should be needed here; any pending PRM interrupts will fire
  223. * once the writes reach the PRM. No return value.
  224. */
  225. void omap44xx_prm_restore_irqen(u32 *saved_mask)
  226. {
  227. omap4_prm_write_inst_reg(saved_mask[0], OMAP4430_PRM_OCP_SOCKET_INST,
  228. OMAP4_PRM_IRQENABLE_MPU_OFFSET);
  229. omap4_prm_write_inst_reg(saved_mask[1], OMAP4430_PRM_OCP_SOCKET_INST,
  230. OMAP4_PRM_IRQENABLE_MPU_2_OFFSET);
  231. }
  232. /**
  233. * omap44xx_prm_reconfigure_io_chain - clear latches and reconfigure I/O chain
  234. *
  235. * Clear any previously-latched I/O wakeup events and ensure that the
  236. * I/O wakeup gates are aligned with the current mux settings. Works
  237. * by asserting WUCLKIN, waiting for WUCLKOUT to be asserted, and then
  238. * deasserting WUCLKIN and waiting for WUCLKOUT to be deasserted.
  239. * No return value. XXX Are the final two steps necessary?
  240. */
  241. void omap44xx_prm_reconfigure_io_chain(void)
  242. {
  243. int i = 0;
  244. /* Trigger WUCLKIN enable */
  245. omap4_prm_rmw_inst_reg_bits(OMAP4430_WUCLK_CTRL_MASK,
  246. OMAP4430_WUCLK_CTRL_MASK,
  247. OMAP4430_PRM_DEVICE_INST,
  248. OMAP4_PRM_IO_PMCTRL_OFFSET);
  249. omap_test_timeout(
  250. (((omap4_prm_read_inst_reg(OMAP4430_PRM_DEVICE_INST,
  251. OMAP4_PRM_IO_PMCTRL_OFFSET) &
  252. OMAP4430_WUCLK_STATUS_MASK) >>
  253. OMAP4430_WUCLK_STATUS_SHIFT) == 1),
  254. MAX_IOPAD_LATCH_TIME, i);
  255. if (i == MAX_IOPAD_LATCH_TIME)
  256. pr_warn("PRM: I/O chain clock line assertion timed out\n");
  257. /* Trigger WUCLKIN disable */
  258. omap4_prm_rmw_inst_reg_bits(OMAP4430_WUCLK_CTRL_MASK, 0x0,
  259. OMAP4430_PRM_DEVICE_INST,
  260. OMAP4_PRM_IO_PMCTRL_OFFSET);
  261. omap_test_timeout(
  262. (((omap4_prm_read_inst_reg(OMAP4430_PRM_DEVICE_INST,
  263. OMAP4_PRM_IO_PMCTRL_OFFSET) &
  264. OMAP4430_WUCLK_STATUS_MASK) >>
  265. OMAP4430_WUCLK_STATUS_SHIFT) == 0),
  266. MAX_IOPAD_LATCH_TIME, i);
  267. if (i == MAX_IOPAD_LATCH_TIME)
  268. pr_warn("PRM: I/O chain clock line deassertion timed out\n");
  269. return;
  270. }
  271. /**
  272. * omap44xx_prm_enable_io_wakeup - enable wakeup events from I/O wakeup latches
  273. *
  274. * Activates the I/O wakeup event latches and allows events logged by
  275. * those latches to signal a wakeup event to the PRCM. For I/O wakeups
  276. * to occur, WAKEUPENABLE bits must be set in the pad mux registers, and
  277. * omap44xx_prm_reconfigure_io_chain() must be called. No return value.
  278. */
  279. static void __init omap44xx_prm_enable_io_wakeup(void)
  280. {
  281. omap4_prm_rmw_inst_reg_bits(OMAP4430_GLOBAL_WUEN_MASK,
  282. OMAP4430_GLOBAL_WUEN_MASK,
  283. OMAP4430_PRM_DEVICE_INST,
  284. OMAP4_PRM_IO_PMCTRL_OFFSET);
  285. }
  286. /**
  287. * omap44xx_prm_read_reset_sources - return the last SoC reset source
  288. *
  289. * Return a u32 representing the last reset sources of the SoC. The
  290. * returned reset source bits are standardized across OMAP SoCs.
  291. */
  292. static u32 omap44xx_prm_read_reset_sources(void)
  293. {
  294. struct prm_reset_src_map *p;
  295. u32 r = 0;
  296. u32 v;
  297. v = omap4_prm_read_inst_reg(OMAP4430_PRM_OCP_SOCKET_INST,
  298. OMAP4_RM_RSTST);
  299. p = omap44xx_prm_reset_src_map;
  300. while (p->reg_shift >= 0 && p->std_shift >= 0) {
  301. if (v & (1 << p->reg_shift))
  302. r |= 1 << p->std_shift;
  303. p++;
  304. }
  305. return r;
  306. }
  307. /* Powerdomain low-level functions */
  308. static int omap4_pwrdm_set_next_pwrst(struct powerdomain *pwrdm, u8 pwrst)
  309. {
  310. omap4_prminst_rmw_inst_reg_bits(OMAP_POWERSTATE_MASK,
  311. (pwrst << OMAP_POWERSTATE_SHIFT),
  312. pwrdm->prcm_partition,
  313. pwrdm->prcm_offs, OMAP4_PM_PWSTCTRL);
  314. return 0;
  315. }
  316. static int omap4_pwrdm_read_next_pwrst(struct powerdomain *pwrdm)
  317. {
  318. u32 v;
  319. v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
  320. OMAP4_PM_PWSTCTRL);
  321. v &= OMAP_POWERSTATE_MASK;
  322. v >>= OMAP_POWERSTATE_SHIFT;
  323. return v;
  324. }
  325. static int omap4_pwrdm_read_pwrst(struct powerdomain *pwrdm)
  326. {
  327. u32 v;
  328. v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
  329. OMAP4_PM_PWSTST);
  330. v &= OMAP_POWERSTATEST_MASK;
  331. v >>= OMAP_POWERSTATEST_SHIFT;
  332. return v;
  333. }
  334. static int omap4_pwrdm_read_prev_pwrst(struct powerdomain *pwrdm)
  335. {
  336. u32 v;
  337. v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
  338. OMAP4_PM_PWSTST);
  339. v &= OMAP4430_LASTPOWERSTATEENTERED_MASK;
  340. v >>= OMAP4430_LASTPOWERSTATEENTERED_SHIFT;
  341. return v;
  342. }
  343. static int omap4_pwrdm_set_lowpwrstchange(struct powerdomain *pwrdm)
  344. {
  345. omap4_prminst_rmw_inst_reg_bits(OMAP4430_LOWPOWERSTATECHANGE_MASK,
  346. (1 << OMAP4430_LOWPOWERSTATECHANGE_SHIFT),
  347. pwrdm->prcm_partition,
  348. pwrdm->prcm_offs, OMAP4_PM_PWSTCTRL);
  349. return 0;
  350. }
  351. static int omap4_pwrdm_clear_all_prev_pwrst(struct powerdomain *pwrdm)
  352. {
  353. omap4_prminst_rmw_inst_reg_bits(OMAP4430_LASTPOWERSTATEENTERED_MASK,
  354. OMAP4430_LASTPOWERSTATEENTERED_MASK,
  355. pwrdm->prcm_partition,
  356. pwrdm->prcm_offs, OMAP4_PM_PWSTST);
  357. return 0;
  358. }
  359. static int omap4_pwrdm_set_logic_retst(struct powerdomain *pwrdm, u8 pwrst)
  360. {
  361. u32 v;
  362. v = pwrst << __ffs(OMAP4430_LOGICRETSTATE_MASK);
  363. omap4_prminst_rmw_inst_reg_bits(OMAP4430_LOGICRETSTATE_MASK, v,
  364. pwrdm->prcm_partition, pwrdm->prcm_offs,
  365. OMAP4_PM_PWSTCTRL);
  366. return 0;
  367. }
  368. static int omap4_pwrdm_set_mem_onst(struct powerdomain *pwrdm, u8 bank,
  369. u8 pwrst)
  370. {
  371. u32 m;
  372. m = omap2_pwrdm_get_mem_bank_onstate_mask(bank);
  373. omap4_prminst_rmw_inst_reg_bits(m, (pwrst << __ffs(m)),
  374. pwrdm->prcm_partition, pwrdm->prcm_offs,
  375. OMAP4_PM_PWSTCTRL);
  376. return 0;
  377. }
  378. static int omap4_pwrdm_set_mem_retst(struct powerdomain *pwrdm, u8 bank,
  379. u8 pwrst)
  380. {
  381. u32 m;
  382. m = omap2_pwrdm_get_mem_bank_retst_mask(bank);
  383. omap4_prminst_rmw_inst_reg_bits(m, (pwrst << __ffs(m)),
  384. pwrdm->prcm_partition, pwrdm->prcm_offs,
  385. OMAP4_PM_PWSTCTRL);
  386. return 0;
  387. }
  388. static int omap4_pwrdm_read_logic_pwrst(struct powerdomain *pwrdm)
  389. {
  390. u32 v;
  391. v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
  392. OMAP4_PM_PWSTST);
  393. v &= OMAP4430_LOGICSTATEST_MASK;
  394. v >>= OMAP4430_LOGICSTATEST_SHIFT;
  395. return v;
  396. }
  397. static int omap4_pwrdm_read_logic_retst(struct powerdomain *pwrdm)
  398. {
  399. u32 v;
  400. v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
  401. OMAP4_PM_PWSTCTRL);
  402. v &= OMAP4430_LOGICRETSTATE_MASK;
  403. v >>= OMAP4430_LOGICRETSTATE_SHIFT;
  404. return v;
  405. }
  406. /**
  407. * omap4_pwrdm_read_prev_logic_pwrst - read the previous logic powerstate
  408. * @pwrdm: struct powerdomain * to read the state for
  409. *
  410. * Reads the previous logic powerstate for a powerdomain. This
  411. * function must determine the previous logic powerstate by first
  412. * checking the previous powerstate for the domain. If that was OFF,
  413. * then logic has been lost. If previous state was RETENTION, the
  414. * function reads the setting for the next retention logic state to
  415. * see the actual value. In every other case, the logic is
  416. * retained. Returns either PWRDM_POWER_OFF or PWRDM_POWER_RET
  417. * depending whether the logic was retained or not.
  418. */
  419. static int omap4_pwrdm_read_prev_logic_pwrst(struct powerdomain *pwrdm)
  420. {
  421. int state;
  422. state = omap4_pwrdm_read_prev_pwrst(pwrdm);
  423. if (state == PWRDM_POWER_OFF)
  424. return PWRDM_POWER_OFF;
  425. if (state != PWRDM_POWER_RET)
  426. return PWRDM_POWER_RET;
  427. return omap4_pwrdm_read_logic_retst(pwrdm);
  428. }
  429. static int omap4_pwrdm_read_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
  430. {
  431. u32 m, v;
  432. m = omap2_pwrdm_get_mem_bank_stst_mask(bank);
  433. v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
  434. OMAP4_PM_PWSTST);
  435. v &= m;
  436. v >>= __ffs(m);
  437. return v;
  438. }
  439. static int omap4_pwrdm_read_mem_retst(struct powerdomain *pwrdm, u8 bank)
  440. {
  441. u32 m, v;
  442. m = omap2_pwrdm_get_mem_bank_retst_mask(bank);
  443. v = omap4_prminst_read_inst_reg(pwrdm->prcm_partition, pwrdm->prcm_offs,
  444. OMAP4_PM_PWSTCTRL);
  445. v &= m;
  446. v >>= __ffs(m);
  447. return v;
  448. }
  449. /**
  450. * omap4_pwrdm_read_prev_mem_pwrst - reads the previous memory powerstate
  451. * @pwrdm: struct powerdomain * to read mem powerstate for
  452. * @bank: memory bank index
  453. *
  454. * Reads the previous memory powerstate for a powerdomain. This
  455. * function must determine the previous memory powerstate by first
  456. * checking the previous powerstate for the domain. If that was OFF,
  457. * then logic has been lost. If previous state was RETENTION, the
  458. * function reads the setting for the next memory retention state to
  459. * see the actual value. In every other case, the logic is
  460. * retained. Returns either PWRDM_POWER_OFF or PWRDM_POWER_RET
  461. * depending whether logic was retained or not.
  462. */
  463. static int omap4_pwrdm_read_prev_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
  464. {
  465. int state;
  466. state = omap4_pwrdm_read_prev_pwrst(pwrdm);
  467. if (state == PWRDM_POWER_OFF)
  468. return PWRDM_POWER_OFF;
  469. if (state != PWRDM_POWER_RET)
  470. return PWRDM_POWER_RET;
  471. return omap4_pwrdm_read_mem_retst(pwrdm, bank);
  472. }
  473. static int omap4_pwrdm_wait_transition(struct powerdomain *pwrdm)
  474. {
  475. u32 c = 0;
  476. /*
  477. * REVISIT: pwrdm_wait_transition() may be better implemented
  478. * via a callback and a periodic timer check -- how long do we expect
  479. * powerdomain transitions to take?
  480. */
  481. /* XXX Is this udelay() value meaningful? */
  482. while ((omap4_prminst_read_inst_reg(pwrdm->prcm_partition,
  483. pwrdm->prcm_offs,
  484. OMAP4_PM_PWSTST) &
  485. OMAP_INTRANSITION_MASK) &&
  486. (c++ < PWRDM_TRANSITION_BAILOUT))
  487. udelay(1);
  488. if (c > PWRDM_TRANSITION_BAILOUT) {
  489. pr_err("powerdomain: %s: waited too long to complete transition\n",
  490. pwrdm->name);
  491. return -EAGAIN;
  492. }
  493. pr_debug("powerdomain: completed transition in %d loops\n", c);
  494. return 0;
  495. }
  496. struct pwrdm_ops omap4_pwrdm_operations = {
  497. .pwrdm_set_next_pwrst = omap4_pwrdm_set_next_pwrst,
  498. .pwrdm_read_next_pwrst = omap4_pwrdm_read_next_pwrst,
  499. .pwrdm_read_pwrst = omap4_pwrdm_read_pwrst,
  500. .pwrdm_read_prev_pwrst = omap4_pwrdm_read_prev_pwrst,
  501. .pwrdm_set_lowpwrstchange = omap4_pwrdm_set_lowpwrstchange,
  502. .pwrdm_clear_all_prev_pwrst = omap4_pwrdm_clear_all_prev_pwrst,
  503. .pwrdm_set_logic_retst = omap4_pwrdm_set_logic_retst,
  504. .pwrdm_read_logic_pwrst = omap4_pwrdm_read_logic_pwrst,
  505. .pwrdm_read_prev_logic_pwrst = omap4_pwrdm_read_prev_logic_pwrst,
  506. .pwrdm_read_logic_retst = omap4_pwrdm_read_logic_retst,
  507. .pwrdm_read_mem_pwrst = omap4_pwrdm_read_mem_pwrst,
  508. .pwrdm_read_mem_retst = omap4_pwrdm_read_mem_retst,
  509. .pwrdm_read_prev_mem_pwrst = omap4_pwrdm_read_prev_mem_pwrst,
  510. .pwrdm_set_mem_onst = omap4_pwrdm_set_mem_onst,
  511. .pwrdm_set_mem_retst = omap4_pwrdm_set_mem_retst,
  512. .pwrdm_wait_transition = omap4_pwrdm_wait_transition,
  513. };
  514. /*
  515. * XXX document
  516. */
  517. static struct prm_ll_data omap44xx_prm_ll_data = {
  518. .read_reset_sources = &omap44xx_prm_read_reset_sources,
  519. };
  520. static int __init omap44xx_prm_init(void)
  521. {
  522. int ret;
  523. if (!cpu_is_omap44xx())
  524. return 0;
  525. ret = prm_register(&omap44xx_prm_ll_data);
  526. if (ret)
  527. return ret;
  528. omap44xx_prm_enable_io_wakeup();
  529. return omap_prcm_register_chain_handler(&omap4_prcm_irq_setup);
  530. }
  531. subsys_initcall(omap44xx_prm_init);
  532. static void __exit omap44xx_prm_exit(void)
  533. {
  534. if (!cpu_is_omap44xx())
  535. return;
  536. /* Should never happen */
  537. WARN(prm_unregister(&omap44xx_prm_ll_data),
  538. "%s: prm_ll_data function pointer mismatch\n", __func__);
  539. }
  540. __exitcall(omap44xx_prm_exit);