+++ /dev/null
-/* This is where the SPARC/LEON3 starts
- *
- * Copyright (C) 2007, 2015
- * Daniel Hellstrom, Cobham Gaisler, daniel@gaisler.com
- *
- * SPDX-License-Identifier: GPL-2.0+
- */
-
-#include <asm-offsets.h>
-#include <config.h>
-#include <asm/asmmacro.h>
-#include <asm/winmacro.h>
-#include <asm/psr.h>
-#include <asm/stack.h>
-#include <asm/leon.h>
-
-/* Entry for traps which jump to a programmer-specified trap handler. */
-#define TRAPR(H) \
- wr %g0, 0xfe0, %psr; \
- mov %g0, %tbr; \
- ba (H); \
- mov %g0, %wim;
-
-#define TRAP(H) \
- mov %psr, %l0; \
- ba (H); \
- nop; nop;
-
-#define TRAPI(ilevel) \
- mov ilevel, %l7; \
- mov %psr, %l0; \
- b _irq_entry; \
- mov %wim, %l3
-
-/* Unexcpected trap will halt the processor by forcing it to error state */
-#undef BAD_TRAP
-#define BAD_TRAP ta 0; nop; nop; nop;
-
-/* Software trap. Treat as BAD_TRAP for the time being... */
-#define SOFT_TRAP TRAP(_hwerr)
-
-#define PSR_INIT 0x1FC0 /* Disable traps, set s and ps */
-#define WIM_INIT 2
-
-/* All traps low-level code here must end with this macro. */
-#define RESTORE_ALL b ret_trap_entry; clr %l6;
-
-#define WRITE_PAUSE nop;nop;nop
-
-WINDOWSIZE = (16 * 4)
-ARGPUSHSIZE = (6 * 4)
-ARGPUSH = (WINDOWSIZE + 4)
-MINFRAME = (WINDOWSIZE + ARGPUSHSIZE + 4)
-
-/* Number of register windows */
-#ifndef CONFIG_SYS_SPARC_NWINDOWS
-#error Must define number of SPARC register windows, default is 8
-#endif
-
-/* Macros to load address into a register. Uses GOT table for PIC */
-#ifdef __PIC__
-
-#define SPARC_PIC_THUNK_CALL(reg) \
- sethi %pc22(_GLOBAL_OFFSET_TABLE_-4), %##reg; \
- call __sparc_get_pc_thunk.reg; \
- add %##reg, %pc10(_GLOBAL_OFFSET_TABLE_+4), %##reg;
-
-#define SPARC_LOAD_ADDRESS(sym, got, reg) \
- sethi %gdop_hix22(sym), %##reg; \
- xor %##reg, %gdop_lox10(sym), %##reg; \
- ld [%##got + %##reg], %##reg, %gdop(sym);
-
-#else
-
-#define SPARC_PIC_THUNK_CALL(reg)
-#define SPARC_LOAD_ADDRESS(sym, got, tmp) \
- set sym, %##reg;
-
-#endif
-
-#define STACK_ALIGN 8
-#define SA(X) (((X)+(STACK_ALIGN-1)) & ~(STACK_ALIGN-1))
-
- .section ".start", "ax"
- .globl _start, start, _trap_table
- .globl _irq_entry, nmi_trap
- .globl _reset_reloc
-
-/* at address 0
- * Hardware traps
- */
-start:
-_start:
-_trap_table:
- TRAPR(_hardreset); ! 00 reset trap
- BAD_TRAP; ! 01 instruction_access_exception
- BAD_TRAP; ! 02 illegal_instruction
- BAD_TRAP; ! 03 priveleged_instruction
- BAD_TRAP; ! 04 fp_disabled
- TRAP(_window_overflow); ! 05 window_overflow
- TRAP(_window_underflow); ! 06 window_underflow
- BAD_TRAP; ! 07 Memory Address Not Aligned
- BAD_TRAP; ! 08 Floating Point Exception
- BAD_TRAP; ! 09 Data Miss Exception
- BAD_TRAP; ! 0a Tagged Instruction Ovrflw
- BAD_TRAP; ! 0b Watchpoint Detected
- BAD_TRAP; ! 0c
- BAD_TRAP; ! 0d
- BAD_TRAP; ! 0e
- BAD_TRAP; ! 0f
- BAD_TRAP; ! 10
- TRAPI(1); ! 11 IRQ level 1
- TRAPI(2); ! 12 IRQ level 2
- TRAPI(3); ! 13 IRQ level 3
- TRAPI(4); ! 14 IRQ level 4
- TRAPI(5); ! 15 IRQ level 5
- TRAPI(6); ! 16 IRQ level 6
- TRAPI(7); ! 17 IRQ level 7
- TRAPI(8); ! 18 IRQ level 8
- TRAPI(9); ! 19 IRQ level 9
- TRAPI(10); ! 1a IRQ level 10
- TRAPI(11); ! 1b IRQ level 11
- TRAPI(12); ! 1c IRQ level 12
- TRAPI(13); ! 1d IRQ level 13
- TRAPI(14); ! 1e IRQ level 14
- TRAP(_nmi_trap); ! 1f IRQ level 15 /
- ! NMI (non maskable interrupt)
- BAD_TRAP; ! 20 r_register_access_error
- BAD_TRAP; ! 21 instruction access error
- BAD_TRAP; ! 22
- BAD_TRAP; ! 23
- BAD_TRAP; ! 24 co-processor disabled
- BAD_TRAP; ! 25 uniplemented FLUSH
- BAD_TRAP; ! 26
- BAD_TRAP; ! 27
- BAD_TRAP; ! 28 co-processor exception
- BAD_TRAP; ! 29 data access error
- BAD_TRAP; ! 2a division by zero
- BAD_TRAP; ! 2b data store error
- BAD_TRAP; ! 2c data access MMU miss
- BAD_TRAP; ! 2d
- BAD_TRAP; ! 2e
- BAD_TRAP; ! 2f
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 30-33
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 34-37
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 38-3b
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 3c-3f
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 40-43
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 44-47
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 48-4b
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 4c-4f
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 50-53
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 54-57
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 58-5b
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 5c-5f
-
- /* implementaion dependent */
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 60-63
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 64-67
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 68-6b
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 6c-6f
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 70-73
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 74-77
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 78-7b
- BAD_TRAP; BAD_TRAP; BAD_TRAP; BAD_TRAP; ! 7c-7f
-
- /* Software traps, not handled */
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 80-83
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 84-87
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 88-8b
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 8c-8f
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 90-93
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 94-97
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 98-9b
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! 9c-9f
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a0-a3
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a4-a7
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! a8-ab
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! ac-af
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b0-b3
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b4-b7
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! b8-bb
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! bc-bf
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c0-c3
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c4-c7
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! c8-cb
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! cc-cf
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d0-d3
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d4-d7
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! d8-db
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! dc-df
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e0-e3
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e4-e7
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! e8-eb
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! ec-ef
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f0-f3
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f4-f7
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! f8-fb
- SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; SOFT_TRAP; ! fc-ff
-
- .section ".text"
- .align 4
-
-_hardreset:
-1000:
- flush
- nop
- nop
- nop
-
- /* Init Cache */
- set (LEON2_PREGS+LEON_REG_CACHECTRL_OFFSET), %g1
- set 0x0081000f, %g2
- st %g2, [%g1]
-
- mov %g0, %y
- clr %g1
- clr %g2
- clr %g3
- clr %g4
- clr %g5
- clr %g6
- clr %g7
-
- mov %asr17, %g3
- and %g3, 0x1f, %g3
-clear_window:
- mov %g0, %l0
- mov %g0, %l1
- mov %g0, %l2
- mov %g0, %l3
- mov %g0, %l4
- mov %g0, %l5
- mov %g0, %l6
- mov %g0, %l7
- mov %g0, %o0
- mov %g0, %o1
- mov %g0, %o2
- mov %g0, %o3
- mov %g0, %o4
- mov %g0, %o5
- mov %g0, %o6
- mov %g0, %o7
- subcc %g3, 1, %g3
- bge clear_window
- save
-
-leon2_init:
- /* LEON2 Register Base in g1 */
- set LEON2_PREGS, %g1
-
-leon2_init_cache:
- /* Set Cache control register */
- set 0x1000f, %g2
- st %g2, [%g1 + 0x14]
-
-leon2_init_clear:
-
- /* Clear LEON2 registers */
- st %g0, [%g1 + LEON2_ECTRL]
- st %g0, [%g1 + LEON2_IMASK]
- st %g0, [%g1 + LEON2_IPEND]
- st %g0, [%g1 + LEON2_IFORCE]
- st %g0, [%g1 + LEON2_ICLEAR]
- st %g0, [%g1 + LEON2_IOREG]
- st %g0, [%g1 + LEON2_IODIR]
- st %g0, [%g1 + LEON2_IOICONF]
- st %g0, [%g1 + LEON2_UCTRL0]
- st %g0, [%g1 + LEON2_UCTRL1]
-
-leon2_init_ioport:
- /* I/O port initialization */
- set 0xaa00, %g2
- st %g2, [%g1 + LEON2_IOREG]
-
-leon2_init_mctrl:
-
- /* memory config register 1 */
- set CONFIG_SYS_GRLIB_MEMCFG1, %g2
- ld [%g1], %g3 !
- and %g3, 0x300, %g3
- or %g2, %g3, %g2
- st %g2, [%g1 + LEON2_MCFG1]
- set CONFIG_SYS_GRLIB_MEMCFG2, %g2 ! Load memory config register 2
-#if !( defined(TSIM) || !defined(BZIMAGE))
- st %g2, [%g1 + LEON2_MCFG2] ! only for prom version, else done by "dumon -i"
-#endif
- set CONFIG_SYS_GRLIB_MEMCFG3, %g2 ! Init FT register
- st %g2, [%g1 + LEON2_ECTRL]
- ld [%g1 + LEON2_ECTRL], %g2
- srl %g2, 30, %g2
- andcc %g2, 3, %g6
- bne,a leon2_init_wim
- mov %g0, %asr16 ! clear err_reg
-
-leon2_init_wim:
- set WIM_INIT, %g3
- mov %g3, %wim
-
-leon2_init_psr:
- set 0x1000, %g3
- mov %psr, %g2
- wr %g2, %g3, %psr
- nop
- nop
- nop
-
-leon2_init_stackp:
- set CONFIG_SYS_INIT_SP_OFFSET, %fp
- andn %fp, 0x0f, %fp
- sub %fp, 64, %sp
-
-leon2_init_tbr:
- set CONFIG_SYS_TEXT_BASE, %g2
- wr %g0, %g2, %tbr
- nop
- nop
- nop
-
-cpu_init_unreloc:
- call cpu_init_f
- nop
-
-board_init_unreloc:
- call board_init_f
- clr %o0 ! boot_flags
-
-dead_unreloc:
- ba dead_unreloc ! infinte loop
- nop
-
-!-------------------------------------------------------------------------------
-
-/* void relocate_code (addr_sp, gd, addr_moni)
- *
- * This "function" does not return, instead it continues in RAM after
- * relocating the monitor code.
- *
- * %o0 = Relocated stack pointer
- * %o1 = Relocated global data pointer
- * %o2 = Relocated text pointer
- */
- .globl relocate_code
- .type relocate_code, #function
- .align 4
-relocate_code:
- SPARC_PIC_THUNK_CALL(l7)
-
-/* un relocated start address of monitor */
-#define TEXT_START _text
-
-/* un relocated end address of monitor */
-#define DATA_END __init_end
-
-reloc:
- SPARC_LOAD_ADDRESS(TEXT_START, l7, g2)
- SPARC_LOAD_ADDRESS(DATA_END, l7, g3)
- mov %o2, %g4 ! relocation address
- sub %g4, %g2, %g6 ! relocation offset
- /* copy .text & .data to relocated address */
-10: ldd [%g2], %l0
- ldd [%g2+8], %l2
- std %l0, [%g4]
- std %l2, [%g4+8]
- inc 16, %g2 ! src += 16
- cmp %g2, %g3
- bcs 10b ! while (src < end)
- inc 16, %g4 ! dst += 16
-
- clr %l0
- clr %l1
- clr %l2
- clr %l3
- clr %g2
-
-/* register g4 contain address to start
- * This means that BSS must be directly after data and code segments
- *
- * g3 is length of bss = (__bss_end-__bss_start)
- *
- */
-
- /* clear bss area (the relocated) */
-clr_bss:
- SPARC_LOAD_ADDRESS(__bss_start, l7, g2)
- SPARC_LOAD_ADDRESS(__bss_end, l7, g3)
- sub %g3,%g2,%g3 ! length of .bss area
- add %g3,%g4,%g3
- /* clearing 16byte a time ==> linker script need to align to 16 byte offset */
- clr %g1 /* std %g0 uses g0 and g1 */
-20:
- std %g0, [%g4]
- std %g0, [%g4+8]
- inc 16, %g4 ! ptr += 16
- cmp %g4, %g3
- bcs 20b ! while (ptr < end)
- nop
-
- /* add offsets to GOT table */
-fixup_got:
- SPARC_LOAD_ADDRESS(__got_start, l7, g4)
- add %g4, %g6, %g4
- SPARC_LOAD_ADDRESS(__got_end, l7, g3)
- add %g3, %g6, %g3
-30: ld [%g4], %l0 ! load old GOT-PTR
-#ifdef CONFIG_RELOC_GOT_SKIP_NULL
- cmp %l0, 0
- be 32f
-#endif
- add %l0, %g6, %l0 ! relocate GOT pointer
- st %l0, [%g4]
-32: inc 4, %g4 ! ptr += 4
- cmp %g4, %g3
- bcs 30b ! while (ptr < end)
- nop
-
-prom_relocate:
- SPARC_LOAD_ADDRESS(__prom_start, l7, g2)
- SPARC_LOAD_ADDRESS(__prom_end, l7, g3)
- /*
- * Calculated addres is stored in this variable by
- * reserve_prom() function in common/board_f.c
- */
- SPARC_LOAD_ADDRESS(__prom_start_reloc, l7, g4)
- ld [%g4], %g4
-
-40: ldd [%g2], %l0
- ldd [%g2+8], %l2
- std %l0, [%g4]
- std %l2, [%g4+8]
- inc 16, %g2
- cmp %g2, %g3
- bcs 40b
- inc 16, %g4
-
-! %o0 = stack pointer (relocated)
-! %o1 = global data pointer (relocated)
-! %o2 = text pointer (relocated)
-
-! %g6 = relocation offset
-! %l7 = _GLOBAL_OFFSET_TABLE_
-
-/* Trap table has been moved, lets tell CPU about
- * the new trap table address
- */
-update_trap_table_address:
- wr %g0, %o2, %tbr
- nop
- nop
- nop
-
-update_stack_pointers:
- mov %o0, %fp
- andn %fp, 0x0f, %fp ! align to 16 bytes
- add %fp, -64, %fp ! make space for a window push
- mov %fp, %sp ! setup stack pointer
-
-jump_board_init_r:
- mov %o1, %o0 ! relocated global data pointer
- mov %o2, %o1 ! relocated text pointer
- SPARC_LOAD_ADDRESS(board_init_r, l7, o3)
- add %o3, %g6, %o3 ! add relocation offset
- call %o3
- nop
-
-dead: ta 0 ! if call returns...
- nop
-
-!------------------------------------------------------------------------------
-
-/* Interrupt handler caller,
- * reg L7: interrupt number
- * reg L0: psr after interrupt
- * reg L1: PC
- * reg L2: next PC
- * reg L3: wim
- */
-_irq_entry:
- SAVE_ALL
-
- or %l0, PSR_PIL, %g2
- wr %g2, 0x0, %psr
- WRITE_PAUSE
- wr %g2, PSR_ET, %psr
- WRITE_PAUSE
- mov %l7, %o0 ! irq level
- set handler_irq, %o1
- set (CONFIG_SYS_RELOC_MONITOR_BASE-CONFIG_SYS_TEXT_BASE), %o2
- add %o1, %o2, %o1
- call %o1
- add %sp, SF_REGS_SZ, %o1 ! pt_regs ptr
- or %l0, PSR_PIL, %g2 ! restore PIL after handler_irq
- wr %g2, PSR_ET, %psr ! keep ET up
- WRITE_PAUSE
-
- RESTORE_ALL
-
-!------------------------------------------------------------------------------
-
-/*
- * Window overflow trap handler.
- */
- .global _window_overflow
-
-_window_overflow:
-
- mov %wim, %l3 ! Calculate next WIM
- mov %g1, %l7
- srl %l3, 1, %g1
- sll %l3, (CONFIG_SYS_SPARC_NWINDOWS-1), %l4
- or %l4, %g1, %g1
-
- save ! Get into window to be saved.
- mov %g1, %wim
- nop; nop; nop
- st %l0, [%sp + 0];
- st %l1, [%sp + 4];
- st %l2, [%sp + 8];
- st %l3, [%sp + 12];
- st %l4, [%sp + 16];
- st %l5, [%sp + 20];
- st %l6, [%sp + 24];
- st %l7, [%sp + 28];
- st %i0, [%sp + 32];
- st %i1, [%sp + 36];
- st %i2, [%sp + 40];
- st %i3, [%sp + 44];
- st %i4, [%sp + 48];
- st %i5, [%sp + 52];
- st %i6, [%sp + 56];
- st %i7, [%sp + 60];
- restore ! Go back to trap window.
- mov %l7, %g1
- jmp %l1 ! Re-execute save.
- rett %l2
-
-/*
- * Window underflow trap handler.
- */
- .global _window_underflow
-
-_window_underflow:
-
- mov %wim, %l3 ! Calculate next WIM
- sll %l3, 1, %l4
- srl %l3, (CONFIG_SYS_SPARC_NWINDOWS-1), %l5
- or %l5, %l4, %l5
- mov %l5, %wim
- nop; nop; nop
- restore ! Two restores to get into the
- restore ! window to restore
- ld [%sp + 0], %l0; ! Restore window from the stack
- ld [%sp + 4], %l1;
- ld [%sp + 8], %l2;
- ld [%sp + 12], %l3;
- ld [%sp + 16], %l4;
- ld [%sp + 20], %l5;
- ld [%sp + 24], %l6;
- ld [%sp + 28], %l7;
- ld [%sp + 32], %i0;
- ld [%sp + 36], %i1;
- ld [%sp + 40], %i2;
- ld [%sp + 44], %i3;
- ld [%sp + 48], %i4;
- ld [%sp + 52], %i5;
- ld [%sp + 56], %i6;
- ld [%sp + 60], %i7;
- save ! Get back to the trap window.
- save
- jmp %l1 ! Re-execute restore.
- rett %l2
-
-!------------------------------------------------------------------------------
-
-_nmi_trap:
- nop
- jmp %l1
- rett %l2
-
-_hwerr:
- ta 0
- nop
- nop
- b _hwerr ! loop infinite
- nop
-
-/* Registers to not touch at all. */
-#define t_psr l0 /* Set by caller */
-#define t_pc l1 /* Set by caller */
-#define t_npc l2 /* Set by caller */
-#define t_wim l3 /* Set by caller */
-#define t_twinmask l4 /* Set at beginning of this entry routine. */
-#define t_kstack l5 /* Set right before pt_regs frame is built */
-#define t_retpc l6 /* If you change this, change winmacro.h header file */
-#define t_systable l7 /* Never touch this, could be the syscall table ptr. */
-#define curptr g6 /* Set after pt_regs frame is built */
-
-trap_setup:
-/* build a pt_regs trap frame. */
- sub %fp, (SF_REGS_SZ + PT_REGS_SZ), %t_kstack
- PT_STORE_ALL(t_kstack, t_psr, t_pc, t_npc, g2)
-
- /* See if we are in the trap window. */
- mov 1, %t_twinmask
- sll %t_twinmask, %t_psr, %t_twinmask ! t_twinmask = (1 << psr)
- andcc %t_twinmask, %t_wim, %g0
- beq 1f ! in trap window, clean up
- nop
-
- /*-------------------------------------------------
- * Spill , adjust %wim and go.
- */
- srl %t_wim, 0x1, %g2 ! begin computation of new %wim
-
- set (CONFIG_SYS_SPARC_NWINDOWS-1), %g3 !NWINDOWS-1
-
- sll %t_wim, %g3, %t_wim ! NWINDOWS-1
- or %t_wim, %g2, %g2
- and %g2, 0xff, %g2
-
- save %g0, %g0, %g0 ! get in window to be saved
-
- /* Set new %wim value */
- wr %g2, 0x0, %wim
-
- /* Save the kernel window onto the corresponding stack. */
- RW_STORE(sp)
-
- restore %g0, %g0, %g0
- /*-------------------------------------------------*/
-
-1:
- /* Trap from kernel with a window available.
- * Just do it...
- */
- jmpl %t_retpc + 0x8, %g0 ! return to caller
- mov %t_kstack, %sp ! jump onto new stack
-
-#define twin_tmp1 l4
-#define glob_tmp g4
-#define curptr g6
-ret_trap_entry:
- wr %t_psr, 0x0, %psr ! enable nesting again, clear ET
-
- /* Will the rett land us in the invalid window? */
- mov 2, %g1
- sll %g1, %t_psr, %g1
-
- set CONFIG_SYS_SPARC_NWINDOWS, %g2 !NWINDOWS
-
- srl %g1, %g2, %g2
- or %g1, %g2, %g1
- rd %wim, %g2
- andcc %g2, %g1, %g0
- be 1f ! Nope, just return from the trap
- sll %g2, 0x1, %g1
-
- /* We have to grab a window before returning. */
- set (CONFIG_SYS_SPARC_NWINDOWS-1), %g3 !NWINDOWS-1
-
- srl %g2, %g3, %g2
- or %g1, %g2, %g1
- and %g1, 0xff, %g1
-
- wr %g1, 0x0, %wim
-
- /* Grrr, make sure we load from the right %sp... */
- PT_LOAD_ALL(sp, t_psr, t_pc, t_npc, g1)
-
- restore %g0, %g0, %g0
- RW_LOAD(sp)
- b 2f
- save %g0, %g0, %g0
-
- /* Reload the entire frame in case this is from a
- * kernel system call or whatever...
- */
-1:
- PT_LOAD_ALL(sp, t_psr, t_pc, t_npc, g1)
-2:
- wr %t_psr, 0x0, %psr
- nop;
- nop;
- nop
-
- jmp %t_pc
- rett %t_npc
-
-/* This is called from relocated C-code.
- * It resets the system by jumping to _start
- */
-_reset_reloc:
- set start, %l0
- call %l0
- nop
projects / people / ms / u-boot.git / blobdiff