diff options
Diffstat (limited to 'libgloss/sparc_leon/regwinflush.S')
| -rw-r--r-- | libgloss/sparc_leon/regwinflush.S | 285 |
1 files changed, 285 insertions, 0 deletions
diff --git a/libgloss/sparc_leon/regwinflush.S b/libgloss/sparc_leon/regwinflush.S new file mode 100644 index 000000000..b21454c98 --- /dev/null +++ b/libgloss/sparc_leon/regwinflush.S @@ -0,0 +1,285 @@ +/* + * Copyright (c) 2011 Aeroflex Gaisler + * + * BSD license: + * + * Permission is hereby granted, free of charge, to any person obtaining a copy + * of this software and associated documentation files (the "Software"), to deal + * in the Software without restriction, including without limitation the rights + * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell + * copies of the Software, and to permit persons to whom the Software is + * furnished to do so, subject to the following conditions: + * + * The above copyright notice and this permission notice shall be included in + * all copies or substantial portions of the Software. + * + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR + * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, + * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL + * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER + * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, + * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN + * THE SOFTWARE. + */ + + +#include <asm-leon/leon.h> +#include <asm-leon/leonstack.h> +#include <asm-leon/asmmacro.h> + + .seg "data" + .global _lb_spillglobals, _lb_issideflush + .align 4 +_lb_spillglobals: + .word 0 + .word 0 + .word 0 + .word 0 + .word 0 + .word 0 + .word 0 +_lb_issideflush: + .word 0 /* off: 28 */ + + .seg "text" + +/* =============================================== */ + +#define _SV save %sp, -SF_REGS_SZ, %sp +#define _RS restore + + /* ------- */ + .weak _flush_windows + .set _flush_windows,__flush_windows + .weak _flush_windows_svt + .set _flush_windows_svt,__flush_windows_svt + /* ------- */ + !.global _flush_windows,_flush_windows_svt +__flush_windows_svt: + rd %wim, %l3 + +__flush_windows: + SAVE_ALL + +#ifndef _FLAT + + set _lb_issideflush, %l3 + st %l0, [%l3] /* mark as inside flush */ + + wr %l0, SPARC_PSR_ET_MASK, %psr + nop; nop; nop + + _SV; _SV; _SV; _SV; _SV; _SV; _SV; + _RS; _RS; _RS; _RS; _RS; _RS; _RS; + + set _lb_issideflush, %l3 + st %g0, [%l3] /* mark as outside flush */ + + /* Advance over the trap instruction. */ + ld [%sp + SF_REGS_SZ + PT_NPC], %l1 + add %l1, 0x4, %l2 + st %l1, [%sp + SF_REGS_SZ + PT_PC] + st %l2, [%sp + SF_REGS_SZ + PT_NPC] +#endif + + RESTORE_ALL + +/* =============================================== */ + +_irqcall_flush_windows: +#ifndef _FLAT + set _lb_spillglobals,%l4 + st %g1,[%l4+0] + st %g4,[%l4+4] + st %l0,[%l4+16] + st %l1,[%l4+20] + st %l2,[%l4+24] + st %l4,[%l4+28] /* mark as inside flush */ + + restore + + mov %psr, %g1 + or %g1, SPARC_PSR_PIL_MASK, %g1 + wr %g1, SPARC_PSR_ET_MASK, %psr /* disable irq, enable traps */ + nop + nop + nop + + sethi %hi(_nwindows_min1), %g4 /* flush registers */ + ld [%g4+%lo(_nwindows_min1)], %g4 +1: save /* NWINDOWS-1 times */ + sub %g4,1,%g4 + + /*****************/ + andncc %g4,0xff,%g0 + be .lab1 + nop + nop + +.lab1: /*****************/ + + cmp %g4,%g0 + bne 1b + nop + + sethi %hi(_nwindows_min1), %g4 + ld [%g4+%lo(_nwindows_min1)], %g4 +2: restore /* NWINDOWS-1 times */ + + /*****************/ + andncc %g4,0xff,%g0 + be .lab2 + nop + nop + +.lab2: /*****************/ + + sub %g4,1,%g4 + cmp %g4,%g0 + bne 2b + nop + + save + + set _lb_spillglobals,%l4 + ld [%l4+4], %g4 + ld [%l4+0], %g1 + ld [%l4+16],%l0 + ld [%l4+20],%l1 + ld [%l4+24],%l2 + st %g0,[%l4+28] /* clean inside flush mark */ + +#endif + + wr %l0, 0, %psr /* restore psr */ + nop + nop + nop + + jmpl %l2, %g0 + rett %l2 + 4 + +/* =============================================== */ + + /* ------- */ + .weak _irqcall_disableirq + .set _irqcall_disableirq,__irqcall_disableirq + .weak _irqcall_disableirq_svt + .set _irqcall_disableirq_svt,__irqcall_disableirq_svt + /* ------- */ + +__irqcall_disableirq: +__irqcall_disableirq_svt: + or %l0, SPARC_PSR_PIL_MASK, %l0 + mov %l0, %psr + nop; nop; nop + jmpl %l2, %g0 + rett %l2 + 4 + +/* =============================================== */ + + /* + * system call (ta 0x2): + * 2: irq_disable: + * o1 = 2 + * 3: irq_enable: + * o0 = old_flags + * o1 = 3 + * 4: enter supervisor mode (from user mode): + * o1 = 4 + * 5: enter user mode: + * o1 = 5 + * 6: flush windows + * + * On entry: + * + * l0 = psr (from trap table) + * l1 = pc + * l2 = npc + * i0 = system call id + */ + + /* ------- */ + .weak _irqcall + .set _irqcall,__irqcall + .weak _irqcall_svt + .set _irqcall_svt,__irqcall_svt + /* ------- */ + !.global _irqcall,_irqcall_svt +__irqcall_svt: +__irqcall: + + subcc %i1, 2, %g0 ! syscall 2, disable interrupts + bne 3f + or %l0, 0x0f00, %l4 ! set PIL=15 + mov %l4, %psr + or %l0, SPARC_PSR_ET_MASK, %i0 ! return old psr with ET=1 + ba,a 9f +3: + subcc %i1, 3, %g0 ! syscall 3, enable interrupts + bne 4f + and %i0, SPARC_PSR_PIL_MASK, %l4 + andn %l0, SPARC_PSR_PIL_MASK, %l5 + or %l5, %l4, %l4 + mov %l4, %psr + ba,a 9f +4: + subcc %i1, 4, %g0 ! syscall 4, enter supervisor + bne 5f + + mov %psr, %l4 + or %l4,SPARC_PSR_PS_MASK,%l4 + mov %l4, %psr ! set previous supervisor %psr + nop; nop; nop + ba,a 9f + +5: + subcc %i1, 5, %g0 ! syscall 5, enter user + bne 6f + + mov %psr, %l4 + andn %l4,SPARC_PSR_PS_MASK,%l4 + mov %l4, %psr ! clear previous supervisor %psr, return to user mode + nop; nop; nop + ba,a 9f + +6: + subcc %i1, 6, %g0 ! syscall 6, flush windows + bne 1f + nop + + ba,a _irqcall_flush_windows + +1: + ta 0 ! halt +9: ! leave + jmpl %l2, %g0 + rett %l2 + 4 + +/* =============================================== */ + + /* call _irqcall through trap */ + .global leonbare_enable_traps !void leonbare_enable_traps(unsigned long old_flags); +leonbare_enable_traps: + set 3,%o1 + retl + ta 0x2 + +/* =============================================== */ + + /* call _irqcall through trap */ + .global leonbare_disable_traps !unsigned long leonbare_disable_traps(); +leonbare_disable_traps: + set 2,%o1 + retl + ta 0x2 + +/* =============================================== */ + + /* flush all windows */ + .global leonbare_flush_windows !void leonbare_flush_windows(); +leonbare_flush_windows: + set 6,%o1 + retl + ta 0x2 + |