powerdomain.c 26 KB

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