1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * OMAP powerdomain control
4 *
5 * Copyright (C) 2007-2008, 2011 Texas Instruments, Inc.
6 * Copyright (C) 2007-2011 Nokia Corporation
7 *
8 * Written by Paul Walmsley
9 * Added OMAP4 specific support by Abhijit Pagare <abhijitpagare@ti.com>
10 * State counting code by Tero Kristo <tero.kristo@nokia.com>
11 */
12 #undef DEBUG
13
14 #include <linux/cpu_pm.h>
15 #include <linux/kernel.h>
16 #include <linux/types.h>
17 #include <linux/list.h>
18 #include <linux/errno.h>
19 #include <linux/string.h>
20 #include <linux/spinlock.h>
21 #include <trace/events/power.h>
22
23 #include "cm2xxx_3xxx.h"
24 #include "prcm44xx.h"
25 #include "cm44xx.h"
26 #include "prm2xxx_3xxx.h"
27 #include "prm44xx.h"
28
29 #include <asm/cpu.h>
30
31 #include "powerdomain.h"
32 #include "clockdomain.h"
33 #include "voltage.h"
34
35 #include "soc.h"
36 #include "pm.h"
37
38 #define PWRDM_TRACE_STATES_FLAG (1<<31)
39
40 static void pwrdms_save_context(void);
41 static void pwrdms_restore_context(void);
42
43 enum {
44 PWRDM_STATE_NOW = 0,
45 PWRDM_STATE_PREV,
46 };
47
48 /*
49 * Types of sleep_switch used internally in omap_set_pwrdm_state()
50 * and its associated static functions
51 *
52 * XXX Better documentation is needed here
53 */
54 #define ALREADYACTIVE_SWITCH 0
55 #define FORCEWAKEUP_SWITCH 1
56 #define LOWPOWERSTATE_SWITCH 2
57
58 /* pwrdm_list contains all registered struct powerdomains */
59 static LIST_HEAD(pwrdm_list);
60
61 static struct pwrdm_ops *arch_pwrdm;
62
63 /* Private functions */
64
65 static struct powerdomain *_pwrdm_lookup(const char *name)
66 {
67 struct powerdomain *pwrdm, *temp_pwrdm;
68
69 pwrdm = NULL;
70
71 list_for_each_entry(temp_pwrdm, &pwrdm_list, node) {
72 if (!strcmp(name, temp_pwrdm->name)) {
73 pwrdm = temp_pwrdm;
74 break;
75 }
76 }
77
78 return pwrdm;
79 }
80
81 /**
82 * _pwrdm_register - register a powerdomain
83 * @pwrdm: struct powerdomain * to register
84 *
85 * Adds a powerdomain to the internal powerdomain list. Returns
86 * -EINVAL if given a null pointer, -EEXIST if a powerdomain is
87 * already registered by the provided name, or 0 upon success.
88 */
89 static int _pwrdm_register(struct powerdomain *pwrdm)
90 {
91 int i;
92 struct voltagedomain *voltdm;
93
94 if (!pwrdm || !pwrdm->name)
95 return -EINVAL;
96
97 if (cpu_is_omap44xx() &&
98 pwrdm->prcm_partition == OMAP4430_INVALID_PRCM_PARTITION) {
99 pr_err("powerdomain: %s: missing OMAP4 PRCM partition ID\n",
100 pwrdm->name);
101 return -EINVAL;
102 }
103
104 if (_pwrdm_lookup(pwrdm->name))
105 return -EEXIST;
106
107 if (arch_pwrdm && arch_pwrdm->pwrdm_has_voltdm)
108 if (!arch_pwrdm->pwrdm_has_voltdm())
109 goto skip_voltdm;
110
111 voltdm = voltdm_lookup(pwrdm->voltdm.name);
112 if (!voltdm) {
113 pr_err("powerdomain: %s: voltagedomain %s does not exist\n",
114 pwrdm->name, pwrdm->voltdm.name);
115 return -EINVAL;
116 }
117 pwrdm->voltdm.ptr = voltdm;
118 INIT_LIST_HEAD(&pwrdm->voltdm_node);
119 skip_voltdm:
120 spin_lock_init(&pwrdm->_lock);
121
122 list_add(&pwrdm->node, &pwrdm_list);
123
124 /* Initialize the powerdomain's state counter */
125 for (i = 0; i < PWRDM_MAX_PWRSTS; i++)
126 pwrdm->state_counter[i] = 0;
127
128 pwrdm->ret_logic_off_counter = 0;
129 for (i = 0; i < pwrdm->banks; i++)
130 pwrdm->ret_mem_off_counter[i] = 0;
131
132 if (arch_pwrdm && arch_pwrdm->pwrdm_wait_transition)
133 arch_pwrdm->pwrdm_wait_transition(pwrdm);
134 pwrdm->state = pwrdm_read_pwrst(pwrdm);
135 pwrdm->state_counter[pwrdm->state] = 1;
136
137 pr_debug("powerdomain: registered %s\n", pwrdm->name);
138
139 return 0;
140 }
141
142 static void _update_logic_membank_counters(struct powerdomain *pwrdm)
143 {
144 int i;
145 u8 prev_logic_pwrst, prev_mem_pwrst;
146
147 prev_logic_pwrst = pwrdm_read_prev_logic_pwrst(pwrdm);
148 if ((pwrdm->pwrsts_logic_ret == PWRSTS_OFF_RET) &&
149 (prev_logic_pwrst == PWRDM_POWER_OFF))
150 pwrdm->ret_logic_off_counter++;
151
152 for (i = 0; i < pwrdm->banks; i++) {
153 prev_mem_pwrst = pwrdm_read_prev_mem_pwrst(pwrdm, i);
154
155 if ((pwrdm->pwrsts_mem_ret[i] == PWRSTS_OFF_RET) &&
156 (prev_mem_pwrst == PWRDM_POWER_OFF))
157 pwrdm->ret_mem_off_counter[i]++;
158 }
159 }
160
161 static int _pwrdm_state_switch(struct powerdomain *pwrdm, int flag)
162 {
163
164 int prev, next, state, trace_state = 0;
165
166 if (pwrdm == NULL)
167 return -EINVAL;
168
169 state = pwrdm_read_pwrst(pwrdm);
170
171 switch (flag) {
172 case PWRDM_STATE_NOW:
173 prev = pwrdm->state;
174 break;
175 case PWRDM_STATE_PREV:
176 prev = pwrdm_read_prev_pwrst(pwrdm);
177 if (prev >= 0 && pwrdm->state != prev)
178 pwrdm->state_counter[prev]++;
179 if (prev == PWRDM_POWER_RET)
180 _update_logic_membank_counters(pwrdm);
181 /*
182 * If the power domain did not hit the desired state,
183 * generate a trace event with both the desired and hit states
184 */
185 next = pwrdm_read_next_pwrst(pwrdm);
186 if (next != prev) {
187 trace_state = (PWRDM_TRACE_STATES_FLAG |
188 ((next & OMAP_POWERSTATE_MASK) << 8) |
189 ((prev & OMAP_POWERSTATE_MASK) << 0));
190 trace_power_domain_target(pwrdm->name,
191 trace_state,
192 raw_smp_processor_id());
193 }
194 break;
195 default:
196 return -EINVAL;
197 }
198
199 if (state != prev)
200 pwrdm->state_counter[state]++;
201
202 pm_dbg_update_time(pwrdm, prev);
203
204 pwrdm->state = state;
205
206 return 0;
207 }
208
209 static int _pwrdm_pre_transition_cb(struct powerdomain *pwrdm, void *unused)
210 {
211 pwrdm_clear_all_prev_pwrst(pwrdm);
212 _pwrdm_state_switch(pwrdm, PWRDM_STATE_NOW);
213 return 0;
214 }
215
216 static int _pwrdm_post_transition_cb(struct powerdomain *pwrdm, void *unused)
217 {
218 _pwrdm_state_switch(pwrdm, PWRDM_STATE_PREV);
219 return 0;
220 }
221
222 /**
223 * _pwrdm_save_clkdm_state_and_activate - prepare for power state change
224 * @pwrdm: struct powerdomain * to operate on
225 * @curr_pwrst: current power state of @pwrdm
226 * @pwrst: power state to switch to
227 *
228 * Determine whether the powerdomain needs to be turned on before
229 * attempting to switch power states. Called by
230 * omap_set_pwrdm_state(). NOTE that if the powerdomain contains
231 * multiple clockdomains, this code assumes that the first clockdomain
232 * supports software-supervised wakeup mode - potentially a problem.
233 * Returns the power state switch mode currently in use (see the
234 * "Types of sleep_switch" comment above).
235 */
236 static u8 _pwrdm_save_clkdm_state_and_activate(struct powerdomain *pwrdm,
237 u8 curr_pwrst, u8 pwrst)
238 {
239 u8 sleep_switch;
240
241 if (curr_pwrst < PWRDM_POWER_ON) {
242 if (curr_pwrst > pwrst &&
243 pwrdm->flags & PWRDM_HAS_LOWPOWERSTATECHANGE &&
244 arch_pwrdm->pwrdm_set_lowpwrstchange) {
245 sleep_switch = LOWPOWERSTATE_SWITCH;
246 } else {
247 clkdm_deny_idle_nolock(pwrdm->pwrdm_clkdms[0]);
248 sleep_switch = FORCEWAKEUP_SWITCH;
249 }
250 } else {
251 sleep_switch = ALREADYACTIVE_SWITCH;
252 }
253
254 return sleep_switch;
255 }
256
257 /**
258 * _pwrdm_restore_clkdm_state - restore the clkdm hwsup state after pwrst change
259 * @pwrdm: struct powerdomain * to operate on
260 * @sleep_switch: return value from _pwrdm_save_clkdm_state_and_activate()
261 *
262 * Restore the clockdomain state perturbed by
263 * _pwrdm_save_clkdm_state_and_activate(), and call the power state
264 * bookkeeping code. Called by omap_set_pwrdm_state(). NOTE that if
265 * the powerdomain contains multiple clockdomains, this assumes that
266 * the first associated clockdomain supports either
267 * hardware-supervised idle control in the register, or
268 * software-supervised sleep. No return value.
269 */
270 static void _pwrdm_restore_clkdm_state(struct powerdomain *pwrdm,
271 u8 sleep_switch)
272 {
273 switch (sleep_switch) {
274 case FORCEWAKEUP_SWITCH:
275 clkdm_allow_idle_nolock(pwrdm->pwrdm_clkdms[0]);
276 break;
277 case LOWPOWERSTATE_SWITCH:
278 if (pwrdm->flags & PWRDM_HAS_LOWPOWERSTATECHANGE &&
279 arch_pwrdm->pwrdm_set_lowpwrstchange)
280 arch_pwrdm->pwrdm_set_lowpwrstchange(pwrdm);
281 pwrdm_state_switch_nolock(pwrdm);
282 break;
283 }
284 }
285
286 /* Public functions */
287
288 /**
289 * pwrdm_register_platform_funcs - register powerdomain implementation fns
290 * @po: func pointers for arch specific implementations
291 *
292 * Register the list of function pointers used to implement the
293 * powerdomain functions on different OMAP SoCs. Should be called
294 * before any other pwrdm_register*() function. Returns -EINVAL if
295 * @po is null, -EEXIST if platform functions have already been
296 * registered, or 0 upon success.
297 */
298 int pwrdm_register_platform_funcs(struct pwrdm_ops *po)
299 {
300 if (!po)
301 return -EINVAL;
302
303 if (arch_pwrdm)
304 return -EEXIST;
305
306 arch_pwrdm = po;
307
308 return 0;
309 }
310
311 /**
312 * pwrdm_register_pwrdms - register SoC powerdomains
313 * @ps: pointer to an array of struct powerdomain to register
314 *
315 * Register the powerdomains available on a particular OMAP SoC. Must
316 * be called after pwrdm_register_platform_funcs(). May be called
317 * multiple times. Returns -EACCES if called before
318 * pwrdm_register_platform_funcs(); -EINVAL if the argument @ps is
319 * null; or 0 upon success.
320 */
321 int pwrdm_register_pwrdms(struct powerdomain **ps)
322 {
323 struct powerdomain **p = NULL;
324
325 if (!arch_pwrdm)
326 return -EEXIST;
327
328 if (!ps)
329 return -EINVAL;
330
331 for (p = ps; *p; p++)
332 _pwrdm_register(*p);
333
334 return 0;
335 }
336
337 static int cpu_notifier(struct notifier_block *nb, unsigned long cmd, void *v)
338 {
339 switch (cmd) {
340 case CPU_CLUSTER_PM_ENTER:
341 if (enable_off_mode)
342 pwrdms_save_context();
343 break;
344 case CPU_CLUSTER_PM_EXIT:
345 if (enable_off_mode)
346 pwrdms_restore_context();
347 break;
348 }
349
350 return NOTIFY_OK;
351 }
352
353 /**
354 * pwrdm_complete_init - set up the powerdomain layer
355 *
356 * Do whatever is necessary to initialize registered powerdomains and
357 * powerdomain code. Currently, this programs the next power state
358 * for each powerdomain to ON. This prevents powerdomains from
359 * unexpectedly losing context or entering high wakeup latency modes
360 * with non-power-management-enabled kernels. Must be called after
361 * pwrdm_register_pwrdms(). Returns -EACCES if called before
362 * pwrdm_register_pwrdms(), or 0 upon success.
363 */
364 int pwrdm_complete_init(void)
365 {
366 struct powerdomain *temp_p;
367 static struct notifier_block nb;
368
369 if (list_empty(&pwrdm_list))
370 return -EACCES;
371
372 list_for_each_entry(temp_p, &pwrdm_list, node)
373 pwrdm_set_next_pwrst(temp_p, PWRDM_POWER_ON);
374
375 /* Only AM43XX can lose pwrdm context during rtc-ddr suspend */
376 if (soc_is_am43xx()) {
377 nb.notifier_call = cpu_notifier;
378 cpu_pm_register_notifier(&nb);
379 }
380
381 return 0;
382 }
383
384 /**
385 * pwrdm_lock - acquire a Linux spinlock on a powerdomain
386 * @pwrdm: struct powerdomain * to lock
387 *
388 * Acquire the powerdomain spinlock on @pwrdm. No return value.
389 */
390 void pwrdm_lock(struct powerdomain *pwrdm)
391 __acquires(&pwrdm->_lock)
392 {
393 spin_lock_irqsave(&pwrdm->_lock, pwrdm->_lock_flags);
394 }
395
396 /**
397 * pwrdm_unlock - release a Linux spinlock on a powerdomain
398 * @pwrdm: struct powerdomain * to unlock
399 *
400 * Release the powerdomain spinlock on @pwrdm. No return value.
401 */
402 void pwrdm_unlock(struct powerdomain *pwrdm)
403 __releases(&pwrdm->_lock)
404 {
405 spin_unlock_irqrestore(&pwrdm->_lock, pwrdm->_lock_flags);
406 }
407
408 /**
409 * pwrdm_lookup - look up a powerdomain by name, return a pointer
410 * @name: name of powerdomain
411 *
412 * Find a registered powerdomain by its name @name. Returns a pointer
413 * to the struct powerdomain if found, or NULL otherwise.
414 */
415 struct powerdomain *pwrdm_lookup(const char *name)
416 {
417 struct powerdomain *pwrdm;
418
419 if (!name)
420 return NULL;
421
422 pwrdm = _pwrdm_lookup(name);
423
424 return pwrdm;
425 }
426
427 /**
428 * pwrdm_for_each - call function on each registered clockdomain
429 * @fn: callback function *
430 *
431 * Call the supplied function @fn for each registered powerdomain.
432 * The callback function @fn can return anything but 0 to bail out
433 * early from the iterator. Returns the last return value of the
434 * callback function, which should be 0 for success or anything else
435 * to indicate failure; or -EINVAL if the function pointer is null.
436 */
437 int pwrdm_for_each(int (*fn)(struct powerdomain *pwrdm, void *user),
438 void *user)
439 {
440 struct powerdomain *temp_pwrdm;
441 int ret = 0;
442
443 if (!fn)
444 return -EINVAL;
445
446 list_for_each_entry(temp_pwrdm, &pwrdm_list, node) {
447 ret = (*fn)(temp_pwrdm, user);
448 if (ret)
449 break;
450 }
451
452 return ret;
453 }
454
455 /**
456 * pwrdm_add_clkdm - add a clockdomain to a powerdomain
457 * @pwrdm: struct powerdomain * to add the clockdomain to
458 * @clkdm: struct clockdomain * to associate with a powerdomain
459 *
460 * Associate the clockdomain @clkdm with a powerdomain @pwrdm. This
461 * enables the use of pwrdm_for_each_clkdm(). Returns -EINVAL if
462 * presented with invalid pointers; -ENOMEM if memory could not be allocated;
463 * or 0 upon success.
464 */
465 int pwrdm_add_clkdm(struct powerdomain *pwrdm, struct clockdomain *clkdm)
466 {
467 int i;
468 int ret = -EINVAL;
469
470 if (!pwrdm || !clkdm)
471 return -EINVAL;
472
473 pr_debug("powerdomain: %s: associating clockdomain %s\n",
474 pwrdm->name, clkdm->name);
475
476 for (i = 0; i < PWRDM_MAX_CLKDMS; i++) {
477 if (!pwrdm->pwrdm_clkdms[i])
478 break;
479 #ifdef DEBUG
480 if (pwrdm->pwrdm_clkdms[i] == clkdm) {
481 ret = -EINVAL;
482 goto pac_exit;
483 }
484 #endif
485 }
486
487 if (i == PWRDM_MAX_CLKDMS) {
488 pr_debug("powerdomain: %s: increase PWRDM_MAX_CLKDMS for clkdm %s\n",
489 pwrdm->name, clkdm->name);
490 WARN_ON(1);
491 ret = -ENOMEM;
492 goto pac_exit;
493 }
494
495 pwrdm->pwrdm_clkdms[i] = clkdm;
496
497 ret = 0;
498
499 pac_exit:
500 return ret;
501 }
502
503 /**
504 * pwrdm_get_mem_bank_count - get number of memory banks in this powerdomain
505 * @pwrdm: struct powerdomain *
506 *
507 * Return the number of controllable memory banks in powerdomain @pwrdm,
508 * starting with 1. Returns -EINVAL if the powerdomain pointer is null.
509 */
510 int pwrdm_get_mem_bank_count(struct powerdomain *pwrdm)
511 {
512 if (!pwrdm)
513 return -EINVAL;
514
515 return pwrdm->banks;
516 }
517
518 /**
519 * pwrdm_set_next_pwrst - set next powerdomain power state
520 * @pwrdm: struct powerdomain * to set
521 * @pwrst: one of the PWRDM_POWER_* macros
522 *
523 * Set the powerdomain @pwrdm's next power state to @pwrst. The powerdomain
524 * may not enter this state immediately if the preconditions for this state
525 * have not been satisfied. Returns -EINVAL if the powerdomain pointer is
526 * null or if the power state is invalid for the powerdomin, or returns 0
527 * upon success.
528 */
529 int pwrdm_set_next_pwrst(struct powerdomain *pwrdm, u8 pwrst)
530 {
531 int ret = -EINVAL;
532
533 if (!pwrdm)
534 return -EINVAL;
535
536 if (!(pwrdm->pwrsts & (1 << pwrst)))
537 return -EINVAL;
538
539 pr_debug("powerdomain: %s: setting next powerstate to %0x\n",
540 pwrdm->name, pwrst);
541
542 if (arch_pwrdm && arch_pwrdm->pwrdm_set_next_pwrst) {
543 /* Trace the pwrdm desired target state */
544 trace_power_domain_target(pwrdm->name, pwrst,
545 raw_smp_processor_id());
546 /* Program the pwrdm desired target state */
547 ret = arch_pwrdm->pwrdm_set_next_pwrst(pwrdm, pwrst);
548 }
549
550 return ret;
551 }
552
553 /**
554 * pwrdm_read_next_pwrst - get next powerdomain power state
555 * @pwrdm: struct powerdomain * to get power state
556 *
557 * Return the powerdomain @pwrdm's next power state. Returns -EINVAL
558 * if the powerdomain pointer is null or returns the next power state
559 * upon success.
560 */
561 int pwrdm_read_next_pwrst(struct powerdomain *pwrdm)
562 {
563 int ret = -EINVAL;
564
565 if (!pwrdm)
566 return -EINVAL;
567
568 if (arch_pwrdm && arch_pwrdm->pwrdm_read_next_pwrst)
569 ret = arch_pwrdm->pwrdm_read_next_pwrst(pwrdm);
570
571 return ret;
572 }
573
574 /**
575 * pwrdm_read_pwrst - get current powerdomain power state
576 * @pwrdm: struct powerdomain * to get power state
577 *
578 * Return the powerdomain @pwrdm's current power state. Returns -EINVAL
579 * if the powerdomain pointer is null or returns the current power state
580 * upon success. Note that if the power domain only supports the ON state
581 * then just return ON as the current state.
582 */
583 int pwrdm_read_pwrst(struct powerdomain *pwrdm)
584 {
585 int ret = -EINVAL;
586
587 if (!pwrdm)
588 return -EINVAL;
589
590 if (pwrdm->pwrsts == PWRSTS_ON)
591 return PWRDM_POWER_ON;
592
593 if (arch_pwrdm && arch_pwrdm->pwrdm_read_pwrst)
594 ret = arch_pwrdm->pwrdm_read_pwrst(pwrdm);
595
596 return ret;
597 }
598
599 /**
600 * pwrdm_read_prev_pwrst - get previous powerdomain power state
601 * @pwrdm: struct powerdomain * to get previous power state
602 *
603 * Return the powerdomain @pwrdm's previous power state. Returns -EINVAL
604 * if the powerdomain pointer is null or returns the previous power state
605 * upon success.
606 */
607 int pwrdm_read_prev_pwrst(struct powerdomain *pwrdm)
608 {
609 int ret = -EINVAL;
610
611 if (!pwrdm)
612 return -EINVAL;
613
614 if (arch_pwrdm && arch_pwrdm->pwrdm_read_prev_pwrst)
615 ret = arch_pwrdm->pwrdm_read_prev_pwrst(pwrdm);
616
617 return ret;
618 }
619
620 /**
621 * pwrdm_set_logic_retst - set powerdomain logic power state upon retention
622 * @pwrdm: struct powerdomain * to set
623 * @pwrst: one of the PWRDM_POWER_* macros
624 *
625 * Set the next power state @pwrst that the logic portion of the
626 * powerdomain @pwrdm will enter when the powerdomain enters retention.
627 * This will be either RETENTION or OFF, if supported. Returns
628 * -EINVAL if the powerdomain pointer is null or the target power
629 * state is not supported, or returns 0 upon success.
630 */
631 int pwrdm_set_logic_retst(struct powerdomain *pwrdm, u8 pwrst)
632 {
633 int ret = -EINVAL;
634
635 if (!pwrdm)
636 return -EINVAL;
637
638 if (!(pwrdm->pwrsts_logic_ret & (1 << pwrst)))
639 return -EINVAL;
640
641 pr_debug("powerdomain: %s: setting next logic powerstate to %0x\n",
642 pwrdm->name, pwrst);
643
644 if (arch_pwrdm && arch_pwrdm->pwrdm_set_logic_retst)
645 ret = arch_pwrdm->pwrdm_set_logic_retst(pwrdm, pwrst);
646
647 return ret;
648 }
649
650 /**
651 * pwrdm_set_mem_onst - set memory power state while powerdomain ON
652 * @pwrdm: struct powerdomain * to set
653 * @bank: memory bank number to set (0-3)
654 * @pwrst: one of the PWRDM_POWER_* macros
655 *
656 * Set the next power state @pwrst that memory bank @bank of the
657 * powerdomain @pwrdm will enter when the powerdomain enters the ON
658 * state. @bank will be a number from 0 to 3, and represents different
659 * types of memory, depending on the powerdomain. Returns -EINVAL if
660 * the powerdomain pointer is null or the target power state is not
661 * supported for this memory bank, -EEXIST if the target memory
662 * bank does not exist or is not controllable, or returns 0 upon
663 * success.
664 */
665 int pwrdm_set_mem_onst(struct powerdomain *pwrdm, u8 bank, u8 pwrst)
666 {
667 int ret = -EINVAL;
668
669 if (!pwrdm)
670 return -EINVAL;
671
672 if (pwrdm->banks < (bank + 1))
673 return -EEXIST;
674
675 if (!(pwrdm->pwrsts_mem_on[bank] & (1 << pwrst)))
676 return -EINVAL;
677
678 pr_debug("powerdomain: %s: setting next memory powerstate for bank %0x while pwrdm-ON to %0x\n",
679 pwrdm->name, bank, pwrst);
680
681 if (arch_pwrdm && arch_pwrdm->pwrdm_set_mem_onst)
682 ret = arch_pwrdm->pwrdm_set_mem_onst(pwrdm, bank, pwrst);
683
684 return ret;
685 }
686
687 /**
688 * pwrdm_set_mem_retst - set memory power state while powerdomain in RET
689 * @pwrdm: struct powerdomain * to set
690 * @bank: memory bank number to set (0-3)
691 * @pwrst: one of the PWRDM_POWER_* macros
692 *
693 * Set the next power state @pwrst that memory bank @bank of the
694 * powerdomain @pwrdm will enter when the powerdomain enters the
695 * RETENTION state. Bank will be a number from 0 to 3, and represents
696 * different types of memory, depending on the powerdomain. @pwrst
697 * will be either RETENTION or OFF, if supported. Returns -EINVAL if
698 * the powerdomain pointer is null or the target power state is not
699 * supported for this memory bank, -EEXIST if the target memory
700 * bank does not exist or is not controllable, or returns 0 upon
701 * success.
702 */
703 int pwrdm_set_mem_retst(struct powerdomain *pwrdm, u8 bank, u8 pwrst)
704 {
705 int ret = -EINVAL;
706
707 if (!pwrdm)
708 return -EINVAL;
709
710 if (pwrdm->banks < (bank + 1))
711 return -EEXIST;
712
713 if (!(pwrdm->pwrsts_mem_ret[bank] & (1 << pwrst)))
714 return -EINVAL;
715
716 pr_debug("powerdomain: %s: setting next memory powerstate for bank %0x while pwrdm-RET to %0x\n",
717 pwrdm->name, bank, pwrst);
718
719 if (arch_pwrdm && arch_pwrdm->pwrdm_set_mem_retst)
720 ret = arch_pwrdm->pwrdm_set_mem_retst(pwrdm, bank, pwrst);
721
722 return ret;
723 }
724
725 /**
726 * pwrdm_read_logic_pwrst - get current powerdomain logic retention power state
727 * @pwrdm: struct powerdomain * to get current logic retention power state
728 *
729 * Return the power state that the logic portion of powerdomain @pwrdm
730 * will enter when the powerdomain enters retention. Returns -EINVAL
731 * if the powerdomain pointer is null or returns the logic retention
732 * power state upon success.
733 */
734 int pwrdm_read_logic_pwrst(struct powerdomain *pwrdm)
735 {
736 int ret = -EINVAL;
737
738 if (!pwrdm)
739 return -EINVAL;
740
741 if (arch_pwrdm && arch_pwrdm->pwrdm_read_logic_pwrst)
742 ret = arch_pwrdm->pwrdm_read_logic_pwrst(pwrdm);
743
744 return ret;
745 }
746
747 /**
748 * pwrdm_read_prev_logic_pwrst - get previous powerdomain logic power state
749 * @pwrdm: struct powerdomain * to get previous logic power state
750 *
751 * Return the powerdomain @pwrdm's previous logic power state. Returns
752 * -EINVAL if the powerdomain pointer is null or returns the previous
753 * logic power state upon success.
754 */
755 int pwrdm_read_prev_logic_pwrst(struct powerdomain *pwrdm)
756 {
757 int ret = -EINVAL;
758
759 if (!pwrdm)
760 return -EINVAL;
761
762 if (arch_pwrdm && arch_pwrdm->pwrdm_read_prev_logic_pwrst)
763 ret = arch_pwrdm->pwrdm_read_prev_logic_pwrst(pwrdm);
764
765 return ret;
766 }
767
768 /**
769 * pwrdm_read_logic_retst - get next powerdomain logic power state
770 * @pwrdm: struct powerdomain * to get next logic power state
771 *
772 * Return the powerdomain pwrdm's logic power state. Returns -EINVAL
773 * if the powerdomain pointer is null or returns the next logic
774 * power state upon success.
775 */
776 int pwrdm_read_logic_retst(struct powerdomain *pwrdm)
777 {
778 int ret = -EINVAL;
779
780 if (!pwrdm)
781 return -EINVAL;
782
783 if (arch_pwrdm && arch_pwrdm->pwrdm_read_logic_retst)
784 ret = arch_pwrdm->pwrdm_read_logic_retst(pwrdm);
785
786 return ret;
787 }
788
789 /**
790 * pwrdm_read_mem_pwrst - get current memory bank power state
791 * @pwrdm: struct powerdomain * to get current memory bank power state
792 * @bank: memory bank number (0-3)
793 *
794 * Return the powerdomain @pwrdm's current memory power state for bank
795 * @bank. Returns -EINVAL if the powerdomain pointer is null, -EEXIST if
796 * the target memory bank does not exist or is not controllable, or
797 * returns the current memory power state upon success.
798 */
799 int pwrdm_read_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
800 {
801 int ret = -EINVAL;
802
803 if (!pwrdm)
804 return ret;
805
806 if (pwrdm->banks < (bank + 1))
807 return ret;
808
809 if (pwrdm->flags & PWRDM_HAS_MPU_QUIRK)
810 bank = 1;
811
812 if (arch_pwrdm && arch_pwrdm->pwrdm_read_mem_pwrst)
813 ret = arch_pwrdm->pwrdm_read_mem_pwrst(pwrdm, bank);
814
815 return ret;
816 }
817
818 /**
819 * pwrdm_read_prev_mem_pwrst - get previous memory bank power state
820 * @pwrdm: struct powerdomain * to get previous memory bank power state
821 * @bank: memory bank number (0-3)
822 *
823 * Return the powerdomain @pwrdm's previous memory power state for
824 * bank @bank. Returns -EINVAL if the powerdomain pointer is null,
825 * -EEXIST if the target memory bank does not exist or is not
826 * controllable, or returns the previous memory power state upon
827 * success.
828 */
829 int pwrdm_read_prev_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
830 {
831 int ret = -EINVAL;
832
833 if (!pwrdm)
834 return ret;
835
836 if (pwrdm->banks < (bank + 1))
837 return ret;
838
839 if (pwrdm->flags & PWRDM_HAS_MPU_QUIRK)
840 bank = 1;
841
842 if (arch_pwrdm && arch_pwrdm->pwrdm_read_prev_mem_pwrst)
843 ret = arch_pwrdm->pwrdm_read_prev_mem_pwrst(pwrdm, bank);
844
845 return ret;
846 }
847
848 /**
849 * pwrdm_read_mem_retst - get next memory bank power state
850 * @pwrdm: struct powerdomain * to get mext memory bank power state
851 * @bank: memory bank number (0-3)
852 *
853 * Return the powerdomain pwrdm's next memory power state for bank
854 * x. Returns -EINVAL if the powerdomain pointer is null, -EEXIST if
855 * the target memory bank does not exist or is not controllable, or
856 * returns the next memory power state upon success.
857 */
858 int pwrdm_read_mem_retst(struct powerdomain *pwrdm, u8 bank)
859 {
860 int ret = -EINVAL;
861
862 if (!pwrdm)
863 return ret;
864
865 if (pwrdm->banks < (bank + 1))
866 return ret;
867
868 if (arch_pwrdm && arch_pwrdm->pwrdm_read_mem_retst)
869 ret = arch_pwrdm->pwrdm_read_mem_retst(pwrdm, bank);
870
871 return ret;
872 }
873
874 /**
875 * pwrdm_clear_all_prev_pwrst - clear previous powerstate register for a pwrdm
876 * @pwrdm: struct powerdomain * to clear
877 *
878 * Clear the powerdomain's previous power state register @pwrdm.
879 * Clears the entire register, including logic and memory bank
880 * previous power states. Returns -EINVAL if the powerdomain pointer
881 * is null, or returns 0 upon success.
882 */
883 int pwrdm_clear_all_prev_pwrst(struct powerdomain *pwrdm)
884 {
885 int ret = -EINVAL;
886
887 if (!pwrdm)
888 return ret;
889
890 /*
891 * XXX should get the powerdomain's current state here;
892 * warn & fail if it is not ON.
893 */
894
895 pr_debug("powerdomain: %s: clearing previous power state reg\n",
896 pwrdm->name);
897
898 if (arch_pwrdm && arch_pwrdm->pwrdm_clear_all_prev_pwrst)
899 ret = arch_pwrdm->pwrdm_clear_all_prev_pwrst(pwrdm);
900
901 return ret;
902 }
903
904 /**
905 * pwrdm_enable_hdwr_sar - enable automatic hardware SAR for a pwrdm
906 * @pwrdm: struct powerdomain *
907 *
908 * Enable automatic context save-and-restore upon power state change
909 * for some devices in the powerdomain @pwrdm. Warning: this only
910 * affects a subset of devices in a powerdomain; check the TRM
911 * closely. Returns -EINVAL if the powerdomain pointer is null or if
912 * the powerdomain does not support automatic save-and-restore, or
913 * returns 0 upon success.
914 */
915 int pwrdm_enable_hdwr_sar(struct powerdomain *pwrdm)
916 {
917 int ret = -EINVAL;
918
919 if (!pwrdm)
920 return ret;
921
922 if (!(pwrdm->flags & PWRDM_HAS_HDWR_SAR))
923 return ret;
924
925 pr_debug("powerdomain: %s: setting SAVEANDRESTORE bit\n", pwrdm->name);
926
927 if (arch_pwrdm && arch_pwrdm->pwrdm_enable_hdwr_sar)
928 ret = arch_pwrdm->pwrdm_enable_hdwr_sar(pwrdm);
929
930 return ret;
931 }
932
933 /**
934 * pwrdm_disable_hdwr_sar - disable automatic hardware SAR for a pwrdm
935 * @pwrdm: struct powerdomain *
936 *
937 * Disable automatic context save-and-restore upon power state change
938 * for some devices in the powerdomain @pwrdm. Warning: this only
939 * affects a subset of devices in a powerdomain; check the TRM
940 * closely. Returns -EINVAL if the powerdomain pointer is null or if
941 * the powerdomain does not support automatic save-and-restore, or
942 * returns 0 upon success.
943 */
944 int pwrdm_disable_hdwr_sar(struct powerdomain *pwrdm)
945 {
946 int ret = -EINVAL;
947
948 if (!pwrdm)
949 return ret;
950
951 if (!(pwrdm->flags & PWRDM_HAS_HDWR_SAR))
952 return ret;
953
954 pr_debug("powerdomain: %s: clearing SAVEANDRESTORE bit\n", pwrdm->name);
955
956 if (arch_pwrdm && arch_pwrdm->pwrdm_disable_hdwr_sar)
957 ret = arch_pwrdm->pwrdm_disable_hdwr_sar(pwrdm);
958
959 return ret;
960 }
961
962 /**
963 * pwrdm_has_hdwr_sar - test whether powerdomain supports hardware SAR
964 * @pwrdm: struct powerdomain *
965 *
966 * Returns 1 if powerdomain @pwrdm supports hardware save-and-restore
967 * for some devices, or 0 if it does not.
968 */
969 bool pwrdm_has_hdwr_sar(struct powerdomain *pwrdm)
970 {
971 return (pwrdm && pwrdm->flags & PWRDM_HAS_HDWR_SAR) ? 1 : 0;
972 }
973
974 int pwrdm_state_switch_nolock(struct powerdomain *pwrdm)
975 {
976 int ret;
977
978 if (!pwrdm || !arch_pwrdm)
979 return -EINVAL;
980
981 ret = arch_pwrdm->pwrdm_wait_transition(pwrdm);
982 if (!ret)
983 ret = _pwrdm_state_switch(pwrdm, PWRDM_STATE_NOW);
984
985 return ret;
986 }
987
988 int __deprecated pwrdm_state_switch(struct powerdomain *pwrdm)
989 {
990 int ret;
991
992 pwrdm_lock(pwrdm);
993 ret = pwrdm_state_switch_nolock(pwrdm);
994 pwrdm_unlock(pwrdm);
995
996 return ret;
997 }
998
999 int pwrdm_pre_transition(struct powerdomain *pwrdm)
1000 {
1001 if (pwrdm)
1002 _pwrdm_pre_transition_cb(pwrdm, NULL);
1003 else
1004 pwrdm_for_each(_pwrdm_pre_transition_cb, NULL);
1005
1006 return 0;
1007 }
1008
1009 int pwrdm_post_transition(struct powerdomain *pwrdm)
1010 {
1011 if (pwrdm)
1012 _pwrdm_post_transition_cb(pwrdm, NULL);
1013 else
1014 pwrdm_for_each(_pwrdm_post_transition_cb, NULL);
1015
1016 return 0;
1017 }
1018
1019 /**
1020 * pwrdm_get_valid_lp_state() - Find best match deep power state
1021 * @pwrdm: power domain for which we want to find best match
1022 * @is_logic_state: Are we looking for logic state match here? Should
1023 * be one of PWRDM_xxx macro values
1024 * @req_state: requested power state
1025 *
1026 * Returns: closest match for requested power state. default fallback
1027 * is RET for logic state and ON for power state.
1028 *
1029 * This does a search from the power domain data looking for the
1030 * closest valid power domain state that the hardware can achieve.
1031 * PRCM definitions for PWRSTCTRL allows us to program whatever
1032 * configuration we'd like, and PRCM will actually attempt such
1033 * a transition, however if the powerdomain does not actually support it,
1034 * we endup with a hung system. The valid power domain states are already
1035 * available in our powerdomain data files. So this function tries to do
1036 * the following:
1037 * a) find if we have an exact match to the request - no issues.
1038 * b) else find if a deeper power state is possible.
1039 * c) failing which, it tries to find closest higher power state for the
1040 * request.
1041 */
1042 u8 pwrdm_get_valid_lp_state(struct powerdomain *pwrdm,
1043 bool is_logic_state, u8 req_state)
1044 {
1045 u8 pwrdm_states = is_logic_state ? pwrdm->pwrsts_logic_ret :
1046 pwrdm->pwrsts;
1047 /* For logic, ret is highest and others, ON is highest */
1048 u8 default_pwrst = is_logic_state ? PWRDM_POWER_RET : PWRDM_POWER_ON;
1049 u8 new_pwrst;
1050 bool found;
1051
1052 /* If it is already supported, nothing to search */
1053 if (pwrdm_states & BIT(req_state))
1054 return req_state;
1055
1056 if (!req_state)
1057 goto up_search;
1058
1059 /*
1060 * So, we dont have a exact match
1061 * Can we get a deeper power state match?
1062 */
1063 new_pwrst = req_state - 1;
1064 found = true;
1065 while (!(pwrdm_states & BIT(new_pwrst))) {
1066 /* No match even at OFF? Not available */
1067 if (new_pwrst == PWRDM_POWER_OFF) {
1068 found = false;
1069 break;
1070 }
1071 new_pwrst--;
1072 }
1073
1074 if (found)
1075 goto done;
1076
1077 up_search:
1078 /* OK, no deeper ones, can we get a higher match? */
1079 new_pwrst = req_state + 1;
1080 while (!(pwrdm_states & BIT(new_pwrst))) {
1081 if (new_pwrst > PWRDM_POWER_ON) {
1082 WARN(1, "powerdomain: %s: Fix max powerstate to ON\n",
1083 pwrdm->name);
1084 return PWRDM_POWER_ON;
1085 }
1086
1087 if (new_pwrst == default_pwrst)
1088 break;
1089 new_pwrst++;
1090 }
1091 done:
1092 return new_pwrst;
1093 }
1094
1095 /**
1096 * omap_set_pwrdm_state - change a powerdomain's current power state
1097 * @pwrdm: struct powerdomain * to change the power state of
1098 * @pwrst: power state to change to
1099 *
1100 * Change the current hardware power state of the powerdomain
1101 * represented by @pwrdm to the power state represented by @pwrst.
1102 * Returns -EINVAL if @pwrdm is null or invalid or if the
1103 * powerdomain's current power state could not be read, or returns 0
1104 * upon success or if @pwrdm does not support @pwrst or any
1105 * lower-power state. XXX Should not return 0 if the @pwrdm does not
1106 * support @pwrst or any lower-power state: this should be an error.
1107 */
1108 int omap_set_pwrdm_state(struct powerdomain *pwrdm, u8 pwrst)
1109 {
1110 u8 next_pwrst, sleep_switch;
1111 int curr_pwrst;
1112 int ret = 0;
1113
1114 if (!pwrdm || IS_ERR(pwrdm))
1115 return -EINVAL;
1116
1117 while (!(pwrdm->pwrsts & (1 << pwrst))) {
1118 if (pwrst == PWRDM_POWER_OFF)
1119 return ret;
1120 pwrst--;
1121 }
1122
1123 pwrdm_lock(pwrdm);
1124
1125 curr_pwrst = pwrdm_read_pwrst(pwrdm);
1126 if (curr_pwrst < 0) {
1127 ret = -EINVAL;
1128 goto osps_out;
1129 }
1130
1131 next_pwrst = pwrdm_read_next_pwrst(pwrdm);
1132 if (curr_pwrst == pwrst && next_pwrst == pwrst)
1133 goto osps_out;
1134
1135 sleep_switch = _pwrdm_save_clkdm_state_and_activate(pwrdm, curr_pwrst,
1136 pwrst);
1137
1138 ret = pwrdm_set_next_pwrst(pwrdm, pwrst);
1139 if (ret)
1140 pr_err("%s: unable to set power state of powerdomain: %s\n",
1141 __func__, pwrdm->name);
1142
1143 _pwrdm_restore_clkdm_state(pwrdm, sleep_switch);
1144
1145 osps_out:
1146 pwrdm_unlock(pwrdm);
1147
1148 return ret;
1149 }
1150
1151 /**
1152 * pwrdm_save_context - save powerdomain registers
1153 *
1154 * Register state is going to be lost due to a suspend or hibernate
1155 * event. Save the powerdomain registers.
1156 */
1157 static int pwrdm_save_context(struct powerdomain *pwrdm, void *unused)
1158 {
1159 if (arch_pwrdm && arch_pwrdm->pwrdm_save_context)
1160 arch_pwrdm->pwrdm_save_context(pwrdm);
1161 return 0;
1162 }
1163
1164 /**
1165 * pwrdm_restore_context - restore powerdomain registers
1166 *
1167 * Restore powerdomain control registers after a suspend or resume
1168 * event.
1169 */
1170 static int pwrdm_restore_context(struct powerdomain *pwrdm, void *unused)
1171 {
1172 if (arch_pwrdm && arch_pwrdm->pwrdm_restore_context)
1173 arch_pwrdm->pwrdm_restore_context(pwrdm);
1174 return 0;
1175 }
1176
1177 static void pwrdms_save_context(void)
1178 {
1179 pwrdm_for_each(pwrdm_save_context, NULL);
1180 }
1181
1182 static void pwrdms_restore_context(void)
1183 {
1184 pwrdm_for_each(pwrdm_restore_context, NULL);
1185 }
1186
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.