powerdomain.c 32 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208
  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 "voltage.h"
  32. #include "soc.h"
  33. #include "pm.h"
  34. #define PWRDM_TRACE_STATES_FLAG (1<<31)
  35. enum {
  36. PWRDM_STATE_NOW = 0,
  37. PWRDM_STATE_PREV,
  38. };
  39. /*
  40. * Types of sleep_switch used internally in omap_set_pwrdm_state()
  41. * and its associated static functions
  42. *
  43. * XXX Better documentation is needed here
  44. */
  45. #define ALREADYACTIVE_SWITCH 0
  46. #define FORCEWAKEUP_SWITCH 1
  47. #define LOWPOWERSTATE_SWITCH 2
  48. /* pwrdm_list contains all registered struct powerdomains */
  49. static LIST_HEAD(pwrdm_list);
  50. static struct pwrdm_ops *arch_pwrdm;
  51. /* Private functions */
  52. static struct powerdomain *_pwrdm_lookup(const char *name)
  53. {
  54. struct powerdomain *pwrdm, *temp_pwrdm;
  55. pwrdm = NULL;
  56. list_for_each_entry(temp_pwrdm, &pwrdm_list, node) {
  57. if (!strcmp(name, temp_pwrdm->name)) {
  58. pwrdm = temp_pwrdm;
  59. break;
  60. }
  61. }
  62. return pwrdm;
  63. }
  64. /**
  65. * _pwrdm_register - register a powerdomain
  66. * @pwrdm: struct powerdomain * to register
  67. *
  68. * Adds a powerdomain to the internal powerdomain list. Returns
  69. * -EINVAL if given a null pointer, -EEXIST if a powerdomain is
  70. * already registered by the provided name, or 0 upon success.
  71. */
  72. static int _pwrdm_register(struct powerdomain *pwrdm)
  73. {
  74. int i;
  75. struct voltagedomain *voltdm;
  76. if (!pwrdm || !pwrdm->name)
  77. return -EINVAL;
  78. if (cpu_is_omap44xx() &&
  79. pwrdm->prcm_partition == OMAP4430_INVALID_PRCM_PARTITION) {
  80. pr_err("powerdomain: %s: missing OMAP4 PRCM partition ID\n",
  81. pwrdm->name);
  82. return -EINVAL;
  83. }
  84. if (_pwrdm_lookup(pwrdm->name))
  85. return -EEXIST;
  86. if (arch_pwrdm && arch_pwrdm->pwrdm_has_voltdm)
  87. if (!arch_pwrdm->pwrdm_has_voltdm())
  88. goto skip_voltdm;
  89. voltdm = voltdm_lookup(pwrdm->voltdm.name);
  90. if (!voltdm) {
  91. pr_err("powerdomain: %s: voltagedomain %s does not exist\n",
  92. pwrdm->name, pwrdm->voltdm.name);
  93. return -EINVAL;
  94. }
  95. pwrdm->voltdm.ptr = voltdm;
  96. INIT_LIST_HEAD(&pwrdm->voltdm_node);
  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_get_mem_bank_count - get number of memory banks in this powerdomain
  408. * @pwrdm: struct powerdomain *
  409. *
  410. * Return the number of controllable memory banks in powerdomain @pwrdm,
  411. * starting with 1. Returns -EINVAL if the powerdomain pointer is null.
  412. */
  413. int pwrdm_get_mem_bank_count(struct powerdomain *pwrdm)
  414. {
  415. if (!pwrdm)
  416. return -EINVAL;
  417. return pwrdm->banks;
  418. }
  419. /**
  420. * pwrdm_set_next_pwrst - set next powerdomain power state
  421. * @pwrdm: struct powerdomain * to set
  422. * @pwrst: one of the PWRDM_POWER_* macros
  423. *
  424. * Set the powerdomain @pwrdm's next power state to @pwrst. The powerdomain
  425. * may not enter this state immediately if the preconditions for this state
  426. * have not been satisfied. Returns -EINVAL if the powerdomain pointer is
  427. * null or if the power state is invalid for the powerdomin, or returns 0
  428. * upon success.
  429. */
  430. int pwrdm_set_next_pwrst(struct powerdomain *pwrdm, u8 pwrst)
  431. {
  432. int ret = -EINVAL;
  433. if (!pwrdm)
  434. return -EINVAL;
  435. if (!(pwrdm->pwrsts & (1 << pwrst)))
  436. return -EINVAL;
  437. pr_debug("powerdomain: %s: setting next powerstate to %0x\n",
  438. pwrdm->name, pwrst);
  439. if (arch_pwrdm && arch_pwrdm->pwrdm_set_next_pwrst) {
  440. /* Trace the pwrdm desired target state */
  441. trace_power_domain_target(pwrdm->name, pwrst,
  442. smp_processor_id());
  443. /* Program the pwrdm desired target state */
  444. ret = arch_pwrdm->pwrdm_set_next_pwrst(pwrdm, pwrst);
  445. }
  446. return ret;
  447. }
  448. /**
  449. * pwrdm_read_next_pwrst - get next powerdomain power state
  450. * @pwrdm: struct powerdomain * to get power state
  451. *
  452. * Return the powerdomain @pwrdm's next power state. Returns -EINVAL
  453. * if the powerdomain pointer is null or returns the next power state
  454. * upon success.
  455. */
  456. int pwrdm_read_next_pwrst(struct powerdomain *pwrdm)
  457. {
  458. int ret = -EINVAL;
  459. if (!pwrdm)
  460. return -EINVAL;
  461. if (arch_pwrdm && arch_pwrdm->pwrdm_read_next_pwrst)
  462. ret = arch_pwrdm->pwrdm_read_next_pwrst(pwrdm);
  463. return ret;
  464. }
  465. /**
  466. * pwrdm_read_pwrst - get current powerdomain power state
  467. * @pwrdm: struct powerdomain * to get power state
  468. *
  469. * Return the powerdomain @pwrdm's current power state. Returns -EINVAL
  470. * if the powerdomain pointer is null or returns the current power state
  471. * upon success. Note that if the power domain only supports the ON state
  472. * then just return ON as the current state.
  473. */
  474. int pwrdm_read_pwrst(struct powerdomain *pwrdm)
  475. {
  476. int ret = -EINVAL;
  477. if (!pwrdm)
  478. return -EINVAL;
  479. if (pwrdm->pwrsts == PWRSTS_ON)
  480. return PWRDM_POWER_ON;
  481. if (arch_pwrdm && arch_pwrdm->pwrdm_read_pwrst)
  482. ret = arch_pwrdm->pwrdm_read_pwrst(pwrdm);
  483. return ret;
  484. }
  485. /**
  486. * pwrdm_read_prev_pwrst - get previous powerdomain power state
  487. * @pwrdm: struct powerdomain * to get previous power state
  488. *
  489. * Return the powerdomain @pwrdm's previous power state. Returns -EINVAL
  490. * if the powerdomain pointer is null or returns the previous power state
  491. * upon success.
  492. */
  493. int pwrdm_read_prev_pwrst(struct powerdomain *pwrdm)
  494. {
  495. int ret = -EINVAL;
  496. if (!pwrdm)
  497. return -EINVAL;
  498. if (arch_pwrdm && arch_pwrdm->pwrdm_read_prev_pwrst)
  499. ret = arch_pwrdm->pwrdm_read_prev_pwrst(pwrdm);
  500. return ret;
  501. }
  502. /**
  503. * pwrdm_set_logic_retst - set powerdomain logic power state upon retention
  504. * @pwrdm: struct powerdomain * to set
  505. * @pwrst: one of the PWRDM_POWER_* macros
  506. *
  507. * Set the next power state @pwrst that the logic portion of the
  508. * powerdomain @pwrdm will enter when the powerdomain enters retention.
  509. * This will be either RETENTION or OFF, if supported. Returns
  510. * -EINVAL if the powerdomain pointer is null or the target power
  511. * state is not not supported, or returns 0 upon success.
  512. */
  513. int pwrdm_set_logic_retst(struct powerdomain *pwrdm, u8 pwrst)
  514. {
  515. int ret = -EINVAL;
  516. if (!pwrdm)
  517. return -EINVAL;
  518. if (!(pwrdm->pwrsts_logic_ret & (1 << pwrst)))
  519. return -EINVAL;
  520. pr_debug("powerdomain: %s: setting next logic powerstate to %0x\n",
  521. pwrdm->name, pwrst);
  522. if (arch_pwrdm && arch_pwrdm->pwrdm_set_logic_retst)
  523. ret = arch_pwrdm->pwrdm_set_logic_retst(pwrdm, pwrst);
  524. return ret;
  525. }
  526. /**
  527. * pwrdm_set_mem_onst - set memory power state while powerdomain ON
  528. * @pwrdm: struct powerdomain * to set
  529. * @bank: memory bank number to set (0-3)
  530. * @pwrst: one of the PWRDM_POWER_* macros
  531. *
  532. * Set the next power state @pwrst that memory bank @bank of the
  533. * powerdomain @pwrdm will enter when the powerdomain enters the ON
  534. * state. @bank will be a number from 0 to 3, and represents different
  535. * types of memory, depending on the powerdomain. Returns -EINVAL if
  536. * the powerdomain pointer is null or the target power state is not
  537. * not supported for this memory bank, -EEXIST if the target memory
  538. * bank does not exist or is not controllable, or returns 0 upon
  539. * success.
  540. */
  541. int pwrdm_set_mem_onst(struct powerdomain *pwrdm, u8 bank, u8 pwrst)
  542. {
  543. int ret = -EINVAL;
  544. if (!pwrdm)
  545. return -EINVAL;
  546. if (pwrdm->banks < (bank + 1))
  547. return -EEXIST;
  548. if (!(pwrdm->pwrsts_mem_on[bank] & (1 << pwrst)))
  549. return -EINVAL;
  550. pr_debug("powerdomain: %s: setting next memory powerstate for bank %0x while pwrdm-ON to %0x\n",
  551. pwrdm->name, bank, pwrst);
  552. if (arch_pwrdm && arch_pwrdm->pwrdm_set_mem_onst)
  553. ret = arch_pwrdm->pwrdm_set_mem_onst(pwrdm, bank, pwrst);
  554. return ret;
  555. }
  556. /**
  557. * pwrdm_set_mem_retst - set memory power state while powerdomain in RET
  558. * @pwrdm: struct powerdomain * to set
  559. * @bank: memory bank number to set (0-3)
  560. * @pwrst: one of the PWRDM_POWER_* macros
  561. *
  562. * Set the next power state @pwrst that memory bank @bank of the
  563. * powerdomain @pwrdm will enter when the powerdomain enters the
  564. * RETENTION state. Bank will be a number from 0 to 3, and represents
  565. * different types of memory, depending on the powerdomain. @pwrst
  566. * will be either RETENTION or OFF, if supported. Returns -EINVAL if
  567. * the powerdomain pointer is null or the target power state is not
  568. * not supported for this memory bank, -EEXIST if the target memory
  569. * bank does not exist or is not controllable, or returns 0 upon
  570. * success.
  571. */
  572. int pwrdm_set_mem_retst(struct powerdomain *pwrdm, u8 bank, u8 pwrst)
  573. {
  574. int ret = -EINVAL;
  575. if (!pwrdm)
  576. return -EINVAL;
  577. if (pwrdm->banks < (bank + 1))
  578. return -EEXIST;
  579. if (!(pwrdm->pwrsts_mem_ret[bank] & (1 << pwrst)))
  580. return -EINVAL;
  581. pr_debug("powerdomain: %s: setting next memory powerstate for bank %0x while pwrdm-RET to %0x\n",
  582. pwrdm->name, bank, pwrst);
  583. if (arch_pwrdm && arch_pwrdm->pwrdm_set_mem_retst)
  584. ret = arch_pwrdm->pwrdm_set_mem_retst(pwrdm, bank, pwrst);
  585. return ret;
  586. }
  587. /**
  588. * pwrdm_read_logic_pwrst - get current powerdomain logic retention power state
  589. * @pwrdm: struct powerdomain * to get current logic retention power state
  590. *
  591. * Return the power state that the logic portion of powerdomain @pwrdm
  592. * will enter when the powerdomain enters retention. Returns -EINVAL
  593. * if the powerdomain pointer is null or returns the logic retention
  594. * power state upon success.
  595. */
  596. int pwrdm_read_logic_pwrst(struct powerdomain *pwrdm)
  597. {
  598. int ret = -EINVAL;
  599. if (!pwrdm)
  600. return -EINVAL;
  601. if (arch_pwrdm && arch_pwrdm->pwrdm_read_logic_pwrst)
  602. ret = arch_pwrdm->pwrdm_read_logic_pwrst(pwrdm);
  603. return ret;
  604. }
  605. /**
  606. * pwrdm_read_prev_logic_pwrst - get previous powerdomain logic power state
  607. * @pwrdm: struct powerdomain * to get previous logic power state
  608. *
  609. * Return the powerdomain @pwrdm's previous logic power state. Returns
  610. * -EINVAL if the powerdomain pointer is null or returns the previous
  611. * logic power state upon success.
  612. */
  613. int pwrdm_read_prev_logic_pwrst(struct powerdomain *pwrdm)
  614. {
  615. int ret = -EINVAL;
  616. if (!pwrdm)
  617. return -EINVAL;
  618. if (arch_pwrdm && arch_pwrdm->pwrdm_read_prev_logic_pwrst)
  619. ret = arch_pwrdm->pwrdm_read_prev_logic_pwrst(pwrdm);
  620. return ret;
  621. }
  622. /**
  623. * pwrdm_read_logic_retst - get next powerdomain logic power state
  624. * @pwrdm: struct powerdomain * to get next logic power state
  625. *
  626. * Return the powerdomain pwrdm's logic power state. Returns -EINVAL
  627. * if the powerdomain pointer is null or returns the next logic
  628. * power state upon success.
  629. */
  630. int pwrdm_read_logic_retst(struct powerdomain *pwrdm)
  631. {
  632. int ret = -EINVAL;
  633. if (!pwrdm)
  634. return -EINVAL;
  635. if (arch_pwrdm && arch_pwrdm->pwrdm_read_logic_retst)
  636. ret = arch_pwrdm->pwrdm_read_logic_retst(pwrdm);
  637. return ret;
  638. }
  639. /**
  640. * pwrdm_read_mem_pwrst - get current memory bank power state
  641. * @pwrdm: struct powerdomain * to get current memory bank power state
  642. * @bank: memory bank number (0-3)
  643. *
  644. * Return the powerdomain @pwrdm's current memory power state for bank
  645. * @bank. Returns -EINVAL if the powerdomain pointer is null, -EEXIST if
  646. * the target memory bank does not exist or is not controllable, or
  647. * returns the current memory power state upon success.
  648. */
  649. int pwrdm_read_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
  650. {
  651. int ret = -EINVAL;
  652. if (!pwrdm)
  653. return ret;
  654. if (pwrdm->banks < (bank + 1))
  655. return ret;
  656. if (pwrdm->flags & PWRDM_HAS_MPU_QUIRK)
  657. bank = 1;
  658. if (arch_pwrdm && arch_pwrdm->pwrdm_read_mem_pwrst)
  659. ret = arch_pwrdm->pwrdm_read_mem_pwrst(pwrdm, bank);
  660. return ret;
  661. }
  662. /**
  663. * pwrdm_read_prev_mem_pwrst - get previous memory bank power state
  664. * @pwrdm: struct powerdomain * to get previous memory bank power state
  665. * @bank: memory bank number (0-3)
  666. *
  667. * Return the powerdomain @pwrdm's previous memory power state for
  668. * bank @bank. Returns -EINVAL if the powerdomain pointer is null,
  669. * -EEXIST if the target memory bank does not exist or is not
  670. * controllable, or returns the previous memory power state upon
  671. * success.
  672. */
  673. int pwrdm_read_prev_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
  674. {
  675. int ret = -EINVAL;
  676. if (!pwrdm)
  677. return ret;
  678. if (pwrdm->banks < (bank + 1))
  679. return ret;
  680. if (pwrdm->flags & PWRDM_HAS_MPU_QUIRK)
  681. bank = 1;
  682. if (arch_pwrdm && arch_pwrdm->pwrdm_read_prev_mem_pwrst)
  683. ret = arch_pwrdm->pwrdm_read_prev_mem_pwrst(pwrdm, bank);
  684. return ret;
  685. }
  686. /**
  687. * pwrdm_read_mem_retst - get next memory bank power state
  688. * @pwrdm: struct powerdomain * to get mext memory bank power state
  689. * @bank: memory bank number (0-3)
  690. *
  691. * Return the powerdomain pwrdm's next memory power state for bank
  692. * x. Returns -EINVAL if the powerdomain pointer is null, -EEXIST if
  693. * the target memory bank does not exist or is not controllable, or
  694. * returns the next memory power state upon success.
  695. */
  696. int pwrdm_read_mem_retst(struct powerdomain *pwrdm, u8 bank)
  697. {
  698. int ret = -EINVAL;
  699. if (!pwrdm)
  700. return ret;
  701. if (pwrdm->banks < (bank + 1))
  702. return ret;
  703. if (arch_pwrdm && arch_pwrdm->pwrdm_read_mem_retst)
  704. ret = arch_pwrdm->pwrdm_read_mem_retst(pwrdm, bank);
  705. return ret;
  706. }
  707. /**
  708. * pwrdm_clear_all_prev_pwrst - clear previous powerstate register for a pwrdm
  709. * @pwrdm: struct powerdomain * to clear
  710. *
  711. * Clear the powerdomain's previous power state register @pwrdm.
  712. * Clears the entire register, including logic and memory bank
  713. * previous power states. Returns -EINVAL if the powerdomain pointer
  714. * is null, or returns 0 upon success.
  715. */
  716. int pwrdm_clear_all_prev_pwrst(struct powerdomain *pwrdm)
  717. {
  718. int ret = -EINVAL;
  719. if (!pwrdm)
  720. return ret;
  721. /*
  722. * XXX should get the powerdomain's current state here;
  723. * warn & fail if it is not ON.
  724. */
  725. pr_debug("powerdomain: %s: clearing previous power state reg\n",
  726. pwrdm->name);
  727. if (arch_pwrdm && arch_pwrdm->pwrdm_clear_all_prev_pwrst)
  728. ret = arch_pwrdm->pwrdm_clear_all_prev_pwrst(pwrdm);
  729. return ret;
  730. }
  731. /**
  732. * pwrdm_enable_hdwr_sar - enable automatic hardware SAR for a pwrdm
  733. * @pwrdm: struct powerdomain *
  734. *
  735. * Enable automatic context save-and-restore upon power state change
  736. * for some devices in the powerdomain @pwrdm. Warning: this only
  737. * affects a subset of devices in a powerdomain; check the TRM
  738. * closely. Returns -EINVAL if the powerdomain pointer is null or if
  739. * the powerdomain does not support automatic save-and-restore, or
  740. * returns 0 upon success.
  741. */
  742. int pwrdm_enable_hdwr_sar(struct powerdomain *pwrdm)
  743. {
  744. int ret = -EINVAL;
  745. if (!pwrdm)
  746. return ret;
  747. if (!(pwrdm->flags & PWRDM_HAS_HDWR_SAR))
  748. return ret;
  749. pr_debug("powerdomain: %s: setting SAVEANDRESTORE bit\n", pwrdm->name);
  750. if (arch_pwrdm && arch_pwrdm->pwrdm_enable_hdwr_sar)
  751. ret = arch_pwrdm->pwrdm_enable_hdwr_sar(pwrdm);
  752. return ret;
  753. }
  754. /**
  755. * pwrdm_disable_hdwr_sar - disable automatic hardware SAR for a pwrdm
  756. * @pwrdm: struct powerdomain *
  757. *
  758. * Disable automatic context save-and-restore upon power state change
  759. * for some devices in the powerdomain @pwrdm. Warning: this only
  760. * affects a subset of devices in a powerdomain; check the TRM
  761. * closely. Returns -EINVAL if the powerdomain pointer is null or if
  762. * the powerdomain does not support automatic save-and-restore, or
  763. * returns 0 upon success.
  764. */
  765. int pwrdm_disable_hdwr_sar(struct powerdomain *pwrdm)
  766. {
  767. int ret = -EINVAL;
  768. if (!pwrdm)
  769. return ret;
  770. if (!(pwrdm->flags & PWRDM_HAS_HDWR_SAR))
  771. return ret;
  772. pr_debug("powerdomain: %s: clearing SAVEANDRESTORE bit\n", pwrdm->name);
  773. if (arch_pwrdm && arch_pwrdm->pwrdm_disable_hdwr_sar)
  774. ret = arch_pwrdm->pwrdm_disable_hdwr_sar(pwrdm);
  775. return ret;
  776. }
  777. /**
  778. * pwrdm_has_hdwr_sar - test whether powerdomain supports hardware SAR
  779. * @pwrdm: struct powerdomain *
  780. *
  781. * Returns 1 if powerdomain @pwrdm supports hardware save-and-restore
  782. * for some devices, or 0 if it does not.
  783. */
  784. bool pwrdm_has_hdwr_sar(struct powerdomain *pwrdm)
  785. {
  786. return (pwrdm && pwrdm->flags & PWRDM_HAS_HDWR_SAR) ? 1 : 0;
  787. }
  788. int pwrdm_state_switch_nolock(struct powerdomain *pwrdm)
  789. {
  790. int ret;
  791. if (!pwrdm || !arch_pwrdm)
  792. return -EINVAL;
  793. ret = arch_pwrdm->pwrdm_wait_transition(pwrdm);
  794. if (!ret)
  795. ret = _pwrdm_state_switch(pwrdm, PWRDM_STATE_NOW);
  796. return ret;
  797. }
  798. int __deprecated pwrdm_state_switch(struct powerdomain *pwrdm)
  799. {
  800. int ret;
  801. pwrdm_lock(pwrdm);
  802. ret = pwrdm_state_switch_nolock(pwrdm);
  803. pwrdm_unlock(pwrdm);
  804. return ret;
  805. }
  806. int pwrdm_pre_transition(struct powerdomain *pwrdm)
  807. {
  808. if (pwrdm)
  809. _pwrdm_pre_transition_cb(pwrdm, NULL);
  810. else
  811. pwrdm_for_each(_pwrdm_pre_transition_cb, NULL);
  812. return 0;
  813. }
  814. int pwrdm_post_transition(struct powerdomain *pwrdm)
  815. {
  816. if (pwrdm)
  817. _pwrdm_post_transition_cb(pwrdm, NULL);
  818. else
  819. pwrdm_for_each(_pwrdm_post_transition_cb, NULL);
  820. return 0;
  821. }
  822. /**
  823. * pwrdm_get_valid_lp_state() - Find best match deep power state
  824. * @pwrdm: power domain for which we want to find best match
  825. * @is_logic_state: Are we looking for logic state match here? Should
  826. * be one of PWRDM_xxx macro values
  827. * @req_state: requested power state
  828. *
  829. * Returns: closest match for requested power state. default fallback
  830. * is RET for logic state and ON for power state.
  831. *
  832. * This does a search from the power domain data looking for the
  833. * closest valid power domain state that the hardware can achieve.
  834. * PRCM definitions for PWRSTCTRL allows us to program whatever
  835. * configuration we'd like, and PRCM will actually attempt such
  836. * a transition, however if the powerdomain does not actually support it,
  837. * we endup with a hung system. The valid power domain states are already
  838. * available in our powerdomain data files. So this function tries to do
  839. * the following:
  840. * a) find if we have an exact match to the request - no issues.
  841. * b) else find if a deeper power state is possible.
  842. * c) failing which, it tries to find closest higher power state for the
  843. * request.
  844. */
  845. u8 pwrdm_get_valid_lp_state(struct powerdomain *pwrdm,
  846. bool is_logic_state, u8 req_state)
  847. {
  848. u8 pwrdm_states = is_logic_state ? pwrdm->pwrsts_logic_ret :
  849. pwrdm->pwrsts;
  850. /* For logic, ret is highest and others, ON is highest */
  851. u8 default_pwrst = is_logic_state ? PWRDM_POWER_RET : PWRDM_POWER_ON;
  852. u8 new_pwrst;
  853. bool found;
  854. /* If it is already supported, nothing to search */
  855. if (pwrdm_states & BIT(req_state))
  856. return req_state;
  857. if (!req_state)
  858. goto up_search;
  859. /*
  860. * So, we dont have a exact match
  861. * Can we get a deeper power state match?
  862. */
  863. new_pwrst = req_state - 1;
  864. found = true;
  865. while (!(pwrdm_states & BIT(new_pwrst))) {
  866. /* No match even at OFF? Not available */
  867. if (new_pwrst == PWRDM_POWER_OFF) {
  868. found = false;
  869. break;
  870. }
  871. new_pwrst--;
  872. }
  873. if (found)
  874. goto done;
  875. up_search:
  876. /* OK, no deeper ones, can we get a higher match? */
  877. new_pwrst = req_state + 1;
  878. while (!(pwrdm_states & BIT(new_pwrst))) {
  879. if (new_pwrst > PWRDM_POWER_ON) {
  880. WARN(1, "powerdomain: %s: Fix max powerstate to ON\n",
  881. pwrdm->name);
  882. return PWRDM_POWER_ON;
  883. }
  884. if (new_pwrst == default_pwrst)
  885. break;
  886. new_pwrst++;
  887. }
  888. done:
  889. return new_pwrst;
  890. }
  891. /**
  892. * omap_set_pwrdm_state - change a powerdomain's current power state
  893. * @pwrdm: struct powerdomain * to change the power state of
  894. * @pwrst: power state to change to
  895. *
  896. * Change the current hardware power state of the powerdomain
  897. * represented by @pwrdm to the power state represented by @pwrst.
  898. * Returns -EINVAL if @pwrdm is null or invalid or if the
  899. * powerdomain's current power state could not be read, or returns 0
  900. * upon success or if @pwrdm does not support @pwrst or any
  901. * lower-power state. XXX Should not return 0 if the @pwrdm does not
  902. * support @pwrst or any lower-power state: this should be an error.
  903. */
  904. int omap_set_pwrdm_state(struct powerdomain *pwrdm, u8 pwrst)
  905. {
  906. u8 next_pwrst, sleep_switch;
  907. int curr_pwrst;
  908. int ret = 0;
  909. bool hwsup = false;
  910. if (!pwrdm || IS_ERR(pwrdm))
  911. return -EINVAL;
  912. while (!(pwrdm->pwrsts & (1 << pwrst))) {
  913. if (pwrst == PWRDM_POWER_OFF)
  914. return ret;
  915. pwrst--;
  916. }
  917. pwrdm_lock(pwrdm);
  918. curr_pwrst = pwrdm_read_pwrst(pwrdm);
  919. if (curr_pwrst < 0) {
  920. ret = -EINVAL;
  921. goto osps_out;
  922. }
  923. next_pwrst = pwrdm_read_next_pwrst(pwrdm);
  924. if (curr_pwrst == pwrst && next_pwrst == pwrst)
  925. goto osps_out;
  926. sleep_switch = _pwrdm_save_clkdm_state_and_activate(pwrdm, curr_pwrst,
  927. pwrst, &hwsup);
  928. ret = pwrdm_set_next_pwrst(pwrdm, pwrst);
  929. if (ret)
  930. pr_err("%s: unable to set power state of powerdomain: %s\n",
  931. __func__, pwrdm->name);
  932. _pwrdm_restore_clkdm_state(pwrdm, sleep_switch, hwsup);
  933. osps_out:
  934. pwrdm_unlock(pwrdm);
  935. return ret;
  936. }
  937. /**
  938. * pwrdm_get_context_loss_count - get powerdomain's context loss count
  939. * @pwrdm: struct powerdomain * to wait for
  940. *
  941. * Context loss count is the sum of powerdomain off-mode counter, the
  942. * logic off counter and the per-bank memory off counter. Returns negative
  943. * (and WARNs) upon error, otherwise, returns the context loss count.
  944. */
  945. int pwrdm_get_context_loss_count(struct powerdomain *pwrdm)
  946. {
  947. int i, count;
  948. if (!pwrdm) {
  949. WARN(1, "powerdomain: %s: pwrdm is null\n", __func__);
  950. return -ENODEV;
  951. }
  952. count = pwrdm->state_counter[PWRDM_POWER_OFF];
  953. count += pwrdm->ret_logic_off_counter;
  954. for (i = 0; i < pwrdm->banks; i++)
  955. count += pwrdm->ret_mem_off_counter[i];
  956. /*
  957. * Context loss count has to be a non-negative value. Clear the sign
  958. * bit to get a value range from 0 to INT_MAX.
  959. */
  960. count &= INT_MAX;
  961. pr_debug("powerdomain: %s: context loss count = %d\n",
  962. pwrdm->name, count);
  963. return count;
  964. }
  965. /**
  966. * pwrdm_can_ever_lose_context - can this powerdomain ever lose context?
  967. * @pwrdm: struct powerdomain *
  968. *
  969. * Given a struct powerdomain * @pwrdm, returns 1 if the powerdomain
  970. * can lose either memory or logic context or if @pwrdm is invalid, or
  971. * returns 0 otherwise. This function is not concerned with how the
  972. * powerdomain registers are programmed (i.e., to go off or not); it's
  973. * concerned with whether it's ever possible for this powerdomain to
  974. * go off while some other part of the chip is active. This function
  975. * assumes that every powerdomain can go to either ON or INACTIVE.
  976. */
  977. bool pwrdm_can_ever_lose_context(struct powerdomain *pwrdm)
  978. {
  979. int i;
  980. if (!pwrdm) {
  981. pr_debug("powerdomain: %s: invalid powerdomain pointer\n",
  982. __func__);
  983. return 1;
  984. }
  985. if (pwrdm->pwrsts & PWRSTS_OFF)
  986. return 1;
  987. if (pwrdm->pwrsts & PWRSTS_RET) {
  988. if (pwrdm->pwrsts_logic_ret & PWRSTS_OFF)
  989. return 1;
  990. for (i = 0; i < pwrdm->banks; i++)
  991. if (pwrdm->pwrsts_mem_ret[i] & PWRSTS_OFF)
  992. return 1;
  993. }
  994. for (i = 0; i < pwrdm->banks; i++)
  995. if (pwrdm->pwrsts_mem_on[i] & PWRSTS_OFF)
  996. return 1;
  997. return 0;
  998. }