powerdomain.c 24 KB

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