newlib-cygwin/libgloss/sparc_leon/regwinflush.S

286 lines
6.5 KiB
ArmAsm
Raw Normal View History

2011-12-15 Konrad Eisele <konrad@gaisler.com> * configure.in: Add SPARC LEON support. * configure: Regenerated. * sparc_leon/asm-leon/amba.h, sparc_leon/asm-leon/asmmacro.h, sparc_leon/asm-leon/clock.h, sparc_leon/asm-leon/contextswitch.h, sparc_leon/asm-leon/elfmacro.h, sparc_leon/asm-leon/head.h, sparc_leon/asm-leon/irq.h, sparc_leon/asm-leon/jiffies.h, sparc_leon/asm-leon/lambapp.h, sparc_leon/asm-leon/lambapp_devs.h, sparc_leon/asm-leon/leon.h, sparc_leon/asm-leon/leon3.h, sparc_leon/asm-leon/leonbare_debug.h, sparc_leon/asm-leon/leonbare_kernel.h, sparc_leon/asm-leon/leonbare_kernel_queue.h, sparc_leon/asm-leon/leoncompat.h, sparc_leon/asm-leon/leondbg.h, sparc_leon/asm-leon/leonstack.h, sparc_leon/asm-leon/liblocks.h, sparc_leon/asm-leon/linkage.h, sparc_leon/asm-leon/param.h, sparc_leon/asm-leon/queue.h, sparc_leon/asm-leon/spinlock.h, sparc_leon/asm-leon/stack.h, sparc_leon/asm-leon/time.h, sparc_leon/asm-leon/timer.h, sparc_leon/asm-leon/types.h, sparc_leon/asm-leon/winmacros.h: New file. * sparc_leon/Makefile.in, sparc_leon/_exit.c, sparc_leon/amba.c, sparc_leon/amba_dbg.c, sparc_leon/amba_driver.c, sparc_leon/amba_scan.c, sparc_leon/asm-leon, sparc_leon/bdinit.S, sparc_leon/busscan.S, sparc_leon/cacheA.S, sparc_leon/catch_interrupt.c, sparc_leon/catch_interrupt_mvt.c, sparc_leon/catch_interrupt_pending.c, sparc_leon/catch_interrupt_svt.c, sparc_leon/configure.in, sparc_leon/console.c, sparc_leon/console_dbg.c, sparc_leon/console_init.c, sparc_leon/contextswitch.c, sparc_leon/contextswitch_asm.S, sparc_leon/crt0.S, sparc_leon/crti.S, sparc_leon/crtn.S, sparc_leon/etrap.S, sparc_leon/etrap_fast.S, sparc_leon/fpu.S, sparc_leon/gettimeofday.c, sparc_leon/initcalls.c, sparc_leon/io.c, sparc_leon/irqinstall.S, sparc_leon/irqtrap.S, sparc_leon/irqtrap_fast.S, sparc_leon/jiffies.c, sparc_leon/kernel.c, sparc_leon/kernel_context.S, sparc_leon/kernel_debug.c, sparc_leon/kernel_debug_var.c, sparc_leon/kernel_mm.c, sparc_leon/kernel_mutex.c, sparc_leon/kernel_queue.c, sparc_leon/kernel_sched.c, sparc_leon/kernel_thread.c, sparc_leon/lcpuinit.S, sparc_leon/locore.S, sparc_leon/locore_atexit.c, sparc_leon/locore_clean.S, sparc_leon/locore_mvt.S, sparc_leon/locore_mvt_reset.S, sparc_leon/locore_svt.S, sparc_leon/locore_svt_reset.S, sparc_leon/locore_svtdisp.S, sparc_leon/locore_var.S, sparc_leon/locore_var_svt.S, sparc_leon/mmu_asm.S, sparc_leon/mutex.c, sparc_leon/nocache.S, sparc_leon/pnpinit.c, sparc_leon/pnpinit_malloc.c, sparc_leon/pnpinit_simple.c, sparc_leon/regwin.S, sparc_leon/regwin_patch.c, sparc_leon/regwin_slow.S, sparc_leon/regwinflush.S, sparc_leon/rtc.c, sparc_leon/rtrap.S, sparc_leon/rtrap_fast.S, sparc_leon/stop.S, sparc_leon/timer.c, sparc_leon/times.c: New file * sparc_leon/configure: Regenerate
2011-12-16 06:58:40 +08:00
/*
* 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