1 /* This is where the SPARC/LEON3 starts
3 * Daniel Hellstrom, daniel@gaisler.com
5 * See file CREDITS for list of people who contributed to this
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.
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.
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,
24 #include <asm-offsets.h>
26 #include <asm/asmmacro.h>
27 #include <asm/winmacro.h>
29 #include <asm/stack.h>
31 #include <timestamp.h>
34 /* Entry for traps which jump to a programmer-specified trap handler. */
36 wr %g0, 0xfe0, %psr; \
46 #define TRAPI(ilevel) \
52 /* Unexcpected trap will halt the processor by forcing it to error state */
54 #define BAD_TRAP ta 0; nop; nop; nop;
56 /* Software trap. Treat as BAD_TRAP for the time being... */
57 #define SOFT_TRAP TRAP(_hwerr)
59 #define PSR_INIT 0x1FC0 /* Disable traps, set s and ps */
62 /* All traps low-level code here must end with this macro. */
63 #define RESTORE_ALL b ret_trap_entry; clr %l6;
65 #define WRITE_PAUSE nop;nop;nop
69 ARGPUSH = (WINDOWSIZE + 4)
70 MINFRAME = (WINDOWSIZE + ARGPUSHSIZE + 4)
72 /* Number of register windows */
73 #ifndef CONFIG_SYS_SPARC_NWINDOWS
74 #error Must define number of SPARC register windows, default is 8
78 #define SA(X) (((X)+(STACK_ALIGN-1)) & ~(STACK_ALIGN-1))
80 .section ".start", "ax"
81 .globl _start, start, _trap_table
82 .globl _irq_entry, nmi_trap
91 TRAPR(_hardreset); ! 00 reset trap
92 BAD_TRAP; ! 01 instruction_access_exception
93 BAD_TRAP; ! 02 illegal_instruction
94 BAD_TRAP; ! 03 priveleged_instruction
95 BAD_TRAP; ! 04 fp_disabled
96 TRAP(_window_overflow); ! 05 window_overflow
97 TRAP(_window_underflow); ! 06 window_underflow
98 BAD_TRAP; ! 07 Memory Address Not Aligned
99 BAD_TRAP; ! 08 Floating Point Exception
100 BAD_TRAP; ! 09 Data Miss Exception
101 BAD_TRAP; ! 0a Tagged Instruction Ovrflw
102 BAD_TRAP; ! 0b Watchpoint Detected
108 TRAPI(1); ! 11 IRQ level 1
109 TRAPI(2); ! 12 IRQ level 2
110 TRAPI(3); ! 13 IRQ level 3
111 TRAPI(4); ! 14 IRQ level 4
112 TRAPI(5); ! 15 IRQ level 5
113 TRAPI(6); ! 16 IRQ level 6
114 TRAPI(7); ! 17 IRQ level 7
115 TRAPI(8); ! 18 IRQ level 8
116 TRAPI(9); ! 19 IRQ level 9
117 TRAPI(10); ! 1a IRQ level 10
118 TRAPI(11); ! 1b IRQ level 11
119 TRAPI(12); ! 1c IRQ level 12
120 TRAPI(13); ! 1d IRQ level 13
121 TRAPI(14); ! 1e IRQ level 14
122 TRAP(_nmi_trap); ! 1f IRQ level 15 /
123 ! NMI (non maskable interrupt)
124 BAD_TRAP; ! 20 r_register_access_error
125 BAD_TRAP; ! 21 instruction access error
128 BAD_TRAP; ! 24 co-processor disabled
129 BAD_TRAP; ! 25 uniplemented FLUSH
132 BAD_TRAP; ! 28 co-processor exception
133 BAD_TRAP; ! 29 data access error
134 BAD_TRAP; ! 2a division by zero
135 BAD_TRAP; ! 2b data store error
136 BAD_TRAP; ! 2c data access MMU miss
140 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 30-33
141 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 34-37
142 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 38-3b
143 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 3c-3f
144 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 40-43
145 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 44-47
146 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 48-4b
147 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 4c-4f
148 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 50-53
149 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 54-57
150 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 58-5b
151 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 5c-5f
153 /* implementaion dependent */
154 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 60-63
155 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 64-67
156 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 68-6b
157 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 6c-6f
158 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 70-73
159 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 74-77
160 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 78-7b
161 BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 7c-7f
163 /* Software traps, not handled */
164 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 80-83
165 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 84-87
166 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 88-8b
167 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 8c-8f
168 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 90-93
169 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 94-97
170 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 98-9b
171 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 9c-9f
172 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a0-a3
173 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a4-a7
174 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a8-ab
175 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! ac-af
176 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b0-b3
177 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b4-b7
178 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b8-bb
179 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! bc-bf
180 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c0-c3
181 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c4-c7
182 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c8-cb
183 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! cc-cf
184 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d0-d3
185 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d4-d7
186 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d8-db
187 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! dc-df
188 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e0-e3
189 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e4-e7
190 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e8-eb
191 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! ec-ef
192 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f0-f3
193 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f4-f7
194 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f8-fb
195 SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! fc-ff
201 .globl version_string
203 .ascii U_BOOT_VERSION
204 .ascii " (", U_BOOT_DATE, " - ", U_BOOT_TIME, ")"
205 .ascii CONFIG_IDENT_STRING, "\0"
218 set (LEON2_PREGS+LEON_REG_CACHECTRL_OFFSET), %g1
255 /* LEON2 Register Base in g1 */
259 /* Set Cache control register */
265 /* Clear LEON2 registers */
266 st %g0, [%g1 + LEON2_ECTRL]
267 st %g0, [%g1 + LEON2_IMASK]
268 st %g0, [%g1 + LEON2_IPEND]
269 st %g0, [%g1 + LEON2_IFORCE]
270 st %g0, [%g1 + LEON2_ICLEAR]
271 st %g0, [%g1 + LEON2_IOREG]
272 st %g0, [%g1 + LEON2_IODIR]
273 st %g0, [%g1 + LEON2_IOICONF]
274 st %g0, [%g1 + LEON2_UCTRL0]
275 st %g0, [%g1 + LEON2_UCTRL1]
278 /* I/O port initialization */
280 st %g2, [%g1 + LEON2_IOREG]
284 /* memory config register 1 */
285 set CONFIG_SYS_GRLIB_MEMCFG1, %g2
289 st %g2, [%g1 + LEON2_MCFG1]
290 set CONFIG_SYS_GRLIB_MEMCFG2, %g2 ! Load memory config register 2
291 #if !( defined(TSIM) || !defined(BZIMAGE))
292 st %g2, [%g1 + LEON2_MCFG2] ! only for prom version, else done by "dumon -i"
294 set CONFIG_SYS_GRLIB_MEMCFG3, %g2 ! Init FT register
295 st %g2, [%g1 + LEON2_ECTRL]
296 ld [%g1 + LEON2_ECTRL], %g2
300 mov %g0, %asr16 ! clear err_reg
315 set CONFIG_SYS_INIT_SP_OFFSET, %fp
323 /* un relocated start address of monitor */
324 #define TEXT_START _text
326 /* un relocated end address of monitor */
327 #define DATA_END __init_end
332 set CONFIG_SYS_RELOC_MONITOR_BASE,%g4
349 /* register g4 contain address to start
350 * This means that BSS must be directly after data and code segments
352 * g3 is length of bss = (__bss_end-__bss_start)
357 /* clear bss area (the relocated) */
362 clr %g1 /* std %g0 uses g0 and g1 */
363 /* clearing 16byte a time ==> linker script need to align to 16 byte offset */
372 /* add offsets to GOT table */
377 * new got offset = (old GOT-PTR (read with ld) -
378 * CONFIG_SYS_RELOC_MONITOR_BASE(from define) ) +
379 * Destination Address (from define)
381 set CONFIG_SYS_RELOC_MONITOR_BASE,%g2
387 sub %g2,%g1,%g2 ! prepare register with (new base address) -
390 ld [%g4],%l0 ! load old GOT-PTR
391 add %l0,%g2,%l0 ! increase with (new base address) -
400 set __prom_start, %g2
402 set CONFIG_SYS_PROM_OFFSET, %g4
411 bne prom_relocate_loop
414 /* Trap table has been moved, lets tell CPU about
415 * the new trap table address
418 set CONFIG_SYS_RELOC_MONITOR_BASE, %g2
423 /* Call relocated init functions */
426 set CONFIG_SYS_RELOC_MONITOR_BASE,%o2
433 set CONFIG_SYS_RELOC_MONITOR_BASE,%o2
439 dead: ta 0 ! if call returns...
442 /* Interrupt handler caller,
443 * reg L7: interrupt number
444 * reg L0: psr after interrupt
457 mov %l7, %o0 ! irq level
459 set (CONFIG_SYS_RELOC_MONITOR_BASE-CONFIG_SYS_TEXT_BASE), %o2
462 add %sp, SF_REGS_SZ, %o1 ! pt_regs ptr
463 or %l0, PSR_PIL, %g2 ! restore PIL after handler_irq
464 wr %g2, PSR_ET, %psr ! keep ET up
469 !Window overflow trap handler.
470 .global _window_overflow
474 mov %wim, %l3 ! Calculate next WIM
477 sll %l3, (CONFIG_SYS_SPARC_NWINDOWS-1) , %l4
480 save ! Get into window to be saved.
501 restore ! Go back to trap window.
503 jmp %l1 ! Re-execute save.
506 /* Window underflow trap handler. */
508 .global _window_underflow
512 mov %wim, %l3 ! Calculate next WIM
514 srl %l3, (CONFIG_SYS_SPARC_NWINDOWS-1), %l5
518 restore ! Two restores to get into the
519 restore ! window to restore
520 ld [%sp + 0], %l0; ! Restore window from the stack
536 save ! Get back to the trap window.
538 jmp %l1 ! Re-execute restore.
552 b _hwerr ! loop infinite
555 /* Registers to not touch at all. */
556 #define t_psr l0 /* Set by caller */
557 #define t_pc l1 /* Set by caller */
558 #define t_npc l2 /* Set by caller */
559 #define t_wim l3 /* Set by caller */
560 #define t_twinmask l4 /* Set at beginning of this entry routine. */
561 #define t_kstack l5 /* Set right before pt_regs frame is built */
562 #define t_retpc l6 /* If you change this, change winmacro.h header file */
563 #define t_systable l7 /* Never touch this, could be the syscall table ptr. */
564 #define curptr g6 /* Set after pt_regs frame is built */
567 /* build a pt_regs trap frame. */
568 sub %fp, (SF_REGS_SZ + PT_REGS_SZ), %t_kstack
569 PT_STORE_ALL(t_kstack, t_psr, t_pc, t_npc, g2)
571 /* See if we are in the trap window. */
573 sll %t_twinmask, %t_psr, %t_twinmask ! t_twinmask = (1 << psr)
574 andcc %t_twinmask, %t_wim, %g0
575 beq 1f ! in trap window, clean up
578 /*-------------------------------------------------
579 * Spill , adjust %wim and go.
581 srl %t_wim, 0x1, %g2 ! begin computation of new %wim
583 set (CONFIG_SYS_SPARC_NWINDOWS-1), %g3 !NWINDOWS-1
585 sll %t_wim, %g3, %t_wim ! NWINDOWS-1
589 save %g0, %g0, %g0 ! get in window to be saved
591 /* Set new %wim value */
594 /* Save the kernel window onto the corresponding stack. */
597 restore %g0, %g0, %g0
598 /*-------------------------------------------------*/
601 /* Trap from kernel with a window available.
604 jmpl %t_retpc + 0x8, %g0 ! return to caller
605 mov %t_kstack, %sp ! jump onto new stack
611 wr %t_psr, 0x0, %psr ! enable nesting again, clear ET
613 /* Will the rett land us in the invalid window? */
617 set CONFIG_SYS_SPARC_NWINDOWS, %g2 !NWINDOWS
623 be 1f ! Nope, just return from the trap
626 /* We have to grab a window before returning. */
627 set (CONFIG_SYS_SPARC_NWINDOWS-1), %g3 !NWINDOWS-1
635 /* Grrr, make sure we load from the right %sp... */
636 PT_LOAD_ALL(sp, t_psr, t_pc, t_npc, g1)
638 restore %g0, %g0, %g0
643 /* Reload the entire frame in case this is from a
644 * kernel system call or whatever...
647 PT_LOAD_ALL(sp, t_psr, t_pc, t_npc, g1)
657 /* This is called from relocated C-code.
658 * It resets the system by jumping to _start