powerdomain.c 28 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045
  1. /*
  2. * OMAP powerdomain control
  3. *
  4. * Copyright (C) 2007-2008 Texas Instruments, Inc.
  5. * Copyright (C) 2007-2008 Nokia Corporation
  6. *
  7. * Written by Paul Walmsley
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License version 2 as
  11. * published by the Free Software Foundation.
  12. */
  13. #ifdef CONFIG_OMAP_DEBUG_POWERDOMAIN
  14. # define DEBUG
  15. #endif
  16. #include <linux/kernel.h>
  17. #include <linux/module.h>
  18. #include <linux/types.h>
  19. #include <linux/delay.h>
  20. #include <linux/spinlock.h>
  21. #include <linux/list.h>
  22. #include <linux/errno.h>
  23. #include <linux/err.h>
  24. #include <linux/io.h>
  25. #include <asm/atomic.h>
  26. #include "cm.h"
  27. #include "cm-regbits-34xx.h"
  28. #include "prm.h"
  29. #include "prm-regbits-34xx.h"
  30. #include <mach/cpu.h>
  31. #include <mach/powerdomain.h>
  32. #include <mach/clockdomain.h>
  33. /* pwrdm_list contains all registered struct powerdomains */
  34. static LIST_HEAD(pwrdm_list);
  35. /*
  36. * pwrdm_rwlock protects pwrdm_list add and del ops - also reused to
  37. * protect pwrdm_clkdms[] during clkdm add/del ops
  38. */
  39. static DEFINE_RWLOCK(pwrdm_rwlock);
  40. /* Private functions */
  41. static u32 prm_read_mod_bits_shift(s16 domain, s16 idx, u32 mask)
  42. {
  43. u32 v;
  44. v = prm_read_mod_reg(domain, idx);
  45. v &= mask;
  46. v >>= __ffs(mask);
  47. return v;
  48. }
  49. static struct powerdomain *_pwrdm_lookup(const char *name)
  50. {
  51. struct powerdomain *pwrdm, *temp_pwrdm;
  52. pwrdm = NULL;
  53. list_for_each_entry(temp_pwrdm, &pwrdm_list, node) {
  54. if (!strcmp(name, temp_pwrdm->name)) {
  55. pwrdm = temp_pwrdm;
  56. break;
  57. }
  58. }
  59. return pwrdm;
  60. }
  61. /* _pwrdm_deps_lookup - look up the specified powerdomain in a pwrdm list */
  62. static struct powerdomain *_pwrdm_deps_lookup(struct powerdomain *pwrdm,
  63. struct pwrdm_dep *deps)
  64. {
  65. struct pwrdm_dep *pd;
  66. if (!pwrdm || !deps || !omap_chip_is(pwrdm->omap_chip))
  67. return ERR_PTR(-EINVAL);
  68. for (pd = deps; pd; pd++) {
  69. if (!omap_chip_is(pd->omap_chip))
  70. continue;
  71. if (!pd->pwrdm && pd->pwrdm_name)
  72. pd->pwrdm = pwrdm_lookup(pd->pwrdm_name);
  73. if (pd->pwrdm == pwrdm)
  74. break;
  75. }
  76. if (!pd)
  77. return ERR_PTR(-ENOENT);
  78. return pd->pwrdm;
  79. }
  80. /* Public functions */
  81. /**
  82. * pwrdm_init - set up the powerdomain layer
  83. *
  84. * Loop through the list of powerdomains, registering all that are
  85. * available on the current CPU. If pwrdm_list is supplied and not
  86. * null, all of the referenced powerdomains will be registered. No
  87. * return value.
  88. */
  89. void pwrdm_init(struct powerdomain **pwrdm_list)
  90. {
  91. struct powerdomain **p = NULL;
  92. if (pwrdm_list)
  93. for (p = pwrdm_list; *p; p++)
  94. pwrdm_register(*p);
  95. }
  96. /**
  97. * pwrdm_register - register a powerdomain
  98. * @pwrdm: struct powerdomain * to register
  99. *
  100. * Adds a powerdomain to the internal powerdomain list. Returns
  101. * -EINVAL if given a null pointer, -EEXIST if a powerdomain is
  102. * already registered by the provided name, or 0 upon success.
  103. */
  104. int pwrdm_register(struct powerdomain *pwrdm)
  105. {
  106. unsigned long flags;
  107. int ret = -EINVAL;
  108. if (!pwrdm)
  109. return -EINVAL;
  110. if (!omap_chip_is(pwrdm->omap_chip))
  111. return -EINVAL;
  112. write_lock_irqsave(&pwrdm_rwlock, flags);
  113. if (_pwrdm_lookup(pwrdm->name)) {
  114. ret = -EEXIST;
  115. goto pr_unlock;
  116. }
  117. list_add(&pwrdm->node, &pwrdm_list);
  118. pr_debug("powerdomain: registered %s\n", pwrdm->name);
  119. ret = 0;
  120. pr_unlock:
  121. write_unlock_irqrestore(&pwrdm_rwlock, flags);
  122. return ret;
  123. }
  124. /**
  125. * pwrdm_unregister - unregister a powerdomain
  126. * @pwrdm: struct powerdomain * to unregister
  127. *
  128. * Removes a powerdomain from the internal powerdomain list. Returns
  129. * -EINVAL if pwrdm argument is NULL.
  130. */
  131. int pwrdm_unregister(struct powerdomain *pwrdm)
  132. {
  133. unsigned long flags;
  134. if (!pwrdm)
  135. return -EINVAL;
  136. write_lock_irqsave(&pwrdm_rwlock, flags);
  137. list_del(&pwrdm->node);
  138. write_unlock_irqrestore(&pwrdm_rwlock, flags);
  139. pr_debug("powerdomain: unregistered %s\n", pwrdm->name);
  140. return 0;
  141. }
  142. /**
  143. * pwrdm_lookup - look up a powerdomain by name, return a pointer
  144. * @name: name of powerdomain
  145. *
  146. * Find a registered powerdomain by its name. Returns a pointer to the
  147. * struct powerdomain if found, or NULL otherwise.
  148. */
  149. struct powerdomain *pwrdm_lookup(const char *name)
  150. {
  151. struct powerdomain *pwrdm;
  152. unsigned long flags;
  153. if (!name)
  154. return NULL;
  155. read_lock_irqsave(&pwrdm_rwlock, flags);
  156. pwrdm = _pwrdm_lookup(name);
  157. read_unlock_irqrestore(&pwrdm_rwlock, flags);
  158. return pwrdm;
  159. }
  160. /**
  161. * pwrdm_for_each - call function on each registered clockdomain
  162. * @fn: callback function *
  163. *
  164. * Call the supplied function for each registered powerdomain. The
  165. * callback function can return anything but 0 to bail out early from
  166. * the iterator. The callback function is called with the pwrdm_rwlock
  167. * held for reading, so no powerdomain structure manipulation
  168. * functions should be called from the callback, although hardware
  169. * powerdomain control functions are fine. Returns the last return
  170. * value of the callback function, which should be 0 for success or
  171. * anything else to indicate failure; or -EINVAL if the function
  172. * pointer is null.
  173. */
  174. int pwrdm_for_each(int (*fn)(struct powerdomain *pwrdm))
  175. {
  176. struct powerdomain *temp_pwrdm;
  177. unsigned long flags;
  178. int ret = 0;
  179. if (!fn)
  180. return -EINVAL;
  181. read_lock_irqsave(&pwrdm_rwlock, flags);
  182. list_for_each_entry(temp_pwrdm, &pwrdm_list, node) {
  183. ret = (*fn)(temp_pwrdm);
  184. if (ret)
  185. break;
  186. }
  187. read_unlock_irqrestore(&pwrdm_rwlock, flags);
  188. return ret;
  189. }
  190. /**
  191. * pwrdm_add_clkdm - add a clockdomain to a powerdomain
  192. * @pwrdm: struct powerdomain * to add the clockdomain to
  193. * @clkdm: struct clockdomain * to associate with a powerdomain
  194. *
  195. * Associate the clockdomain 'clkdm' with a powerdomain 'pwrdm'. This
  196. * enables the use of pwrdm_for_each_clkdm(). Returns -EINVAL if
  197. * presented with invalid pointers; -ENOMEM if memory could not be allocated;
  198. * or 0 upon success.
  199. */
  200. int pwrdm_add_clkdm(struct powerdomain *pwrdm, struct clockdomain *clkdm)
  201. {
  202. unsigned long flags;
  203. int i;
  204. int ret = -EINVAL;
  205. if (!pwrdm || !clkdm)
  206. return -EINVAL;
  207. pr_debug("powerdomain: associating clockdomain %s with powerdomain "
  208. "%s\n", clkdm->name, pwrdm->name);
  209. write_lock_irqsave(&pwrdm_rwlock, flags);
  210. for (i = 0; i < PWRDM_MAX_CLKDMS; i++) {
  211. if (!pwrdm->pwrdm_clkdms[i])
  212. break;
  213. #ifdef DEBUG
  214. if (pwrdm->pwrdm_clkdms[i] == clkdm) {
  215. ret = -EINVAL;
  216. goto pac_exit;
  217. }
  218. #endif
  219. }
  220. if (i == PWRDM_MAX_CLKDMS) {
  221. pr_debug("powerdomain: increase PWRDM_MAX_CLKDMS for "
  222. "pwrdm %s clkdm %s\n", pwrdm->name, clkdm->name);
  223. WARN_ON(1);
  224. ret = -ENOMEM;
  225. goto pac_exit;
  226. }
  227. pwrdm->pwrdm_clkdms[i] = clkdm;
  228. ret = 0;
  229. pac_exit:
  230. write_unlock_irqrestore(&pwrdm_rwlock, flags);
  231. return ret;
  232. }
  233. /**
  234. * pwrdm_del_clkdm - remove a clockdomain from a powerdomain
  235. * @pwrdm: struct powerdomain * to add the clockdomain to
  236. * @clkdm: struct clockdomain * to associate with a powerdomain
  237. *
  238. * Dissociate the clockdomain 'clkdm' from the powerdomain
  239. * 'pwrdm'. Returns -EINVAL if presented with invalid pointers;
  240. * -ENOENT if the clkdm was not associated with the powerdomain, or 0
  241. * upon success.
  242. */
  243. int pwrdm_del_clkdm(struct powerdomain *pwrdm, struct clockdomain *clkdm)
  244. {
  245. unsigned long flags;
  246. int ret = -EINVAL;
  247. int i;
  248. if (!pwrdm || !clkdm)
  249. return -EINVAL;
  250. pr_debug("powerdomain: dissociating clockdomain %s from powerdomain "
  251. "%s\n", clkdm->name, pwrdm->name);
  252. write_lock_irqsave(&pwrdm_rwlock, flags);
  253. for (i = 0; i < PWRDM_MAX_CLKDMS; i++)
  254. if (pwrdm->pwrdm_clkdms[i] == clkdm)
  255. break;
  256. if (i == PWRDM_MAX_CLKDMS) {
  257. pr_debug("powerdomain: clkdm %s not associated with pwrdm "
  258. "%s ?!\n", clkdm->name, pwrdm->name);
  259. ret = -ENOENT;
  260. goto pdc_exit;
  261. }
  262. pwrdm->pwrdm_clkdms[i] = NULL;
  263. ret = 0;
  264. pdc_exit:
  265. write_unlock_irqrestore(&pwrdm_rwlock, flags);
  266. return ret;
  267. }
  268. /**
  269. * pwrdm_for_each_clkdm - call function on each clkdm in a pwrdm
  270. * @pwrdm: struct powerdomain * to iterate over
  271. * @fn: callback function *
  272. *
  273. * Call the supplied function for each clockdomain in the powerdomain
  274. * 'pwrdm'. The callback function can return anything but 0 to bail
  275. * out early from the iterator. The callback function is called with
  276. * the pwrdm_rwlock held for reading, so no powerdomain structure
  277. * manipulation functions should be called from the callback, although
  278. * hardware powerdomain control functions are fine. Returns -EINVAL
  279. * if presented with invalid pointers; or passes along the last return
  280. * value of the callback function, which should be 0 for success or
  281. * anything else to indicate failure.
  282. */
  283. int pwrdm_for_each_clkdm(struct powerdomain *pwrdm,
  284. int (*fn)(struct powerdomain *pwrdm,
  285. struct clockdomain *clkdm))
  286. {
  287. unsigned long flags;
  288. int ret = 0;
  289. int i;
  290. if (!fn)
  291. return -EINVAL;
  292. read_lock_irqsave(&pwrdm_rwlock, flags);
  293. for (i = 0; i < PWRDM_MAX_CLKDMS && !ret; i++)
  294. ret = (*fn)(pwrdm, pwrdm->pwrdm_clkdms[i]);
  295. read_unlock_irqrestore(&pwrdm_rwlock, flags);
  296. return ret;
  297. }
  298. /**
  299. * pwrdm_add_wkdep - add a wakeup dependency from pwrdm2 to pwrdm1
  300. * @pwrdm1: wake this struct powerdomain * up (dependent)
  301. * @pwrdm2: when this struct powerdomain * wakes up (source)
  302. *
  303. * When the powerdomain represented by pwrdm2 wakes up (due to an
  304. * interrupt), wake up pwrdm1. Implemented in hardware on the OMAP,
  305. * this feature is designed to reduce wakeup latency of the dependent
  306. * powerdomain. Returns -EINVAL if presented with invalid powerdomain
  307. * pointers, -ENOENT if pwrdm2 cannot wake up pwrdm1 in hardware, or
  308. * 0 upon success.
  309. */
  310. int pwrdm_add_wkdep(struct powerdomain *pwrdm1, struct powerdomain *pwrdm2)
  311. {
  312. struct powerdomain *p;
  313. if (!pwrdm1)
  314. return -EINVAL;
  315. p = _pwrdm_deps_lookup(pwrdm2, pwrdm1->wkdep_srcs);
  316. if (IS_ERR(p)) {
  317. pr_debug("powerdomain: hardware cannot set/clear wake up of "
  318. "%s when %s wakes up\n", pwrdm1->name, pwrdm2->name);
  319. return IS_ERR(p);
  320. }
  321. pr_debug("powerdomain: hardware will wake up %s when %s wakes up\n",
  322. pwrdm1->name, pwrdm2->name);
  323. prm_set_mod_reg_bits((1 << pwrdm2->dep_bit),
  324. pwrdm1->prcm_offs, PM_WKDEP);
  325. return 0;
  326. }
  327. /**
  328. * pwrdm_del_wkdep - remove a wakeup dependency from pwrdm2 to pwrdm1
  329. * @pwrdm1: wake this struct powerdomain * up (dependent)
  330. * @pwrdm2: when this struct powerdomain * wakes up (source)
  331. *
  332. * Remove a wakeup dependency that causes pwrdm1 to wake up when pwrdm2
  333. * wakes up. Returns -EINVAL if presented with invalid powerdomain
  334. * pointers, -ENOENT if pwrdm2 cannot wake up pwrdm1 in hardware, or
  335. * 0 upon success.
  336. */
  337. int pwrdm_del_wkdep(struct powerdomain *pwrdm1, struct powerdomain *pwrdm2)
  338. {
  339. struct powerdomain *p;
  340. if (!pwrdm1)
  341. return -EINVAL;
  342. p = _pwrdm_deps_lookup(pwrdm2, pwrdm1->wkdep_srcs);
  343. if (IS_ERR(p)) {
  344. pr_debug("powerdomain: hardware cannot set/clear wake up of "
  345. "%s when %s wakes up\n", pwrdm1->name, pwrdm2->name);
  346. return IS_ERR(p);
  347. }
  348. pr_debug("powerdomain: hardware will no longer wake up %s after %s "
  349. "wakes up\n", pwrdm1->name, pwrdm2->name);
  350. prm_clear_mod_reg_bits((1 << pwrdm2->dep_bit),
  351. pwrdm1->prcm_offs, PM_WKDEP);
  352. return 0;
  353. }
  354. /**
  355. * pwrdm_read_wkdep - read wakeup dependency state from pwrdm2 to pwrdm1
  356. * @pwrdm1: wake this struct powerdomain * up (dependent)
  357. * @pwrdm2: when this struct powerdomain * wakes up (source)
  358. *
  359. * Return 1 if a hardware wakeup dependency exists wherein pwrdm1 will be
  360. * awoken when pwrdm2 wakes up; 0 if dependency is not set; -EINVAL
  361. * if either powerdomain pointer is invalid; or -ENOENT if the hardware
  362. * is incapable.
  363. *
  364. * REVISIT: Currently this function only represents software-controllable
  365. * wakeup dependencies. Wakeup dependencies fixed in hardware are not
  366. * yet handled here.
  367. */
  368. int pwrdm_read_wkdep(struct powerdomain *pwrdm1, struct powerdomain *pwrdm2)
  369. {
  370. struct powerdomain *p;
  371. if (!pwrdm1)
  372. return -EINVAL;
  373. p = _pwrdm_deps_lookup(pwrdm2, pwrdm1->wkdep_srcs);
  374. if (IS_ERR(p)) {
  375. pr_debug("powerdomain: hardware cannot set/clear wake up of "
  376. "%s when %s wakes up\n", pwrdm1->name, pwrdm2->name);
  377. return IS_ERR(p);
  378. }
  379. return prm_read_mod_bits_shift(pwrdm1->prcm_offs, PM_WKDEP,
  380. (1 << pwrdm2->dep_bit));
  381. }
  382. /**
  383. * pwrdm_add_sleepdep - add a sleep dependency from pwrdm2 to pwrdm1
  384. * @pwrdm1: prevent this struct powerdomain * from sleeping (dependent)
  385. * @pwrdm2: when this struct powerdomain * is active (source)
  386. *
  387. * Prevent pwrdm1 from automatically going inactive (and then to
  388. * retention or off) if pwrdm2 is still active. Returns -EINVAL if
  389. * presented with invalid powerdomain pointers or called on a machine
  390. * that does not support software-configurable hardware sleep dependencies,
  391. * -ENOENT if the specified dependency cannot be set in hardware, or
  392. * 0 upon success.
  393. */
  394. int pwrdm_add_sleepdep(struct powerdomain *pwrdm1, struct powerdomain *pwrdm2)
  395. {
  396. struct powerdomain *p;
  397. if (!pwrdm1)
  398. return -EINVAL;
  399. if (!cpu_is_omap34xx())
  400. return -EINVAL;
  401. p = _pwrdm_deps_lookup(pwrdm2, pwrdm1->sleepdep_srcs);
  402. if (IS_ERR(p)) {
  403. pr_debug("powerdomain: hardware cannot set/clear sleep "
  404. "dependency affecting %s from %s\n", pwrdm1->name,
  405. pwrdm2->name);
  406. return IS_ERR(p);
  407. }
  408. pr_debug("powerdomain: will prevent %s from sleeping if %s is active\n",
  409. pwrdm1->name, pwrdm2->name);
  410. cm_set_mod_reg_bits((1 << pwrdm2->dep_bit),
  411. pwrdm1->prcm_offs, OMAP3430_CM_SLEEPDEP);
  412. return 0;
  413. }
  414. /**
  415. * pwrdm_del_sleepdep - remove a sleep dependency from pwrdm2 to pwrdm1
  416. * @pwrdm1: prevent this struct powerdomain * from sleeping (dependent)
  417. * @pwrdm2: when this struct powerdomain * is active (source)
  418. *
  419. * Allow pwrdm1 to automatically go inactive (and then to retention or
  420. * off), independent of the activity state of pwrdm2. Returns -EINVAL
  421. * if presented with invalid powerdomain pointers or called on a machine
  422. * that does not support software-configurable hardware sleep dependencies,
  423. * -ENOENT if the specified dependency cannot be cleared in hardware, or
  424. * 0 upon success.
  425. */
  426. int pwrdm_del_sleepdep(struct powerdomain *pwrdm1, struct powerdomain *pwrdm2)
  427. {
  428. struct powerdomain *p;
  429. if (!pwrdm1)
  430. return -EINVAL;
  431. if (!cpu_is_omap34xx())
  432. return -EINVAL;
  433. p = _pwrdm_deps_lookup(pwrdm2, pwrdm1->sleepdep_srcs);
  434. if (IS_ERR(p)) {
  435. pr_debug("powerdomain: hardware cannot set/clear sleep "
  436. "dependency affecting %s from %s\n", pwrdm1->name,
  437. pwrdm2->name);
  438. return IS_ERR(p);
  439. }
  440. pr_debug("powerdomain: will no longer prevent %s from sleeping if "
  441. "%s is active\n", pwrdm1->name, pwrdm2->name);
  442. cm_clear_mod_reg_bits((1 << pwrdm2->dep_bit),
  443. pwrdm1->prcm_offs, OMAP3430_CM_SLEEPDEP);
  444. return 0;
  445. }
  446. /**
  447. * pwrdm_read_sleepdep - read sleep dependency state from pwrdm2 to pwrdm1
  448. * @pwrdm1: prevent this struct powerdomain * from sleeping (dependent)
  449. * @pwrdm2: when this struct powerdomain * is active (source)
  450. *
  451. * Return 1 if a hardware sleep dependency exists wherein pwrdm1 will
  452. * not be allowed to automatically go inactive if pwrdm2 is active;
  453. * 0 if pwrdm1's automatic power state inactivity transition is independent
  454. * of pwrdm2's; -EINVAL if either powerdomain pointer is invalid or called
  455. * on a machine that does not support software-configurable hardware sleep
  456. * dependencies; or -ENOENT if the hardware is incapable.
  457. *
  458. * REVISIT: Currently this function only represents software-controllable
  459. * sleep dependencies. Sleep dependencies fixed in hardware are not
  460. * yet handled here.
  461. */
  462. int pwrdm_read_sleepdep(struct powerdomain *pwrdm1, struct powerdomain *pwrdm2)
  463. {
  464. struct powerdomain *p;
  465. if (!pwrdm1)
  466. return -EINVAL;
  467. if (!cpu_is_omap34xx())
  468. return -EINVAL;
  469. p = _pwrdm_deps_lookup(pwrdm2, pwrdm1->sleepdep_srcs);
  470. if (IS_ERR(p)) {
  471. pr_debug("powerdomain: hardware cannot set/clear sleep "
  472. "dependency affecting %s from %s\n", pwrdm1->name,
  473. pwrdm2->name);
  474. return IS_ERR(p);
  475. }
  476. return prm_read_mod_bits_shift(pwrdm1->prcm_offs, OMAP3430_CM_SLEEPDEP,
  477. (1 << pwrdm2->dep_bit));
  478. }
  479. /**
  480. * pwrdm_get_mem_bank_count - get number of memory banks in this powerdomain
  481. * @pwrdm: struct powerdomain *
  482. *
  483. * Return the number of controllable memory banks in powerdomain pwrdm,
  484. * starting with 1. Returns -EINVAL if the powerdomain pointer is null.
  485. */
  486. int pwrdm_get_mem_bank_count(struct powerdomain *pwrdm)
  487. {
  488. if (!pwrdm)
  489. return -EINVAL;
  490. return pwrdm->banks;
  491. }
  492. /**
  493. * pwrdm_set_next_pwrst - set next powerdomain power state
  494. * @pwrdm: struct powerdomain * to set
  495. * @pwrst: one of the PWRDM_POWER_* macros
  496. *
  497. * Set the powerdomain pwrdm's next power state to pwrst. The powerdomain
  498. * may not enter this state immediately if the preconditions for this state
  499. * have not been satisfied. Returns -EINVAL if the powerdomain pointer is
  500. * null or if the power state is invalid for the powerdomin, or returns 0
  501. * upon success.
  502. */
  503. int pwrdm_set_next_pwrst(struct powerdomain *pwrdm, u8 pwrst)
  504. {
  505. if (!pwrdm)
  506. return -EINVAL;
  507. if (!(pwrdm->pwrsts & (1 << pwrst)))
  508. return -EINVAL;
  509. pr_debug("powerdomain: setting next powerstate for %s to %0x\n",
  510. pwrdm->name, pwrst);
  511. prm_rmw_mod_reg_bits(OMAP_POWERSTATE_MASK,
  512. (pwrst << OMAP_POWERSTATE_SHIFT),
  513. pwrdm->prcm_offs, PM_PWSTCTRL);
  514. return 0;
  515. }
  516. /**
  517. * pwrdm_read_next_pwrst - get next powerdomain power state
  518. * @pwrdm: struct powerdomain * to get power state
  519. *
  520. * Return the powerdomain pwrdm's next power state. Returns -EINVAL
  521. * if the powerdomain pointer is null or returns the next power state
  522. * upon success.
  523. */
  524. int pwrdm_read_next_pwrst(struct powerdomain *pwrdm)
  525. {
  526. if (!pwrdm)
  527. return -EINVAL;
  528. return prm_read_mod_bits_shift(pwrdm->prcm_offs, PM_PWSTCTRL,
  529. OMAP_POWERSTATE_MASK);
  530. }
  531. /**
  532. * pwrdm_read_pwrst - get current powerdomain power state
  533. * @pwrdm: struct powerdomain * to get power state
  534. *
  535. * Return the powerdomain pwrdm's current power state. Returns -EINVAL
  536. * if the powerdomain pointer is null or returns the current power state
  537. * upon success.
  538. */
  539. int pwrdm_read_pwrst(struct powerdomain *pwrdm)
  540. {
  541. if (!pwrdm)
  542. return -EINVAL;
  543. return prm_read_mod_bits_shift(pwrdm->prcm_offs, PM_PWSTST,
  544. OMAP_POWERSTATEST_MASK);
  545. }
  546. /**
  547. * pwrdm_read_prev_pwrst - get previous powerdomain power state
  548. * @pwrdm: struct powerdomain * to get previous power state
  549. *
  550. * Return the powerdomain pwrdm's previous power state. Returns -EINVAL
  551. * if the powerdomain pointer is null or returns the previous power state
  552. * upon success.
  553. */
  554. int pwrdm_read_prev_pwrst(struct powerdomain *pwrdm)
  555. {
  556. if (!pwrdm)
  557. return -EINVAL;
  558. return prm_read_mod_bits_shift(pwrdm->prcm_offs, OMAP3430_PM_PREPWSTST,
  559. OMAP3430_LASTPOWERSTATEENTERED_MASK);
  560. }
  561. /**
  562. * pwrdm_set_logic_retst - set powerdomain logic power state upon retention
  563. * @pwrdm: struct powerdomain * to set
  564. * @pwrst: one of the PWRDM_POWER_* macros
  565. *
  566. * Set the next power state that the logic portion of the powerdomain
  567. * pwrdm will enter when the powerdomain enters retention. This will
  568. * be either RETENTION or OFF, if supported. Returns -EINVAL if the
  569. * powerdomain pointer is null or the target power state is not not
  570. * supported, or returns 0 upon success.
  571. */
  572. int pwrdm_set_logic_retst(struct powerdomain *pwrdm, u8 pwrst)
  573. {
  574. if (!pwrdm)
  575. return -EINVAL;
  576. if (!(pwrdm->pwrsts_logic_ret & (1 << pwrst)))
  577. return -EINVAL;
  578. pr_debug("powerdomain: setting next logic powerstate for %s to %0x\n",
  579. pwrdm->name, pwrst);
  580. /*
  581. * The register bit names below may not correspond to the
  582. * actual names of the bits in each powerdomain's register,
  583. * but the type of value returned is the same for each
  584. * powerdomain.
  585. */
  586. prm_rmw_mod_reg_bits(OMAP3430_LOGICL1CACHERETSTATE,
  587. (pwrst << __ffs(OMAP3430_LOGICL1CACHERETSTATE)),
  588. pwrdm->prcm_offs, PM_PWSTCTRL);
  589. return 0;
  590. }
  591. /**
  592. * pwrdm_set_mem_onst - set memory power state while powerdomain ON
  593. * @pwrdm: struct powerdomain * to set
  594. * @bank: memory bank number to set (0-3)
  595. * @pwrst: one of the PWRDM_POWER_* macros
  596. *
  597. * Set the next power state that memory bank x of the powerdomain
  598. * pwrdm will enter when the powerdomain enters the ON state. Bank
  599. * will be a number from 0 to 3, and represents different types of
  600. * memory, depending on the powerdomain. Returns -EINVAL if the
  601. * powerdomain pointer is null or the target power state is not not
  602. * supported for this memory bank, -EEXIST if the target memory bank
  603. * does not exist or is not controllable, or returns 0 upon success.
  604. */
  605. int pwrdm_set_mem_onst(struct powerdomain *pwrdm, u8 bank, u8 pwrst)
  606. {
  607. u32 m;
  608. if (!pwrdm)
  609. return -EINVAL;
  610. if (pwrdm->banks < (bank + 1))
  611. return -EEXIST;
  612. if (!(pwrdm->pwrsts_mem_on[bank] & (1 << pwrst)))
  613. return -EINVAL;
  614. pr_debug("powerdomain: setting next memory powerstate for domain %s "
  615. "bank %0x while pwrdm-ON to %0x\n", pwrdm->name, bank, pwrst);
  616. /*
  617. * The register bit names below may not correspond to the
  618. * actual names of the bits in each powerdomain's register,
  619. * but the type of value returned is the same for each
  620. * powerdomain.
  621. */
  622. switch (bank) {
  623. case 0:
  624. m = OMAP3430_SHAREDL1CACHEFLATONSTATE_MASK;
  625. break;
  626. case 1:
  627. m = OMAP3430_L1FLATMEMONSTATE_MASK;
  628. break;
  629. case 2:
  630. m = OMAP3430_SHAREDL2CACHEFLATONSTATE_MASK;
  631. break;
  632. case 3:
  633. m = OMAP3430_L2FLATMEMONSTATE_MASK;
  634. break;
  635. default:
  636. WARN_ON(1); /* should never happen */
  637. return -EEXIST;
  638. }
  639. prm_rmw_mod_reg_bits(m, (pwrst << __ffs(m)),
  640. pwrdm->prcm_offs, PM_PWSTCTRL);
  641. return 0;
  642. }
  643. /**
  644. * pwrdm_set_mem_retst - set memory power state while powerdomain in RET
  645. * @pwrdm: struct powerdomain * to set
  646. * @bank: memory bank number to set (0-3)
  647. * @pwrst: one of the PWRDM_POWER_* macros
  648. *
  649. * Set the next power state that memory bank x of the powerdomain
  650. * pwrdm will enter when the powerdomain enters the RETENTION state.
  651. * Bank will be a number from 0 to 3, and represents different types
  652. * of memory, depending on the powerdomain. pwrst will be either
  653. * RETENTION or OFF, if supported. Returns -EINVAL if the powerdomain
  654. * pointer is null or the target power state is not not supported for
  655. * this memory bank, -EEXIST if the target memory bank does not exist
  656. * or is not controllable, or returns 0 upon success.
  657. */
  658. int pwrdm_set_mem_retst(struct powerdomain *pwrdm, u8 bank, u8 pwrst)
  659. {
  660. u32 m;
  661. if (!pwrdm)
  662. return -EINVAL;
  663. if (pwrdm->banks < (bank + 1))
  664. return -EEXIST;
  665. if (!(pwrdm->pwrsts_mem_ret[bank] & (1 << pwrst)))
  666. return -EINVAL;
  667. pr_debug("powerdomain: setting next memory powerstate for domain %s "
  668. "bank %0x while pwrdm-RET to %0x\n", pwrdm->name, bank, pwrst);
  669. /*
  670. * The register bit names below may not correspond to the
  671. * actual names of the bits in each powerdomain's register,
  672. * but the type of value returned is the same for each
  673. * powerdomain.
  674. */
  675. switch (bank) {
  676. case 0:
  677. m = OMAP3430_SHAREDL1CACHEFLATRETSTATE;
  678. break;
  679. case 1:
  680. m = OMAP3430_L1FLATMEMRETSTATE;
  681. break;
  682. case 2:
  683. m = OMAP3430_SHAREDL2CACHEFLATRETSTATE;
  684. break;
  685. case 3:
  686. m = OMAP3430_L2FLATMEMRETSTATE;
  687. break;
  688. default:
  689. WARN_ON(1); /* should never happen */
  690. return -EEXIST;
  691. }
  692. prm_rmw_mod_reg_bits(m, (pwrst << __ffs(m)), pwrdm->prcm_offs,
  693. PM_PWSTCTRL);
  694. return 0;
  695. }
  696. /**
  697. * pwrdm_read_logic_pwrst - get current powerdomain logic retention power state
  698. * @pwrdm: struct powerdomain * to get current logic retention power state
  699. *
  700. * Return the current power state that the logic portion of
  701. * powerdomain pwrdm will enter
  702. * Returns -EINVAL if the powerdomain pointer is null or returns the
  703. * current logic retention power state upon success.
  704. */
  705. int pwrdm_read_logic_pwrst(struct powerdomain *pwrdm)
  706. {
  707. if (!pwrdm)
  708. return -EINVAL;
  709. return prm_read_mod_bits_shift(pwrdm->prcm_offs, PM_PWSTST,
  710. OMAP3430_LOGICSTATEST);
  711. }
  712. /**
  713. * pwrdm_read_prev_logic_pwrst - get previous powerdomain logic power state
  714. * @pwrdm: struct powerdomain * to get previous logic power state
  715. *
  716. * Return the powerdomain pwrdm's logic power state. Returns -EINVAL
  717. * if the powerdomain pointer is null or returns the previous logic
  718. * power state upon success.
  719. */
  720. int pwrdm_read_prev_logic_pwrst(struct powerdomain *pwrdm)
  721. {
  722. if (!pwrdm)
  723. return -EINVAL;
  724. /*
  725. * The register bit names below may not correspond to the
  726. * actual names of the bits in each powerdomain's register,
  727. * but the type of value returned is the same for each
  728. * powerdomain.
  729. */
  730. return prm_read_mod_bits_shift(pwrdm->prcm_offs, OMAP3430_PM_PREPWSTST,
  731. OMAP3430_LASTLOGICSTATEENTERED);
  732. }
  733. /**
  734. * pwrdm_read_mem_pwrst - get current memory bank power state
  735. * @pwrdm: struct powerdomain * to get current memory bank power state
  736. * @bank: memory bank number (0-3)
  737. *
  738. * Return the powerdomain pwrdm's current memory power state for bank
  739. * x. Returns -EINVAL if the powerdomain pointer is null, -EEXIST if
  740. * the target memory bank does not exist or is not controllable, or
  741. * returns the current memory power state upon success.
  742. */
  743. int pwrdm_read_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
  744. {
  745. u32 m;
  746. if (!pwrdm)
  747. return -EINVAL;
  748. if (pwrdm->banks < (bank + 1))
  749. return -EEXIST;
  750. /*
  751. * The register bit names below may not correspond to the
  752. * actual names of the bits in each powerdomain's register,
  753. * but the type of value returned is the same for each
  754. * powerdomain.
  755. */
  756. switch (bank) {
  757. case 0:
  758. m = OMAP3430_SHAREDL1CACHEFLATSTATEST_MASK;
  759. break;
  760. case 1:
  761. m = OMAP3430_L1FLATMEMSTATEST_MASK;
  762. break;
  763. case 2:
  764. m = OMAP3430_SHAREDL2CACHEFLATSTATEST_MASK;
  765. break;
  766. case 3:
  767. m = OMAP3430_L2FLATMEMSTATEST_MASK;
  768. break;
  769. default:
  770. WARN_ON(1); /* should never happen */
  771. return -EEXIST;
  772. }
  773. return prm_read_mod_bits_shift(pwrdm->prcm_offs, PM_PWSTST, m);
  774. }
  775. /**
  776. * pwrdm_read_prev_mem_pwrst - get previous memory bank power state
  777. * @pwrdm: struct powerdomain * to get previous memory bank power state
  778. * @bank: memory bank number (0-3)
  779. *
  780. * Return the powerdomain pwrdm's previous memory power state for bank
  781. * x. Returns -EINVAL if the powerdomain pointer is null, -EEXIST if
  782. * the target memory bank does not exist or is not controllable, or
  783. * returns the previous memory power state upon success.
  784. */
  785. int pwrdm_read_prev_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
  786. {
  787. u32 m;
  788. if (!pwrdm)
  789. return -EINVAL;
  790. if (pwrdm->banks < (bank + 1))
  791. return -EEXIST;
  792. /*
  793. * The register bit names below may not correspond to the
  794. * actual names of the bits in each powerdomain's register,
  795. * but the type of value returned is the same for each
  796. * powerdomain.
  797. */
  798. switch (bank) {
  799. case 0:
  800. m = OMAP3430_LASTMEM1STATEENTERED_MASK;
  801. break;
  802. case 1:
  803. m = OMAP3430_LASTMEM2STATEENTERED_MASK;
  804. break;
  805. case 2:
  806. m = OMAP3430_LASTSHAREDL2CACHEFLATSTATEENTERED_MASK;
  807. break;
  808. case 3:
  809. m = OMAP3430_LASTL2FLATMEMSTATEENTERED_MASK;
  810. break;
  811. default:
  812. WARN_ON(1); /* should never happen */
  813. return -EEXIST;
  814. }
  815. return prm_read_mod_bits_shift(pwrdm->prcm_offs,
  816. OMAP3430_PM_PREPWSTST, m);
  817. }
  818. /**
  819. * pwrdm_clear_all_prev_pwrst - clear previous powerstate register for a pwrdm
  820. * @pwrdm: struct powerdomain * to clear
  821. *
  822. * Clear the powerdomain's previous power state register. Clears the
  823. * entire register, including logic and memory bank previous power states.
  824. * Returns -EINVAL if the powerdomain pointer is null, or returns 0 upon
  825. * success.
  826. */
  827. int pwrdm_clear_all_prev_pwrst(struct powerdomain *pwrdm)
  828. {
  829. if (!pwrdm)
  830. return -EINVAL;
  831. /*
  832. * XXX should get the powerdomain's current state here;
  833. * warn & fail if it is not ON.
  834. */
  835. pr_debug("powerdomain: clearing previous power state reg for %s\n",
  836. pwrdm->name);
  837. prm_write_mod_reg(0, pwrdm->prcm_offs, OMAP3430_PM_PREPWSTST);
  838. return 0;
  839. }
  840. /**
  841. * pwrdm_wait_transition - wait for powerdomain power transition to finish
  842. * @pwrdm: struct powerdomain * to wait for
  843. *
  844. * If the powerdomain pwrdm is in the process of a state transition,
  845. * spin until it completes the power transition, or until an iteration
  846. * bailout value is reached. Returns -EINVAL if the powerdomain
  847. * pointer is null, -EAGAIN if the bailout value was reached, or
  848. * returns 0 upon success.
  849. */
  850. int pwrdm_wait_transition(struct powerdomain *pwrdm)
  851. {
  852. u32 c = 0;
  853. if (!pwrdm)
  854. return -EINVAL;
  855. /*
  856. * REVISIT: pwrdm_wait_transition() may be better implemented
  857. * via a callback and a periodic timer check -- how long do we expect
  858. * powerdomain transitions to take?
  859. */
  860. /* XXX Is this udelay() value meaningful? */
  861. while ((prm_read_mod_reg(pwrdm->prcm_offs, PM_PWSTST) &
  862. OMAP_INTRANSITION) &&
  863. (c++ < PWRDM_TRANSITION_BAILOUT))
  864. udelay(1);
  865. if (c >= PWRDM_TRANSITION_BAILOUT) {
  866. printk(KERN_ERR "powerdomain: waited too long for "
  867. "powerdomain %s to complete transition\n", pwrdm->name);
  868. return -EAGAIN;
  869. }
  870. pr_debug("powerdomain: completed transition in %d loops\n", c);
  871. return 0;
  872. }