1 /* This is where the SPARC/LEON3 starts
3 * Daniel Hellstrom, daniel@gaisler.com
5 * SPDX-License-Identifier: GPL-2.0+
8 #include <asm-offsets.h>
10 #include <asm/asmmacro.h>
11 #include <asm/winmacro.h>
13 #include <asm/stack.h>
18 /* Default Plug&Play I/O area */
19 #ifndef CONFIG_AMBAPP_IOAREA
20 #define CONFIG_AMBAPP_IOAREA AMBA_DEFAULT_IOAREA
23 /* Entry for traps which jump to a programmer-specified trap handler. */
25 wr %g0, 0xfe0, %psr; \
35 #define TRAPI(ilevel) \
41 /* Unexcpected trap will halt the processor by forcing it to error state */
43 #define BAD_TRAP ta 0; nop; nop; nop;
45 /* Software trap. Treat as BAD_TRAP for the time being... */
46 #define SOFT_TRAP TRAP(_hwerr)
48 #define PSR_INIT 0x1FC0 /* Disable traps, set s and ps */
51 /* All traps low-level code here must end with this macro. */
52 #define RESTORE_ALL b ret_trap_entry; clr %l6;
54 #define WRITE_PAUSE nop;nop;nop
58 ARGPUSH = (WINDOWSIZE + 4)
59 MINFRAME = (WINDOWSIZE + ARGPUSHSIZE + 4)
61 /* Number of register windows */
62 #ifndef CONFIG_SYS_SPARC_NWINDOWS
63 #error Must define number of SPARC register windows, default is 8
66 /* Macros to load address into a register. Uses GOT table for PIC */
69 #define SPARC_PIC_THUNK_CALL(reg) \
70 sethi %pc22(_GLOBAL_OFFSET_TABLE_-4), %##reg; \
71 call __sparc_get_pc_thunk.reg; \
72 add %##reg, %pc10(_GLOBAL_OFFSET_TABLE_+4), %##reg;
74 #define SPARC_LOAD_ADDRESS(sym, got, reg) \
75 sethi %gdop_hix22(sym), %##reg; \
76 xor %##reg, %gdop_lox10(sym), %##reg; \
77 ld [%##got + %##reg], %##reg, %gdop(sym);
81 #define SPARC_PIC_THUNK_CALL(reg)
82 #define SPARC_LOAD_ADDRESS(sym, got, tmp) \
88 #define SA(X) (((X)+(STACK_ALIGN-1)) & ~(STACK_ALIGN-1))
90 .section ".start", "ax"
91 .globl _start, start, _trap_table
92 .globl _irq_entry, nmi_trap
101 TRAPR(_hardreset); ! 00 reset trap
102 BAD_TRAP; ! 01 instruction_access_exception
103 BAD_TRAP; ! 02 illegal_instruction
104 BAD_TRAP; ! 03 priveleged_instruction
105 BAD_TRAP; ! 04 fp_disabled
106 TRAP(_window_overflow); ! 05 window_overflow
107 TRAP(_window_underflow); ! 06 window_underflow
108 BAD_TRAP; ! 07 Memory Address Not Aligned
109 BAD_TRAP; ! 08 Floating Point Exception
110 BAD_TRAP; ! 09 Data Miss Exception
111 BAD_TRAP; ! 0a Tagged Instruction Ovrflw
112 BAD_TRAP; ! 0b Watchpoint Detected
118 TRAPI(1); ! 11 IRQ level 1
119 TRAPI(2); ! 12 IRQ level 2
120 TRAPI(3); ! 13 IRQ level 3
121 TRAPI(4); ! 14 IRQ level 4
122 TRAPI(5); ! 15 IRQ level 5
123 TRAPI(6); ! 16 IRQ level 6
124 TRAPI(7); ! 17 IRQ level 7
125 TRAPI(8); ! 18 IRQ level 8
126 TRAPI(9); ! 19 IRQ level 9
127 TRAPI(10); ! 1a IRQ level 10
128 TRAPI(11); ! 1b IRQ level 11
129 TRAPI(12); ! 1c IRQ level 12
130 TRAPI(13); ! 1d IRQ level 13
131 TRAPI(14); ! 1e IRQ level 14
132 TRAP(_nmi_trap); ! 1f IRQ level 15 /
133 ! NMI (non maskable interrupt)
134 BAD_TRAP; ! 20 r_register_access_error
135 BAD_TRAP; ! 21 instruction access error
138 BAD_TRAP; ! 24 co-processor disabled
139 BAD_TRAP; ! 25 uniplemented FLUSH
142 BAD_TRAP; ! 28 co-processor exception
143 BAD_TRAP; ! 29 data access error
144 BAD_TRAP; ! 2a division by zero
145 BAD_TRAP; ! 2b data store error
146 BAD_TRAP; ! 2c data access MMU miss
150 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 30-33
151 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 34-37
152 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 38-3b
153 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 3c-3f
154 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 40-43
155 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 44-47
156 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 48-4b
157 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 4c-4f
158 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 50-53
159 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 54-57
160 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 58-5b
161 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 5c-5f
163 /* implementaion dependent */
164 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 60-63
165 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 64-67
166 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 68-6b
167 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 6c-6f
168 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 70-73
169 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 74-77
170 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 78-7b
171 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 7c-7f
173 /* Software traps, not handled */
174 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 80-83
175 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 84-87
176 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 88-8b
177 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 8c-8f
178 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 90-93
179 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 94-97
180 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 98-9b
181 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 9c-9f
182 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a0-a3
183 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a4-a7
184 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a8-ab
185 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! ac-af
186 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b0-b3
187 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b4-b7
188 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b8-bb
189 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! bc-bf
190 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c0-c3
191 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c4-c7
192 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c8-cb
193 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! cc-cf
194 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d0-d3
195 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d4-d7
196 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d8-db
197 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! dc-df
198 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e0-e3
199 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e4-e7
200 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e8-eb
201 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! ec-ef
202 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f0-f3
203 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f4-f7
204 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f8-fb
205 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! fc-ff
211 .extern leon3_snooping_avail
212 .globl version_string
214 .ascii U_BOOT_VERSION_STRING, "\0"
217 .extern _nomem_amba_init, _nomem_memory_ctrl_init
224 /* Enable I/D-Cache and Snooping */
265 set CONFIG_SYS_INIT_SP_OFFSET, %fp
269 /* Obtain the address of _GLOBAL_OFFSET_TABLE_ */
270 SPARC_PIC_THUNK_CALL(l7)
272 /* Scan AMBA Bus for AMBA buses using PnP information. All found
273 * AMBA buses I/O area will be located in i0-i5 upon return.
274 * The i0-i5 registers are later used by _nomem_amba_init2
277 call _nomem_amba_init
278 sethi %hi(CONFIG_AMBAPP_IOAREA), %o0
280 /* Scan AMBA Buses for memory controllers, then initialize the
281 * memory controllers. Note that before setting up the memory controller
282 * the stack can not be used.
285 SPARC_LOAD_ADDRESS(grlib_mctrl_handlers, l7, o0)
287 call _nomem_memory_ctrl_init
290 /* The return valu indicate how many memory controllers where found and
291 * initialized, if no memory controller was initialized, we can not continue
292 * because from here on we expect memory to be working.
295 memory_ctrl_init_failed:
296 beq memory_ctrl_init_failed
299 /*** From now on the stack can be used. ***/
305 /* un relocated start address of monitor */
306 #define TEXT_START _text
308 /* un relocated end address of monitor */
309 #define DATA_END __init_end
312 SPARC_LOAD_ADDRESS(TEXT_START, l7, g2)
313 SPARC_LOAD_ADDRESS(DATA_END, l7, g3)
314 set CONFIG_SYS_RELOC_MONITOR_BASE,%g4
331 /* register g4 contain address to start
332 * This means that BSS must be directly after data and code segments
334 * g3 is length of bss = (__bss_end-__bss_start)
339 /* clear bss area (the relocated) */
340 SPARC_LOAD_ADDRESS(__bss_start, l7, g2)
341 SPARC_LOAD_ADDRESS(__bss_end, l7, g3)
344 clr %g1 /* std %g0 uses g0 and g1 */
345 /* clearing 16byte a time ==> linker script need to align to 16 byte offset */
354 /* add offsets to GOT table */
356 SPARC_LOAD_ADDRESS(__got_start, l7, g4)
357 SPARC_LOAD_ADDRESS(__got_end, l7, g3)
359 * new got offset = (old GOT-PTR (read with ld) -
360 * CONFIG_SYS_RELOC_MONITOR_BASE(from define) ) +
361 * Destination Address (from define)
363 set CONFIG_SYS_RELOC_MONITOR_BASE,%g2
364 SPARC_LOAD_ADDRESS(TEXT_START, l7, g1)
369 sub %g2,%g1,%g2 ! prepare register with (new base address) -
372 ld [%g4],%l0 ! load old GOT-PTR
373 add %l0,%g2,%l0 ! increase with (new base address) -
382 SPARC_LOAD_ADDRESS(__prom_start, l7, g2)
383 SPARC_LOAD_ADDRESS(__prom_end, l7, g3)
384 set CONFIG_SYS_PROM_OFFSET, %g4
393 bne prom_relocate_loop
396 /* Trap table has been moved, lets tell CPU about
397 * the new trap table address
400 set CONFIG_SYS_RELOC_MONITOR_BASE, %g2
406 /* If CACHE snooping is available in hardware the
407 * variable leon3_snooping_avail will be set to
411 sethi %hi(0x00800000), %o0
414 sethi %hi(leon3_snooping_avail+CONFIG_SYS_RELOC_MONITOR_BASE-CONFIG_SYS_TEXT_BASE), %o1
415 st %o0, [%lo(leon3_snooping_avail+CONFIG_SYS_RELOC_MONITOR_BASE-CONFIG_SYS_TEXT_BASE)+%o1]
419 /* Call relocated init functions */
421 SPARC_LOAD_ADDRESS(cpu_init_f2, l7, o1)
422 set CONFIG_SYS_RELOC_MONITOR_BASE,%o2
428 SPARC_LOAD_ADDRESS(board_init_f, l7, o1)
429 set CONFIG_SYS_RELOC_MONITOR_BASE,%o2
430 SPARC_LOAD_ADDRESS(TEXT_START, l7, g1)
436 dead: ta 0 ! if call returns...
439 /* Interrupt handler caller,
440 * reg L7: interrupt number
441 * reg L0: psr after interrupt
454 mov %l7, %o0 ! irq level
456 set (CONFIG_SYS_RELOC_MONITOR_BASE-CONFIG_SYS_TEXT_BASE), %o2
459 add %sp, SF_REGS_SZ, %o1 ! pt_regs ptr
460 or %l0, PSR_PIL, %g2 ! restore PIL after handler_irq
461 wr %g2, PSR_ET, %psr ! keep ET up
466 !Window overflow trap handler.
467 .global _window_overflow
471 mov %wim, %l3 ! Calculate next WIM
474 sll %l3, (CONFIG_SYS_SPARC_NWINDOWS-1) , %l4
477 save ! Get into window to be saved.
498 restore ! Go back to trap window.
500 jmp %l1 ! Re-execute save.
503 /* Window underflow trap handler. */
505 .global _window_underflow
509 mov %wim, %l3 ! Calculate next WIM
511 srl %l3, (CONFIG_SYS_SPARC_NWINDOWS-1), %l5
515 restore ! Two restores to get into the
516 restore ! window to restore
517 ld [%sp + 0], %l0; ! Restore window from the stack
533 save ! Get back to the trap window.
535 jmp %l1 ! Re-execute restore.
549 b _hwerr ! loop infinite
552 /* Registers to not touch at all. */
553 #define t_psr l0 /* Set by caller */
554 #define t_pc l1 /* Set by caller */
555 #define t_npc l2 /* Set by caller */
556 #define t_wim l3 /* Set by caller */
557 #define t_twinmask l4 /* Set at beginning of this entry routine. */
558 #define t_kstack l5 /* Set right before pt_regs frame is built */
559 #define t_retpc l6 /* If you change this, change winmacro.h header file */
560 #define t_systable l7 /* Never touch this, could be the syscall table ptr. */
561 #define curptr g6 /* Set after pt_regs frame is built */
564 /* build a pt_regs trap frame. */
565 sub %fp, (SF_REGS_SZ + PT_REGS_SZ), %t_kstack
566 PT_STORE_ALL(t_kstack, t_psr, t_pc, t_npc, g2)
568 /* See if we are in the trap window. */
570 sll %t_twinmask, %t_psr, %t_twinmask ! t_twinmask = (1 << psr)
571 andcc %t_twinmask, %t_wim, %g0
572 beq 1f ! in trap window, clean up
575 /*-------------------------------------------------
576 * Spill , adjust %wim and go.
578 srl %t_wim, 0x1, %g2 ! begin computation of new %wim
580 set (CONFIG_SYS_SPARC_NWINDOWS-1), %g3 !NWINDOWS-1
582 sll %t_wim, %g3, %t_wim ! NWINDOWS-1
586 save %g0, %g0, %g0 ! get in window to be saved
588 /* Set new %wim value */
591 /* Save the kernel window onto the corresponding stack. */
594 restore %g0, %g0, %g0
595 /*-------------------------------------------------*/
598 /* Trap from kernel with a window available.
601 jmpl %t_retpc + 0x8, %g0 ! return to caller
602 mov %t_kstack, %sp ! jump onto new stack
608 wr %t_psr, 0x0, %psr ! enable nesting again, clear ET
610 /* Will the rett land us in the invalid window? */
614 set CONFIG_SYS_SPARC_NWINDOWS, %g2 !NWINDOWS
620 be 1f ! Nope, just return from the trap
623 /* We have to grab a window before returning. */
624 set (CONFIG_SYS_SPARC_NWINDOWS-1), %g3 !NWINDOWS-1
632 /* Grrr, make sure we load from the right %sp... */
633 PT_LOAD_ALL(sp, t_psr, t_pc, t_npc, g1)
635 restore %g0, %g0, %g0
640 /* Reload the entire frame in case this is from a
641 * kernel system call or whatever...
644 PT_LOAD_ALL(sp, t_psr, t_pc, t_npc, g1)
654 /* This is called from relocated C-code.
655 * It resets the system by jumping to _start