]>
Commit | Line | Data |
---|---|---|
1e9a164e DH |
1 | /* This is where the SPARC/LEON3 starts |
2 | * Copyright (C) 2007, | |
3 | * Daniel Hellstrom, daniel@gaisler.com | |
4 | * | |
5 | * See file CREDITS for list of people who contributed to this | |
6 | * project. | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or | |
9 | * modify it under the terms of the GNU General Public License as | |
10 | * published by the Free Software Foundation; either version 2 of | |
11 | * the License, or (at your option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, | |
14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | * GNU General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; if not, write to the Free Software | |
20 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | |
21 | * MA 02111-1307 USA | |
22 | */ | |
23 | ||
24 | #include <config.h> | |
25 | #include <asm/asmmacro.h> | |
26 | #include <asm/winmacro.h> | |
27 | #include <asm/psr.h> | |
28 | #include <asm/stack.h> | |
29 | #include <asm/leon.h> | |
30 | #include <version.h> | |
31 | ||
32 | /* Entry for traps which jump to a programmer-specified trap handler. */ | |
33 | #define TRAPR(H) \ | |
53677ef1 WD |
34 | wr %g0, 0xfe0, %psr; \ |
35 | mov %g0, %tbr; \ | |
36 | ba (H); \ | |
37 | mov %g0, %wim; | |
1e9a164e DH |
38 | |
39 | #define TRAP(H) \ | |
40 | mov %psr, %l0; \ | |
41 | ba (H); \ | |
42 | nop; nop; | |
43 | ||
44 | #define TRAPI(ilevel) \ | |
53677ef1 WD |
45 | mov ilevel, %l7; \ |
46 | mov %psr, %l0; \ | |
47 | b _irq_entry; \ | |
48 | mov %wim, %l3 | |
1e9a164e DH |
49 | |
50 | /* Unexcpected trap will halt the processor by forcing it to error state */ | |
51 | #undef BAD_TRAP | |
52 | #define BAD_TRAP ta 0; nop; nop; nop; | |
53 | ||
54 | /* Software trap. Treat as BAD_TRAP for the time being... */ | |
55 | #define SOFT_TRAP TRAP(_hwerr) | |
56 | ||
57 | #define PSR_INIT 0x1FC0 /* Disable traps, set s and ps */ | |
58 | #define WIM_INIT 2 | |
59 | ||
60 | /* All traps low-level code here must end with this macro. */ | |
61 | #define RESTORE_ALL b ret_trap_entry; clr %l6; | |
62 | ||
63 | #define WRITE_PAUSE nop;nop;nop | |
64 | ||
65 | WINDOWSIZE = (16 * 4) | |
66 | ARGPUSHSIZE = (6 * 4) | |
67 | ARGPUSH = (WINDOWSIZE + 4) | |
68 | MINFRAME = (WINDOWSIZE + ARGPUSHSIZE + 4) | |
69 | ||
70 | /* Number of register windows */ | |
6d0f6bcf | 71 | #ifndef CONFIG_SYS_SPARC_NWINDOWS |
1e9a164e DH |
72 | #error Must define number of SPARC register windows, default is 8 |
73 | #endif | |
74 | ||
75 | #define STACK_ALIGN 8 | |
76 | #define SA(X) (((X)+(STACK_ALIGN-1)) & ~(STACK_ALIGN-1)) | |
77 | ||
78 | .section ".start", "ax" | |
53677ef1 | 79 | .globl _start, start, _trap_table |
1e9a164e DH |
80 | .globl _irq_entry, nmi_trap |
81 | .globl _reset_reloc | |
82 | ||
83 | /* at address 0 | |
84 | * Hardware traps | |
85 | */ | |
86 | start: | |
87 | _start: | |
88 | _trap_table: | |
89 | TRAPR(_hardreset); ! 00 reset trap | |
90 | BAD_TRAP; ! 01 instruction_access_exception | |
91 | BAD_TRAP; ! 02 illegal_instruction | |
92 | BAD_TRAP; ! 03 priveleged_instruction | |
93 | BAD_TRAP; ! 04 fp_disabled | |
94 | TRAP(_window_overflow); ! 05 window_overflow | |
95 | TRAP(_window_underflow); ! 06 window_underflow | |
96 | BAD_TRAP; ! 07 Memory Address Not Aligned | |
97 | BAD_TRAP; ! 08 Floating Point Exception | |
98 | BAD_TRAP; ! 09 Data Miss Exception | |
99 | BAD_TRAP; ! 0a Tagged Instruction Ovrflw | |
100 | BAD_TRAP; ! 0b Watchpoint Detected | |
101 | BAD_TRAP; ! 0c | |
102 | BAD_TRAP; ! 0d | |
103 | BAD_TRAP; ! 0e | |
104 | BAD_TRAP; ! 0f | |
105 | BAD_TRAP; ! 10 | |
106 | TRAPI(1); ! 11 IRQ level 1 | |
107 | TRAPI(2); ! 12 IRQ level 2 | |
108 | TRAPI(3); ! 13 IRQ level 3 | |
109 | TRAPI(4); ! 14 IRQ level 4 | |
110 | TRAPI(5); ! 15 IRQ level 5 | |
111 | TRAPI(6); ! 16 IRQ level 6 | |
112 | TRAPI(7); ! 17 IRQ level 7 | |
113 | TRAPI(8); ! 18 IRQ level 8 | |
114 | TRAPI(9); ! 19 IRQ level 9 | |
115 | TRAPI(10); ! 1a IRQ level 10 | |
116 | TRAPI(11); ! 1b IRQ level 11 | |
117 | TRAPI(12); ! 1c IRQ level 12 | |
118 | TRAPI(13); ! 1d IRQ level 13 | |
119 | TRAPI(14); ! 1e IRQ level 14 | |
120 | TRAP(_nmi_trap); ! 1f IRQ level 15 / | |
53677ef1 | 121 | ! NMI (non maskable interrupt) |
1e9a164e DH |
122 | BAD_TRAP; ! 20 r_register_access_error |
123 | BAD_TRAP; ! 21 instruction access error | |
124 | BAD_TRAP; ! 22 | |
125 | BAD_TRAP; ! 23 | |
126 | BAD_TRAP; ! 24 co-processor disabled | |
127 | BAD_TRAP; ! 25 uniplemented FLUSH | |
128 | BAD_TRAP; ! 26 | |
129 | BAD_TRAP; ! 27 | |
130 | BAD_TRAP; ! 28 co-processor exception | |
131 | BAD_TRAP; ! 29 data access error | |
132 | BAD_TRAP; ! 2a division by zero | |
133 | BAD_TRAP; ! 2b data store error | |
134 | BAD_TRAP; ! 2c data access MMU miss | |
135 | BAD_TRAP; ! 2d | |
136 | BAD_TRAP; ! 2e | |
137 | BAD_TRAP; ! 2f | |
138 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 30-33 | |
139 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 34-37 | |
140 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 38-3b | |
141 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 3c-3f | |
142 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 40-43 | |
143 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 44-47 | |
144 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 48-4b | |
145 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 4c-4f | |
146 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 50-53 | |
147 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 54-57 | |
148 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 58-5b | |
149 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 5c-5f | |
150 | ||
151 | /* implementaion dependent */ | |
152 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 60-63 | |
153 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 64-67 | |
154 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 68-6b | |
155 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 6c-6f | |
156 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 70-73 | |
157 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 74-77 | |
158 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 78-7b | |
159 | BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 7c-7f | |
160 | ||
161 | /* Software traps, not handled */ | |
162 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 80-83 | |
163 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 84-87 | |
164 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 88-8b | |
165 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 8c-8f | |
166 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 90-93 | |
167 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 94-97 | |
168 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 98-9b | |
169 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 9c-9f | |
170 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a0-a3 | |
171 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a4-a7 | |
172 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a8-ab | |
173 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! ac-af | |
174 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b0-b3 | |
175 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b4-b7 | |
176 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b8-bb | |
177 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! bc-bf | |
178 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c0-c3 | |
179 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c4-c7 | |
180 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c8-cb | |
181 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! cc-cf | |
182 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d0-d3 | |
183 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d4-d7 | |
184 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d8-db | |
185 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! dc-df | |
186 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e0-e3 | |
187 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e4-e7 | |
188 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e8-eb | |
189 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! ec-ef | |
190 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f0-f3 | |
191 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f4-f7 | |
192 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f8-fb | |
193 | SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! fc-ff | |
194 | /* | |
195 | * Version string | |
196 | */ | |
197 | ||
198 | .data | |
199 | .extern leon3_snooping_avail | |
200 | .globl version_string | |
201 | version_string: | |
202 | .ascii U_BOOT_VERSION | |
203 | .ascii " (", __DATE__, " - ", __TIME__, ")" | |
204 | .ascii CONFIG_IDENT_STRING, "\0" | |
205 | ||
206 | .section ".text" | |
207 | .align 4 | |
208 | ||
209 | _hardreset: | |
210 | 1000: | |
211 | flush | |
212 | ||
213 | /* Enable I/D-Cache and Snooping */ | |
214 | set 0x0081000f, %g2 | |
215 | sta %g2, [%g0] 2 | |
216 | ||
217 | mov %g0, %y | |
218 | clr %g1 | |
219 | clr %g2 | |
220 | clr %g3 | |
221 | clr %g4 | |
222 | clr %g5 | |
223 | clr %g6 | |
224 | clr %g7 | |
225 | ||
226 | mov %asr17, %g3 | |
227 | and %g3, 0x1f, %g3 | |
228 | clear_window: | |
229 | mov %g0, %l0 | |
230 | mov %g0, %l1 | |
231 | mov %g0, %l2 | |
232 | mov %g0, %l3 | |
233 | mov %g0, %l4 | |
234 | mov %g0, %l5 | |
235 | mov %g0, %l6 | |
236 | mov %g0, %l7 | |
237 | mov %g0, %o0 | |
238 | mov %g0, %o1 | |
239 | mov %g0, %o2 | |
240 | mov %g0, %o3 | |
241 | mov %g0, %o4 | |
242 | mov %g0, %o5 | |
243 | mov %g0, %o6 | |
244 | mov %g0, %o7 | |
245 | subcc %g3, 1, %g3 | |
246 | bge clear_window | |
247 | save | |
248 | ||
249 | wininit: | |
250 | set WIM_INIT, %g3 | |
251 | mov %g3, %wim | |
252 | ||
253 | stackp: | |
6d0f6bcf | 254 | set CONFIG_SYS_INIT_SP_OFFSET, %fp |
1e9a164e DH |
255 | andn %fp, 0x0f, %fp |
256 | sub %fp, 64, %sp | |
257 | ||
258 | cpu_init_unreloc: | |
259 | call cpu_init_f | |
260 | nop | |
261 | ||
262 | /* un relocated start address of monitor */ | |
263 | #define TEXT_START _text | |
264 | ||
265 | /* un relocated end address of monitor */ | |
266 | #define DATA_END __init_end | |
267 | ||
268 | reloc: | |
269 | set TEXT_START,%g2 | |
270 | set DATA_END,%g3 | |
6d0f6bcf | 271 | set CONFIG_SYS_RELOC_MONITOR_BASE,%g4 |
1e9a164e DH |
272 | reloc_loop: |
273 | ldd [%g2],%l0 | |
274 | ldd [%g2+8],%l2 | |
275 | std %l0,[%g4] | |
276 | std %l2,[%g4+8] | |
277 | inc 16,%g2 | |
278 | subcc %g3,%g2,%g0 | |
279 | bne reloc_loop | |
280 | inc 16,%g4 | |
281 | ||
282 | clr %l0 | |
283 | clr %l1 | |
284 | clr %l2 | |
285 | clr %l3 | |
286 | clr %g2 | |
287 | ||
288 | /* register g4 contain address to start | |
289 | * This means that BSS must be directly after data and code segments | |
290 | * | |
291 | * g3 is length of bss = (__bss_end-__bss_start) | |
292 | * | |
293 | */ | |
294 | ||
295 | clr_bss: | |
296 | /* clear bss area (the relocated) */ | |
297 | set __bss_start,%g2 | |
298 | set __bss_end,%g3 | |
299 | sub %g3,%g2,%g3 | |
300 | add %g3,%g4,%g3 | |
301 | clr %g1 /* std %g0 uses g0 and g1 */ | |
302 | /* clearing 16byte a time ==> linker script need to align to 16 byte offset */ | |
303 | clr_bss_16: | |
304 | std %g0,[%g4] | |
305 | std %g0,[%g4+8] | |
306 | inc 16,%g4 | |
307 | cmp %g3,%g4 | |
308 | bne clr_bss_16 | |
309 | nop | |
310 | ||
311 | /* add offsets to GOT table */ | |
312 | fixup_got: | |
313 | set __got_start,%g4 | |
314 | set __got_end,%g3 | |
315 | /* | |
316 | * new got offset = (old GOT-PTR (read with ld) - | |
6d0f6bcf | 317 | * CONFIG_SYS_RELOC_MONITOR_BASE(from define) ) + |
1e9a164e DH |
318 | * Destination Address (from define) |
319 | */ | |
6d0f6bcf | 320 | set CONFIG_SYS_RELOC_MONITOR_BASE,%g2 |
1e9a164e DH |
321 | set TEXT_START, %g1 |
322 | add %g4,%g2,%g4 | |
323 | sub %g4,%g1,%g4 | |
324 | add %g3,%g2,%g3 | |
325 | sub %g3,%g1,%g3 | |
326 | sub %g2,%g1,%g2 ! prepare register with (new base address) - | |
327 | ! (old base address) | |
328 | got_loop: | |
329 | ld [%g4],%l0 ! load old GOT-PTR | |
330 | add %l0,%g2,%l0 ! increase with (new base address) - | |
331 | ! (old base) | |
332 | st %l0,[%g4] | |
333 | inc 4,%g4 | |
334 | cmp %g3,%g4 | |
335 | bne got_loop | |
336 | nop | |
337 | ||
338 | prom_relocate: | |
339 | set __prom_start, %g2 | |
340 | set __prom_end, %g3 | |
6d0f6bcf | 341 | set CONFIG_SYS_PROM_OFFSET, %g4 |
1e9a164e DH |
342 | |
343 | prom_relocate_loop: | |
344 | ldd [%g2],%l0 | |
345 | ldd [%g2+8],%l2 | |
346 | std %l0,[%g4] | |
347 | std %l2,[%g4+8] | |
348 | inc 16,%g2 | |
349 | subcc %g3,%g2,%g0 | |
350 | bne prom_relocate_loop | |
351 | inc 16,%g4 | |
352 | ||
353 | /* Trap table has been moved, lets tell CPU about | |
354 | * the new trap table address | |
355 | */ | |
356 | ||
6d0f6bcf | 357 | set CONFIG_SYS_RELOC_MONITOR_BASE, %g2 |
1e9a164e DH |
358 | wr %g0, %g2, %tbr |
359 | nop | |
360 | nop | |
361 | nop | |
1aeed8d7 WD |
362 | |
363 | /* If CACHE snooping is available in hardware the | |
1e9a164e DH |
364 | * variable leon3_snooping_avail will be set to |
365 | * 0x800000 else 0. | |
366 | */ | |
367 | snoop_detect: | |
368 | sethi %hi(0x00800000), %o0 | |
369 | lda [%g0] 2, %o1 | |
370 | and %o0, %o1, %o0 | |
6d0f6bcf JCPV |
371 | sethi %hi(leon3_snooping_avail+CONFIG_SYS_RELOC_MONITOR_BASE-TEXT_BASE), %o1 |
372 | st %o0, [%lo(leon3_snooping_avail+CONFIG_SYS_RELOC_MONITOR_BASE-TEXT_BASE)+%o1] | |
1e9a164e DH |
373 | |
374 | /* call relocate*/ | |
375 | nop | |
376 | /* Call relocated init functions */ | |
377 | jump: | |
378 | set cpu_init_f2,%o1 | |
6d0f6bcf | 379 | set CONFIG_SYS_RELOC_MONITOR_BASE,%o2 |
1e9a164e DH |
380 | add %o1,%o2,%o1 |
381 | sub %o1,%g1,%o1 | |
382 | call %o1 | |
383 | clr %o0 | |
384 | ||
385 | set board_init_f,%o1 | |
6d0f6bcf | 386 | set CONFIG_SYS_RELOC_MONITOR_BASE,%o2 |
1e9a164e DH |
387 | add %o1,%o2,%o1 |
388 | sub %o1,%g1,%o1 | |
389 | call %o1 | |
390 | clr %o0 | |
391 | ||
392 | dead: ta 0 ! if call returns... | |
393 | nop | |
394 | ||
395 | /* Interrupt handler caller, | |
396 | * reg L7: interrupt number | |
397 | * reg L0: psr after interrupt | |
398 | * reg L1: PC | |
399 | * reg L2: next PC | |
400 | * reg L3: wim | |
401 | */ | |
402 | _irq_entry: | |
403 | SAVE_ALL | |
404 | ||
405 | or %l0, PSR_PIL, %g2 | |
406 | wr %g2, 0x0, %psr | |
407 | WRITE_PAUSE | |
408 | wr %g2, PSR_ET, %psr | |
409 | WRITE_PAUSE | |
410 | mov %l7, %o0 ! irq level | |
411 | set handler_irq, %o1 | |
6d0f6bcf | 412 | set (CONFIG_SYS_RELOC_MONITOR_BASE-TEXT_BASE), %o2 |
1e9a164e DH |
413 | add %o1, %o2, %o1 |
414 | call %o1 | |
415 | add %sp, SF_REGS_SZ, %o1 ! pt_regs ptr | |
416 | or %l0, PSR_PIL, %g2 ! restore PIL after handler_irq | |
417 | wr %g2, PSR_ET, %psr ! keep ET up | |
418 | WRITE_PAUSE | |
419 | ||
420 | RESTORE_ALL | |
421 | ||
422 | !Window overflow trap handler. | |
423 | .global _window_overflow | |
424 | ||
425 | _window_overflow: | |
426 | ||
427 | mov %wim, %l3 ! Calculate next WIM | |
428 | mov %g1, %l7 | |
429 | srl %l3, 1, %g1 | |
6d0f6bcf | 430 | sll %l3, (CONFIG_SYS_SPARC_NWINDOWS-1) , %l4 |
1e9a164e DH |
431 | or %l4, %g1, %g1 |
432 | ||
433 | save ! Get into window to be saved. | |
434 | mov %g1, %wim | |
435 | nop; | |
436 | nop; | |
437 | nop | |
438 | st %l0, [%sp + 0]; | |
439 | st %l1, [%sp + 4]; | |
440 | st %l2, [%sp + 8]; | |
441 | st %l3, [%sp + 12]; | |
442 | st %l4, [%sp + 16]; | |
443 | st %l5, [%sp + 20]; | |
444 | st %l6, [%sp + 24]; | |
445 | st %l7, [%sp + 28]; | |
446 | st %i0, [%sp + 32]; | |
447 | st %i1, [%sp + 36]; | |
448 | st %i2, [%sp + 40]; | |
449 | st %i3, [%sp + 44]; | |
450 | st %i4, [%sp + 48]; | |
451 | st %i5, [%sp + 52]; | |
452 | st %i6, [%sp + 56]; | |
453 | st %i7, [%sp + 60]; | |
454 | restore ! Go back to trap window. | |
455 | mov %l7, %g1 | |
456 | jmp %l1 ! Re-execute save. | |
457 | rett %l2 | |
458 | ||
459 | /* Window underflow trap handler. */ | |
460 | ||
461 | .global _window_underflow | |
462 | ||
463 | _window_underflow: | |
464 | ||
465 | mov %wim, %l3 ! Calculate next WIM | |
466 | sll %l3, 1, %l4 | |
6d0f6bcf | 467 | srl %l3, (CONFIG_SYS_SPARC_NWINDOWS-1), %l5 |
1e9a164e DH |
468 | or %l5, %l4, %l5 |
469 | mov %l5, %wim | |
470 | nop; nop; nop | |
471 | restore ! Two restores to get into the | |
472 | restore ! window to restore | |
53677ef1 | 473 | ld [%sp + 0], %l0; ! Restore window from the stack |
1e9a164e DH |
474 | ld [%sp + 4], %l1; |
475 | ld [%sp + 8], %l2; | |
476 | ld [%sp + 12], %l3; | |
477 | ld [%sp + 16], %l4; | |
478 | ld [%sp + 20], %l5; | |
479 | ld [%sp + 24], %l6; | |
480 | ld [%sp + 28], %l7; | |
481 | ld [%sp + 32], %i0; | |
482 | ld [%sp + 36], %i1; | |
483 | ld [%sp + 40], %i2; | |
484 | ld [%sp + 44], %i3; | |
485 | ld [%sp + 48], %i4; | |
486 | ld [%sp + 52], %i5; | |
487 | ld [%sp + 56], %i6; | |
488 | ld [%sp + 60], %i7; | |
489 | save ! Get back to the trap window. | |
490 | save | |
491 | jmp %l1 ! Re-execute restore. | |
492 | rett %l2 | |
493 | ||
494 | retl | |
495 | ||
496 | _nmi_trap: | |
497 | nop | |
498 | jmp %l1 | |
499 | rett %l2 | |
500 | ||
501 | _hwerr: | |
502 | ta 0 | |
503 | nop | |
504 | nop | |
53677ef1 | 505 | b _hwerr ! loop infinite |
1e9a164e DH |
506 | nop |
507 | ||
508 | /* Registers to not touch at all. */ | |
509 | #define t_psr l0 /* Set by caller */ | |
510 | #define t_pc l1 /* Set by caller */ | |
511 | #define t_npc l2 /* Set by caller */ | |
512 | #define t_wim l3 /* Set by caller */ | |
513 | #define t_twinmask l4 /* Set at beginning of this entry routine. */ | |
514 | #define t_kstack l5 /* Set right before pt_regs frame is built */ | |
515 | #define t_retpc l6 /* If you change this, change winmacro.h header file */ | |
516 | #define t_systable l7 /* Never touch this, could be the syscall table ptr. */ | |
517 | #define curptr g6 /* Set after pt_regs frame is built */ | |
518 | ||
519 | trap_setup: | |
520 | /* build a pt_regs trap frame. */ | |
521 | sub %fp, (SF_REGS_SZ + PT_REGS_SZ), %t_kstack | |
522 | PT_STORE_ALL(t_kstack, t_psr, t_pc, t_npc, g2) | |
523 | ||
524 | /* See if we are in the trap window. */ | |
525 | mov 1, %t_twinmask | |
526 | sll %t_twinmask, %t_psr, %t_twinmask ! t_twinmask = (1 << psr) | |
527 | andcc %t_twinmask, %t_wim, %g0 | |
528 | beq 1f ! in trap window, clean up | |
529 | nop | |
530 | ||
531 | /*------------------------------------------------- | |
532 | * Spill , adjust %wim and go. | |
533 | */ | |
534 | srl %t_wim, 0x1, %g2 ! begin computation of new %wim | |
535 | ||
6d0f6bcf | 536 | set (CONFIG_SYS_SPARC_NWINDOWS-1), %g3 !NWINDOWS-1 |
1e9a164e DH |
537 | |
538 | sll %t_wim, %g3, %t_wim ! NWINDOWS-1 | |
539 | or %t_wim, %g2, %g2 | |
540 | and %g2, 0xff, %g2 | |
541 | ||
542 | save %g0, %g0, %g0 ! get in window to be saved | |
543 | ||
544 | /* Set new %wim value */ | |
545 | wr %g2, 0x0, %wim | |
546 | ||
547 | /* Save the kernel window onto the corresponding stack. */ | |
548 | RW_STORE(sp) | |
549 | ||
550 | restore %g0, %g0, %g0 | |
551 | /*-------------------------------------------------*/ | |
552 | ||
553 | 1: | |
554 | /* Trap from kernel with a window available. | |
555 | * Just do it... | |
556 | */ | |
557 | jmpl %t_retpc + 0x8, %g0 ! return to caller | |
558 | mov %t_kstack, %sp ! jump onto new stack | |
559 | ||
560 | #define twin_tmp1 l4 | |
561 | #define glob_tmp g4 | |
562 | #define curptr g6 | |
563 | ret_trap_entry: | |
564 | wr %t_psr, 0x0, %psr ! enable nesting again, clear ET | |
565 | ||
566 | /* Will the rett land us in the invalid window? */ | |
567 | mov 2, %g1 | |
568 | sll %g1, %t_psr, %g1 | |
569 | ||
6d0f6bcf | 570 | set CONFIG_SYS_SPARC_NWINDOWS, %g2 !NWINDOWS |
1e9a164e DH |
571 | |
572 | srl %g1, %g2, %g2 | |
573 | or %g1, %g2, %g1 | |
574 | rd %wim, %g2 | |
575 | andcc %g2, %g1, %g0 | |
576 | be 1f ! Nope, just return from the trap | |
577 | sll %g2, 0x1, %g1 | |
578 | ||
579 | /* We have to grab a window before returning. */ | |
6d0f6bcf | 580 | set (CONFIG_SYS_SPARC_NWINDOWS-1), %g3 !NWINDOWS-1 |
1e9a164e DH |
581 | |
582 | srl %g2, %g3, %g2 | |
583 | or %g1, %g2, %g1 | |
584 | and %g1, 0xff, %g1 | |
585 | ||
586 | wr %g1, 0x0, %wim | |
587 | ||
588 | /* Grrr, make sure we load from the right %sp... */ | |
589 | PT_LOAD_ALL(sp, t_psr, t_pc, t_npc, g1) | |
590 | ||
591 | restore %g0, %g0, %g0 | |
592 | RW_LOAD(sp) | |
593 | b 2f | |
594 | save %g0, %g0, %g0 | |
595 | ||
596 | /* Reload the entire frame in case this is from a | |
597 | * kernel system call or whatever... | |
598 | */ | |
599 | 1: | |
600 | PT_LOAD_ALL(sp, t_psr, t_pc, t_npc, g1) | |
601 | 2: | |
602 | wr %t_psr, 0x0, %psr | |
603 | nop; | |
604 | nop; | |
605 | nop | |
606 | ||
607 | jmp %t_pc | |
608 | rett %t_npc | |
609 | ||
610 | /* This is called from relocated C-code. | |
611 | * It resets the system by jumping to _start | |
612 | */ | |
613 | _reset_reloc: | |
614 | set start, %l0 | |
615 | call %l0 | |
616 | nop |