Merge branches 'release' and 'dock' into release
[linux-2.6] / arch / powerpc / platforms / powermac / sleep.S
1 /*
2  * This file contains sleep low-level functions for PowerBook G3.
3  *    Copyright (C) 1999 Benjamin Herrenschmidt (benh@kernel.crashing.org)
4  *    and Paul Mackerras (paulus@samba.org).
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License
8  * as published by the Free Software Foundation; either version
9  * 2 of the License, or (at your option) any later version.
10  *
11  */
12
13 #include <asm/processor.h>
14 #include <asm/page.h>
15 #include <asm/ppc_asm.h>
16 #include <asm/cputable.h>
17 #include <asm/cache.h>
18 #include <asm/thread_info.h>
19 #include <asm/asm-offsets.h>
20
21 #define MAGIC   0x4c617273      /* 'Lars' */
22
23 /*
24  * Structure for storing CPU registers on the stack.
25  */
26 #define SL_SP           0
27 #define SL_PC           4
28 #define SL_MSR          8
29 #define SL_SDR1         0xc
30 #define SL_SPRG0        0x10    /* 4 sprg's */
31 #define SL_DBAT0        0x20
32 #define SL_IBAT0        0x28
33 #define SL_DBAT1        0x30
34 #define SL_IBAT1        0x38
35 #define SL_DBAT2        0x40
36 #define SL_IBAT2        0x48
37 #define SL_DBAT3        0x50
38 #define SL_IBAT3        0x58
39 #define SL_TB           0x60
40 #define SL_R2           0x68
41 #define SL_CR           0x6c
42 #define SL_R12          0x70    /* r12 to r31 */
43 #define SL_SIZE         (SL_R12 + 80)
44
45         .section .text
46         .align  5
47
48 #if defined(CONFIG_PM) || defined(CONFIG_CPU_FREQ_PMAC) || \
49     (defined(CONFIG_HOTPLUG_CPU) && defined(CONFIG_PPC32))
50
51 /* This gets called by via-pmu.c late during the sleep process.
52  * The PMU was already send the sleep command and will shut us down
53  * soon. We need to save all that is needed and setup the wakeup
54  * vector that will be called by the ROM on wakeup
55  */
56 _GLOBAL(low_sleep_handler)
57 #ifndef CONFIG_6xx
58         blr
59 #else
60         mflr    r0
61         stw     r0,4(r1)
62         stwu    r1,-SL_SIZE(r1)
63         mfcr    r0
64         stw     r0,SL_CR(r1)
65         stw     r2,SL_R2(r1)
66         stmw    r12,SL_R12(r1)
67
68         /* Save MSR & SDR1 */
69         mfmsr   r4
70         stw     r4,SL_MSR(r1)
71         mfsdr1  r4
72         stw     r4,SL_SDR1(r1)
73
74         /* Get a stable timebase and save it */
75 1:      mftbu   r4
76         stw     r4,SL_TB(r1)
77         mftb    r5
78         stw     r5,SL_TB+4(r1)
79         mftbu   r3
80         cmpw    r3,r4
81         bne     1b
82
83         /* Save SPRGs */
84         mfsprg  r4,0
85         stw     r4,SL_SPRG0(r1)
86         mfsprg  r4,1
87         stw     r4,SL_SPRG0+4(r1)
88         mfsprg  r4,2
89         stw     r4,SL_SPRG0+8(r1)
90         mfsprg  r4,3
91         stw     r4,SL_SPRG0+12(r1)
92
93         /* Save BATs */
94         mfdbatu r4,0
95         stw     r4,SL_DBAT0(r1)
96         mfdbatl r4,0
97         stw     r4,SL_DBAT0+4(r1)
98         mfdbatu r4,1
99         stw     r4,SL_DBAT1(r1)
100         mfdbatl r4,1
101         stw     r4,SL_DBAT1+4(r1)
102         mfdbatu r4,2
103         stw     r4,SL_DBAT2(r1)
104         mfdbatl r4,2
105         stw     r4,SL_DBAT2+4(r1)
106         mfdbatu r4,3
107         stw     r4,SL_DBAT3(r1)
108         mfdbatl r4,3
109         stw     r4,SL_DBAT3+4(r1)
110         mfibatu r4,0
111         stw     r4,SL_IBAT0(r1)
112         mfibatl r4,0
113         stw     r4,SL_IBAT0+4(r1)
114         mfibatu r4,1
115         stw     r4,SL_IBAT1(r1)
116         mfibatl r4,1
117         stw     r4,SL_IBAT1+4(r1)
118         mfibatu r4,2
119         stw     r4,SL_IBAT2(r1)
120         mfibatl r4,2
121         stw     r4,SL_IBAT2+4(r1)
122         mfibatu r4,3
123         stw     r4,SL_IBAT3(r1)
124         mfibatl r4,3
125         stw     r4,SL_IBAT3+4(r1)
126
127         /* Backup various CPU config stuffs */
128         bl      __save_cpu_setup
129
130         /* The ROM can wake us up via 2 different vectors:
131          *  - On wallstreet & lombard, we must write a magic
132          *    value 'Lars' at address 4 and a pointer to a
133          *    memory location containing the PC to resume from
134          *    at address 0.
135          *  - On Core99, we must store the wakeup vector at
136          *    address 0x80 and eventually it's parameters
137          *    at address 0x84. I've have some trouble with those
138          *    parameters however and I no longer use them.
139          */
140         lis     r5,grackle_wake_up@ha
141         addi    r5,r5,grackle_wake_up@l
142         tophys(r5,r5)
143         stw     r5,SL_PC(r1)
144         lis     r4,KERNELBASE@h
145         tophys(r5,r1)
146         addi    r5,r5,SL_PC
147         lis     r6,MAGIC@ha
148         addi    r6,r6,MAGIC@l
149         stw     r5,0(r4)
150         stw     r6,4(r4)
151         /* Setup stuffs at 0x80-0x84 for Core99 */
152         lis     r3,core99_wake_up@ha
153         addi    r3,r3,core99_wake_up@l
154         tophys(r3,r3)
155         stw     r3,0x80(r4)
156         stw     r5,0x84(r4)
157         /* Store a pointer to our backup storage into
158          * a kernel global
159          */
160         lis r3,sleep_storage@ha
161         addi r3,r3,sleep_storage@l
162         stw r5,0(r3)
163
164         .globl  low_cpu_die
165 low_cpu_die:
166         /* Flush & disable all caches */
167         bl      flush_disable_caches
168
169         /* Turn off data relocation. */
170         mfmsr   r3              /* Save MSR in r7 */
171         rlwinm  r3,r3,0,28,26   /* Turn off DR bit */
172         sync
173         mtmsr   r3
174         isync
175
176 BEGIN_FTR_SECTION
177         /* Flush any pending L2 data prefetches to work around HW bug */
178         sync
179         lis     r3,0xfff0
180         lwz     r0,0(r3)        /* perform cache-inhibited load to ROM */
181         sync                    /* (caches are disabled at this point) */
182 END_FTR_SECTION_IFSET(CPU_FTR_SPEC7450)
183
184 /*
185  * Set the HID0 and MSR for sleep.
186  */
187         mfspr   r2,SPRN_HID0
188         rlwinm  r2,r2,0,10,7    /* clear doze, nap */
189         oris    r2,r2,HID0_SLEEP@h
190         sync
191         isync
192         mtspr   SPRN_HID0,r2
193         sync
194
195 /* This loop puts us back to sleep in case we have a spurrious
196  * wakeup so that the host bridge properly stays asleep. The
197  * CPU will be turned off, either after a known time (about 1
198  * second) on wallstreet & lombard, or as soon as the CPU enters
199  * SLEEP mode on core99
200  */
201         mfmsr   r2
202         oris    r2,r2,MSR_POW@h
203 1:      sync
204         mtmsr   r2
205         isync
206         b       1b
207
208 /*
209  * Here is the resume code.
210  */
211
212
213 /*
214  * Core99 machines resume here
215  * r4 has the physical address of SL_PC(sp) (unused)
216  */
217 _GLOBAL(core99_wake_up)
218         /* Make sure HID0 no longer contains any sleep bit and that data cache
219          * is disabled
220          */
221         mfspr   r3,SPRN_HID0
222         rlwinm  r3,r3,0,11,7            /* clear SLEEP, NAP, DOZE bits */
223         rlwinm  3,r3,0,18,15            /* clear DCE, ICE */
224         mtspr   SPRN_HID0,r3
225         sync
226         isync
227
228         /* sanitize MSR */
229         mfmsr   r3
230         ori     r3,r3,MSR_EE|MSR_IP
231         xori    r3,r3,MSR_EE|MSR_IP
232         sync
233         isync
234         mtmsr   r3
235         sync
236         isync
237
238         /* Recover sleep storage */
239         lis     r3,sleep_storage@ha
240         addi    r3,r3,sleep_storage@l
241         tophys(r3,r3)
242         lwz     r1,0(r3)
243
244         /* Pass thru to older resume code ... */
245 /*
246  * Here is the resume code for older machines.
247  * r1 has the physical address of SL_PC(sp).
248  */
249
250 grackle_wake_up:
251
252         /* Restore the kernel's segment registers before
253          * we do any r1 memory access as we are not sure they
254          * are in a sane state above the first 256Mb region
255          */
256         li      r0,16           /* load up segment register values */
257         mtctr   r0              /* for context 0 */
258         lis     r3,0x2000       /* Ku = 1, VSID = 0 */
259         li      r4,0
260 3:      mtsrin  r3,r4
261         addi    r3,r3,0x111     /* increment VSID */
262         addis   r4,r4,0x1000    /* address of next segment */
263         bdnz    3b
264         sync
265         isync
266
267         subi    r1,r1,SL_PC
268
269         /* Restore various CPU config stuffs */
270         bl      __restore_cpu_setup
271
272         /* Make sure all FPRs have been initialized */
273         bl      reloc_offset
274         bl      __init_fpu_registers
275
276         /* Invalidate & enable L1 cache, we don't care about
277          * whatever the ROM may have tried to write to memory
278          */
279         bl      __inval_enable_L1
280
281         /* Restore the BATs, and SDR1.  Then we can turn on the MMU. */
282         lwz     r4,SL_SDR1(r1)
283         mtsdr1  r4
284         lwz     r4,SL_SPRG0(r1)
285         mtsprg  0,r4
286         lwz     r4,SL_SPRG0+4(r1)
287         mtsprg  1,r4
288         lwz     r4,SL_SPRG0+8(r1)
289         mtsprg  2,r4
290         lwz     r4,SL_SPRG0+12(r1)
291         mtsprg  3,r4
292
293         lwz     r4,SL_DBAT0(r1)
294         mtdbatu 0,r4
295         lwz     r4,SL_DBAT0+4(r1)
296         mtdbatl 0,r4
297         lwz     r4,SL_DBAT1(r1)
298         mtdbatu 1,r4
299         lwz     r4,SL_DBAT1+4(r1)
300         mtdbatl 1,r4
301         lwz     r4,SL_DBAT2(r1)
302         mtdbatu 2,r4
303         lwz     r4,SL_DBAT2+4(r1)
304         mtdbatl 2,r4
305         lwz     r4,SL_DBAT3(r1)
306         mtdbatu 3,r4
307         lwz     r4,SL_DBAT3+4(r1)
308         mtdbatl 3,r4
309         lwz     r4,SL_IBAT0(r1)
310         mtibatu 0,r4
311         lwz     r4,SL_IBAT0+4(r1)
312         mtibatl 0,r4
313         lwz     r4,SL_IBAT1(r1)
314         mtibatu 1,r4
315         lwz     r4,SL_IBAT1+4(r1)
316         mtibatl 1,r4
317         lwz     r4,SL_IBAT2(r1)
318         mtibatu 2,r4
319         lwz     r4,SL_IBAT2+4(r1)
320         mtibatl 2,r4
321         lwz     r4,SL_IBAT3(r1)
322         mtibatu 3,r4
323         lwz     r4,SL_IBAT3+4(r1)
324         mtibatl 3,r4
325
326 BEGIN_FTR_SECTION
327         li      r4,0
328         mtspr   SPRN_DBAT4U,r4
329         mtspr   SPRN_DBAT4L,r4
330         mtspr   SPRN_DBAT5U,r4
331         mtspr   SPRN_DBAT5L,r4
332         mtspr   SPRN_DBAT6U,r4
333         mtspr   SPRN_DBAT6L,r4
334         mtspr   SPRN_DBAT7U,r4
335         mtspr   SPRN_DBAT7L,r4
336         mtspr   SPRN_IBAT4U,r4
337         mtspr   SPRN_IBAT4L,r4
338         mtspr   SPRN_IBAT5U,r4
339         mtspr   SPRN_IBAT5L,r4
340         mtspr   SPRN_IBAT6U,r4
341         mtspr   SPRN_IBAT6L,r4
342         mtspr   SPRN_IBAT7U,r4
343         mtspr   SPRN_IBAT7L,r4
344 END_FTR_SECTION_IFSET(CPU_FTR_HAS_HIGH_BATS)
345
346         /* Flush all TLBs */
347         lis     r4,0x1000
348 1:      addic.  r4,r4,-0x1000
349         tlbie   r4
350         blt     1b
351         sync
352
353         /* restore the MSR and turn on the MMU */
354         lwz     r3,SL_MSR(r1)
355         bl      turn_on_mmu
356
357         /* get back the stack pointer */
358         tovirt(r1,r1)
359
360         /* Restore TB */
361         li      r3,0
362         mttbl   r3
363         lwz     r3,SL_TB(r1)
364         lwz     r4,SL_TB+4(r1)
365         mttbu   r3
366         mttbl   r4
367
368         /* Restore the callee-saved registers and return */
369         lwz     r0,SL_CR(r1)
370         mtcr    r0
371         lwz     r2,SL_R2(r1)
372         lmw     r12,SL_R12(r1)
373         addi    r1,r1,SL_SIZE
374         lwz     r0,4(r1)
375         mtlr    r0
376         blr
377
378 turn_on_mmu:
379         mflr    r4
380         tovirt(r4,r4)
381         mtsrr0  r4
382         mtsrr1  r3
383         sync
384         isync
385         rfi
386
387 #endif /* defined(CONFIG_PM) || defined(CONFIG_CPU_FREQ) */
388
389         .section .data
390         .balign L1_CACHE_BYTES
391 sleep_storage:
392         .long 0
393         .balign L1_CACHE_BYTES, 0
394
395 #endif /* CONFIG_6xx */
396         .section .text