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