powerdomain.c 32 KB

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