Use common switch / setfault / trampoline code. (except amigappc because
it doesn't use trap_subr.S either).
This commit is contained in:
matt
parent
cd7c0ee5c4
commit
af212d3fda
@ -1,4 +1,4 @@
|
||||
/* $NetBSD: locore.s,v 1.20 2000/12/04 17:05:50 tsubai Exp $ */
|
||||
/* $NetBSD: locore.s,v 1.21 2001/02/25 20:34:24 matt Exp $ */
|
||||
/* $OpenBSD: locore.S,v 1.4 1997/01/26 09:06:38 rahnds Exp $ */
|
||||
|
||||
/*
|
||||
@ -179,268 +179,6 @@ __start_cpu0:
|
||||
bl _C_LABEL(main)
|
||||
|
||||
loop: b loop /* XXX not reached */
|
||||
/*
|
||||
* No processes are runnable, so loop waiting for one.
|
||||
* Separate label here for accounting purposes.
|
||||
* When we get here, interrupts are off (MSR[EE]=0) and sched_lock is held.
|
||||
*/
|
||||
ASENTRY(Idle)
|
||||
lis 8,_C_LABEL(sched_whichqs)@ha
|
||||
lwz 9,_C_LABEL(sched_whichqs)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
bne- .Lsw1 /* at least one queue non-empty */
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
mfmsr 3
|
||||
ori 3,3,PSL_EE@l /* reenable ints again */
|
||||
mtmsr 3
|
||||
isync
|
||||
|
||||
/* May do some power saving here? */
|
||||
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
manipulating runque */
|
||||
mtmsr 3
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
b _ASM_LABEL(Idle)
|
||||
|
||||
/*
|
||||
* switchexit gets called from cpu_exit to complete the exit procedure.
|
||||
*/
|
||||
ENTRY(switchexit)
|
||||
/* First switch to the idle pcb/kernel stack */
|
||||
lis 6,idle_u@ha
|
||||
lwz 6,idle_u@l(6)
|
||||
lis 7,_C_LABEL(curpcb)@ha
|
||||
stw 6,_C_LABEL(curpcb)@l(7)
|
||||
addi 1,6,USPACE-16 /* 16 bytes are reserved at stack top */
|
||||
/*
|
||||
* Schedule the vmspace and stack to be freed (the proc arg is
|
||||
* already in r3).
|
||||
*/
|
||||
bl _C_LABEL(exit2)
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
|
||||
/* Fall through to cpu_switch to actually select another proc */
|
||||
li 3,0 /* indicate exited process */
|
||||
|
||||
/*
|
||||
* void cpu_switch(struct proc *p)
|
||||
* Find a runnable process and switch to it.
|
||||
*/
|
||||
/* XXX noprofile? --thorpej@netbsd.org */
|
||||
ENTRY(cpu_switch)
|
||||
mflr 0 /* save lr */
|
||||
stw 0,4(1)
|
||||
stwu 1,-16(1)
|
||||
stw 31,12(1)
|
||||
stw 30,8(1)
|
||||
|
||||
mr 30,3
|
||||
lis 3,_C_LABEL(curproc)@ha
|
||||
xor 31,31,31
|
||||
stw 31,_C_LABEL(curproc)@l(3) /* Zero to not accumulate cpu time */
|
||||
lis 3,_C_LABEL(curpcb)@ha
|
||||
lwz 31,_C_LABEL(curpcb)@l(3)
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
/* Release the sched_lock before processing interrupts. */
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
xor 3,3,3
|
||||
bl _C_LABEL(lcsplx)
|
||||
stw 3,PCB_SPL(31) /* save spl */
|
||||
|
||||
/* Lock the scheduler. */
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
manipulating runque */
|
||||
mtmsr 3
|
||||
isync
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
|
||||
/* Find a new process */
|
||||
lis 8,_C_LABEL(sched_whichqs)@ha
|
||||
lwz 9,_C_LABEL(sched_whichqs)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
beq- _ASM_LABEL(Idle) /* all queues empty */
|
||||
.Lsw1:
|
||||
cntlzw 10,9
|
||||
lis 4,_C_LABEL(sched_qs)@ha
|
||||
addi 4,4,_C_LABEL(sched_qs)@l
|
||||
slwi 3,10,3
|
||||
add 3,3,4 /* select queue */
|
||||
|
||||
lwz 31,P_FORW(3) /* unlink first proc from queue */
|
||||
lwz 4,P_FORW(31)
|
||||
stw 4,P_FORW(3)
|
||||
stw 3,P_BACK(4)
|
||||
|
||||
cmpl 0,3,4 /* queue empty? */
|
||||
bne 1f
|
||||
|
||||
lis 3,0x80000000@h
|
||||
srw 3,3,10
|
||||
andc 9,9,3
|
||||
stw 9,_C_LABEL(sched_whichqs)@l(8) /* mark it empty */
|
||||
|
||||
1:
|
||||
/* just did this resched thing */
|
||||
xor 3,3,3
|
||||
lis 4,_C_LABEL(want_resched)@ha
|
||||
stw 3,_C_LABEL(want_resched)@l(4)
|
||||
|
||||
stw 3,P_BACK(31) /* probably superfluous */
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
/* Unlock the sched_lock, but leave interrupts off, for now. */
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
#if defined(MULTIPROCESSOR)
|
||||
/*
|
||||
* XXXSMP
|
||||
* p->p_cpu = curcpu();
|
||||
*/
|
||||
#endif
|
||||
|
||||
/* Process now running on a processor. */
|
||||
li 3,SONPROC /* p->p_stat = SONPROC */
|
||||
stb 3,P_STAT(31)
|
||||
|
||||
/* record new process */
|
||||
lis 4,_C_LABEL(curproc)@ha
|
||||
stw 31,_C_LABEL(curproc)@l(4)
|
||||
|
||||
mfmsr 3
|
||||
ori 3,3,PSL_EE@l /* Now we can interrupt again */
|
||||
mtmsr 3
|
||||
|
||||
cmpl 0,31,30 /* is it the same process? */
|
||||
beq switch_return
|
||||
|
||||
or. 30,30,30 /* old process was exiting? */
|
||||
beq switch_exited
|
||||
|
||||
mfsr 10,USER_SR /* save USER_SR for copyin/copyout */
|
||||
mfcr 11 /* save cr */
|
||||
mr 12,2 /* save r2 */
|
||||
stwu 1,-SFRAMELEN(1) /* still running on old stack */
|
||||
stmw 10,8(1)
|
||||
lwz 3,P_ADDR(30)
|
||||
stw 1,PCB_SP(3) /* save SP */
|
||||
|
||||
switch_exited:
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
actually switching */
|
||||
mtmsr 3
|
||||
|
||||
/* indicate new pcb */
|
||||
lwz 4,P_ADDR(31)
|
||||
lis 5,_C_LABEL(curpcb)@ha
|
||||
stw 4,_C_LABEL(curpcb)@l(5)
|
||||
|
||||
/* save real pmap pointer for spill fill */
|
||||
lwz 5,PCB_PMR(4)
|
||||
lis 6,_C_LABEL(curpm)@ha
|
||||
stwu 5,_C_LABEL(curpm)@l(6)
|
||||
stwcx. 5,0,6 /* clear possible reservation */
|
||||
|
||||
addic. 5,5,64
|
||||
li 6,0
|
||||
mfsr 8,KERNEL_SR /* save kernel SR */
|
||||
1:
|
||||
addis 6,6,-0x10000000@ha /* set new procs segment registers */
|
||||
or. 6,6,6 /* This is done from the real
|
||||
address pmap */
|
||||
lwzu 7,-4(5) /* so we don't have to worry */
|
||||
mtsrin 7,6 /* about accessibility */
|
||||
bne 1b
|
||||
mtsr KERNEL_SR,8 /* restore kernel SR */
|
||||
isync
|
||||
|
||||
lwz 1,PCB_SP(4) /* get new procs SP */
|
||||
|
||||
ori 3,3,PSL_EE@l /* interrupts are okay again */
|
||||
mtmsr 3
|
||||
|
||||
lmw 10,8(1) /* get other regs */
|
||||
lwz 1,0(1) /* get saved SP */
|
||||
mr 2,12 /* get saved r2 */
|
||||
mtcr 11 /* get saved cr */
|
||||
isync
|
||||
mtsr USER_SR,10 /* get saved USER_SR */
|
||||
isync
|
||||
|
||||
switch_return:
|
||||
mr 30,7 /* save proc pointer */
|
||||
lwz 3,PCB_SPL(4)
|
||||
bl _C_LABEL(lcsplx)
|
||||
|
||||
mr 3,30 /* get curproc for special fork
|
||||
returns */
|
||||
|
||||
lwz 31,12(1)
|
||||
lwz 30,8(1)
|
||||
addi 1,1,16
|
||||
lwz 0,4(1)
|
||||
mtlr 0
|
||||
blr
|
||||
|
||||
/*
|
||||
* Child comes here at the end of a fork.
|
||||
* Return to userspace via the trap return path.
|
||||
*/
|
||||
.globl _C_LABEL(fork_trampoline)
|
||||
_C_LABEL(fork_trampoline):
|
||||
xor 3,3,3
|
||||
bl _C_LABEL(lcsplx)
|
||||
mtlr 31
|
||||
mr 3,30
|
||||
blrl /* jump indirect to r31 */
|
||||
b trapexit
|
||||
|
||||
/*
|
||||
* Pull in common trap vector code.
|
||||
*/
|
||||
#include <powerpc/powerpc/trap_subr.S>
|
||||
|
||||
/*
|
||||
* int setfault()
|
||||
*
|
||||
* Similar to setjmp to setup for handling faults on accesses to user memory.
|
||||
* Any routine using this may only call bcopy, either the form below,
|
||||
* or the (currently used) C code optimized, so it doesn't use any non-volatile
|
||||
* registers.
|
||||
*/
|
||||
.globl _C_LABEL(setfault)
|
||||
_C_LABEL(setfault):
|
||||
mflr 0
|
||||
mfcr 12
|
||||
lis 4,_C_LABEL(curpcb)@ha
|
||||
lwz 4,_C_LABEL(curpcb)@l(4)
|
||||
stw 3,PCB_FAULT(4)
|
||||
stw 0,0(3)
|
||||
stw 1,4(3)
|
||||
stw 2,8(3)
|
||||
stmw 12,12(3)
|
||||
xor 3,3,3
|
||||
blr
|
||||
|
||||
.globl _C_LABEL(enable_intr)
|
||||
_C_LABEL(enable_intr):
|
||||
@ -462,3 +200,13 @@ _C_LABEL(debug_led):
|
||||
ori 4, 4, 0x0c00
|
||||
stb 3, 0(4)
|
||||
blr
|
||||
/*
|
||||
* Pull in common switch & setfault code.
|
||||
*/
|
||||
#include <powerpc/powerpc/locore_subr.S>
|
||||
|
||||
/*
|
||||
* Pull in common trap vector code.
|
||||
*/
|
||||
#include <powerpc/powerpc/trap_subr.S>
|
||||
|
||||
|
||||
@ -1,4 +1,4 @@
|
||||
/* $NetBSD: locore.S,v 1.35 2001/01/01 05:23:17 tsubai Exp $ */
|
||||
/* $NetBSD: locore.S,v 1.36 2001/02/25 20:34:24 matt Exp $ */
|
||||
|
||||
/*
|
||||
* Copyright (C) 1995, 1996 Wolfgang Solfrank.
|
||||
@ -109,9 +109,6 @@ GLOBAL(eintrcnt)
|
||||
GLOBAL(ofmsr)
|
||||
.long 0 /* msr used in Open Firmware */
|
||||
|
||||
GLOBAL(powersave)
|
||||
.long 0
|
||||
|
||||
/*
|
||||
* File-scope for locore.S
|
||||
*/
|
||||
@ -347,340 +344,6 @@ ofw_back:
|
||||
mtlr 0
|
||||
blr
|
||||
|
||||
|
||||
/*
|
||||
* No processes are runnable, so loop waiting for one.
|
||||
* Separate label here for accounting purposes.
|
||||
* When we get here, interrupts are off (MSR[EE]=0) and sched_lock is held.
|
||||
*/
|
||||
ASENTRY(Idle)
|
||||
lis 8,_C_LABEL(sched_whichqs)@ha
|
||||
lwz 9,_C_LABEL(sched_whichqs)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
bne+ .Lsw1 /* at least one queue non-empty */
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
mfmsr 3
|
||||
ori 3,3,PSL_EE@l /* reenable ints again */
|
||||
mtmsr 3
|
||||
isync
|
||||
|
||||
/* Check if we can use power saving mode */
|
||||
lis 8,_C_LABEL(powersave)@ha
|
||||
lwz 9,_C_LABEL(powersave)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
beq 1f
|
||||
|
||||
sync
|
||||
oris 3,3,PSL_POW@h /* enter power saving mode */
|
||||
mtmsr 3
|
||||
isync
|
||||
1:
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
manipulating runque */
|
||||
mtmsr 3
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
b _ASM_LABEL(Idle)
|
||||
|
||||
/*
|
||||
* switchexit gets called from cpu_exit to complete the exit procedure.
|
||||
*/
|
||||
ENTRY(switchexit)
|
||||
/* First switch to the idle pcb/kernel stack */
|
||||
#if defined(MULTIPROCESSOR)
|
||||
GET_CPUINFO(7)
|
||||
lwz 6,CI_IDLE_PCB(7)
|
||||
stw 6,CI_CURPCB(7)
|
||||
#else
|
||||
lis 6,idle_u@ha
|
||||
lwz 6,idle_u@l(6)
|
||||
lis 7,_C_LABEL(curpcb)@ha
|
||||
stw 6,_C_LABEL(curpcb)@l(7)
|
||||
#endif
|
||||
addi 1,6,USPACE-16 /* 16 bytes are reserved at stack top */
|
||||
/*
|
||||
* Schedule the vmspace and stack to be freed (the proc arg is
|
||||
* already in r3).
|
||||
*/
|
||||
bl _C_LABEL(exit2)
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
|
||||
/* Fall through to cpu_switch to actually select another proc */
|
||||
li 3,0 /* indicate exited process */
|
||||
|
||||
/*
|
||||
* void cpu_switch(struct proc *p)
|
||||
* Find a runnable process and switch to it.
|
||||
*/
|
||||
/* XXX noprofile? --thorpej@netbsd.org */
|
||||
ENTRY(cpu_switch)
|
||||
mflr 0 /* save lr */
|
||||
stw 0,4(1)
|
||||
stwu 1,-16(1)
|
||||
stw 31,12(1)
|
||||
stw 30,8(1)
|
||||
|
||||
mr 30,3
|
||||
#if defined(MULTIPROCESSOR)
|
||||
/* Switch to the idle PCB unless we're already running on it. */
|
||||
GET_CPUINFO(7)
|
||||
cmpwi 30,0 /* old process was exiting? */
|
||||
beq 1f
|
||||
|
||||
mfsr 10,USER_SR /* save USER_SR for copyin/copyout */
|
||||
mfcr 11 /* save cr */
|
||||
mr 12,2 /* save r2 */
|
||||
stwu 1,-SFRAMELEN(1) /* still running on old stack */
|
||||
stmw 10,8(1)
|
||||
lwz 3,P_ADDR(30)
|
||||
stw 1,PCB_SP(3) /* save SP */
|
||||
|
||||
lwz 6,CI_IDLE_PCB(7)
|
||||
addi 1,6,USPACE-16 /* 16 bytes are reserved at stack top */
|
||||
|
||||
1:
|
||||
xor 31,31,31
|
||||
stw 31,CI_CURPROC(7) /* Zero to not accumulate cpu time */
|
||||
lwz 31,CI_CURPCB(7)
|
||||
|
||||
lwz 3,CI_CPL(7)
|
||||
stw 3,PCB_SPL(31) /* save spl */
|
||||
#else
|
||||
lis 3,_C_LABEL(curproc)@ha
|
||||
xor 31,31,31
|
||||
stw 31,_C_LABEL(curproc)@l(3) /* Zero to not accumulate cpu time */
|
||||
lis 3,_C_LABEL(curpcb)@ha
|
||||
lwz 31,_C_LABEL(curpcb)@l(3)
|
||||
#endif
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
/* Release the sched_lock before processing interrupts. */
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
xor 3,3,3
|
||||
bl _C_LABEL(lcsplx)
|
||||
#if !defined(MULTIPROCESSOR)
|
||||
stw 3,PCB_SPL(31) /* save spl */
|
||||
#endif
|
||||
|
||||
/* Lock the scheduler. */
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
manipulating runque */
|
||||
mtmsr 3
|
||||
isync
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
|
||||
/* Find a new process */
|
||||
lis 8,_C_LABEL(sched_whichqs)@ha
|
||||
lwz 9,_C_LABEL(sched_whichqs)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
beq- _ASM_LABEL(Idle) /* all queues empty */
|
||||
.Lsw1:
|
||||
cntlzw 10,9
|
||||
lis 4,_C_LABEL(sched_qs)@ha
|
||||
addi 4,4,_C_LABEL(sched_qs)@l
|
||||
slwi 3,10,3
|
||||
add 3,3,4 /* select queue */
|
||||
|
||||
lwz 31,P_FORW(3) /* unlink first proc from queue */
|
||||
lwz 4,P_FORW(31)
|
||||
stw 4,P_FORW(3)
|
||||
stw 3,P_BACK(4)
|
||||
|
||||
cmpl 0,3,4 /* queue empty? */
|
||||
bne 1f
|
||||
|
||||
lis 3,0x80000000@h
|
||||
srw 3,3,10
|
||||
andc 9,9,3
|
||||
stw 9,_C_LABEL(sched_whichqs)@l(8) /* mark it empty */
|
||||
|
||||
1:
|
||||
/* just did this resched thing */
|
||||
xor 3,3,3
|
||||
#if defined(MULTIPROCESSOR)
|
||||
GET_CPUINFO(4)
|
||||
stw 3,CI_WANT_RESCHED(4)
|
||||
#else
|
||||
lis 4,_C_LABEL(want_resched)@ha
|
||||
stw 3,_C_LABEL(want_resched)@l(4)
|
||||
#endif
|
||||
|
||||
stw 3,P_BACK(31) /* probably superfluous */
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
/* Unlock the sched_lock, but leave interrupts off, for now. */
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
#if defined(MULTIPROCESSOR)
|
||||
GET_CPUINFO(4)
|
||||
stw 4,P_CPU(31) /* p->p_cpu = curcpu() */
|
||||
#endif
|
||||
|
||||
/* Process now running on a processor. */
|
||||
li 3,SONPROC /* p->p_stat = SONPROC */
|
||||
stb 3,P_STAT(31)
|
||||
|
||||
/* record new process */
|
||||
#if defined(MULTIPROCESSOR)
|
||||
stw 31,CI_CURPROC(4)
|
||||
#else
|
||||
lis 4,_C_LABEL(curproc)@ha
|
||||
stw 31,_C_LABEL(curproc)@l(4)
|
||||
#endif
|
||||
|
||||
mfmsr 3
|
||||
ori 3,3,PSL_EE@l /* Now we can interrupt again */
|
||||
mtmsr 3
|
||||
|
||||
#if !defined(MULTIPROCESSOR) /* XXX */
|
||||
cmpl 0,31,30 /* is it the same process? */
|
||||
beq switch_return
|
||||
|
||||
or. 30,30,30 /* old process was exiting? */
|
||||
beq switch_exited
|
||||
|
||||
mfsr 10,USER_SR /* save USER_SR for copyin/copyout */
|
||||
mfcr 11 /* save cr */
|
||||
mr 12,2 /* save r2 */
|
||||
stwu 1,-SFRAMELEN(1) /* still running on old stack */
|
||||
stmw 10,8(1)
|
||||
lwz 3,P_ADDR(30)
|
||||
stw 1,PCB_SP(3) /* save SP */
|
||||
#endif
|
||||
|
||||
switch_exited:
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
actually switching */
|
||||
mtmsr 3
|
||||
|
||||
/* indicate new pcb */
|
||||
lwz 4,P_ADDR(31)
|
||||
#if defined(MULTIPROCESSOR)
|
||||
GET_CPUINFO(6)
|
||||
stw 4,CI_CURPCB(6)
|
||||
#else
|
||||
lis 5,_C_LABEL(curpcb)@ha
|
||||
stw 4,_C_LABEL(curpcb)@l(5)
|
||||
#endif
|
||||
|
||||
/* save real pmap pointer for spill fill */
|
||||
lwz 5,PCB_PMR(4)
|
||||
#if defined(MULTIPROCESSOR)
|
||||
stwu 5,CI_CURPM(6)
|
||||
#else
|
||||
lis 6,_C_LABEL(curpm)@ha
|
||||
stwu 5,_C_LABEL(curpm)@l(6)
|
||||
#endif
|
||||
stwcx. 5,0,6 /* clear possible reservation */
|
||||
|
||||
addic. 5,5,64
|
||||
li 6,0
|
||||
mfsr 8,KERNEL_SR /* save kernel SR */
|
||||
1:
|
||||
addis 6,6,-0x10000000@ha /* set new procs segment registers */
|
||||
or. 6,6,6 /* This is done from the real
|
||||
address pmap */
|
||||
lwzu 7,-4(5) /* so we don't have to worry */
|
||||
mtsrin 7,6 /* about accessibility */
|
||||
bne 1b
|
||||
mtsr KERNEL_SR,8 /* restore kernel SR */
|
||||
isync
|
||||
|
||||
lwz 1,PCB_SP(4) /* get new procs SP */
|
||||
|
||||
ori 3,3,PSL_EE@l /* interrupts are okay again */
|
||||
mtmsr 3
|
||||
|
||||
lmw 10,8(1) /* get other regs */
|
||||
lwz 1,0(1) /* get saved SP */
|
||||
mr 2,12 /* get saved r2 */
|
||||
mtcr 11 /* get saved cr */
|
||||
isync
|
||||
mtsr USER_SR,10 /* get saved USER_SR */
|
||||
isync
|
||||
|
||||
switch_return:
|
||||
mr 30,7 /* save proc pointer */
|
||||
lwz 3,PCB_SPL(4)
|
||||
bl _C_LABEL(lcsplx)
|
||||
|
||||
mr 3,30 /* get curproc for special fork
|
||||
returns */
|
||||
|
||||
lwz 31,12(1)
|
||||
lwz 30,8(1)
|
||||
addi 1,1,16
|
||||
lwz 0,4(1)
|
||||
mtlr 0
|
||||
blr
|
||||
|
||||
/*
|
||||
* Child comes here at the end of a fork.
|
||||
* Return to userspace via the trap return path.
|
||||
*/
|
||||
.globl _C_LABEL(fork_trampoline)
|
||||
_C_LABEL(fork_trampoline):
|
||||
#if defined(MULTIPROCESSOR)
|
||||
bl _C_LABEL(proc_trampoline_mp)
|
||||
#endif
|
||||
xor 3,3,3
|
||||
bl _C_LABEL(lcsplx)
|
||||
mtlr 31
|
||||
mr 3,30
|
||||
blrl /* jump indirect to r31 */
|
||||
b trapexit
|
||||
|
||||
/*
|
||||
* Pull in common trap vector code.
|
||||
*/
|
||||
#include <powerpc/powerpc/trap_subr.S>
|
||||
|
||||
/*
|
||||
* int setfault()
|
||||
*
|
||||
* Similar to setjmp to setup for handling faults on accesses to user memory.
|
||||
* Any routine using this may only call bcopy, either the form below,
|
||||
* or the (currently used) C code optimized, so it doesn't use any non-volatile
|
||||
* registers.
|
||||
*/
|
||||
.globl _C_LABEL(setfault)
|
||||
_C_LABEL(setfault):
|
||||
mflr 0
|
||||
mfcr 12
|
||||
#if defined(MULTIPROCESSOR)
|
||||
GET_CPUINFO(4)
|
||||
lwz 4,CI_CURPCB(4)
|
||||
#else
|
||||
lis 4,_C_LABEL(curpcb)@ha
|
||||
lwz 4,_C_LABEL(curpcb)@l(4)
|
||||
#endif
|
||||
stw 3,PCB_FAULT(4)
|
||||
stw 0,0(3)
|
||||
stw 1,4(3)
|
||||
stw 2,8(3)
|
||||
stmw 12,12(3)
|
||||
xor 3,3,3
|
||||
blr
|
||||
|
||||
#if defined(MULTIPROCESSOR)
|
||||
.globl _C_LABEL(cpu_spinup_trampoline)
|
||||
_C_LABEL(cpu_spinup_trampoline):
|
||||
@ -703,3 +366,14 @@ _C_LABEL(cpu_spinup_trampoline):
|
||||
b 1b
|
||||
|
||||
#endif
|
||||
|
||||
/*
|
||||
* Pull in common switch and setfault code.
|
||||
*/
|
||||
#include <powerpc/powerpc/locore_subr.S>
|
||||
|
||||
/*
|
||||
* Pull in common trap vector code.
|
||||
*/
|
||||
#include <powerpc/powerpc/trap_subr.S>
|
||||
|
||||
|
||||
@ -1,4 +1,4 @@
|
||||
/* $NetBSD: locore.S,v 1.21 2000/12/04 17:05:51 tsubai Exp $ */
|
||||
/* $NetBSD: locore.S,v 1.22 2001/02/25 20:34:25 matt Exp $ */
|
||||
|
||||
/*
|
||||
* Copyright (C) 1995, 1996 Wolfgang Solfrank.
|
||||
@ -233,275 +233,12 @@ ofw_back:
|
||||
mtlr 0
|
||||
blr
|
||||
|
||||
|
||||
/*
|
||||
* No processes are runnable, so loop waiting for one.
|
||||
* Separate label here for accounting purposes.
|
||||
* When we get here, interrupts are off (MSR[EE]=0) and sched_lock is held.
|
||||
* Pull in common switch / setfault code.
|
||||
*/
|
||||
ASENTRY(Idle)
|
||||
lis 8,_C_LABEL(sched_whichqs)@ha
|
||||
lwz 9,_C_LABEL(sched_whichqs)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
bne- .Lsw1 /* at least one queue non-empty */
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
mfmsr 3
|
||||
ori 3,3,PSL_EE@l /* reenable ints again */
|
||||
mtmsr 3
|
||||
isync
|
||||
|
||||
/* May do some power saving here? */
|
||||
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
manipulating runque */
|
||||
mtmsr 3
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
b _ASM_LABEL(Idle)
|
||||
|
||||
/*
|
||||
* switchexit gets called from cpu_exit to complete the exit procedure.
|
||||
*/
|
||||
ENTRY(switchexit)
|
||||
/* First switch to the idle pcb/kernel stack */
|
||||
lis 6,idle_u@ha
|
||||
lwz 6,idle_u@l(6)
|
||||
lis 7,_C_LABEL(curpcb)@ha
|
||||
stw 6,_C_LABEL(curpcb)@l(7)
|
||||
addi 1,6,USPACE-16 /* 16 bytes are reserved at stack top */
|
||||
/*
|
||||
* Schedule the vmspace and stack to be freed (the proc arg is
|
||||
* already in r3).
|
||||
*/
|
||||
bl _C_LABEL(exit2)
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
|
||||
/* Fall through to cpu_switch to actually select another proc */
|
||||
li 3,0 /* indicate exited process */
|
||||
|
||||
/*
|
||||
* void cpu_switch(struct proc *p)
|
||||
* Find a runnable process and switch to it.
|
||||
*/
|
||||
/* XXX noprofile? --thorpej@netbsd.org */
|
||||
ENTRY(cpu_switch)
|
||||
mflr 0 /* save lr */
|
||||
stw 0,4(1)
|
||||
stwu 1,-16(1)
|
||||
stw 31,12(1)
|
||||
stw 30,8(1)
|
||||
|
||||
mr 30,3
|
||||
lis 3,_C_LABEL(curproc)@ha
|
||||
xor 31,31,31
|
||||
stw 31,_C_LABEL(curproc)@l(3) /* Zero to not accumulate cpu time */
|
||||
lis 3,_C_LABEL(curpcb)@ha
|
||||
lwz 31,_C_LABEL(curpcb)@l(3)
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
/* Release the sched_lock before processing interrupts. */
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
xor 3,3,3
|
||||
lis 4,_C_LABEL(machine_interface)+SPLX@ha
|
||||
lwz 0,_C_LABEL(machine_interface)+SPLX@l(4)
|
||||
mtlr 0
|
||||
blrl
|
||||
stw 3,PCB_SPL(31) /* save spl */
|
||||
|
||||
/* Lock the scheduler. */
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
manipulating runque */
|
||||
mtmsr 3
|
||||
isync
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
|
||||
/* Find a new process */
|
||||
lis 8,_C_LABEL(sched_whichqs)@ha
|
||||
lwz 9,_C_LABEL(sched_whichqs)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
beq- _ASM_LABEL(Idle) /* all queues empty */
|
||||
.Lsw1:
|
||||
cntlzw 10,9
|
||||
lis 4,_C_LABEL(sched_qs)@ha
|
||||
addi 4,4,_C_LABEL(sched_qs)@l
|
||||
slwi 3,10,3
|
||||
add 3,3,4 /* select queue */
|
||||
|
||||
lwz 31,P_FORW(3) /* unlink first proc from queue */
|
||||
lwz 4,P_FORW(31)
|
||||
stw 4,P_FORW(3)
|
||||
stw 3,P_BACK(4)
|
||||
|
||||
cmpl 0,3,4 /* queue empty? */
|
||||
bne 1f
|
||||
|
||||
lis 3,0x80000000@h
|
||||
srw 3,3,10
|
||||
andc 9,9,3
|
||||
stw 9,_C_LABEL(sched_whichqs)@l(8) /* mark it empty */
|
||||
|
||||
1:
|
||||
/* just did this resched thing */
|
||||
xor 3,3,3
|
||||
lis 4,_C_LABEL(want_resched)@ha
|
||||
stw 3,_C_LABEL(want_resched)@l(4)
|
||||
|
||||
stw 3,P_BACK(31) /* probably superfluous */
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
/* Unlock the sched_lock, but leave interrupts off, for now. */
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
#ifdef MULTIPROCESSOR
|
||||
/*
|
||||
* XXXSMP
|
||||
* p->p_cpu = curcpu();
|
||||
*/
|
||||
#endif
|
||||
|
||||
/* Process now running on a processor. */
|
||||
li 3,SONPROC /* p->p_stat = SONPROC */
|
||||
stb 3,P_STAT(31)
|
||||
|
||||
/* record new process */
|
||||
lis 4,_C_LABEL(curproc)@ha
|
||||
stw 31,_C_LABEL(curproc)@l(4)
|
||||
|
||||
mfmsr 3
|
||||
ori 3,3,PSL_EE@l /* Now we can interrupt again */
|
||||
mtmsr 3
|
||||
|
||||
cmpl 0,31,30 /* is it the same process? */
|
||||
beq switch_return
|
||||
|
||||
or. 30,30,30 /* old process was exiting? */
|
||||
beq switch_exited
|
||||
|
||||
mfsr 10,USER_SR /* save USER_SR for copyin/copyout */
|
||||
mfcr 11 /* save cr */
|
||||
mr 12,2 /* save r2 */
|
||||
stwu 1,-SFRAMELEN(1) /* still running on old stack */
|
||||
stmw 10,8(1)
|
||||
lwz 3,P_ADDR(30)
|
||||
stw 1,PCB_SP(3) /* save SP */
|
||||
|
||||
switch_exited:
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
actually switching */
|
||||
mtmsr 3
|
||||
|
||||
/* indicate new pcb */
|
||||
lwz 4,P_ADDR(31)
|
||||
lis 5,_C_LABEL(curpcb)@ha
|
||||
stw 4,_C_LABEL(curpcb)@l(5)
|
||||
|
||||
/* save real pmap pointer for spill fill */
|
||||
lwz 5,PCB_PMR(4)
|
||||
lis 6,_C_LABEL(curpm)@ha
|
||||
stwu 5,_C_LABEL(curpm)@l(6)
|
||||
stwcx. 5,0,6 /* clear possible reservation */
|
||||
|
||||
addic. 5,5,64
|
||||
li 6,0
|
||||
mfsr 8,KERNEL_SR /* save kernel SR */
|
||||
1:
|
||||
addis 6,6,-0x10000000@ha /* set new procs segment registers */
|
||||
or. 6,6,6 /* This is done from the real
|
||||
address pmap */
|
||||
lwzu 7,-4(5) /* so we don't have to worry */
|
||||
mtsrin 7,6 /* about accessibility */
|
||||
bne 1b
|
||||
mtsr KERNEL_SR,8 /* restore kernel SR */
|
||||
isync
|
||||
|
||||
lwz 1,PCB_SP(4) /* get new procs SP */
|
||||
|
||||
ori 3,3,PSL_EE@l /* interrupts are okay again */
|
||||
mtmsr 3
|
||||
|
||||
lmw 10,8(1) /* get other regs */
|
||||
lwz 1,0(1) /* get saved SP */
|
||||
mr 2,12 /* get saved r2 */
|
||||
mtcr 11 /* get saved cr */
|
||||
isync
|
||||
mtsr USER_SR,10 /* get saved USER_SR */
|
||||
isync
|
||||
|
||||
switch_return:
|
||||
mr 30,7 /* save proc pointer */
|
||||
lwz 3,PCB_SPL(4)
|
||||
lis 4,_C_LABEL(machine_interface)+SPLX@ha
|
||||
lwz 0,_C_LABEL(machine_interface)+SPLX@l(4)
|
||||
mtlr 0
|
||||
blrl
|
||||
|
||||
mr 3,30 /* get curproc for special fork
|
||||
returns */
|
||||
|
||||
lwz 31,12(1)
|
||||
lwz 30,8(1)
|
||||
addi 1,1,16
|
||||
lwz 0,4(1)
|
||||
mtlr 0
|
||||
blr
|
||||
|
||||
/*
|
||||
* Child comes here at the end of a fork.
|
||||
* Mostly similar to the above.
|
||||
*/
|
||||
.globl _C_LABEL(fork_trampoline)
|
||||
_C_LABEL(fork_trampoline):
|
||||
xor 3,3,3
|
||||
lis 4,_C_LABEL(machine_interface)+SPLX@ha
|
||||
lwz 0,_C_LABEL(machine_interface)+SPLX@l(4)
|
||||
mtlr 0
|
||||
blrl
|
||||
mtlr 31
|
||||
mr 3,30
|
||||
blrl /* jump indirect to r31 */
|
||||
b trapexit
|
||||
#include <powerpc/powerpc/locore_subr.S>
|
||||
|
||||
/*
|
||||
* Pull in common trap vector code.
|
||||
*/
|
||||
#include <powerpc/powerpc/trap_subr.S>
|
||||
|
||||
/*
|
||||
* int setfault()
|
||||
*
|
||||
* Similar to setjmp to setup for handling faults on accesses to user memory.
|
||||
* Any routine using this may only call bcopy, either the form below,
|
||||
* or the (currently used) C code optimized, so it doesn't use any non-volatile
|
||||
* registers.
|
||||
*/
|
||||
.globl _C_LABEL(setfault)
|
||||
_C_LABEL(setfault):
|
||||
mflr 0
|
||||
mfcr 12
|
||||
lis 4,_C_LABEL(curpcb)@ha
|
||||
lwz 4,_C_LABEL(curpcb)@l(4)
|
||||
stw 3,PCB_FAULT(4)
|
||||
stw 0,0(3)
|
||||
stw 1,4(3)
|
||||
stw 2,8(3)
|
||||
stmw 12,12(3)
|
||||
xor 3,3,3
|
||||
blr
|
||||
|
||||
@ -1,4 +1,4 @@
|
||||
/* $NetBSD: locore.s,v 1.9 2000/12/04 17:05:51 tsubai Exp $ */
|
||||
/* $NetBSD: locore.s,v 1.10 2001/02/25 20:34:25 matt Exp $ */
|
||||
/* $OpenBSD: locore.S,v 1.4 1997/01/26 09:06:38 rahnds Exp $ */
|
||||
|
||||
/*
|
||||
@ -186,268 +186,6 @@ __start:
|
||||
|
||||
loop:
|
||||
b loop /* not reached */
|
||||
/*
|
||||
* No processes are runnable, so loop waiting for one.
|
||||
* Separate label here for accounting purposes.
|
||||
* When we get here, interrupts are off (MSR[EE]=0) and sched_lock is held.
|
||||
*/
|
||||
ASENTRY(Idle)
|
||||
lis 8,_C_LABEL(sched_whichqs)@ha
|
||||
lwz 9,_C_LABEL(sched_whichqs)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
bne- .Lsw1 /* at least one queue non-empty */
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
mfmsr 3
|
||||
ori 3,3,PSL_EE@l /* reenable ints again */
|
||||
mtmsr 3
|
||||
isync
|
||||
|
||||
/* May do some power saving here? */
|
||||
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
manipulating runque */
|
||||
mtmsr 3
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
b _ASM_LABEL(Idle)
|
||||
|
||||
/*
|
||||
* switchexit gets called from cpu_exit to complete the exit procedure.
|
||||
*/
|
||||
ENTRY(switchexit)
|
||||
/* First switch to the idle pcb/kernel stack */
|
||||
lis 6,idle_u@ha
|
||||
lwz 6,idle_u@l(6)
|
||||
lis 7,_C_LABEL(curpcb)@ha
|
||||
stw 6,_C_LABEL(curpcb)@l(7)
|
||||
addi 1,6,USPACE-16 /* 16 bytes are reserved at stack top */
|
||||
/*
|
||||
* Schedule the vmspace and stack to be freed (the proc arg is
|
||||
* already in r3).
|
||||
*/
|
||||
bl _C_LABEL(exit2)
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
|
||||
/* Fall through to cpu_switch to actually select another proc */
|
||||
li 3,0 /* indicate exited process */
|
||||
|
||||
/*
|
||||
* void cpu_switch(struct proc *p)
|
||||
* Find a runnable process and switch to it.
|
||||
*/
|
||||
/* XXX noprofile? --thorpej@netbsd.org */
|
||||
ENTRY(cpu_switch)
|
||||
mflr 0 /* save lr */
|
||||
stw 0,4(1)
|
||||
stwu 1,-16(1)
|
||||
stw 31,12(1)
|
||||
stw 30,8(1)
|
||||
|
||||
mr 30,3
|
||||
lis 3,_C_LABEL(curproc)@ha
|
||||
xor 31,31,31
|
||||
stw 31,_C_LABEL(curproc)@l(3) /* Zero to not accumulate cpu time */
|
||||
lis 3,_C_LABEL(curpcb)@ha
|
||||
lwz 31,_C_LABEL(curpcb)@l(3)
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
/* Release the sched_lock before processing interrupts. */
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
xor 3,3,3
|
||||
bl _C_LABEL(lcsplx)
|
||||
stw 3,PCB_SPL(31) /* save spl */
|
||||
|
||||
/* Lock the scheduler. */
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
manipulating runque */
|
||||
mtmsr 3
|
||||
isync
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
bl _C_LABEL(sched_lock_idle)
|
||||
#endif
|
||||
|
||||
/* Find a new process */
|
||||
lis 8,_C_LABEL(sched_whichqs)@ha
|
||||
lwz 9,_C_LABEL(sched_whichqs)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
beq- _ASM_LABEL(Idle) /* all queues empty */
|
||||
.Lsw1:
|
||||
cntlzw 10,9
|
||||
lis 4,_C_LABEL(sched_qs)@ha
|
||||
addi 4,4,_C_LABEL(sched_qs)@l
|
||||
slwi 3,10,3
|
||||
add 3,3,4 /* select queue */
|
||||
|
||||
lwz 31,P_FORW(3) /* unlink first proc from queue */
|
||||
lwz 4,P_FORW(31)
|
||||
stw 4,P_FORW(3)
|
||||
stw 3,P_BACK(4)
|
||||
|
||||
cmpl 0,3,4 /* queue empty? */
|
||||
bne 1f
|
||||
|
||||
lis 3,0x80000000@h
|
||||
srw 3,3,10
|
||||
andc 9,9,3
|
||||
stw 9,_C_LABEL(sched_whichqs)@l(8) /* mark it empty */
|
||||
|
||||
1:
|
||||
/* just did this resched thing */
|
||||
xor 3,3,3
|
||||
lis 4,_C_LABEL(want_resched)@ha
|
||||
stw 3,_C_LABEL(want_resched)@l(4)
|
||||
|
||||
stw 3,P_BACK(31) /* probably superfluous */
|
||||
|
||||
#if defined(MULTIPROCESSOR) || defined(LOCKDEBUG)
|
||||
/* Unlock the sched_lock, but leave interrupts off, for now. */
|
||||
bl _C_LABEL(sched_unlock_idle)
|
||||
#endif
|
||||
|
||||
#if defined(MULTIPROCESSOR)
|
||||
/*
|
||||
* XXXSMP
|
||||
* p->p_cpu = curcpu();
|
||||
*/
|
||||
#endif
|
||||
|
||||
/* Process now running on a processor. */
|
||||
li 3,SONPROC /* p->p_stat = SONPROC */
|
||||
stb 3,P_STAT(31)
|
||||
|
||||
/* record new process */
|
||||
lis 4,_C_LABEL(curproc)@ha
|
||||
stw 31,_C_LABEL(curproc)@l(4)
|
||||
|
||||
mfmsr 3
|
||||
ori 3,3,PSL_EE@l /* Now we can interrupt again */
|
||||
mtmsr 3
|
||||
|
||||
cmpl 0,31,30 /* is it the same process? */
|
||||
beq switch_return
|
||||
|
||||
or. 30,30,30 /* old process was exiting? */
|
||||
beq switch_exited
|
||||
|
||||
mfsr 10,USER_SR /* save USER_SR for copyin/copyout */
|
||||
mfcr 11 /* save cr */
|
||||
mr 12,2 /* save r2 */
|
||||
stwu 1,-SFRAMELEN(1) /* still running on old stack */
|
||||
stmw 10,8(1)
|
||||
lwz 3,P_ADDR(30)
|
||||
stw 1,PCB_SP(3) /* save SP */
|
||||
|
||||
switch_exited:
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
actually switching */
|
||||
mtmsr 3
|
||||
|
||||
/* indicate new pcb */
|
||||
lwz 4,P_ADDR(31)
|
||||
lis 5,_C_LABEL(curpcb)@ha
|
||||
stw 4,_C_LABEL(curpcb)@l(5)
|
||||
|
||||
/* save real pmap pointer for spill fill */
|
||||
lwz 5,PCB_PMR(4)
|
||||
lis 6,_C_LABEL(curpm)@ha
|
||||
stwu 5,_C_LABEL(curpm)@l(6)
|
||||
stwcx. 5,0,6 /* clear possible reservation */
|
||||
|
||||
addic. 5,5,64
|
||||
li 6,0
|
||||
mfsr 8,KERNEL_SR /* save kernel SR */
|
||||
1:
|
||||
addis 6,6,-0x10000000@ha /* set new procs segment registers */
|
||||
or. 6,6,6 /* This is done from the real
|
||||
address pmap */
|
||||
lwzu 7,-4(5) /* so we don't have to worry */
|
||||
mtsrin 7,6 /* about accessibility */
|
||||
bne 1b
|
||||
mtsr KERNEL_SR,8 /* restore kernel SR */
|
||||
isync
|
||||
|
||||
lwz 1,PCB_SP(4) /* get new procs SP */
|
||||
|
||||
ori 3,3,PSL_EE@l /* interrupts are okay again */
|
||||
mtmsr 3
|
||||
|
||||
lmw 10,8(1) /* get other regs */
|
||||
lwz 1,0(1) /* get saved SP */
|
||||
mr 2,12 /* get saved r2 */
|
||||
mtcr 11 /* get saved cr */
|
||||
isync
|
||||
mtsr USER_SR,10 /* get saved USER_SR */
|
||||
isync
|
||||
|
||||
switch_return:
|
||||
mr 30,7 /* save proc pointer */
|
||||
lwz 3,PCB_SPL(4)
|
||||
bl _C_LABEL(lcsplx)
|
||||
|
||||
mr 3,30 /* get curproc for special fork
|
||||
returns */
|
||||
|
||||
lwz 31,12(1)
|
||||
lwz 30,8(1)
|
||||
addi 1,1,16
|
||||
lwz 0,4(1)
|
||||
mtlr 0
|
||||
blr
|
||||
|
||||
/*
|
||||
* Child comes here at the end of a fork.
|
||||
* Return to userspace via the trap return path.
|
||||
*/
|
||||
.globl _C_LABEL(fork_trampoline)
|
||||
_C_LABEL(fork_trampoline):
|
||||
xor 3,3,3
|
||||
bl _C_LABEL(lcsplx)
|
||||
mtlr 31
|
||||
mr 3,30
|
||||
blrl /* jump indirect to r31 */
|
||||
b trapexit
|
||||
|
||||
/*
|
||||
* Pull in common trap vector code.
|
||||
*/
|
||||
#include <powerpc/powerpc/trap_subr.S>
|
||||
|
||||
/*
|
||||
* int setfault()
|
||||
*
|
||||
* Similar to setjmp to setup for handling faults on accesses to user memory.
|
||||
* Any routine using this may only call bcopy, either the form below,
|
||||
* or the (currently used) C code optimized, so it doesn't use any non-volatile
|
||||
* registers.
|
||||
*/
|
||||
.globl _C_LABEL(setfault)
|
||||
_C_LABEL(setfault):
|
||||
mflr 0
|
||||
mfcr 12
|
||||
lis 4,_C_LABEL(curpcb)@ha
|
||||
lwz 4,_C_LABEL(curpcb)@l(4)
|
||||
stw 3,PCB_FAULT(4)
|
||||
stw 0,0(3)
|
||||
stw 1,4(3)
|
||||
stw 2,8(3)
|
||||
stmw 12,12(3)
|
||||
xor 3,3,3
|
||||
blr
|
||||
|
||||
.globl _C_LABEL(enable_intr)
|
||||
_C_LABEL(enable_intr):
|
||||
@ -462,3 +200,13 @@ _C_LABEL(disable_intr):
|
||||
andi. 3,3,~PSL_EE@l
|
||||
mtmsr 3
|
||||
blr
|
||||
|
||||
/*
|
||||
* Pull in common switch / setfault code.
|
||||
*/
|
||||
#include <powerpc/powerpc/locore_subr.S>
|
||||
|
||||
/*
|
||||
* Pull in common trap vector code.
|
||||
*/
|
||||
#include <powerpc/powerpc/trap_subr.S>
|
||||
|
||||
@ -1,4 +1,4 @@
|
||||
/* $NetBSD: locore.s,v 1.1 2001/02/04 18:32:18 briggs Exp $ */
|
||||
/* $NetBSD: locore.s,v 1.2 2001/02/25 20:34:25 matt Exp $ */
|
||||
/* $OpenBSD: locore.S,v 1.4 1997/01/26 09:06:38 rahnds Exp $ */
|
||||
|
||||
/*
|
||||
@ -149,240 +149,6 @@ __start:
|
||||
|
||||
loop: b loop /* XXX not reached */
|
||||
|
||||
/*
|
||||
* No processes are runnable, so loop waiting for one.
|
||||
* Separate label here for accounting purposes.
|
||||
*/
|
||||
ASENTRY(Idle)
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
manipulating runque */
|
||||
mtmsr 3
|
||||
|
||||
lis 8,_C_LABEL(sched_whichqs)@ha
|
||||
lwz 9,_C_LABEL(sched_whichqs)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
bne- .Lsw1 /* at least one queue non-empty */
|
||||
|
||||
ori 3,3,PSL_EE@l /* reenable ints again */
|
||||
mtmsr 3
|
||||
isync
|
||||
|
||||
/* May do some power saving here? */
|
||||
|
||||
b _ASM_LABEL(Idle)
|
||||
|
||||
/*
|
||||
* switchexit gets called from cpu_exit to complete the exit procedure.
|
||||
*/
|
||||
ENTRY(switchexit)
|
||||
/* First switch to the idle pcb/kernel stack */
|
||||
lis 6,idle_u@ha
|
||||
lwz 6,idle_u@l(6)
|
||||
lis 7,_C_LABEL(curpcb)@ha
|
||||
stw 6,_C_LABEL(curpcb)@l(7)
|
||||
addi 1,6,USPACE-16 /* 16 bytes are reserved at stack top */
|
||||
/*
|
||||
* Schedule the vmspace and stack to be freed (the proc arg is
|
||||
* already in r3).
|
||||
*/
|
||||
bl _C_LABEL(exit2)
|
||||
|
||||
/* Fall through to cpu_switch to actually select another proc */
|
||||
li 3,0 /* indicate exited process */
|
||||
|
||||
/*
|
||||
* void cpu_switch(struct proc *p)
|
||||
* Find a runnable process and switch to it.
|
||||
*/
|
||||
/* XXX noprofile? --thorpej@netbsd.org */
|
||||
ENTRY(cpu_switch)
|
||||
mflr 0 /* save lr */
|
||||
stw 0,4(1)
|
||||
stwu 1,-16(1)
|
||||
stw 31,12(1)
|
||||
stw 30,8(1)
|
||||
|
||||
mr 30,3
|
||||
lis 3,_C_LABEL(curproc)@ha
|
||||
xor 31,31,31
|
||||
stw 31,_C_LABEL(curproc)@l(3) /* Zero to not accumulate cpu time */
|
||||
lis 3,_C_LABEL(curpcb)@ha
|
||||
lwz 31,_C_LABEL(curpcb)@l(3)
|
||||
|
||||
xor 3,3,3
|
||||
bl _C_LABEL(lcsplx)
|
||||
stw 3,PCB_SPL(31) /* save spl */
|
||||
|
||||
/* Find a new process */
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
manipulating runque */
|
||||
mtmsr 3
|
||||
isync
|
||||
|
||||
lis 8,_C_LABEL(sched_whichqs)@ha
|
||||
lwz 9,_C_LABEL(sched_whichqs)@l(8)
|
||||
|
||||
or. 9,9,9
|
||||
beq- _ASM_LABEL(Idle) /* all queues empty */
|
||||
.Lsw1:
|
||||
cntlzw 10,9
|
||||
lis 4,_C_LABEL(sched_qs)@ha
|
||||
addi 4,4,_C_LABEL(sched_qs)@l
|
||||
slwi 3,10,3
|
||||
add 3,3,4 /* select queue */
|
||||
|
||||
lwz 31,P_FORW(3) /* unlink first proc from queue */
|
||||
lwz 4,P_FORW(31)
|
||||
stw 4,P_FORW(3)
|
||||
stw 3,P_BACK(4)
|
||||
|
||||
cmpl 0,3,4 /* queue empty? */
|
||||
bne 1f
|
||||
|
||||
lis 3,0x80000000@h
|
||||
srw 3,3,10
|
||||
andc 9,9,3
|
||||
stw 9,_C_LABEL(sched_whichqs)@l(8) /* mark it empty */
|
||||
|
||||
1:
|
||||
/* just did this resched thing */
|
||||
xor 3,3,3
|
||||
lis 4,_C_LABEL(want_resched)@ha
|
||||
stw 3,_C_LABEL(want_resched)@l(4)
|
||||
|
||||
stw 3,P_BACK(31) /* probably superfluous */
|
||||
|
||||
#if defined(MULTIPROCESSOR)
|
||||
/*
|
||||
* XXXSMP
|
||||
* p->p_cpu = curcpu();
|
||||
*/
|
||||
#endif
|
||||
|
||||
/* Process now running on a processor. */
|
||||
li 3,SONPROC /* p->p_stat = SONPROC */
|
||||
stb 3,P_STAT(31)
|
||||
|
||||
/* record new process */
|
||||
lis 4,_C_LABEL(curproc)@ha
|
||||
stw 31,_C_LABEL(curproc)@l(4)
|
||||
|
||||
mfmsr 3
|
||||
ori 3,3,PSL_EE@l /* Now we can interrupt again */
|
||||
mtmsr 3
|
||||
|
||||
cmpl 0,31,30 /* is it the same process? */
|
||||
beq switch_return
|
||||
|
||||
or. 30,30,30 /* old process was exiting? */
|
||||
beq switch_exited
|
||||
|
||||
mfsr 10,USER_SR /* save USER_SR for copyin/copyout */
|
||||
mfcr 11 /* save cr */
|
||||
mr 12,2 /* save r2 */
|
||||
stwu 1,-SFRAMELEN(1) /* still running on old stack */
|
||||
stmw 10,8(1)
|
||||
lwz 3,P_ADDR(30)
|
||||
stw 1,PCB_SP(3) /* save SP */
|
||||
|
||||
switch_exited:
|
||||
mfmsr 3
|
||||
andi. 3,3,~PSL_EE@l /* disable interrupts while
|
||||
actually switching */
|
||||
mtmsr 3
|
||||
|
||||
/* indicate new pcb */
|
||||
lwz 4,P_ADDR(31)
|
||||
lis 5,_C_LABEL(curpcb)@ha
|
||||
stw 4,_C_LABEL(curpcb)@l(5)
|
||||
|
||||
/* save real pmap pointer for spill fill */
|
||||
lwz 5,PCB_PMR(4)
|
||||
lis 6,_C_LABEL(curpm)@ha
|
||||
stwu 5,_C_LABEL(curpm)@l(6)
|
||||
stwcx. 5,0,6 /* clear possible reservation */
|
||||
|
||||
addic. 5,5,64
|
||||
li 6,0
|
||||
mfsr 8,KERNEL_SR /* save kernel SR */
|
||||
1:
|
||||
addis 6,6,-0x10000000@ha /* set new procs segment registers */
|
||||
or. 6,6,6 /* This is done from the real
|
||||
address pmap */
|
||||
lwzu 7,-4(5) /* so we don't have to worry */
|
||||
mtsrin 7,6 /* about accessibility */
|
||||
bne 1b
|
||||
mtsr KERNEL_SR,8 /* restore kernel SR */
|
||||
isync
|
||||
|
||||
lwz 1,PCB_SP(4) /* get new procs SP */
|
||||
|
||||
ori 3,3,PSL_EE@l /* interrupts are okay again */
|
||||
mtmsr 3
|
||||
|
||||
lmw 10,8(1) /* get other regs */
|
||||
lwz 1,0(1) /* get saved SP */
|
||||
mr 2,12 /* get saved r2 */
|
||||
mtcr 11 /* get saved cr */
|
||||
isync
|
||||
mtsr USER_SR,10 /* get saved USER_SR */
|
||||
isync
|
||||
|
||||
switch_return:
|
||||
mr 30,7 /* save proc pointer */
|
||||
lwz 3,PCB_SPL(4)
|
||||
bl _C_LABEL(lcsplx)
|
||||
|
||||
mr 3,30 /* get curproc for special fork
|
||||
returns */
|
||||
|
||||
lwz 31,12(1)
|
||||
lwz 30,8(1)
|
||||
addi 1,1,16
|
||||
lwz 0,4(1)
|
||||
mtlr 0
|
||||
blr
|
||||
|
||||
#include <powerpc/powerpc/trap_subr.S>
|
||||
|
||||
/*
|
||||
* Child comes here at the end of a fork.
|
||||
* Mostly similar to the above.
|
||||
*/
|
||||
.globl _C_LABEL(fork_trampoline)
|
||||
_C_LABEL(fork_trampoline):
|
||||
xor 3,3,3
|
||||
bl _C_LABEL(lcsplx)
|
||||
mtlr 31
|
||||
mr 3,30
|
||||
blrl /* jump indirect to r31 */
|
||||
b trapexit
|
||||
|
||||
/*
|
||||
* int setfault()
|
||||
*
|
||||
* Similar to setjmp to setup for handling faults on accesses to user memory.
|
||||
* Any routine using this may only call bcopy, either the form below,
|
||||
* or the (currently used) C code optimized, so it doesn't use any non-volatile
|
||||
* registers.
|
||||
*/
|
||||
.globl _C_LABEL(setfault)
|
||||
_C_LABEL(setfault):
|
||||
mflr 0
|
||||
mfcr 12
|
||||
lis 4,_C_LABEL(curpcb)@ha
|
||||
lwz 4,_C_LABEL(curpcb)@l(4)
|
||||
stw 3,PCB_FAULT(4)
|
||||
stw 0,0(3)
|
||||
stw 1,4(3)
|
||||
stw 2,8(3)
|
||||
stmw 12,12(3)
|
||||
xor 3,3,3
|
||||
blr
|
||||
|
||||
.globl _C_LABEL(enable_intr)
|
||||
_C_LABEL(enable_intr):
|
||||
mfmsr 3
|
||||
@ -403,3 +169,13 @@ _C_LABEL(sandpoint_reboot):
|
||||
ori 3,3,PSL_IP@l
|
||||
mtmsr 3
|
||||
b 0xFFF00100
|
||||
|
||||
/*
|
||||
* Include common switch / setfault code
|
||||
*/
|
||||
#include <powerpc/powerpc/locore_subr.S>
|
||||
|
||||
/*
|
||||
* Include common trap / execption code
|
||||
*/
|
||||
#include <powerpc/powerpc/trap_subr.S>
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user