URL
https://opencores.org/ocsvn/or1k/or1k/trunk
Subversion Repositories or1k
[/] [or1k/] [trunk/] [linux/] [linux-2.4/] [arch/] [sparc64/] [kernel/] [rtrap.S] - Rev 1765
Compare with Previous | Blame | View Log
/* $Id: rtrap.S,v 1.1.1.1 2004-04-15 01:34:22 phoenix Exp $* rtrap.S: Preparing for return from trap on Sparc V9.** Copyright (C) 1997,1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)* Copyright (C) 1997 David S. Miller (davem@caip.rutgers.edu)*/#include <asm/asi.h>#include <asm/pstate.h>#include <asm/ptrace.h>#include <asm/spitfire.h>#include <asm/head.h>#include <asm/visasm.h>#include <asm/processor.h>#define RTRAP_PSTATE (PSTATE_RMO|PSTATE_PEF|PSTATE_PRIV|PSTATE_IE)#define RTRAP_PSTATE_IRQOFF (PSTATE_RMO|PSTATE_PEF|PSTATE_PRIV)#define RTRAP_PSTATE_AG_IRQOFF (PSTATE_RMO|PSTATE_PEF|PSTATE_PRIV|PSTATE_AG)/* Register %l6 keeps track of whether we are returning* from a system call or not. It is cleared if we call* do_signal, and it must not be otherwise modified until* we fully commit to returning to userspace.*/.text.align 32__handle_softirq:call do_softirqnopba,a,pt %xcc, __handle_softirq_continuenop__handle_preemption:call schedulewrpr %g0, RTRAP_PSTATE, %pstateba,pt %xcc, __handle_preemption_continuewrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate__handle_user_windows:call fault_in_user_windowswrpr %g0, RTRAP_PSTATE, %pstatewrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate/* Redo sched+sig checks */ldx [%g6 + AOFF_task_need_resched], %l0brz,pt %l0, 1fnopcall schedulewrpr %g0, RTRAP_PSTATE, %pstatewrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate1: lduw [%g6 + AOFF_task_sigpending], %l0brz,pt %l0, __handle_user_windows_continuenopclr %o0mov %l5, %o2mov %l6, %o3add %sp, PTREGS_OFF, %o1call do_signalwrpr %g0, RTRAP_PSTATE, %pstatewrpr %g0, RTRAP_PSTATE_IRQOFF, %pstateclr %l6/* Signal delivery can modify pt_regs tstate, so we must* reload it.*/ldx [%sp + PTREGS_OFF + PT_V9_TSTATE], %l1sethi %hi(0xf << 20), %l4and %l1, %l4, %l4ba,pt %xcc, __handle_user_windows_continueandn %l1, %l4, %l1__handle_perfctrs:call update_perfctrswrpr %g0, RTRAP_PSTATE, %pstatewrpr %g0, RTRAP_PSTATE_IRQOFF, %pstateldub [%g6 + AOFF_task_thread + AOFF_thread_w_saved], %o2brz,pt %o2, 1fnop/* Redo userwin+sched+sig checks */call fault_in_user_windowswrpr %g0, RTRAP_PSTATE, %pstatewrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate1: ldx [%g6 + AOFF_task_need_resched], %l0brz,pt %l0, 1fnopcall schedulewrpr %g0, RTRAP_PSTATE, %pstatewrpr %g0, RTRAP_PSTATE_IRQOFF, %pstate1: lduw [%g6 + AOFF_task_sigpending], %l0brz,pt %l0, __handle_perfctrs_continuesethi %hi(TSTATE_PEF), %o0clr %o0mov %l5, %o2mov %l6, %o3add %sp, PTREGS_OFF, %o1call do_signalwrpr %g0, RTRAP_PSTATE, %pstatewrpr %g0, RTRAP_PSTATE_IRQOFF, %pstateclr %l6/* Signal delivery can modify pt_regs tstate, so we must* reload it.*/ldx [%sp + PTREGS_OFF + PT_V9_TSTATE], %l1sethi %hi(0xf << 20), %l4and %l1, %l4, %l4andn %l1, %l4, %l1ba,pt %xcc, __handle_perfctrs_continuesethi %hi(TSTATE_PEF), %o0__handle_userfpu:rd %fprs, %l5andcc %l5, FPRS_FEF, %g0sethi %hi(TSTATE_PEF), %o0be,a,pn %icc, __handle_userfpu_continueandn %l1, %o0, %l1ba,a,pt %xcc, __handle_userfpu_continue__handle_signal:clr %o0mov %l5, %o2mov %l6, %o3add %sp, PTREGS_OFF, %o1call do_signalwrpr %g0, RTRAP_PSTATE, %pstatewrpr %g0, RTRAP_PSTATE_IRQOFF, %pstateclr %l6/* Signal delivery can modify pt_regs tstate, so we must* reload it.*/ldx [%sp + PTREGS_OFF + PT_V9_TSTATE], %l1sethi %hi(0xf << 20), %l4and %l1, %l4, %l4ba,pt %xcc, __handle_signal_continueandn %l1, %l4, %l1.align 64.globl rtrap_clr_l6, rtrap, irqsz_patchme, rtrap_xcallrtrap_clr_l6: clr %l6rtrap: lduw [%g6 + AOFF_task_processor], %l0sethi %hi(irq_stat), %l2 ! &softirq_activeor %l2, %lo(irq_stat), %l2 ! &softirq_activeirqsz_patchme: sllx %l0, 0, %l0lduw [%l2 + %l0], %l1 ! softirq_pendingcmp %l1, 0/* mm/ultra.S:xcall_report_regs KNOWS about this load. */bne,pn %icc, __handle_softirqldx [%sp + PTREGS_OFF + PT_V9_TSTATE], %l1__handle_softirq_continue:rtrap_xcall:sethi %hi(0xf << 20), %l4andcc %l1, TSTATE_PRIV, %l3and %l1, %l4, %l4bne,pn %icc, to_kernelandn %l1, %l4, %l1/* We must hold IRQs off and atomically test schedule+signal* state, then hold them off all the way back to userspace.* If we are returning to kernel, none of this matters.** If we do not do this, there is a window where we would do* the tests, later the signal/resched event arrives but we do* not process it since we are still in kernel mode. It would* take until the next local IRQ before the signal/resched* event would be handled.** This also means that if we have to deal with performance* counters or user windows, we have to redo all of these* sched+signal checks with IRQs disabled.*/to_user: wrpr %g0, RTRAP_PSTATE_IRQOFF, %pstatewrpr 0, %pil__handle_preemption_continue:ldx [%g6 + AOFF_task_need_resched], %l0brnz,pn %l0, __handle_preemptionlduw [%g6 + AOFF_task_sigpending], %l0brnz,pn %l0, __handle_signalnop__handle_signal_continue:ldub [%g6 + AOFF_task_thread + AOFF_thread_w_saved], %o2brnz,pn %o2, __handle_user_windowsnop__handle_user_windows_continue:ldub [%g6 + AOFF_task_thread + AOFF_thread_flags], %l5andcc %l5, SPARC_FLAG_PERFCTR, %g0sethi %hi(TSTATE_PEF), %o0bne,pn %xcc, __handle_perfctrs__handle_perfctrs_continue:andcc %l1, %o0, %g0/* This fpdepth clear is neccessary for non-syscall rtraps only */bne,pn %xcc, __handle_userfpustb %g0, [%g6 + AOFF_task_thread + AOFF_thread_fpdepth]__handle_userfpu_continue:rt_continue: ldx [%sp + PTREGS_OFF + PT_V9_G1], %g1ldx [%sp + PTREGS_OFF + PT_V9_G2], %g2ldx [%sp + PTREGS_OFF + PT_V9_G3], %g3ldx [%sp + PTREGS_OFF + PT_V9_G4], %g4ldx [%sp + PTREGS_OFF + PT_V9_G5], %g5ldx [%sp + PTREGS_OFF + PT_V9_G6], %g6ldx [%sp + PTREGS_OFF + PT_V9_G7], %g7wrpr %g0, RTRAP_PSTATE_AG_IRQOFF, %pstateldx [%sp + PTREGS_OFF + PT_V9_I0], %i0ldx [%sp + PTREGS_OFF + PT_V9_I1], %i1ldx [%sp + PTREGS_OFF + PT_V9_I2], %i2ldx [%sp + PTREGS_OFF + PT_V9_I3], %i3ldx [%sp + PTREGS_OFF + PT_V9_I4], %i4ldx [%sp + PTREGS_OFF + PT_V9_I5], %i5ldx [%sp + PTREGS_OFF + PT_V9_I6], %i6ldx [%sp + PTREGS_OFF + PT_V9_I7], %i7ldx [%sp + PTREGS_OFF + PT_V9_TPC], %l2ldx [%sp + PTREGS_OFF + PT_V9_TNPC], %o2ld [%sp + PTREGS_OFF + PT_V9_Y], %o3wr %o3, %g0, %ysrl %l4, 20, %l4wrpr %l4, 0x0, %pilwrpr %g0, 0x1, %tlwrpr %l1, %g0, %tstatewrpr %l2, %g0, %tpcwrpr %o2, %g0, %tnpcbrnz,pn %l3, kern_rttmov PRIMARY_CONTEXT, %l7ldxa [%l7 + %l7] ASI_DMMU, %l0stxa %l0, [%l7] ASI_DMMUflush %g6rdpr %wstate, %l1rdpr %otherwin, %l2srl %l1, 3, %l1wrpr %l2, %g0, %canrestorewrpr %l1, %g0, %wstatewrpr %g0, %g0, %otherwinrestorerdpr %canrestore, %g1wrpr %g1, 0x0, %cleanwinretrynopkern_rtt: restoreretryto_kernel: ldub [%g6 + AOFF_task_thread + AOFF_thread_fpdepth], %l5brz,pt %l5, rt_continuesrl %l5, 1, %o0add %g6, AOFF_task_thread + AOFF_thread_fpsaved, %l6ldub [%l6 + %o0], %l2sub %l5, 2, %l5add %g6, AOFF_task_thread + AOFF_thread_gsr, %o1andcc %l2, (FPRS_FEF|FPRS_DU), %g0be,pt %icc, 2fand %l2, FPRS_DL, %l6andcc %l2, FPRS_FEF, %g0be,pn %icc, 5fsll %o0, 3, %o5rd %fprs, %g5wr %g5, FPRS_FEF, %fprsldx [%o1 + %o5], %g5add %g6, AOFF_task_thread + AOFF_thread_xfsr, %o1membar #StoreLoad | #LoadLoadsll %o0, 8, %o2add %g6, AOFF_task_fpregs, %o3brz,pn %l6, 1fadd %g6, AOFF_task_fpregs+0x40, %o4ldda [%o3 + %o2] ASI_BLK_P, %f0ldda [%o4 + %o2] ASI_BLK_P, %f161: andcc %l2, FPRS_DU, %g0be,pn %icc, 1fwr %g5, 0, %gsradd %o2, 0x80, %o2ldda [%o3 + %o2] ASI_BLK_P, %f32ldda [%o4 + %o2] ASI_BLK_P, %f481: membar #Syncldx [%o1 + %o5], %fsr2: stb %l5, [%g6 + AOFF_task_thread + AOFF_thread_fpdepth]ba,pt %xcc, rt_continuenop5: wr %g0, FPRS_FEF, %fprsmembar #StoreLoad | #LoadLoadsll %o0, 8, %o2add %g6, AOFF_task_fpregs+0x80, %o3add %g6, AOFF_task_fpregs+0xc0, %o4ldda [%o3 + %o2] ASI_BLK_P, %f32ldda [%o4 + %o2] ASI_BLK_P, %f48membar #Syncwr %g0, FPRS_DU, %fprsba,pt %xcc, rt_continuestb %l5, [%g6 + AOFF_task_thread + AOFF_thread_fpdepth]