cpu/leon3/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 <version.h>
  31
  32 /* Entry for traps which jump to a programmer-specified trap handler.  */
  33 #define TRAPR(H)  \
  34         wr      %g0, 0xfe0, %psr; \
  35         mov     %g0, %tbr; \
  36         ba      (H); \
  37         mov     %g0, %wim;
  38
  39 #define TRAP(H) \
  40         mov     %psr, %l0; \
  41         ba      (H); \
  42         nop; nop;
  43
  44 #define TRAPI(ilevel) \
  45         mov     ilevel, %l7; \
  46         mov     %psr, %l0; \
  47         b       _irq_entry; \
  48         mov     %wim, %l3
  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 */
  71 #ifndef CFG_SPARC_NWINDOWS
  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"
  79         .globl  _start, start, _trap_table
  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 /
 121                                         ! NMI (non maskable interrupt)
 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:
 254         set     CFG_INIT_SP_OFFSET, %fp
 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
 271         set     CFG_RELOC_MONITOR_BASE,%g4
 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) -
 317  *   CFG_RELOC_MONITOR_BASE(from define) ) +
 318  *   Destination Address (from define)
 319  */
 320         set     CFG_RELOC_MONITOR_BASE,%g2
 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
 341         set     CFG_PROM_OFFSET, %g4
 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
 357         set     CFG_RELOC_MONITOR_BASE, %g2
 358         wr      %g0, %g2, %tbr
 359         nop
 360         nop
 361         nop
 362
 363 /* If CACHE snooping is available in hardware the
 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
 371         sethi   %hi(leon3_snooping_avail+CFG_RELOC_MONITOR_BASE-TEXT_BASE), %o1
 372         st      %o0, [%lo(leon3_snooping_avail+CFG_RELOC_MONITOR_BASE-TEXT_BASE)+%o1]
 373
 374 /*      call    relocate*/
 375         nop
 376 /* Call relocated init functions */
 377 jump:
 378         set     cpu_init_f2,%o1
 379         set     CFG_RELOC_MONITOR_BASE,%o2
 380         add     %o1,%o2,%o1
 381         sub     %o1,%g1,%o1
 382         call    %o1
 383         clr     %o0
 384
 385         set     board_init_f,%o1
 386         set     CFG_RELOC_MONITOR_BASE,%o2
 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
 412         set     (CFG_RELOC_MONITOR_BASE-TEXT_BASE), %o2
 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
 430         sll     %l3, (CFG_SPARC_NWINDOWS-1) , %l4
 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
 467         srl  %l3, (CFG_SPARC_NWINDOWS-1), %l5
 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
 473         ld      [%sp + 0], %l0;         ! Restore window from the stack
 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
 505         b _hwerr                        ! loop infinite
 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
 536         set     (CFG_SPARC_NWINDOWS-1), %g3     !NWINDOWS-1
 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
 570         set     CFG_SPARC_NWINDOWS, %g2 !NWINDOWS
 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. */
 580         set     (CFG_SPARC_NWINDOWS-1), %g3     !NWINDOWS-1
 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