powerdomain.c 28 KB

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