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