powerdomain.c 28 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081
  1. /*
  2. * OMAP powerdomain control
  3. *
  4. * Copyright (C) 2007-2008, 2011 Texas Instruments, Inc.
  5. * Copyright (C) 2007-2011 Nokia Corporation
  6. *
  7. * Written by Paul Walmsley
  8. * Added OMAP4 specific support by Abhijit Pagare <abhijitpagare@ti.com>
  9. * State counting code by Tero Kristo <tero.kristo@nokia.com>
  10. *
  11. * This program is free software; you can redistribute it and/or modify
  12. * it under the terms of the GNU General Public License version 2 as
  13. * published by the Free Software Foundation.
  14. */
  15. #undef DEBUG
  16. #include <linux/kernel.h>
  17. #include <linux/types.h>
  18. #include <linux/list.h>
  19. #include <linux/errno.h>
  20. #include <linux/string.h>
  21. #include <trace/events/power.h>
  22. #include "cm2xxx_3xxx.h"
  23. #include "prcm44xx.h"
  24. #include "cm44xx.h"
  25. #include "prm2xxx_3xxx.h"
  26. #include "prm44xx.h"
  27. #include <asm/cpu.h>
  28. #include "powerdomain.h"
  29. #include "clockdomain.h"
  30. #include "soc.h"
  31. #include "pm.h"
  32. #define PWRDM_TRACE_STATES_FLAG (1<<31)
  33. enum {
  34. PWRDM_STATE_NOW = 0,
  35. PWRDM_STATE_PREV,
  36. };
  37. /* pwrdm_list contains all registered struct powerdomains */
  38. static LIST_HEAD(pwrdm_list);
  39. static struct pwrdm_ops *arch_pwrdm;
  40. /* Private functions */
  41. static struct powerdomain *_pwrdm_lookup(const char *name)
  42. {
  43. struct powerdomain *pwrdm, *temp_pwrdm;
  44. pwrdm = NULL;
  45. list_for_each_entry(temp_pwrdm, &pwrdm_list, node) {
  46. if (!strcmp(name, temp_pwrdm->name)) {
  47. pwrdm = temp_pwrdm;
  48. break;
  49. }
  50. }
  51. return pwrdm;
  52. }
  53. /**
  54. * _pwrdm_register - register a powerdomain
  55. * @pwrdm: struct powerdomain * to register
  56. *
  57. * Adds a powerdomain to the internal powerdomain list. Returns
  58. * -EINVAL if given a null pointer, -EEXIST if a powerdomain is
  59. * already registered by the provided name, or 0 upon success.
  60. */
  61. static int _pwrdm_register(struct powerdomain *pwrdm)
  62. {
  63. int i;
  64. struct voltagedomain *voltdm;
  65. if (!pwrdm || !pwrdm->name)
  66. return -EINVAL;
  67. if (cpu_is_omap44xx() &&
  68. pwrdm->prcm_partition == OMAP4430_INVALID_PRCM_PARTITION) {
  69. pr_err("powerdomain: %s: missing OMAP4 PRCM partition ID\n",
  70. pwrdm->name);
  71. return -EINVAL;
  72. }
  73. if (_pwrdm_lookup(pwrdm->name))
  74. return -EEXIST;
  75. voltdm = voltdm_lookup(pwrdm->voltdm.name);
  76. if (!voltdm) {
  77. pr_err("powerdomain: %s: voltagedomain %s does not exist\n",
  78. pwrdm->name, pwrdm->voltdm.name);
  79. return -EINVAL;
  80. }
  81. pwrdm->voltdm.ptr = voltdm;
  82. INIT_LIST_HEAD(&pwrdm->voltdm_node);
  83. voltdm_add_pwrdm(voltdm, pwrdm);
  84. list_add(&pwrdm->node, &pwrdm_list);
  85. /* Initialize the powerdomain's state counter */
  86. for (i = 0; i < PWRDM_MAX_PWRSTS; i++)
  87. pwrdm->state_counter[i] = 0;
  88. pwrdm->ret_logic_off_counter = 0;
  89. for (i = 0; i < pwrdm->banks; i++)
  90. pwrdm->ret_mem_off_counter[i] = 0;
  91. pwrdm_wait_transition(pwrdm);
  92. pwrdm->state = pwrdm_read_pwrst(pwrdm);
  93. pwrdm->state_counter[pwrdm->state] = 1;
  94. pr_debug("powerdomain: registered %s\n", pwrdm->name);
  95. return 0;
  96. }
  97. static void _update_logic_membank_counters(struct powerdomain *pwrdm)
  98. {
  99. int i;
  100. u8 prev_logic_pwrst, prev_mem_pwrst;
  101. prev_logic_pwrst = pwrdm_read_prev_logic_pwrst(pwrdm);
  102. if ((pwrdm->pwrsts_logic_ret == PWRSTS_OFF_RET) &&
  103. (prev_logic_pwrst == PWRDM_POWER_OFF))
  104. pwrdm->ret_logic_off_counter++;
  105. for (i = 0; i < pwrdm->banks; i++) {
  106. prev_mem_pwrst = pwrdm_read_prev_mem_pwrst(pwrdm, i);
  107. if ((pwrdm->pwrsts_mem_ret[i] == PWRSTS_OFF_RET) &&
  108. (prev_mem_pwrst == PWRDM_POWER_OFF))
  109. pwrdm->ret_mem_off_counter[i]++;
  110. }
  111. }
  112. static int _pwrdm_state_switch(struct powerdomain *pwrdm, int flag)
  113. {
  114. int prev, next, state, trace_state = 0;
  115. if (pwrdm == NULL)
  116. return -EINVAL;
  117. state = pwrdm_read_pwrst(pwrdm);
  118. switch (flag) {
  119. case PWRDM_STATE_NOW:
  120. prev = pwrdm->state;
  121. break;
  122. case PWRDM_STATE_PREV:
  123. prev = pwrdm_read_prev_pwrst(pwrdm);
  124. if (pwrdm->state != prev)
  125. pwrdm->state_counter[prev]++;
  126. if (prev == PWRDM_POWER_RET)
  127. _update_logic_membank_counters(pwrdm);
  128. /*
  129. * If the power domain did not hit the desired state,
  130. * generate a trace event with both the desired and hit states
  131. */
  132. next = pwrdm_read_next_pwrst(pwrdm);
  133. if (next != prev) {
  134. trace_state = (PWRDM_TRACE_STATES_FLAG |
  135. ((next & OMAP_POWERSTATE_MASK) << 8) |
  136. ((prev & OMAP_POWERSTATE_MASK) << 0));
  137. trace_power_domain_target(pwrdm->name, trace_state,
  138. smp_processor_id());
  139. }
  140. break;
  141. default:
  142. return -EINVAL;
  143. }
  144. if (state != prev)
  145. pwrdm->state_counter[state]++;
  146. pm_dbg_update_time(pwrdm, prev);
  147. pwrdm->state = state;
  148. return 0;
  149. }
  150. static int _pwrdm_pre_transition_cb(struct powerdomain *pwrdm, void *unused)
  151. {
  152. pwrdm_clear_all_prev_pwrst(pwrdm);
  153. _pwrdm_state_switch(pwrdm, PWRDM_STATE_NOW);
  154. return 0;
  155. }
  156. static int _pwrdm_post_transition_cb(struct powerdomain *pwrdm, void *unused)
  157. {
  158. _pwrdm_state_switch(pwrdm, PWRDM_STATE_PREV);
  159. return 0;
  160. }
  161. /* Public functions */
  162. /**
  163. * pwrdm_register_platform_funcs - register powerdomain implementation fns
  164. * @po: func pointers for arch specific implementations
  165. *
  166. * Register the list of function pointers used to implement the
  167. * powerdomain functions on different OMAP SoCs. Should be called
  168. * before any other pwrdm_register*() function. Returns -EINVAL if
  169. * @po is null, -EEXIST if platform functions have already been
  170. * registered, or 0 upon success.
  171. */
  172. int pwrdm_register_platform_funcs(struct pwrdm_ops *po)
  173. {
  174. if (!po)
  175. return -EINVAL;
  176. if (arch_pwrdm)
  177. return -EEXIST;
  178. arch_pwrdm = po;
  179. return 0;
  180. }
  181. /**
  182. * pwrdm_register_pwrdms - register SoC powerdomains
  183. * @ps: pointer to an array of struct powerdomain to register
  184. *
  185. * Register the powerdomains available on a particular OMAP SoC. Must
  186. * be called after pwrdm_register_platform_funcs(). May be called
  187. * multiple times. Returns -EACCES if called before
  188. * pwrdm_register_platform_funcs(); -EINVAL if the argument @ps is
  189. * null; or 0 upon success.
  190. */
  191. int pwrdm_register_pwrdms(struct powerdomain **ps)
  192. {
  193. struct powerdomain **p = NULL;
  194. if (!arch_pwrdm)
  195. return -EEXIST;
  196. if (!ps)
  197. return -EINVAL;
  198. for (p = ps; *p; p++)
  199. _pwrdm_register(*p);
  200. return 0;
  201. }
  202. /**
  203. * pwrdm_complete_init - set up the powerdomain layer
  204. *
  205. * Do whatever is necessary to initialize registered powerdomains and
  206. * powerdomain code. Currently, this programs the next power state
  207. * for each powerdomain to ON. This prevents powerdomains from
  208. * unexpectedly losing context or entering high wakeup latency modes
  209. * with non-power-management-enabled kernels. Must be called after
  210. * pwrdm_register_pwrdms(). Returns -EACCES if called before
  211. * pwrdm_register_pwrdms(), or 0 upon success.
  212. */
  213. int pwrdm_complete_init(void)
  214. {
  215. struct powerdomain *temp_p;
  216. if (list_empty(&pwrdm_list))
  217. return -EACCES;
  218. list_for_each_entry(temp_p, &pwrdm_list, node)
  219. pwrdm_set_next_pwrst(temp_p, PWRDM_POWER_ON);
  220. return 0;
  221. }
  222. /**
  223. * pwrdm_lookup - look up a powerdomain by name, return a pointer
  224. * @name: name of powerdomain
  225. *
  226. * Find a registered powerdomain by its name @name. Returns a pointer
  227. * to the struct powerdomain if found, or NULL otherwise.
  228. */
  229. struct powerdomain *pwrdm_lookup(const char *name)
  230. {
  231. struct powerdomain *pwrdm;
  232. if (!name)
  233. return NULL;
  234. pwrdm = _pwrdm_lookup(name);
  235. return pwrdm;
  236. }
  237. /**
  238. * pwrdm_for_each - call function on each registered clockdomain
  239. * @fn: callback function *
  240. *
  241. * Call the supplied function @fn for each registered powerdomain.
  242. * The callback function @fn can return anything but 0 to bail out
  243. * early from the iterator. Returns the last return value of the
  244. * callback function, which should be 0 for success or anything else
  245. * to indicate failure; or -EINVAL if the function pointer is null.
  246. */
  247. int pwrdm_for_each(int (*fn)(struct powerdomain *pwrdm, void *user),
  248. void *user)
  249. {
  250. struct powerdomain *temp_pwrdm;
  251. int ret = 0;
  252. if (!fn)
  253. return -EINVAL;
  254. list_for_each_entry(temp_pwrdm, &pwrdm_list, node) {
  255. ret = (*fn)(temp_pwrdm, user);
  256. if (ret)
  257. break;
  258. }
  259. return ret;
  260. }
  261. /**
  262. * pwrdm_add_clkdm - add a clockdomain to a powerdomain
  263. * @pwrdm: struct powerdomain * to add the clockdomain to
  264. * @clkdm: struct clockdomain * to associate with a powerdomain
  265. *
  266. * Associate the clockdomain @clkdm with a powerdomain @pwrdm. This
  267. * enables the use of pwrdm_for_each_clkdm(). Returns -EINVAL if
  268. * presented with invalid pointers; -ENOMEM if memory could not be allocated;
  269. * or 0 upon success.
  270. */
  271. int pwrdm_add_clkdm(struct powerdomain *pwrdm, struct clockdomain *clkdm)
  272. {
  273. int i;
  274. int ret = -EINVAL;
  275. if (!pwrdm || !clkdm)
  276. return -EINVAL;
  277. pr_debug("powerdomain: %s: associating clockdomain %s\n",
  278. pwrdm->name, clkdm->name);
  279. for (i = 0; i < PWRDM_MAX_CLKDMS; i++) {
  280. if (!pwrdm->pwrdm_clkdms[i])
  281. break;
  282. #ifdef DEBUG
  283. if (pwrdm->pwrdm_clkdms[i] == clkdm) {
  284. ret = -EINVAL;
  285. goto pac_exit;
  286. }
  287. #endif
  288. }
  289. if (i == PWRDM_MAX_CLKDMS) {
  290. pr_debug("powerdomain: %s: increase PWRDM_MAX_CLKDMS for clkdm %s\n",
  291. pwrdm->name, clkdm->name);
  292. WARN_ON(1);
  293. ret = -ENOMEM;
  294. goto pac_exit;
  295. }
  296. pwrdm->pwrdm_clkdms[i] = clkdm;
  297. ret = 0;
  298. pac_exit:
  299. return ret;
  300. }
  301. /**
  302. * pwrdm_del_clkdm - remove a clockdomain from a powerdomain
  303. * @pwrdm: struct powerdomain * to add the clockdomain to
  304. * @clkdm: struct clockdomain * to associate with a powerdomain
  305. *
  306. * Dissociate the clockdomain @clkdm from the powerdomain
  307. * @pwrdm. Returns -EINVAL if presented with invalid pointers; -ENOENT
  308. * if @clkdm was not associated with the powerdomain, or 0 upon
  309. * success.
  310. */
  311. int pwrdm_del_clkdm(struct powerdomain *pwrdm, struct clockdomain *clkdm)
  312. {
  313. int ret = -EINVAL;
  314. int i;
  315. if (!pwrdm || !clkdm)
  316. return -EINVAL;
  317. pr_debug("powerdomain: %s: dissociating clockdomain %s\n",
  318. pwrdm->name, clkdm->name);
  319. for (i = 0; i < PWRDM_MAX_CLKDMS; i++)
  320. if (pwrdm->pwrdm_clkdms[i] == clkdm)
  321. break;
  322. if (i == PWRDM_MAX_CLKDMS) {
  323. pr_debug("powerdomain: %s: clkdm %s not associated?!\n",
  324. pwrdm->name, clkdm->name);
  325. ret = -ENOENT;
  326. goto pdc_exit;
  327. }
  328. pwrdm->pwrdm_clkdms[i] = NULL;
  329. ret = 0;
  330. pdc_exit:
  331. return ret;
  332. }
  333. /**
  334. * pwrdm_for_each_clkdm - call function on each clkdm in a pwrdm
  335. * @pwrdm: struct powerdomain * to iterate over
  336. * @fn: callback function *
  337. *
  338. * Call the supplied function @fn for each clockdomain in the powerdomain
  339. * @pwrdm. The callback function can return anything but 0 to bail
  340. * out early from the iterator. Returns -EINVAL if presented with
  341. * invalid pointers; or passes along the last return value of the
  342. * callback function, which should be 0 for success or anything else
  343. * to indicate failure.
  344. */
  345. int pwrdm_for_each_clkdm(struct powerdomain *pwrdm,
  346. int (*fn)(struct powerdomain *pwrdm,
  347. struct clockdomain *clkdm))
  348. {
  349. int ret = 0;
  350. int i;
  351. if (!fn)
  352. return -EINVAL;
  353. for (i = 0; i < PWRDM_MAX_CLKDMS && !ret; i++)
  354. ret = (*fn)(pwrdm, pwrdm->pwrdm_clkdms[i]);
  355. return ret;
  356. }
  357. /**
  358. * pwrdm_get_voltdm - return a ptr to the voltdm that this pwrdm resides in
  359. * @pwrdm: struct powerdomain *
  360. *
  361. * Return a pointer to the struct voltageomain that the specified powerdomain
  362. * @pwrdm exists in.
  363. */
  364. struct voltagedomain *pwrdm_get_voltdm(struct powerdomain *pwrdm)
  365. {
  366. return pwrdm->voltdm.ptr;
  367. }
  368. /**
  369. * pwrdm_get_mem_bank_count - get number of memory banks in this powerdomain
  370. * @pwrdm: struct powerdomain *
  371. *
  372. * Return the number of controllable memory banks in powerdomain @pwrdm,
  373. * starting with 1. Returns -EINVAL if the powerdomain pointer is null.
  374. */
  375. int pwrdm_get_mem_bank_count(struct powerdomain *pwrdm)
  376. {
  377. if (!pwrdm)
  378. return -EINVAL;
  379. return pwrdm->banks;
  380. }
  381. /**
  382. * pwrdm_set_next_pwrst - set next powerdomain power state
  383. * @pwrdm: struct powerdomain * to set
  384. * @pwrst: one of the PWRDM_POWER_* macros
  385. *
  386. * Set the powerdomain @pwrdm's next power state to @pwrst. The powerdomain
  387. * may not enter this state immediately if the preconditions for this state
  388. * have not been satisfied. Returns -EINVAL if the powerdomain pointer is
  389. * null or if the power state is invalid for the powerdomin, or returns 0
  390. * upon success.
  391. */
  392. int pwrdm_set_next_pwrst(struct powerdomain *pwrdm, u8 pwrst)
  393. {
  394. int ret = -EINVAL;
  395. if (!pwrdm)
  396. return -EINVAL;
  397. if (!(pwrdm->pwrsts & (1 << pwrst)))
  398. return -EINVAL;
  399. pr_debug("powerdomain: %s: setting next powerstate to %0x\n",
  400. pwrdm->name, pwrst);
  401. if (arch_pwrdm && arch_pwrdm->pwrdm_set_next_pwrst) {
  402. /* Trace the pwrdm desired target state */
  403. trace_power_domain_target(pwrdm->name, pwrst,
  404. smp_processor_id());
  405. /* Program the pwrdm desired target state */
  406. ret = arch_pwrdm->pwrdm_set_next_pwrst(pwrdm, pwrst);
  407. }
  408. return ret;
  409. }
  410. /**
  411. * pwrdm_read_next_pwrst - get next powerdomain power state
  412. * @pwrdm: struct powerdomain * to get power state
  413. *
  414. * Return the powerdomain @pwrdm's next power state. Returns -EINVAL
  415. * if the powerdomain pointer is null or returns the next power state
  416. * upon success.
  417. */
  418. int pwrdm_read_next_pwrst(struct powerdomain *pwrdm)
  419. {
  420. int ret = -EINVAL;
  421. if (!pwrdm)
  422. return -EINVAL;
  423. if (arch_pwrdm && arch_pwrdm->pwrdm_read_next_pwrst)
  424. ret = arch_pwrdm->pwrdm_read_next_pwrst(pwrdm);
  425. return ret;
  426. }
  427. /**
  428. * pwrdm_read_pwrst - get current powerdomain power state
  429. * @pwrdm: struct powerdomain * to get power state
  430. *
  431. * Return the powerdomain @pwrdm's current power state. Returns -EINVAL
  432. * if the powerdomain pointer is null or returns the current power state
  433. * upon success. Note that if the power domain only supports the ON state
  434. * then just return ON as the current state.
  435. */
  436. int pwrdm_read_pwrst(struct powerdomain *pwrdm)
  437. {
  438. int ret = -EINVAL;
  439. if (!pwrdm)
  440. return -EINVAL;
  441. if (pwrdm->pwrsts == PWRSTS_ON)
  442. return PWRDM_POWER_ON;
  443. if (arch_pwrdm && arch_pwrdm->pwrdm_read_pwrst)
  444. ret = arch_pwrdm->pwrdm_read_pwrst(pwrdm);
  445. return ret;
  446. }
  447. /**
  448. * pwrdm_read_prev_pwrst - get previous powerdomain power state
  449. * @pwrdm: struct powerdomain * to get previous power state
  450. *
  451. * Return the powerdomain @pwrdm's previous power state. Returns -EINVAL
  452. * if the powerdomain pointer is null or returns the previous power state
  453. * upon success.
  454. */
  455. int pwrdm_read_prev_pwrst(struct powerdomain *pwrdm)
  456. {
  457. int ret = -EINVAL;
  458. if (!pwrdm)
  459. return -EINVAL;
  460. if (arch_pwrdm && arch_pwrdm->pwrdm_read_prev_pwrst)
  461. ret = arch_pwrdm->pwrdm_read_prev_pwrst(pwrdm);
  462. return ret;
  463. }
  464. /**
  465. * pwrdm_set_logic_retst - set powerdomain logic power state upon retention
  466. * @pwrdm: struct powerdomain * to set
  467. * @pwrst: one of the PWRDM_POWER_* macros
  468. *
  469. * Set the next power state @pwrst that the logic portion of the
  470. * powerdomain @pwrdm will enter when the powerdomain enters retention.
  471. * This will be either RETENTION or OFF, if supported. Returns
  472. * -EINVAL if the powerdomain pointer is null or the target power
  473. * state is not not supported, or returns 0 upon success.
  474. */
  475. int pwrdm_set_logic_retst(struct powerdomain *pwrdm, u8 pwrst)
  476. {
  477. int ret = -EINVAL;
  478. if (!pwrdm)
  479. return -EINVAL;
  480. if (!(pwrdm->pwrsts_logic_ret & (1 << pwrst)))
  481. return -EINVAL;
  482. pr_debug("powerdomain: %s: setting next logic powerstate to %0x\n",
  483. pwrdm->name, pwrst);
  484. if (arch_pwrdm && arch_pwrdm->pwrdm_set_logic_retst)
  485. ret = arch_pwrdm->pwrdm_set_logic_retst(pwrdm, pwrst);
  486. return ret;
  487. }
  488. /**
  489. * pwrdm_set_mem_onst - set memory power state while powerdomain ON
  490. * @pwrdm: struct powerdomain * to set
  491. * @bank: memory bank number to set (0-3)
  492. * @pwrst: one of the PWRDM_POWER_* macros
  493. *
  494. * Set the next power state @pwrst that memory bank @bank of the
  495. * powerdomain @pwrdm will enter when the powerdomain enters the ON
  496. * state. @bank will be a number from 0 to 3, and represents different
  497. * types of memory, depending on the powerdomain. Returns -EINVAL if
  498. * the powerdomain pointer is null or the target power state is not
  499. * not supported for this memory bank, -EEXIST if the target memory
  500. * bank does not exist or is not controllable, or returns 0 upon
  501. * success.
  502. */
  503. int pwrdm_set_mem_onst(struct powerdomain *pwrdm, u8 bank, u8 pwrst)
  504. {
  505. int ret = -EINVAL;
  506. if (!pwrdm)
  507. return -EINVAL;
  508. if (pwrdm->banks < (bank + 1))
  509. return -EEXIST;
  510. if (!(pwrdm->pwrsts_mem_on[bank] & (1 << pwrst)))
  511. return -EINVAL;
  512. pr_debug("powerdomain: %s: setting next memory powerstate for bank %0x while pwrdm-ON to %0x\n",
  513. pwrdm->name, bank, pwrst);
  514. if (arch_pwrdm && arch_pwrdm->pwrdm_set_mem_onst)
  515. ret = arch_pwrdm->pwrdm_set_mem_onst(pwrdm, bank, pwrst);
  516. return ret;
  517. }
  518. /**
  519. * pwrdm_set_mem_retst - set memory power state while powerdomain in RET
  520. * @pwrdm: struct powerdomain * to set
  521. * @bank: memory bank number to set (0-3)
  522. * @pwrst: one of the PWRDM_POWER_* macros
  523. *
  524. * Set the next power state @pwrst that memory bank @bank of the
  525. * powerdomain @pwrdm will enter when the powerdomain enters the
  526. * RETENTION state. Bank will be a number from 0 to 3, and represents
  527. * different types of memory, depending on the powerdomain. @pwrst
  528. * will be either RETENTION or OFF, if supported. Returns -EINVAL if
  529. * the powerdomain pointer is null or the target power state is not
  530. * not supported for this memory bank, -EEXIST if the target memory
  531. * bank does not exist or is not controllable, or returns 0 upon
  532. * success.
  533. */
  534. int pwrdm_set_mem_retst(struct powerdomain *pwrdm, u8 bank, u8 pwrst)
  535. {
  536. int ret = -EINVAL;
  537. if (!pwrdm)
  538. return -EINVAL;
  539. if (pwrdm->banks < (bank + 1))
  540. return -EEXIST;
  541. if (!(pwrdm->pwrsts_mem_ret[bank] & (1 << pwrst)))
  542. return -EINVAL;
  543. pr_debug("powerdomain: %s: setting next memory powerstate for bank %0x while pwrdm-RET to %0x\n",
  544. pwrdm->name, bank, pwrst);
  545. if (arch_pwrdm && arch_pwrdm->pwrdm_set_mem_retst)
  546. ret = arch_pwrdm->pwrdm_set_mem_retst(pwrdm, bank, pwrst);
  547. return ret;
  548. }
  549. /**
  550. * pwrdm_read_logic_pwrst - get current powerdomain logic retention power state
  551. * @pwrdm: struct powerdomain * to get current logic retention power state
  552. *
  553. * Return the power state that the logic portion of powerdomain @pwrdm
  554. * will enter when the powerdomain enters retention. Returns -EINVAL
  555. * if the powerdomain pointer is null or returns the logic retention
  556. * power state upon success.
  557. */
  558. int pwrdm_read_logic_pwrst(struct powerdomain *pwrdm)
  559. {
  560. int ret = -EINVAL;
  561. if (!pwrdm)
  562. return -EINVAL;
  563. if (arch_pwrdm && arch_pwrdm->pwrdm_read_logic_pwrst)
  564. ret = arch_pwrdm->pwrdm_read_logic_pwrst(pwrdm);
  565. return ret;
  566. }
  567. /**
  568. * pwrdm_read_prev_logic_pwrst - get previous powerdomain logic power state
  569. * @pwrdm: struct powerdomain * to get previous logic power state
  570. *
  571. * Return the powerdomain @pwrdm's previous logic power state. Returns
  572. * -EINVAL if the powerdomain pointer is null or returns the previous
  573. * logic power state upon success.
  574. */
  575. int pwrdm_read_prev_logic_pwrst(struct powerdomain *pwrdm)
  576. {
  577. int ret = -EINVAL;
  578. if (!pwrdm)
  579. return -EINVAL;
  580. if (arch_pwrdm && arch_pwrdm->pwrdm_read_prev_logic_pwrst)
  581. ret = arch_pwrdm->pwrdm_read_prev_logic_pwrst(pwrdm);
  582. return ret;
  583. }
  584. /**
  585. * pwrdm_read_logic_retst - get next powerdomain logic power state
  586. * @pwrdm: struct powerdomain * to get next logic power state
  587. *
  588. * Return the powerdomain pwrdm's logic power state. Returns -EINVAL
  589. * if the powerdomain pointer is null or returns the next logic
  590. * power state upon success.
  591. */
  592. int pwrdm_read_logic_retst(struct powerdomain *pwrdm)
  593. {
  594. int ret = -EINVAL;
  595. if (!pwrdm)
  596. return -EINVAL;
  597. if (arch_pwrdm && arch_pwrdm->pwrdm_read_logic_retst)
  598. ret = arch_pwrdm->pwrdm_read_logic_retst(pwrdm);
  599. return ret;
  600. }
  601. /**
  602. * pwrdm_read_mem_pwrst - get current memory bank power state
  603. * @pwrdm: struct powerdomain * to get current memory bank power state
  604. * @bank: memory bank number (0-3)
  605. *
  606. * Return the powerdomain @pwrdm's current memory power state for bank
  607. * @bank. Returns -EINVAL if the powerdomain pointer is null, -EEXIST if
  608. * the target memory bank does not exist or is not controllable, or
  609. * returns the current memory power state upon success.
  610. */
  611. int pwrdm_read_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
  612. {
  613. int ret = -EINVAL;
  614. if (!pwrdm)
  615. return ret;
  616. if (pwrdm->banks < (bank + 1))
  617. return ret;
  618. if (pwrdm->flags & PWRDM_HAS_MPU_QUIRK)
  619. bank = 1;
  620. if (arch_pwrdm && arch_pwrdm->pwrdm_read_mem_pwrst)
  621. ret = arch_pwrdm->pwrdm_read_mem_pwrst(pwrdm, bank);
  622. return ret;
  623. }
  624. /**
  625. * pwrdm_read_prev_mem_pwrst - get previous memory bank power state
  626. * @pwrdm: struct powerdomain * to get previous memory bank power state
  627. * @bank: memory bank number (0-3)
  628. *
  629. * Return the powerdomain @pwrdm's previous memory power state for
  630. * bank @bank. Returns -EINVAL if the powerdomain pointer is null,
  631. * -EEXIST if the target memory bank does not exist or is not
  632. * controllable, or returns the previous memory power state upon
  633. * success.
  634. */
  635. int pwrdm_read_prev_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
  636. {
  637. int ret = -EINVAL;
  638. if (!pwrdm)
  639. return ret;
  640. if (pwrdm->banks < (bank + 1))
  641. return ret;
  642. if (pwrdm->flags & PWRDM_HAS_MPU_QUIRK)
  643. bank = 1;
  644. if (arch_pwrdm && arch_pwrdm->pwrdm_read_prev_mem_pwrst)
  645. ret = arch_pwrdm->pwrdm_read_prev_mem_pwrst(pwrdm, bank);
  646. return ret;
  647. }
  648. /**
  649. * pwrdm_read_mem_retst - get next memory bank power state
  650. * @pwrdm: struct powerdomain * to get mext memory bank power state
  651. * @bank: memory bank number (0-3)
  652. *
  653. * Return the powerdomain pwrdm's next memory power state for bank
  654. * x. Returns -EINVAL if the powerdomain pointer is null, -EEXIST if
  655. * the target memory bank does not exist or is not controllable, or
  656. * returns the next memory power state upon success.
  657. */
  658. int pwrdm_read_mem_retst(struct powerdomain *pwrdm, u8 bank)
  659. {
  660. int ret = -EINVAL;
  661. if (!pwrdm)
  662. return ret;
  663. if (pwrdm->banks < (bank + 1))
  664. return ret;
  665. if (arch_pwrdm && arch_pwrdm->pwrdm_read_mem_retst)
  666. ret = arch_pwrdm->pwrdm_read_mem_retst(pwrdm, bank);
  667. return ret;
  668. }
  669. /**
  670. * pwrdm_clear_all_prev_pwrst - clear previous powerstate register for a pwrdm
  671. * @pwrdm: struct powerdomain * to clear
  672. *
  673. * Clear the powerdomain's previous power state register @pwrdm.
  674. * Clears the entire register, including logic and memory bank
  675. * previous power states. Returns -EINVAL if the powerdomain pointer
  676. * is null, or returns 0 upon success.
  677. */
  678. int pwrdm_clear_all_prev_pwrst(struct powerdomain *pwrdm)
  679. {
  680. int ret = -EINVAL;
  681. if (!pwrdm)
  682. return ret;
  683. /*
  684. * XXX should get the powerdomain's current state here;
  685. * warn & fail if it is not ON.
  686. */
  687. pr_debug("powerdomain: %s: clearing previous power state reg\n",
  688. pwrdm->name);
  689. if (arch_pwrdm && arch_pwrdm->pwrdm_clear_all_prev_pwrst)
  690. ret = arch_pwrdm->pwrdm_clear_all_prev_pwrst(pwrdm);
  691. return ret;
  692. }
  693. /**
  694. * pwrdm_enable_hdwr_sar - enable automatic hardware SAR for a pwrdm
  695. * @pwrdm: struct powerdomain *
  696. *
  697. * Enable automatic context save-and-restore upon power state change
  698. * for some devices in the powerdomain @pwrdm. Warning: this only
  699. * affects a subset of devices in a powerdomain; check the TRM
  700. * closely. Returns -EINVAL if the powerdomain pointer is null or if
  701. * the powerdomain does not support automatic save-and-restore, or
  702. * returns 0 upon success.
  703. */
  704. int pwrdm_enable_hdwr_sar(struct powerdomain *pwrdm)
  705. {
  706. int ret = -EINVAL;
  707. if (!pwrdm)
  708. return ret;
  709. if (!(pwrdm->flags & PWRDM_HAS_HDWR_SAR))
  710. return ret;
  711. pr_debug("powerdomain: %s: setting SAVEANDRESTORE bit\n", pwrdm->name);
  712. if (arch_pwrdm && arch_pwrdm->pwrdm_enable_hdwr_sar)
  713. ret = arch_pwrdm->pwrdm_enable_hdwr_sar(pwrdm);
  714. return ret;
  715. }
  716. /**
  717. * pwrdm_disable_hdwr_sar - disable automatic hardware SAR for a pwrdm
  718. * @pwrdm: struct powerdomain *
  719. *
  720. * Disable automatic context save-and-restore upon power state change
  721. * for some devices in the powerdomain @pwrdm. Warning: this only
  722. * affects a subset of devices in a powerdomain; check the TRM
  723. * closely. Returns -EINVAL if the powerdomain pointer is null or if
  724. * the powerdomain does not support automatic save-and-restore, or
  725. * returns 0 upon success.
  726. */
  727. int pwrdm_disable_hdwr_sar(struct powerdomain *pwrdm)
  728. {
  729. int ret = -EINVAL;
  730. if (!pwrdm)
  731. return ret;
  732. if (!(pwrdm->flags & PWRDM_HAS_HDWR_SAR))
  733. return ret;
  734. pr_debug("powerdomain: %s: clearing SAVEANDRESTORE bit\n", pwrdm->name);
  735. if (arch_pwrdm && arch_pwrdm->pwrdm_disable_hdwr_sar)
  736. ret = arch_pwrdm->pwrdm_disable_hdwr_sar(pwrdm);
  737. return ret;
  738. }
  739. /**
  740. * pwrdm_has_hdwr_sar - test whether powerdomain supports hardware SAR
  741. * @pwrdm: struct powerdomain *
  742. *
  743. * Returns 1 if powerdomain @pwrdm supports hardware save-and-restore
  744. * for some devices, or 0 if it does not.
  745. */
  746. bool pwrdm_has_hdwr_sar(struct powerdomain *pwrdm)
  747. {
  748. return (pwrdm && pwrdm->flags & PWRDM_HAS_HDWR_SAR) ? 1 : 0;
  749. }
  750. /**
  751. * pwrdm_set_lowpwrstchange - Request a low power state change
  752. * @pwrdm: struct powerdomain *
  753. *
  754. * Allows a powerdomain to transtion to a lower power sleep state
  755. * from an existing sleep state without waking up the powerdomain.
  756. * Returns -EINVAL if the powerdomain pointer is null or if the
  757. * powerdomain does not support LOWPOWERSTATECHANGE, or returns 0
  758. * upon success.
  759. */
  760. int pwrdm_set_lowpwrstchange(struct powerdomain *pwrdm)
  761. {
  762. int ret = -EINVAL;
  763. if (!pwrdm)
  764. return -EINVAL;
  765. if (!(pwrdm->flags & PWRDM_HAS_LOWPOWERSTATECHANGE))
  766. return -EINVAL;
  767. pr_debug("powerdomain: %s: setting LOWPOWERSTATECHANGE bit\n",
  768. pwrdm->name);
  769. if (arch_pwrdm && arch_pwrdm->pwrdm_set_lowpwrstchange)
  770. ret = arch_pwrdm->pwrdm_set_lowpwrstchange(pwrdm);
  771. return ret;
  772. }
  773. /**
  774. * pwrdm_wait_transition - wait for powerdomain power transition to finish
  775. * @pwrdm: struct powerdomain * to wait for
  776. *
  777. * If the powerdomain @pwrdm is in the process of a state transition,
  778. * spin until it completes the power transition, or until an iteration
  779. * bailout value is reached. Returns -EINVAL if the powerdomain
  780. * pointer is null, -EAGAIN if the bailout value was reached, or
  781. * returns 0 upon success.
  782. */
  783. int pwrdm_wait_transition(struct powerdomain *pwrdm)
  784. {
  785. int ret = -EINVAL;
  786. if (!pwrdm)
  787. return -EINVAL;
  788. if (arch_pwrdm && arch_pwrdm->pwrdm_wait_transition)
  789. ret = arch_pwrdm->pwrdm_wait_transition(pwrdm);
  790. return ret;
  791. }
  792. int pwrdm_state_switch(struct powerdomain *pwrdm)
  793. {
  794. int ret;
  795. ret = pwrdm_wait_transition(pwrdm);
  796. if (!ret)
  797. ret = _pwrdm_state_switch(pwrdm, PWRDM_STATE_NOW);
  798. return ret;
  799. }
  800. int pwrdm_pre_transition(struct powerdomain *pwrdm)
  801. {
  802. if (pwrdm)
  803. _pwrdm_pre_transition_cb(pwrdm, NULL);
  804. else
  805. pwrdm_for_each(_pwrdm_pre_transition_cb, NULL);
  806. return 0;
  807. }
  808. int pwrdm_post_transition(struct powerdomain *pwrdm)
  809. {
  810. if (pwrdm)
  811. _pwrdm_post_transition_cb(pwrdm, NULL);
  812. else
  813. pwrdm_for_each(_pwrdm_post_transition_cb, NULL);
  814. return 0;
  815. }
  816. /**
  817. * pwrdm_get_context_loss_count - get powerdomain's context loss count
  818. * @pwrdm: struct powerdomain * to wait for
  819. *
  820. * Context loss count is the sum of powerdomain off-mode counter, the
  821. * logic off counter and the per-bank memory off counter. Returns negative
  822. * (and WARNs) upon error, otherwise, returns the context loss count.
  823. */
  824. int pwrdm_get_context_loss_count(struct powerdomain *pwrdm)
  825. {
  826. int i, count;
  827. if (!pwrdm) {
  828. WARN(1, "powerdomain: %s: pwrdm is null\n", __func__);
  829. return -ENODEV;
  830. }
  831. count = pwrdm->state_counter[PWRDM_POWER_OFF];
  832. count += pwrdm->ret_logic_off_counter;
  833. for (i = 0; i < pwrdm->banks; i++)
  834. count += pwrdm->ret_mem_off_counter[i];
  835. /*
  836. * Context loss count has to be a non-negative value. Clear the sign
  837. * bit to get a value range from 0 to INT_MAX.
  838. */
  839. count &= INT_MAX;
  840. pr_debug("powerdomain: %s: context loss count = %d\n",
  841. pwrdm->name, count);
  842. return count;
  843. }
  844. /**
  845. * pwrdm_can_ever_lose_context - can this powerdomain ever lose context?
  846. * @pwrdm: struct powerdomain *
  847. *
  848. * Given a struct powerdomain * @pwrdm, returns 1 if the powerdomain
  849. * can lose either memory or logic context or if @pwrdm is invalid, or
  850. * returns 0 otherwise. This function is not concerned with how the
  851. * powerdomain registers are programmed (i.e., to go off or not); it's
  852. * concerned with whether it's ever possible for this powerdomain to
  853. * go off while some other part of the chip is active. This function
  854. * assumes that every powerdomain can go to either ON or INACTIVE.
  855. */
  856. bool pwrdm_can_ever_lose_context(struct powerdomain *pwrdm)
  857. {
  858. int i;
  859. if (IS_ERR_OR_NULL(pwrdm)) {
  860. pr_debug("powerdomain: %s: invalid powerdomain pointer\n",
  861. __func__);
  862. return 1;
  863. }
  864. if (pwrdm->pwrsts & PWRSTS_OFF)
  865. return 1;
  866. if (pwrdm->pwrsts & PWRSTS_RET) {
  867. if (pwrdm->pwrsts_logic_ret & PWRSTS_OFF)
  868. return 1;
  869. for (i = 0; i < pwrdm->banks; i++)
  870. if (pwrdm->pwrsts_mem_ret[i] & PWRSTS_OFF)
  871. return 1;
  872. }
  873. for (i = 0; i < pwrdm->banks; i++)
  874. if (pwrdm->pwrsts_mem_on[i] & PWRSTS_OFF)
  875. return 1;
  876. return 0;
  877. }