powerdomain.c 26 KB

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