diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /arch/ppc/platforms/pmac_sleep.S |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'arch/ppc/platforms/pmac_sleep.S')
-rw-r--r-- | arch/ppc/platforms/pmac_sleep.S | 390 |
1 files changed, 390 insertions, 0 deletions
diff --git a/arch/ppc/platforms/pmac_sleep.S b/arch/ppc/platforms/pmac_sleep.S new file mode 100644 index 000000000000..3139b6766ad3 --- /dev/null +++ b/arch/ppc/platforms/pmac_sleep.S | |||
@@ -0,0 +1,390 @@ | |||
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 <linux/config.h> | ||
14 | #include <asm/processor.h> | ||
15 | #include <asm/page.h> | ||
16 | #include <asm/ppc_asm.h> | ||
17 | #include <asm/cputable.h> | ||
18 | #include <asm/cache.h> | ||
19 | #include <asm/thread_info.h> | ||
20 | #include <asm/offsets.h> | ||
21 | |||
22 | #define MAGIC 0x4c617273 /* 'Lars' */ | ||
23 | |||
24 | /* | ||
25 | * Structure for storing CPU registers on the stack. | ||
26 | */ | ||
27 | #define SL_SP 0 | ||
28 | #define SL_PC 4 | ||
29 | #define SL_MSR 8 | ||
30 | #define SL_SDR1 0xc | ||
31 | #define SL_SPRG0 0x10 /* 4 sprg's */ | ||
32 | #define SL_DBAT0 0x20 | ||
33 | #define SL_IBAT0 0x28 | ||
34 | #define SL_DBAT1 0x30 | ||
35 | #define SL_IBAT1 0x38 | ||
36 | #define SL_DBAT2 0x40 | ||
37 | #define SL_IBAT2 0x48 | ||
38 | #define SL_DBAT3 0x50 | ||
39 | #define SL_IBAT3 0x58 | ||
40 | #define SL_TB 0x60 | ||
41 | #define SL_R2 0x68 | ||
42 | #define SL_CR 0x6c | ||
43 | #define SL_R12 0x70 /* r12 to r31 */ | ||
44 | #define SL_SIZE (SL_R12 + 80) | ||
45 | |||
46 | .section .text | ||
47 | .align 5 | ||
48 | |||
49 | #if defined(CONFIG_PMAC_PBOOK) || defined(CONFIG_CPU_FREQ_PMAC) | ||
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 | /* Flush & disable all caches */ | ||
165 | bl flush_disable_caches | ||
166 | |||
167 | /* Turn off data relocation. */ | ||
168 | mfmsr r3 /* Save MSR in r7 */ | ||
169 | rlwinm r3,r3,0,28,26 /* Turn off DR bit */ | ||
170 | sync | ||
171 | mtmsr r3 | ||
172 | isync | ||
173 | |||
174 | BEGIN_FTR_SECTION | ||
175 | /* Flush any pending L2 data prefetches to work around HW bug */ | ||
176 | sync | ||
177 | lis r3,0xfff0 | ||
178 | lwz r0,0(r3) /* perform cache-inhibited load to ROM */ | ||
179 | sync /* (caches are disabled at this point) */ | ||
180 | END_FTR_SECTION_IFSET(CPU_FTR_SPEC7450) | ||
181 | |||
182 | /* | ||
183 | * Set the HID0 and MSR for sleep. | ||
184 | */ | ||
185 | mfspr r2,SPRN_HID0 | ||
186 | rlwinm r2,r2,0,10,7 /* clear doze, nap */ | ||
187 | oris r2,r2,HID0_SLEEP@h | ||
188 | sync | ||
189 | isync | ||
190 | mtspr SPRN_HID0,r2 | ||
191 | sync | ||
192 | |||
193 | /* This loop puts us back to sleep in case we have a spurrious | ||
194 | * wakeup so that the host bridge properly stays asleep. The | ||
195 | * CPU will be turned off, either after a known time (about 1 | ||
196 | * second) on wallstreet & lombard, or as soon as the CPU enters | ||
197 | * SLEEP mode on core99 | ||
198 | */ | ||
199 | mfmsr r2 | ||
200 | oris r2,r2,MSR_POW@h | ||
201 | 1: sync | ||
202 | mtmsr r2 | ||
203 | isync | ||
204 | b 1b | ||
205 | |||
206 | /* | ||
207 | * Here is the resume code. | ||
208 | */ | ||
209 | |||
210 | |||
211 | /* | ||
212 | * Core99 machines resume here | ||
213 | * r4 has the physical address of SL_PC(sp) (unused) | ||
214 | */ | ||
215 | _GLOBAL(core99_wake_up) | ||
216 | /* Make sure HID0 no longer contains any sleep bit and that data cache | ||
217 | * is disabled | ||
218 | */ | ||
219 | mfspr r3,SPRN_HID0 | ||
220 | rlwinm r3,r3,0,11,7 /* clear SLEEP, NAP, DOZE bits */ | ||
221 | rlwinm 3,r3,0,18,15 /* clear DCE, ICE */ | ||
222 | mtspr SPRN_HID0,r3 | ||
223 | sync | ||
224 | isync | ||
225 | |||
226 | /* sanitize MSR */ | ||
227 | mfmsr r3 | ||
228 | ori r3,r3,MSR_EE|MSR_IP | ||
229 | xori r3,r3,MSR_EE|MSR_IP | ||
230 | sync | ||
231 | isync | ||
232 | mtmsr r3 | ||
233 | sync | ||
234 | isync | ||
235 | |||
236 | /* Recover sleep storage */ | ||
237 | lis r3,sleep_storage@ha | ||
238 | addi r3,r3,sleep_storage@l | ||
239 | tophys(r3,r3) | ||
240 | lwz r1,0(r3) | ||
241 | |||
242 | /* Pass thru to older resume code ... */ | ||
243 | /* | ||
244 | * Here is the resume code for older machines. | ||
245 | * r1 has the physical address of SL_PC(sp). | ||
246 | */ | ||
247 | |||
248 | grackle_wake_up: | ||
249 | |||
250 | /* Restore the kernel's segment registers before | ||
251 | * we do any r1 memory access as we are not sure they | ||
252 | * are in a sane state above the first 256Mb region | ||
253 | */ | ||
254 | li r0,16 /* load up segment register values */ | ||
255 | mtctr r0 /* for context 0 */ | ||
256 | lis r3,0x2000 /* Ku = 1, VSID = 0 */ | ||
257 | li r4,0 | ||
258 | 3: mtsrin r3,r4 | ||
259 | addi r3,r3,0x111 /* increment VSID */ | ||
260 | addis r4,r4,0x1000 /* address of next segment */ | ||
261 | bdnz 3b | ||
262 | sync | ||
263 | isync | ||
264 | |||
265 | subi r1,r1,SL_PC | ||
266 | |||
267 | /* Restore various CPU config stuffs */ | ||
268 | bl __restore_cpu_setup | ||
269 | |||
270 | /* Invalidate & enable L1 cache, we don't care about | ||
271 | * whatever the ROM may have tried to write to memory | ||
272 | */ | ||
273 | bl __inval_enable_L1 | ||
274 | |||
275 | /* Restore the BATs, and SDR1. Then we can turn on the MMU. */ | ||
276 | lwz r4,SL_SDR1(r1) | ||
277 | mtsdr1 r4 | ||
278 | lwz r4,SL_SPRG0(r1) | ||
279 | mtsprg 0,r4 | ||
280 | lwz r4,SL_SPRG0+4(r1) | ||
281 | mtsprg 1,r4 | ||
282 | lwz r4,SL_SPRG0+8(r1) | ||
283 | mtsprg 2,r4 | ||
284 | lwz r4,SL_SPRG0+12(r1) | ||
285 | mtsprg 3,r4 | ||
286 | |||
287 | lwz r4,SL_DBAT0(r1) | ||
288 | mtdbatu 0,r4 | ||
289 | lwz r4,SL_DBAT0+4(r1) | ||
290 | mtdbatl 0,r4 | ||
291 | lwz r4,SL_DBAT1(r1) | ||
292 | mtdbatu 1,r4 | ||
293 | lwz r4,SL_DBAT1+4(r1) | ||
294 | mtdbatl 1,r4 | ||
295 | lwz r4,SL_DBAT2(r1) | ||
296 | mtdbatu 2,r4 | ||
297 | lwz r4,SL_DBAT2+4(r1) | ||
298 | mtdbatl 2,r4 | ||
299 | lwz r4,SL_DBAT3(r1) | ||
300 | mtdbatu 3,r4 | ||
301 | lwz r4,SL_DBAT3+4(r1) | ||
302 | mtdbatl 3,r4 | ||
303 | lwz r4,SL_IBAT0(r1) | ||
304 | mtibatu 0,r4 | ||
305 | lwz r4,SL_IBAT0+4(r1) | ||
306 | mtibatl 0,r4 | ||
307 | lwz r4,SL_IBAT1(r1) | ||
308 | mtibatu 1,r4 | ||
309 | lwz r4,SL_IBAT1+4(r1) | ||
310 | mtibatl 1,r4 | ||
311 | lwz r4,SL_IBAT2(r1) | ||
312 | mtibatu 2,r4 | ||
313 | lwz r4,SL_IBAT2+4(r1) | ||
314 | mtibatl 2,r4 | ||
315 | lwz r4,SL_IBAT3(r1) | ||
316 | mtibatu 3,r4 | ||
317 | lwz r4,SL_IBAT3+4(r1) | ||
318 | mtibatl 3,r4 | ||
319 | |||
320 | BEGIN_FTR_SECTION | ||
321 | li r4,0 | ||
322 | mtspr SPRN_DBAT4U,r4 | ||
323 | mtspr SPRN_DBAT4L,r4 | ||
324 | mtspr SPRN_DBAT5U,r4 | ||
325 | mtspr SPRN_DBAT5L,r4 | ||
326 | mtspr SPRN_DBAT6U,r4 | ||
327 | mtspr SPRN_DBAT6L,r4 | ||
328 | mtspr SPRN_DBAT7U,r4 | ||
329 | mtspr SPRN_DBAT7L,r4 | ||
330 | mtspr SPRN_IBAT4U,r4 | ||
331 | mtspr SPRN_IBAT4L,r4 | ||
332 | mtspr SPRN_IBAT5U,r4 | ||
333 | mtspr SPRN_IBAT5L,r4 | ||
334 | mtspr SPRN_IBAT6U,r4 | ||
335 | mtspr SPRN_IBAT6L,r4 | ||
336 | mtspr SPRN_IBAT7U,r4 | ||
337 | mtspr SPRN_IBAT7L,r4 | ||
338 | END_FTR_SECTION_IFSET(CPU_FTR_HAS_HIGH_BATS) | ||
339 | |||
340 | /* Flush all TLBs */ | ||
341 | lis r4,0x1000 | ||
342 | 1: addic. r4,r4,-0x1000 | ||
343 | tlbie r4 | ||
344 | blt 1b | ||
345 | sync | ||
346 | |||
347 | /* restore the MSR and turn on the MMU */ | ||
348 | lwz r3,SL_MSR(r1) | ||
349 | bl turn_on_mmu | ||
350 | |||
351 | /* get back the stack pointer */ | ||
352 | tovirt(r1,r1) | ||
353 | |||
354 | /* Restore TB */ | ||
355 | li r3,0 | ||
356 | mttbl r3 | ||
357 | lwz r3,SL_TB(r1) | ||
358 | lwz r4,SL_TB+4(r1) | ||
359 | mttbu r3 | ||
360 | mttbl r4 | ||
361 | |||
362 | /* Restore the callee-saved registers and return */ | ||
363 | lwz r0,SL_CR(r1) | ||
364 | mtcr r0 | ||
365 | lwz r2,SL_R2(r1) | ||
366 | lmw r12,SL_R12(r1) | ||
367 | addi r1,r1,SL_SIZE | ||
368 | lwz r0,4(r1) | ||
369 | mtlr r0 | ||
370 | blr | ||
371 | |||
372 | turn_on_mmu: | ||
373 | mflr r4 | ||
374 | tovirt(r4,r4) | ||
375 | mtsrr0 r4 | ||
376 | mtsrr1 r3 | ||
377 | sync | ||
378 | isync | ||
379 | rfi | ||
380 | |||
381 | #endif /* defined(CONFIG_PMAC_PBOOK) || defined(CONFIG_CPU_FREQ) */ | ||
382 | |||
383 | .section .data | ||
384 | .balign L1_CACHE_LINE_SIZE | ||
385 | sleep_storage: | ||
386 | .long 0 | ||
387 | .balign L1_CACHE_LINE_SIZE, 0 | ||
388 | |||
389 | #endif /* CONFIG_6xx */ | ||
390 | .section .text | ||