1 // SPDX-License-Identifier: GPL-2.0-only
3 * Copyright (C) 2006-2007 PA Semi, Inc
5 * Maintained by: Olof Johansson <olof@lixom.net>
10 #include <linux/kernel.h>
11 #include <linux/string.h>
12 #include <linux/irq.h>
14 #include <asm/machdep.h>
25 static struct sleep_mode modes
[] = {
26 { .name
= "spin", .entry
= &idle_spin
},
27 { .name
= "doze", .entry
= &idle_doze
},
30 static int current_mode
= 0;
32 static int pasemi_system_reset_exception(struct pt_regs
*regs
)
34 /* If we were woken up from power savings, we need to return
35 * to the calling function, since nip is not saved across
39 if (regs
->msr
& SRR1_WAKEMASK
)
40 regs_set_return_ip(regs
, regs
->link
);
42 switch (regs
->msr
& SRR1_WAKEMASK
) {
48 * Handle these when interrupts get re-enabled and we take
49 * them as regular exceptions. We are in an NMI context
50 * and can't handle these here.
58 /* Set higher astate since we come out of power savings at 0 */
59 restore_astate(hard_smp_processor_id());
61 /* everything handled */
62 regs_set_recoverable(regs
);
66 static int __init
pasemi_idle_init(void)
68 #ifndef CONFIG_PPC_PASEMI_CPUFREQ
69 pr_warn("No cpufreq driver, powersavings modes disabled\n");
73 ppc_md
.system_reset_exception
= pasemi_system_reset_exception
;
74 ppc_md
.power_save
= modes
[current_mode
].entry
;
75 pr_info("Using PA6T idle loop (%s)\n", modes
[current_mode
].name
);
79 machine_late_initcall(pasemi
, pasemi_idle_init
);
81 static int __init
idle_param(char *p
)
84 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
85 if (!strcmp(modes
[i
].name
, p
)) {
93 early_param("idle", idle_param
);