1 TRAP ta 0; nop; nop; nop;
3 /* Software trap. Treat as BAD_TRAP for the time being... */
4 #define SOFT_TRAP TRAP(_hwerr)
6 #define PSR_INIT 0x1FC0 /* Disable traps, set s and ps */
9 /* All traps low-level code here must end with this macro. */
10 #define RESTORE_ALL b ret_trap_entry; clr %l6;
12 #define WRITE_PAUSE nop;nop;nop
16 ARGPUSH = (WINDOWSIZE + 4)
17 MINFRAME = (WINDOWSIZE + ARGPUSHSIZE + 4)
19 /* Number of register windows */
20 #ifndef CONFIG_SYS_SPARC_NWINDOWS
21 #error Must define number of SPARC register windows, default is 8
25 #define SA(X) (((X)+(STACK_ALIGN-1)) & ~(STACK_ALIGN-1))
27 .section ".start", "ax"
30 #define BAD_TRAP ta 0; nop; nop; nop;
32 /* Software trap. Treat as BAD_TRAP for the time being... */
33 #define SOFT_TRAP TRAP(_hwerr)
35 #define PSR_INIT 0x1FC0 /* Disable traps, set s and ps */
38 /* All traps low-level code here must end with this macro. */
39 #define RESTORE_ALL b ret_trap_entry; clr %l6;
41 #define WRITE_PAUSE nop;nop;nop
45 ARGPUSH = (WINDOWSIZE + 4)
46 MINFRAME = (WINDOWSIZE + ARGPUSHSIZE + 4)
48 /* Number of register windows */
49 #ifndef CONFIG_SYS_SPARC_NWINDOWS
50 #error Must define number of SPARC register windows, default is 8
54 #define SA(X) (((X)+(STACK_ALIGN-1)) & ~(STACK_ALIGN-1))
56 .section ".start", "ax"
57 .globl _start, start, _trap_table
58 .globl _irq_entry, nmi_trap
67 TRAPR(_hardreset); ! 00 reset trap
68 BAD_TRAP; ! 01 instruction_access_exception
69 BAD_TRAP; ! 02 illegal_instruction
70 BAD_TRAP; ! 03 priveleged_instruction
71 BAD_TRAP; ! 04 fp_disabled
72 TRAP(_window_overflow); ! 05 window_overflow
73 TRAP(_window_underflow); ! 06 window_underflow
74 BAD_TRAP; ! 07 Memory Address Not Aligned
75 BAD_TRAP; ! 08 Floating Point Exception
76 BAD_TRAP; ! 09 Data Miss Exception
77 BAD_TRAP; ! 0a Tagged Instruction Ovrflw
78 BAD_TRAP; ! 0b Watchpoint Detected
84 TRAPI(1); ! 11 IRQ level 1
85 TRAPI(2); ! 12 IRQ level 2
86 TRAPI(3); ! 13 IRQ level 3
87 TRAPI(4); ! 14 IRQ level 4
88 TRAPI(5); ! 15 IRQ level 5
89 TRAPI(6); ! 16 IRQ level 6
90 TRAPI(7); ! 17 IRQ level 7
91 TRAPI(8); ! 18 IRQ level 8
92 TRAPI(9); ! 19 IRQ level 9
93 TRAPI(10); ! 1a IRQ level 10
94 TRAPI(11); ! 1b IRQ level 11
95 TRAPI(12); ! 1c IRQ level 12
96 TRAPI(13); ! 1d IRQ level 13
97 TRAPI(14); ! 1e IRQ level 14
98 TRAP(_nmi_trap); ! 1f IRQ level 15 /
99 ! NMI (non maskable interrupt)
100 BAD_TRAP; ! 20 r_register_access_error
101 BAD_TRAP; ! 21 instruction access error
104 BAD_TRAP; ! 24 co-processor disabled
105 BAD_TRAP; ! 25 uniplemented FLUSH
108 BAD_TRAP; ! 28 co-processor exception
109 BAD_TRAP; ! 29 data access error
110 BAD_TRAP; ! 2a division by zero
111 BAD_TRAP; ! 2b data store error
112 BAD_TRAP; ! 2c data access MMU miss
116 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 30-33
117 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 34-37
118 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 38-3b
119 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 3c-3f
120 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 40-43
121 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 44-47
122 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 48-4b
123 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 4c-4f
124 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 50-53
125 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 54-57
126 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 58-5b
127 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 5c-5f
129 /* implementaion dependent */
130 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 60-63
131 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 64-67
132 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 68-6b
133 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 6c-6f
134 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 70-73
135 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 74-77
136 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 78-7b
137 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 7c-7f
139 /* Software traps, not handled */
140 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 80-83
141 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 84-87
142 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 88-8b
143 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 8c-8f
144 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 90-93
145 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 94-97
146 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 98-9b
147 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 9c-9f
148 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a0-a3
149 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a4-a7
150 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a8-ab
151 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! ac-af
152 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b0-b3
153 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b4-b7
154 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b8-bb
155 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! bc-bf
156 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c0-c3
157 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c4-c7
158 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c8-cb
159 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! cc-cf
160 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d0-d3
161 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d4-d7
162 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d8-db
163 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! dc-df
164 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e0-e3
165 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e4-e7
166 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e8-eb
167 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! ec-ef
168 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f0-f3
169 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f4-f7
170 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f8-fb
171 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! fc-ff
177 .extern leon3_snooping_avail
178 .globl version_string
180 .ascii U_BOOT_VERSION_STRING, "\0"
189 /* Enable I/D-Cache and Snooping */
230 set CONFIG_SYS_INIT_SP_OFFSET, %fp
238 /* un relocated start address of monitor */
239 #define TEXT_START _text
241 /* un relocated end address of monitor */
242 #define DATA_END __init_end
247 set CONFIG_SYS_RELOC_MONITOR_BASE,%g4
264 /* register g4 contain address to start
265 * This means that BSS must be directly after data and code segments
267 * g3 is length of bss = (__bss_end-__bss_start)
272 /* clear bss area (the relocated) */
277 clr %g1 /* std %g0 uses g0 and g1 */
278 /* clearing 16byte a time ==> linker script need to align to 16 byte offset */
287 /* add offsets to GOT table */
292 * new got offset = (old GOT-PTR (read with ld) -
293 * CONFIG_SYS_RELOC_MONITOR_BASE(from define) ) +
294 * Destination Address (from define)
296 set CONFIG_SYS_RELOC_MONITOR_BASE,%g2
302 sub %g2,%g1,%g2 ! prepare register with (new base address) -
305 ld [%g4],%l0 ! load old GOT-PTR
306 add %l0,%g2,%l0 ! increase with (new base address) -
315 set __prom_start, %g2
317 set CONFIG_SYS_PROM_OFFSET, %g4
326 bne prom_relocate_loop
329 /* Trap table has been moved, lets tell CPU about
330 * the new trap table address
333 set CONFIG_SYS_RELOC_MONITOR_BASE, %g2
339 /* If CACHE snooping is available in hardware the
340 * variable leon3_snooping_avail will be set to
344 sethi %hi(0x00800000), %o0
347 sethi %hi(leon3_snooping_avail+CONFIG_SYS_RELOC_MONITOR_BASE-CONFIG_SYS_TEXT_BASE), %o1
348 st %o0, [%lo(leon3_snooping_avail+CONFIG_SYS_RELOC_MONITOR_BASE-CONFIG_SYS_TEXT_BASE)+%o1]
352 /* Call relocated init functions */
355 set CONFIG_SYS_RELOC_MONITOR_BASE,%o2
362 set CONFIG_SYS_RELOC_MONITOR_BASE,%o2
368 dead: ta 0 ! if call returns...
371 /* Interrupt handler caller,
372 * reg L7: interrupt number
373 * reg L0: psr after interrupt
386 mov %l7, %o0 ! irq level
388 set (CONFIG_SYS_RELOC_MONITOR_BASE-CONFIG_SYS_TEXT_BASE), %o2
391 add %sp, SF_REGS_SZ, %o1 ! pt_regs ptr
392 or %l0, PSR_PIL, %g2 ! restore PIL after handler_irq
393 wr %g2, PSR_ET, %psr ! keep ET up
398 !Window overflow trap handler.
399 .global _window_overflow
403 mov %wim, %l3 ! Calculate next WIM
406 sll %l3, (CONFIG_SYS_SPARC_NWINDOWS-1) , %l4
409 save ! Get into window to be saved.
430 restore ! Go back to trap window.
432 jmp %l1 ! Re-execute save.
435 /* Window underflow trap handler. */
437 .global _window_underflow
441 mov %wim, %l3 ! Calculate next WIM
443 srl %l3, (CONFIG_SYS_SPARC_NWINDOWS-1), %l5
447 restore ! Two restores to get into the
448 restore ! window to restore
449 ld [%sp + 0], %l0; ! Restore window from the stack
465 save ! Get back to the trap window.
467 jmp %l1 ! Re-execute restore.
481 b _hwerr ! loop infinite
484 /* Registers to not touch at all. */
485 #define t_psr l0 /* Set by caller */
486 #define t_pc l1 /* Set by caller */
487 #define t_npc l2 /* Set by caller */
488 #define t_wim l3 /* Set by caller */
489 #define t_twinmask l4 /* Set at beginning of this entry routine. */
490 #define t_kstack l5 /* Set right before pt_regs frame is built */
491 #define t_retpc l6 /* If you change this, change winmacro.h header file */
492 #define t_systable l7 /* Never touch this, could be the syscall table ptr. */
493 #define curptr g6 /* Set after pt_regs frame is built */
496 /* build a pt_regs trap frame. */
497 sub %fp, (SF_REGS_SZ + PT_REGS_SZ), %t_kstack
498 PT_STORE_ALL(t_kstack, t_psr, t_pc, t_npc, g2)
500 /* See if we are in the trap window. */
502 sll %t_twinmask, %t_psr, %t_twinmask ! t_twinmask = (1 << psr)
503 andcc %t_twinmask, %t_wim, %g0
504 beq 1f ! in trap window, clean up
507 /*-------------------------------------------------
508 * Spill , adjust %wim and go.
510 srl %t_wim, 0x1, %g2 ! begin computation of new %wim
512 set (CONFIG_SYS_SPARC_NWINDOWS-1), %g3 !NWINDOWS-1
514 sll %t_wim, %g3, %t_wim ! NWINDOWS-1
518 save %g0, %g0, %g0 ! get in window to be saved
520 /* Set new %wim value */
523 /* Save the kernel window onto the corresponding stack. */
526 restore %g0, %g0, %g0
527 /*-------------------------------------------------*/
530 /* Trap from kernel with a window available.
533 jmpl %t_retpc + 0x8, %g0 ! return to caller
534 mov %t_kstack, %sp ! jump onto new stack
540 wr %t_psr, 0x0, %psr ! enable nesting again, clear ET
542 /* Will the rett land us in the invalid window? */
546 set CONFIG_SYS_SPARC_NWINDOWS, %g2 !NWINDOWS
552 be 1f ! Nope, just return from the trap
555 /* We have to grab a window before returning. */
556 set (CONFIG_SYS_SPARC_NWINDOWS-1), %g3 !NWINDOWS-1
564 /* Grrr, make sure we load from the right %sp... */
565 PT_LOAD_ALL(sp, t_psr, t_pc, t_npc, g1)
567 restore %g0, %g0, %g0
572 /* Reload the entire frame in case this is from a
573 * kernel system call or whatever...
576 PT_LOAD_ALL(sp, t_psr, t_pc, t_npc, g1)
586 /* This is called from relocated C-code.
587 * It resets the system by jumping to _start