]> git.karo-electronics.de Git - karo-tx-linux.git/blob - arch/powerpc/kernel/idle_power7.S
Merge branch 'for-linus' of git://git.kernel.dk/linux-block
[karo-tx-linux.git] / arch / powerpc / kernel / idle_power7.S
1 /*
2  *  This file contains the power_save function for Power7 CPUs.
3  *
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.
8  */
9
10 #include <linux/threads.h>
11 #include <asm/processor.h>
12 #include <asm/page.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>
20 #include <asm/opal.h>
21
22 #undef DEBUG
23
24 /* Idle state entry routines */
25
26 #define IDLE_STATE_ENTER_SEQ(IDLE_INST)                         \
27         /* Magic NAP/SLEEP/WINKLE mode enter sequence */        \
28         std     r0,0(r1);                                       \
29         ptesync;                                                \
30         ld      r0,0(r1);                                       \
31 1:      cmp     cr0,r0,r0;                                      \
32         bne     1b;                                             \
33         IDLE_INST;                                              \
34         b       .
35
36         .text
37
38 /*
39  * Pass requested state in r3:
40  *      0 - nap
41  *      1 - sleep
42  *
43  * To check IRQ_HAPPENED in r4
44  *      0 - don't check
45  *      1 - check
46  */
47 _GLOBAL(power7_powersave_common)
48         /* Use r3 to pass state nap/sleep/winkle */
49         /* NAP is a state loss, we create a regs frame on the
50          * stack, fill it up with the state we care about and
51          * stick a pointer to it in PACAR1. We really only
52          * need to save PC, some CR bits and the NV GPRs,
53          * but for now an interrupt frame will do.
54          */
55         mflr    r0
56         std     r0,16(r1)
57         stdu    r1,-INT_FRAME_SIZE(r1)
58         std     r0,_LINK(r1)
59         std     r0,_NIP(r1)
60
61 #ifndef CONFIG_SMP
62         /* Make sure FPU, VSX etc... are flushed as we may lose
63          * state when going to nap mode
64          */
65         bl      discard_lazy_cpu_state
66 #endif /* CONFIG_SMP */
67
68         /* Hard disable interrupts */
69         mfmsr   r9
70         rldicl  r9,r9,48,1
71         rotldi  r9,r9,16
72         mtmsrd  r9,1                    /* hard-disable interrupts */
73
74         /* Check if something happened while soft-disabled */
75         lbz     r0,PACAIRQHAPPENED(r13)
76         cmpwi   cr0,r0,0
77         beq     1f
78         cmpwi   cr0,r4,0
79         beq     1f
80         addi    r1,r1,INT_FRAME_SIZE
81         ld      r0,16(r1)
82         mtlr    r0
83         blr
84
85 1:      /* We mark irqs hard disabled as this is the state we'll
86          * be in when returning and we need to tell arch_local_irq_restore()
87          * about it
88          */
89         li      r0,PACA_IRQ_HARD_DIS
90         stb     r0,PACAIRQHAPPENED(r13)
91
92         /* We haven't lost state ... yet */
93         li      r0,0
94         stb     r0,PACA_NAPSTATELOST(r13)
95
96         /* Continue saving state */
97         SAVE_GPR(2, r1)
98         SAVE_NVGPRS(r1)
99         mfcr    r4
100         std     r4,_CCR(r1)
101         std     r9,_MSR(r1)
102         std     r1,PACAR1(r13)
103
104 _GLOBAL(power7_enter_nap_mode)
105 #ifdef CONFIG_KVM_BOOK3S_HV_POSSIBLE
106         /* Tell KVM we're napping */
107         li      r4,KVM_HWTHREAD_IN_NAP
108         stb     r4,HSTATE_HWTHREAD_STATE(r13)
109 #endif
110         cmpwi   cr0,r3,1
111         beq     2f
112         IDLE_STATE_ENTER_SEQ(PPC_NAP)
113         /* No return */
114 2:      IDLE_STATE_ENTER_SEQ(PPC_SLEEP)
115         /* No return */
116
117 _GLOBAL(power7_idle)
118         /* Now check if user or arch enabled NAP mode */
119         LOAD_REG_ADDRBASE(r3,powersave_nap)
120         lwz     r4,ADDROFF(powersave_nap)(r3)
121         cmpwi   0,r4,0
122         beqlr
123         li      r3, 1
124         /* fall through */
125
126 _GLOBAL(power7_nap)
127         mr      r4,r3
128         li      r3,0
129         b       power7_powersave_common
130         /* No return */
131
132 _GLOBAL(power7_sleep)
133         li      r3,1
134         li      r4,0
135         b       power7_powersave_common
136         /* No return */
137
138 _GLOBAL(power7_wakeup_tb_loss)
139         ld      r2,PACATOC(r13);
140         ld      r1,PACAR1(r13)
141
142         /* Time base re-sync */
143         li      r0,OPAL_RESYNC_TIMEBASE
144         LOAD_REG_ADDR(r11,opal);
145         ld      r12,8(r11);
146         ld      r2,0(r11);
147         mtctr   r12
148         bctrl
149
150         /* TODO: Check r3 for failure */
151
152         REST_NVGPRS(r1)
153         REST_GPR(2, r1)
154         ld      r3,_CCR(r1)
155         ld      r4,_MSR(r1)
156         ld      r5,_NIP(r1)
157         addi    r1,r1,INT_FRAME_SIZE
158         mtcr    r3
159         mfspr   r3,SPRN_SRR1            /* Return SRR1 */
160         mtspr   SPRN_SRR1,r4
161         mtspr   SPRN_SRR0,r5
162         rfid
163
164 _GLOBAL(power7_wakeup_loss)
165         ld      r1,PACAR1(r13)
166         REST_NVGPRS(r1)
167         REST_GPR(2, r1)
168         ld      r3,_CCR(r1)
169         ld      r4,_MSR(r1)
170         ld      r5,_NIP(r1)
171         addi    r1,r1,INT_FRAME_SIZE
172         mtcr    r3
173         mtspr   SPRN_SRR1,r4
174         mtspr   SPRN_SRR0,r5
175         rfid
176
177 _GLOBAL(power7_wakeup_noloss)
178         lbz     r0,PACA_NAPSTATELOST(r13)
179         cmpwi   r0,0
180         bne     power7_wakeup_loss
181         ld      r1,PACAR1(r13)
182         ld      r4,_MSR(r1)
183         ld      r5,_NIP(r1)
184         addi    r1,r1,INT_FRAME_SIZE
185         mtspr   SPRN_SRR1,r4
186         mtspr   SPRN_SRR0,r5
187         rfid