2 * This file contains the power_save function for Power7 CPUs.
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
10 #include <linux/threads.h>
11 #include <asm/processor.h>
13 #include <asm/cputable.h>
14 #include <asm/thread_info.h>
15 #include <asm/ppc_asm.h>
16 #include <asm/asm-offsets.h>
17 #include <asm/ppc-opcode.h>
18 #include <asm/hw_irq.h>
19 #include <asm/kvm_book3s_asm.h>
26 /* Now check if user or arch enabled NAP mode */
27 LOAD_REG_ADDRBASE(r3,powersave_nap)
28 lwz r4,ADDROFF(powersave_nap)(r3)
34 /* NAP is a state loss, we create a regs frame on the
35 * stack, fill it up with the state we care about and
36 * stick a pointer to it in PACAR1. We really only
37 * need to save PC, some CR bits and the NV GPRs,
38 * but for now an interrupt frame will do.
42 stdu r1,-INT_FRAME_SIZE(r1)
47 /* Make sure FPU, VSX etc... are flushed as we may lose
48 * state when going to nap mode
50 bl .discard_lazy_cpu_state
51 #endif /* CONFIG_SMP */
53 /* Hard disable interrupts */
57 mtmsrd r9,1 /* hard-disable interrupts */
59 /* Check if something happened while soft-disabled */
60 lbz r0,PACAIRQHAPPENED(r13)
63 addi r1,r1,INT_FRAME_SIZE
68 1: /* We mark irqs hard disabled as this is the state we'll
69 * be in when returning and we need to tell arch_local_irq_restore()
72 li r0,PACA_IRQ_HARD_DIS
73 stb r0,PACAIRQHAPPENED(r13)
75 /* We haven't lost state ... yet */
77 stb r0,PACA_NAPSTATELOST(r13)
79 /* Continue saving state */
87 #ifdef CONFIG_KVM_BOOK3S_64_HV
88 /* Tell KVM we're napping */
89 li r4,KVM_HWTHREAD_IN_NAP
90 stb r4,HSTATE_HWTHREAD_STATE(r13)
93 /* Magic NAP mode enter sequence */
102 _GLOBAL(power7_wakeup_loss)
109 addi r1,r1,INT_FRAME_SIZE
115 _GLOBAL(power7_wakeup_noloss)
116 lbz r0,PACA_NAPSTATELOST(r13)
118 bne .power7_wakeup_loss
122 addi r1,r1,INT_FRAME_SIZE