/*
* Copyright (c) 2000 Apple Computer, Inc. All rights reserved.
*
* @APPLE_LICENSE_HEADER_START@
*
* The contents of this file constitute Original Code as defined in and
* are subject to the Apple Public Source License Version 1.1 (the
* "License"). You may not use this file except in compliance with the
* License. Please obtain a copy of the License at
* http://www.apple.com/publicsource and read it before using this file.
*
* This Original Code and all software distributed under the License are
* distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY KIND, EITHER
* EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
* INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE OR NON-INFRINGEMENT. Please see the
* License for the specific language governing rights and limitations
* under the License.
*
* @APPLE_LICENSE_HEADER_END@
*/
/*
* @OSF_FREE_COPYRIGHT@
*/
/*
* @APPLE_FREE_COPYRIGHT@
*/
/*
Firmware.s
Handle things that should be treated as an extension of the hardware
Lovingly crafted by Bill Angell using traditional methods and only natural or recycled materials.
No animal products are used other than rendered otter bile and deep fried pork lard.
*/
#include <cpus.h>
#include <ppc/asm.h>
#include <ppc/proc_reg.h>
#include <ppc/POWERMAC/mp/MPPlugIn.h>
#include <ppc/exception.h>
#include <mach/machine/vm_param.h>
#include <assym.s>
/*
* Here we generate the table of supported firmware calls
*/
.data
.align 5 /* Line up on cache line */
.globl EXT(FWtable)
EXT(FWtable):
.globl CutTrace /* Let everyone know 'bout it */
.set CutTrace,(.-EXT(FWtable))/4|0x80000000 /* Call number for CutTrace */
.long callUnimp /* This was already handled in lowmem_vectors */
#include <ppc/FirmwareCalls.h>
.set EXT(FirmwareCnt), (.-EXT(FWtable))/4 /* Get the top number */
.text
#define SIMPLESCC 1
#define NOTQUITEASSIMPLE 1
/*
* This routine handles the firmware call routine. It must be entered with IR and DR off,
* interruptions disabled, and in supervisor state.
*
* When we enter, we expect R0 to have call number, and LR
* to point to the return. Also, all registers saved in savearea in R13.
* R3 is as passed in by the user. All others must be gotten from the save area
*/
ENTRY(FirmwareCall, TAG_NO_FRAME_USED)
rlwinm r1,r0,2,1,29 /* Clear out bit 0 and multiply by 4 */
lis r12,HIGH_ADDR(EXT(FWtable)) /* Get the high part of the firmware call table */
cmplwi r1,EXT(FirmwareCnt)*4 /* Is it a valid firmware call number */
mflr r11 /* Save the return */
ori r12,r12,LOW_ADDR(EXT(FWtable)) /* Now the low part */
ble+ goodCall /* Yeah, it is... */
li r3,T_SYSTEM_CALL /* Tell the vector handler that we know nothing */
blr /* Return for errors... */
goodCall: mfsprg r10,0 /* Make sure about the per_proc block */
lwzx r1,r1,r12 /* Pick up the address of the routine */
lwz r4,saver4(r13) /* Pass in caller's R4 */
lwz r5,saver5(r13) /* Pass in caller's R5 */
rlwinm. r1,r1,0,0,29 /* Make sure the flag bits are clear */
stw r11,PP_TEMPWORK1(r10) /* Save our return point */
mtlr r1 /* Put it in the LR */
beq- callUnimp /* This one was unimplimented... */
blrl /* Call the routine... */
mfsprg r10,0 /* Make sure about the per_proc again */
stw r3,saver3(r13) /* Pass back the return code to caller */
lwz r11,PP_TEMPWORK1(r10) /* Get our return point */
li r3,T_IN_VAIN /* Tell the vector handler that we took care of it */
mtlr r11 /* Set the return */
blr /* Bye, dudes... */
callUnimp: lwz r11,PP_TEMPWORK1(r10) /* Restore the return address */
li r3,T_SYSTEM_CALL /* Tell the vector handler that we know nothing */
mtlr r11 /* Restore the LR */
blr /* Return for errors... */
/*
* This routine is used to store using a real address. It stores parmeter1 at parameter2.
*/
ENTRY(StoreReal, TAG_NO_FRAME_USED)
lis r0,HIGH_ADDR(StoreRealCall) /* Get the top part of the SC number */
ori r0,r0,LOW_ADDR(StoreRealCall) /* and the bottom part */
sc /* Do it to it */
blr /* Bye bye, Birdie... */
ENTRY(StoreRealLL, TAG_NO_FRAME_USED)
stw r3,0(r4) /* Store the word */
blr /* Leave... */
/*
* This routine is used to clear a range of physical pages.
*/
ENTRY(ClearReal, TAG_NO_FRAME_USED)
lis r0,HIGH_ADDR(ClearRealCall) /* Get the top part of the SC number */
ori r0,r0,LOW_ADDR(ClearRealCall) /* and the bottom part */
sc /* Do it to it */
blr /* Bye bye, Birdie... */
ENTRY(ClearRealLL, TAG_NO_FRAME_USED)
/*
* We take the first parameter as a physical address. The second is the length in bytes.
* Being crazy, I'll round the address down, and the length up. We could end up clearing
* an extra page at the start and one at the end, but we don't really care. If someone
* is stupid enough to give me unaligned addresses and lengths, I am just arrogant enough
* to take them at their word and to hell with them.
*/
neg r5,r3 /* Negate the address */
addi r4,r4,4095 /* Round length up */
rlwinm r5,r5,0,20,31 /* Save extra length */
rlwinm r3,r3,0,0,19 /* Round the page on down */
add r4,r4,r5 /* Add up all extra lengths */
li r6,32 /* Get a displacement */
rlwinm r4,r4,0,0,19 /* Round the length back down */
clrloop: subi r4,r4,32 /* Back off a cache line */
dcbz 0,r3 /* Do the even line */
sub. r4,r4,r6 /* Back off a second time (we only do this to generate a CR */
dcbz r6,r3 /* Clear the even line */
addi r3,r3,64 /* Move up to every other line */
bgt+ clrloop /* Go until we've done it all... */
blr /* Leave... */
/*
* This routine will read in 32 byte of real storage.
*/
ENTRY(ReadReal, TAG_NO_FRAME_USED)
mfmsr r0 /* Get the MSR */
rlwinm r5,r0,0,28,26 /* Clear DR bit */
rlwinm r5,r5,0,17,15 /* Clear EE bit */
mtmsr r5 /* Disable EE and DR */
isync /* Just make sure about it */
lwz r5,0(r3) /* Get word 0 */
lwz r6,4(r3) /* Get word 1 */
lwz r7,8(r3) /* Get word 2 */
lwz r8,12(r3) /* Get word 3 */
lwz r9,16(r3) /* Get word 4 */
lwz r10,20(r3) /* Get word 5 */
lwz r11,24(r3) /* Get word 6 */
lwz r12,28(r3) /* Get word 7 */
mtmsr r0 /* Restore original machine state */
isync /* Insure goodness */
stw r5,0(r4) /* Set word 0 */
stw r6,4(r4) /* Set word 1 */
stw r7,8(r4) /* Set word 2 */
stw r8,12(r4) /* Set word 3 */
stw r9,16(r4) /* Set word 4 */
stw r10,20(r4) /* Set word 5 */
stw r11,24(r4) /* Set word 6 */
stw r12,28(r4) /* Set word 7 */
blr
/*
* This routine is used to load all 4 DBATs.
*/
ENTRY(LoadDBATs, TAG_NO_FRAME_USED)
lis r0,HIGH_ADDR(LoadDBATsCall) /* Top half of LoadDBATsCall firmware call number */
ori r0,r0,LOW_ADDR(LoadDBATsCall) /* Bottom half */
sc /* Do it to it */
blr /* Bye bye, Birdie... */
ENTRY(xLoadDBATsLL, TAG_NO_FRAME_USED)
lwz r4,0(r3) /* Get DBAT 0 high */
lwz r5,4(r3) /* Get DBAT 0 low */
lwz r6,8(r3) /* Get DBAT 1 high */
lwz r7,12(r3) /* Get DBAT 1 low */
lwz r8,16(r3) /* Get DBAT 2 high */
lwz r9,20(r3) /* Get DBAT 2 low */
lwz r10,24(r3) /* Get DBAT 3 high */
lwz r11,28(r3) /* Get DBAT 3 low */
sync /* Common decency and the state law require you to wash your hands */
mtdbatu 0,r4 /* Load DBAT 0 high */
mtdbatl 0,r5 /* Load DBAT 0 low */
mtdbatu 1,r6 /* Load DBAT 1 high */
mtdbatl 1,r7 /* Load DBAT 1 low */
mtdbatu 2,r8 /* Load DBAT 2 high */
mtdbatl 2,r9 /* Load DBAT 2 low */
mtdbatu 3,r10 /* Load DBAT 3 high */
mtdbatl 3,r11 /* Load DBAT 3 low */
sync /* Make sure it's done */
isync /* Toss out anything new */
blr /* Leave... */
/*
* This routine is used to load all 4 IBATs.
*/
ENTRY(LoadIBATs, TAG_NO_FRAME_USED)
lis r0,HIGH_ADDR(LoadIBATsCall) /* Top half of CreateFakeIO firmware call number */
ori r0,r0,LOW_ADDR(LoadIBATsCall) /* Bottom half */
sc /* Do it to it */
blr /* Bye bye, Birdie... */
ENTRY(xLoadIBATsLL, TAG_NO_FRAME_USED)
lwz r4,0(r3) /* Get IBAT 0 high */
lwz r5,4(r3) /* Get IBAT 0 low */
lwz r6,8(r3) /* Get IBAT 1 high */
lwz r7,12(r3) /* Get IBAT 1 low */
lwz r8,16(r3) /* Get IBAT 2 high */
lwz r9,20(r3) /* Get IBAT 2 low */
lwz r10,24(r3) /* Get IBAT 3 high */
lwz r11,28(r3) /* Get IBAT 3 low */
sync /* Common decency and the state law require you to wash your hands */
mtibatu 0,r4 /* Load IBAT 0 high */
mtibatl 0,r5 /* Load IBAT 0 low */
mtibatu 1,r6 /* Load IBAT 1 high */
mtibatl 1,r7 /* Load IBAT 1 low */
mtibatu 2,r8 /* Load IBAT 2 high */
mtibatl 2,r9 /* Load IBAT 2 low */
mtibatu 3,r10 /* Load IBAT 3 high */
mtibatl 3,r11 /* Load IBAT 3 low */
sync /* Make sure it's done */
isync /* Toss out anything new */
blr /* Leave... */
/*
* This is the glue to call the CutTrace firmware call
*/
ENTRY(dbgTrace, TAG_NO_FRAME_USED)
lis r0,HIGH_ADDR(CutTrace) /* Top half of CreateFakeIO firmware call number */
ori r0,r0,LOW_ADDR(CutTrace) /* Bottom half */
sc /* Do it to it */
blr /* Bye bye, Birdie... */
/*
* This is the glue to create a fake I/O interruption
*/
ENTRY(CreateFakeIO, TAG_NO_FRAME_USED)
lis r0,HIGH_ADDR(CreateFakeIOCall) /* Top half of CreateFakeIO firmware call number */
ori r0,r0,LOW_ADDR(CreateFakeIOCall) /* Bottom half */
sc /* Do it to it */
blr /* Bye bye, Birdie... */
/*
* This is the glue to create a fake Dec interruption
*/
ENTRY(CreateFakeDEC, TAG_NO_FRAME_USED)
lis r0,HIGH_ADDR(CreateFakeDECCall) /* Top half of CreateFakeDEC firmware call number */
ori r0,r0,LOW_ADDR(CreateFakeDECCall) /* Bottom half */
sc /* Do it to it */
blr /* Bye bye, Birdie... */
/*
* This is the glue to create a shutdown context
*/
ENTRY(CreateShutdownCTX, TAG_NO_FRAME_USED)
lis r0,HIGH_ADDR(CreateShutdownCTXCall) /* Top half of CreateFakeIO firmware call number */
ori r0,r0,LOW_ADDR(CreateShutdownCTXCall) /* Bottom half */
sc /* Do it to it */
blr /* Bye bye, Birdie... */
/*
* This is the glue to choke system
*/
ENTRY(ChokeSys, TAG_NO_FRAME_USED)
lis r0,HIGH_ADDR(Choke) /* Top half of Choke firmware call number */
ori r0,r0,LOW_ADDR(Choke) /* Bottom half */
sc /* Do it to it */
blr /* Bye bye, Birdie... */
/*
* Used to initialize the SCC for debugging output
*/
ENTRY(fwSCCinit, TAG_NO_FRAME_USED)
mfmsr r8 /* Save the MSR */
mr. r3,r3 /* See if printer or modem */
rlwinm r12,r8,0,28,25 /* Turn off translation */
lis r10,0xF301 /* Set the top part */
rlwinm r12,r12,0,17,15 /* Turn off interruptions */
#if 0
mtmsr r12 /* Smash the MSR */
isync /* Make it clean */
#endif
ori r10,r10,0x2000 /* Assume the printer (this is the normal one) */
beq+ fwSCCprnt /* It sure are... */
ori r10,r10,0x0002 /* Move it over to the modem port */
fwSCCprnt: dcbf 0,r10 /* Insure it is out */
sync
eieio
dcbi 0,r10 /* Toss it */
sync
li r7,0x09 /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x80 /* Reset channel A */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x04 /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x44 /* x16 clock, 1 stop bit */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x03 /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0xC0 /* 8 bits per char */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x05 /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0xE2 /* DTR mode, 8bit/char */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x02 /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x00 /* Vector 0 */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x0A /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x00 /* Clear misc controls */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x0B /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x50 /* B/R gen T/R */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x0C /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x0A /* 9600 baud low */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x0D /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x00 /* 9600 baud high */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x03 /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0xC1 /* 8 bits/char, Rx enable */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x05 /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0xEA /* 8 bits/char, Tx enable */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x0E /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x01 /* BR rate gen enable */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x0F /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x00 /* ints off */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x10 /* Reset ext/stat ints */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x10 /* Reset ext/stat ints */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x01 /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x10 /* int on Rx, no Tx int enable */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x09 /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x0A /* int on Rx, Tx int enable */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Master enable, no vector */
dcbi 0,r10
eieio
li r7,0x09 /* Set the register */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
li r7,0x02 /* No vector */
stb r7,0(r10) /* Set the register */
dcbf 0,r10 /* Force it out */
sync /* Master enable, no vector */
dcbi 0,r10
eieio
lbz r7,0(r10) /* Clear interrupts */
sync /* Master enable, no vector */
dcbi 0,r10
eieio
wSCCrdy: eieio /* Barricade it */
lbz r7,0(r10) /* Get current status */
dcbi 0,r10
sync
andi. r7,r7,0x04 /* Is transmitter empty? */
beq wSCCrdy /* Nope... */
eieio
#if 0
mtmsr r8 /* Restore 'rupts and TR */
isync
#endif
blr /* Leave... */
/*
* This routine is used to write debug output to either the modem or printer port.
* parm 1 is printer (0) or modem (1)
ENTRY(dbgDisp, TAG_NO_FRAME_USED)
mr r12,r0 /* Keep R0 pristene */
lis r0,HIGH_ADDR(dbgDispCall) /* Top half of dbgDispCall firmware call number */
ori r0,r0,LOW_ADDR(dbgDispCall) /* Bottom half */
sc /* Go display the stuff */
mr r0,r12 /* Restore R0 */
blr /* Return... */
/* Here's the low-level part of dbgDisp */
ENTRY(dbgDispLL, TAG_NO_FRAME_USED)
dbgDispInt: mfmsr r8 /* Save the MSR */
#if 0
lis r10,0xF301 /* (TEST/DEBUG) */
ori r10,r10,0x2002 /* (TEST/DEBUG) */
dcbf 0,r10 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r10 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
li r7,0x35 /* (TEST/DEBUG) */
stb r7,4(r10) /* (TEST/DEBUG) */
lis r7,10 /* (TEST/DEBUG) */
spw6: addi r7,r7,-1 /* (TEST/DEBUG) */
mr. r7,r7 /* (TEST/DEBUG) */
bne- spw6 /* (TEST/DEBUG) */
dcbf 0,r10 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r10 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
#endif
rlwinm r12,r8,0,28,25 /* Turn off translation */
rlwinm r12,r12,0,17,15 /* Turn off interruptions */
mflr r11 /* Save the link register */
#if 0
mr r7,r12 /* (TEST/DEBUG) */
bl dumpr7 /* (TEST/DEBUG) */
#endif
mr. r3,r3 /* See if printer or modem */
lis r10,0xF301 /* Set the top part */
mr r3,r4 /* Copy the ID parameter */
#if 0
mr r9,r12 /* (TEST/DEBUG) */
mtmsr r12 /* (TEST/DEBUG) */
isync /* (TEST/DEBUG) */
#if 0
mtmsr r8 /* (TEST/DEBUG) */
isync /* (TEST/DEBUG) */
#endif
lis r12,0xF301 /* (TEST/DEBUG) */
ori r12,r12,0x2002 /* (TEST/DEBUG) */
#if 1
dcbf 0,r12 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r12 /* (TEST/DEBUG) */
#endif
xqrw1: eieio /* (TEST/DEBUG) */
lbz r7,0(r12) /* (TEST/DEBUG) */
dcbi 0,r12 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
andi. r7,r7,0x04 /* (TEST/DEBUG) */
beq xqrw1 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
li r7,0x36 /* (TEST/DEBUG) */
stb r7,4(r12) /* (TEST/DEBUG) */
eieio
dcbf 0,r12 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r12 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
lis r7,10 /* (TEST/DEBUG) */
spw7: addi r7,r7,-1 /* (TEST/DEBUG) */
mr. r7,r7 /* (TEST/DEBUG) */
bne- spw7 /* (TEST/DEBUG) */
dcbf 0,r12 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r12 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
mr r12,r9 /* (TEST/DEBUG) */
#endif
mtmsr r12 /* Smash the MSR */
isync /* Make it clean */
#if SIMPLESCC && !NOTQUITEASSIMPLE
ori r10,r10,0x3010 /* Assume the printer (this is the normal one) */
#else
ori r10,r10,0x2000 /* Assume the printer (this is the normal one) */
#endif
beq+ dbgDprintr /* It sure are... */
#if SIMPLESCC && !NOTQUITEASSIMPLE
ori r10,r10,0x0020 /* Move it over to the modem port */
#else
ori r10,r10,0x0002 /* Move it over to the modem port */
#if !NOTQUITEASSIMPLE
lis r7,0xF300 /* Address of SCC rounded to 128k */
ori r7,r7,0x0032 /* Make it cache inhibited */
mtdbatl 3,r7 /* Load DBAT 3 low */
lis r7,0xF300 /* Address of SCC rounded to 128k */
ori r7,r7,0x0002 /* Make it supervisor only */
mtdbatu 3,r7 /* Load DBAT 3 high */
ori r12,r12,0x0010 /* Turn on DR */
mtmsr r12 /* Smash the MSR */
isync /* Make it clean */
#endif
#endif
dbgDprintr: sync
#if 0
mr r7,r10 /* (TEST/DEBUG) */
bl dumpr7 /* (TEST/DEBUG) */
#endif
dcbi 0,r10 /* Toss it */
eieio
#if 0
lis r12,0xF301 /* (TEST/DEBUG) */
ori r12,r12,0x2002 /* (TEST/DEBUG) */
dcbf 0,r12 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r12 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
li r7,0x37 /* (TEST/DEBUG) */
stb r7,4(r12) /* (TEST/DEBUG) */
lis r7,12 /* (TEST/DEBUG) */
spw8: addi r7,r7,-1 /* (TEST/DEBUG) */
mr. r7,r7 /* (TEST/DEBUG) */
bne- spw8 /* (TEST/DEBUG) */
dcbf 0,r12 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r12 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
#endif
/* Print the ID parameter */
lis r12,HIGH_ADDR(fwdisplock) /* Get the display locker outer */
ori r12,r12,LOW_ADDR(fwdisplock) /* Last part */
lwarx r7,0,r12 ddwait0: lwarx r7,0,r12 /* Get the lock */
mr. r7,r7 /* Is it locked? */
bne- ddwait0 /* Yup... */
stwcx. r12,0,r12 /* Try to get it */
bne- ddwait0 /* Nope, start all over... */
#if 0
dcbf 0,r10 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r10 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
li r7,0x38 /* (TEST/DEBUG) */
stb r7,6(r10) /* (TEST/DEBUG) */
lis r7,10 /* (TEST/DEBUG) */
spwa: addi r7,r7,-1 /* (TEST/DEBUG) */
mr. r7,r7 /* (TEST/DEBUG) */
bne- spwa /* (TEST/DEBUG) */
dcbf 0,r10 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r10 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
#endif
rlwinm r3,r3,8,0,31 /* Get the first character */
bl dbgDchar /* Print it */
rlwinm r3,r3,8,0,31 /* Get the second character */
bl dbgDchar /* Print it */
rlwinm r3,r3,8,0,31 /* Get the third character */
bl dbgDchar /* Print it */
rlwinm r3,r3,8,0,31 /* Get the fourth character */
bl dbgDchar /* Print it */
li r3,0x20 /* Get a space for a separator */
bl dbgDchar /* Print it */
bl dbg4byte /* Print register 5 in hex */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
mtlr r11 /* Get back the return */
#if !SIMPLESCC && !NOTQUITEASSIMPLE
li r7,0 /* Get a zero */
mtdbatu 3,r7 /* Invalidate DBAT 3 upper */
mtdbatl 3,r7 /* Invalidate DBAT 3 lower */
#endif
lis r12,HIGH_ADDR(fwdisplock) /* Get the display locker outer */
li r7,0 /* Get a zero */
ori r12,r12,LOW_ADDR(fwdisplock) /* Last part */
dcbi 0,r10 /* ? */
stw r7,0(r12) /* Release the display lock */
mtmsr r8 /* Restore the MSR */
isync /* Wait for it */
blr /* Leave... */
dbg4byte: mflr r12 /* Save the return */
lis r4,HIGH_ADDR(hexTab) /* Point to the top of table */
li r6,8 /* Set number of hex digits to dump */
ori r4,r4,LOW_ADDR(hexTab) /* Point to the bottom of table */
dbgDnext: rlwinm r5,r5,4,0,31 /* Rotate a nybble */
subi r6,r6,1 /* Back down the count */
rlwinm r3,r5,0,28,31 /* Isolate the last nybble */
lbzx r3,r4,r3 /* Convert to ascii */
bl dbgDchar /* Print it */
mr. r6,r6 /* Any more? */
bne+ dbgDnext /* Convert 'em all... */
li r3,0x20 /* Space */
bl dbgDchar /* Send it */
mtlr r12 /* Restore LR */
blr /* Return... */
/* Write to whichever serial port. Try to leave it clean, but not too hard (this is a hack) */
dbgDchar:
#if SIMPLESCC && !NOTQUITEASSIMPLE
stb r3,0(r10) /* ? */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
lis r7,3 /* Get enough for about 1ms */
dbgDchar0: addi r7,r7,-1 /* Count down */
mr. r7,r7 /* Waited long enough? */
bgt+ dbgDchar0 /* Nope... */
#endif
#if NOTQUITEASSIMPLE
#if 0
li r7,0x01 /* ? */
stb r7,0(r10) /* ? */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
lbz r7,0(r10) /* ? */
dcbi 0,r10 /* Force it out */
sync /* kill it off */
eieio
li r7,0x00 /* ? */
stb r7,0(r10) /* ? */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
lbz r7,0(r10) /* ? */
dcbi 0,r10 /* Force it out */
sync /* kill it off */
eieio
#endif
qrw1: eieio /* Barricade it */
lbz r7,0(r10) /* ? */
dcbi 0,r10
sync
andi. r7,r7,0x04 /* ? */
beq qrw1 /* Nope... */
eieio
stb r3,4(r10) /* ? */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
qrw2: eieio /* Barricade it */
lbz r7,0(r10) /* ? */
dcbi 0,r10
sync
andi. r7,r7,0x04 /* ? */
beq qrw2 /* Nope... */
#if 0
eieio
li r7,0x10 /* ? */
stb r7,0(r10) /* ? */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
lbz r7,0(r10) /* ? */
dcbi 0,r10 /* Force it out */
sync /* kill it off */
eieio
#endif
lis r7,0x0080 /* ? */
lis r9,0xF300 /* ? */
ori r7,r7,0x010F /* ? */
stw r7,0x28(r9) /* ? */
dcbf 0,r10 /* Force it out */
sync /* Make sure it's out there */
dcbi 0,r10
eieio
#endif
#if !SIMPLESCC && !NOTQUITEASSIMPLE
rlwinm r9,r10,0,0,29 /* Get channel a */
eieio /* Barricade it */
li r7,0x03 /* ? */
stb r7,0(r9) /* ? */
eieio /* Barricade it */
lbz r7,0(r9) /* ? */
eieio /* Barricade it */
lbz r7,0(r9) /* ? */
dchrw1: eieio /* Barricade it */
lbz r7,0(r10) /* ? */
andi. r7,r7,0x04 /* ? */
beq dchrw1 /* Nope... */
stb r3,4(r10) /* ? */
sync /* Make sure it's there */
eieio /* Don't get confused */
dchrw2: eieio /* Barricade it */
lbz r7,0(r10) /* ? */
andi. r7,r7,0x04 /* ? */
beq dchrw2 /* Nope... */
eieio /* Avoid confusion */
lbz r7,0(r10) /* ? */
andi. r7,r7,0x40 /* ? */
beq+ nounder /* Nope... */
eieio /* Avoid confusion */
li r7,0xC0 /* ? */
stb r7,0(r10) /* ? */
nounder: eieio /* Avoid confusion */
li r7,0x10 /* ? */
stb r7,0(r10) /* ? */
eieio /* Avoid confusion */
li r7,0x38 /* ? */
stb r7,0(r9) /* ? */
eieio /* Avoid confusion */
li r7,0x30 /* ? */
stb r7,0(r10) /* ? */
eieio /* Avoid confusion */
li r7,0x20 /* ? */
stb r7,0(r10) /* ? */
eieio /* Avoid confusion */
sync
#endif
blr /* Return */
.globl hexTab
hexTab: STRINGD "0123456789ABCDEF" /* Convert hex numbers to printable hex */
/*
* Dumps all the registers in the savearea in R13
*/
ENTRY(dbgRegsLL, TAG_NO_FRAME_USED)
li r3,0 /* ? */
bl dbgRegsCm /* Join on up... */
/*
* Note that we bypass the normal return 'cause we don't wanna mess up R3
*/
mfsprg r11,0 /* Get the per_proc */
lwz r11,PP_TEMPWORK1(r11) /* Get our return point */
li r3,T_IN_VAIN /* Tell the vector handler that we took care of it */
mtlr r11 /* Set the return */
blr /* Bye, dudes... */
ENTRY(dbgRegs, TAG_NO_FRAME_USED)
dbgRegsCm: mfmsr r8 /* Save the MSR */
mr. r3,r3 /* ? */
rlwinm r12,r8,0,28,25 /* Turn off translation */
lis r10,0xF301 /* Set the top part */
rlwinm r12,r12,0,17,15 /* Turn off interruptions */
mtmsr r12 /* Smash the MSR */
isync /* Make it clean */
#if SIMPLESCC && !NOTQUITEASSIMPLE
ori r10,r10,0x3010 /* ? */
#else
ori r10,r10,0x2000 /* ? */
#endif
mflr r11 /* Save the link register */
beq+ dbgDprints /* It sure are... */
#if SIMPLESCC && !NOTQUITEASSIMPLE
ori r10,r10,0x0020 /* ? */
#else
ori r10,r10,0x0002 /* ? */
dcbf 0,r10 /* Insure it is out */
sync
dcbi 0,r10 /* Toss it */
#if !NOTQUITEASSIMPLE
lis r7,0xF300 /* ? */
ori r7,r7,0x0032 /* ? */
mtdbatl 3,r7 /* ? */
lis r7,0xF300 /* ? */
ori r7,r7,0x0002 /* ? */
mtdbatu 3,r7 /* ? */
ori r12,r12,0x0010 /* ? */
mtmsr r12 /* ? */
isync /* ? */
#endif
#endif
dbgDprints:
lis r3,HIGH_ADDR(fwdisplock) /* Get the display locker outer */
ori r3,r3,LOW_ADDR(fwdisplock) /* Last part */
lwarx r5,0,r3 mr. r5,r5 /* Is it locked? */
bne- ddwait1 /* Yup... */
stwcx. r3,0,r3 /* Try to get it */
bne- ddwait1 /* Nope, start all over... */
li r3,0x52 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x65 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x67 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x73 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,saver0(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver1(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver2(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver3(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,saver4(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver5(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver6(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver7(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,saver8(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver9(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver10(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver11(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,saver12(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver13(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver14(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver15(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,saver16(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver17(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver18(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver19(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,saver20(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver21(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver22(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver23(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,saver24(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver25(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver26(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver27(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,saver28(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver29(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver30(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,saver31(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
/* Segment registers */
li r3,0x53 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x65 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x67 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x73 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,savesr0(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr1(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr2(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr3(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,savesr4(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr5(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr6(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr7(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,savesr8(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr9(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr10(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr11(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,savesr12(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr13(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr14(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesr15(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x30 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x31 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x64 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x64 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,savesrr0(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savesrr1(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savedar(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savedsisr(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x6C /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x63 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x63 /* Print eyecatcher */
bl dbgDchar /* Send it */
li r3,0x20 /* Print eyecatcher */
bl dbgDchar /* Send it */
lwz r5,savelr(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savecr(r13) /* Do register */
bl dbg4byte /* Print */
lwz r5,savectr(r13) /* Do register */
bl dbg4byte /* Print */
li r3,0x0A /* Linefeed */
bl dbgDchar /* Send it */
li r3,0x0D /* Carriage return */
bl dbgDchar /* Send it */
mtlr r11 /* Get back the return */
dcbi 0,r10 /* ? */
#if !SIMPLESCC && !NOTQUITEASSIMPLE
li r7,0 /* Get a zero */
mtdbatu 3,r7 /* Invalidate DBAT 3 upper */
mtdbatl 3,r7 /* Invalidate DBAT 3 lower */
#endif
lis r3,HIGH_ADDR(fwdisplock) /* Get the display locker outer */
li r7,0 /* Get a zero */
ori r3,r3,LOW_ADDR(fwdisplock) /* Last part */
stw r7,0(r3) /* Clear display lock */
mtmsr r8 /* Restore the MSR */
isync /* Wait for it */
blr /* Leave... */
/*
* Used for debugging to leave stuff in 0x380-0x3FF (128 bytes).
* Mapping is V=R. Stores and loads are real.
*/
ENTRY(dbgCkpt, TAG_NO_FRAME_USED)
mr r12,r0 /* Keep R0 pristene */
lis r0,HIGH_ADDR(dbgCkptCall) /* Top half of dbgCkptCall firmware call number */
ori r0,r0,LOW_ADDR(dbgCkptCall) /* Bottom half */
sc /* Go stash the stuff */
mr r0,r12 /* Restore R0 */
blr /* Return... */
/* Here's the low-level part of dbgCkpt */
ENTRY(dbgCkptLL, TAG_NO_FRAME_USED)
li r12,0x380 /* Point to output area */
li r1,32 /* Get line size */
dcbz 0,r12 /* Make sure we don't fetch a cache line */
lwz r4,0x00(r3) /* Load up storage to checkpoint */
dcbt r1,r3 /* Start in the next line */
lwz r5,0x04(r3) /* Load up storage to checkpoint */
lwz r6,0x08(r3) /* Load up storage to checkpoint */
lwz r7,0x0C(r3) /* Load up storage to checkpoint */
lwz r8,0x10(r3) /* Load up storage to checkpoint */
lwz r9,0x14(r3) /* Load up storage to checkpoint */
lwz r10,0x18(r3) /* Load up storage to checkpoint */
lwz r11,0x1C(r3) /* Load up storage to checkpoint */
add r3,r3,r1 /* Bump input */
stw r4,0x00(r12) /* Store it */
stw r5,0x04(r12) /* Store it */
stw r6,0x08(r12) /* Store it */
stw r7,0x0C(r12) /* Store it */
stw r8,0x10(r12) /* Store it */
stw r9,0x14(r12) /* Store it */
stw r10,0x18(r12) /* Store it */
stw r11,0x1C(r12) /* Store it */
dcbz r1,r12 /* Clear the next line */
add r12,r12,r1 /* Point to next output line */
lwz r4,0x00(r3) /* Load up storage to checkpoint */
lwz r5,0x04(r3) /* Load up storage to checkpoint */
lwz r6,0x08(r3) /* Load up storage to checkpoint */
lwz r7,0x0C(r3) /* Load up storage to checkpoint */
lwz r8,0x10(r3) /* Load up storage to checkpoint */
lwz r9,0x14(r3) /* Load up storage to checkpoint */
lwz r10,0x18(r3) /* Load up storage to checkpoint */
lwz r11,0x1C(r3) /* Load up storage to checkpoint */
dcbt r1,r3 /* Touch the next line */
add r3,r3,r1 /* Point to next input line */
stw r4,0x00(r12) /* Store it */
stw r5,0x04(r12) /* Store it */
stw r6,0x08(r12) /* Store it */
stw r7,0x0C(r12) /* Store it */
stw r8,0x10(r12) /* Store it */
stw r9,0x14(r12) /* Store it */
stw r10,0x18(r12) /* Store it */
stw r11,0x1C(r12) /* Store it */
dcbz r1,r12 /* Clear the next line */
add r12,r12,r1 /* Point to next output line */
lwz r4,0x00(r3) /* Load up storage to checkpoint */
lwz r5,0x04(r3) /* Load up storage to checkpoint */
lwz r6,0x08(r3) /* Load up storage to checkpoint */
lwz r7,0x0C(r3) /* Load up storage to checkpoint */
lwz r8,0x10(r3) /* Load up storage to checkpoint */
lwz r9,0x14(r3) /* Load up storage to checkpoint */
lwz r10,0x18(r3) /* Load up storage to checkpoint */
lwz r11,0x1C(r3) /* Load up storage to checkpoint */
dcbt r1,r3 /* Touch the next line */
add r3,r3,r1 /* Point to next input line */
stw r4,0x00(r12) /* Store it */
stw r5,0x04(r12) /* Store it */
stw r6,0x08(r12) /* Store it */
stw r7,0x0C(r12) /* Store it */
stw r8,0x10(r12) /* Store it */
stw r9,0x14(r12) /* Store it */
stw r10,0x18(r12) /* Store it */
stw r11,0x1C(r12) /* Store it */
dcbz r1,r12 /* Clear the next line */
add r12,r12,r1 /* Point to next output line */
lwz r4,0x00(r3) /* Load up storage to checkpoint */
lwz r5,0x04(r3) /* Load up storage to checkpoint */
lwz r6,0x08(r3) /* Load up storage to checkpoint */
lwz r7,0x0C(r3) /* Load up storage to checkpoint */
lwz r8,0x10(r3) /* Load up storage to checkpoint */
lwz r9,0x14(r3) /* Load up storage to checkpoint */
lwz r10,0x18(r3) /* Load up storage to checkpoint */
lwz r11,0x1C(r3) /* Load up storage to checkpoint */
stw r4,0x00(r12) /* Store it */
stw r5,0x04(r12) /* Store it */
stw r6,0x08(r12) /* Store it */
stw r7,0x0C(r12) /* Store it */
stw r8,0x10(r12) /* Store it */
stw r9,0x14(r12) /* Store it */
stw r10,0x18(r12) /* Store it */
stw r11,0x1C(r12) /* Store it */
blr
/*
* Do Preemption. Forces a T_PREEMPT trap to allow a preemption to occur.
*/
ENTRY(DoPreemptLL, TAG_NO_FRAME_USED)
mfsprg r11,0 /* Get the per_proc address */
lwz r11,PP_TEMPWORK1(r11) /* Restore the return address */
li r3,T_PREEMPT /* Set preemption interrupt value */
mtlr r11 /* Restore the LR */
stw r3,saveexception(r13) /* Modify the exception type to preemption */
blr /* Return to interrupt handler */
/*
* Force 'rupt handler to dispatch with new context
* R3 at the call contains the new savearea.
* R4 at the call contains a return code to pass back in R3.
* Forces a T_CSWITCH
*/
ENTRY(SwitchContextLL, TAG_NO_FRAME_USED)
mfsprg r11,0 /* Get the per_proc address */
lwz r11,PP_TEMPWORK1(r11) /* Restore the return address */
li r3,T_CSWITCH /* Set context switch value */
mtlr r11 /* Restore the LR */
stw r3,saveexception(r13) /* Modify the exception type to switch context */
blr /* Return to interrupt handler */
/*
* Create a fake I/O 'rupt.
* Forces a T_INTERRUPT trap to pretend that an actual I/O interrupt occurred.
*/
ENTRY(CreateFakeIOLL, TAG_NO_FRAME_USED)
mfsprg r11,0 /* Get the per_proc address */
lwz r11,PP_TEMPWORK1(r11) /* Restore the return address */
li r3,T_INTERRUPT /* Set external interrupt value */
mtlr r11 /* Restore the LR */
stw r3,saveexception(r13) /* Modify the exception type to external */
blr /* Return to interrupt handler */
/*
* Create a shutdown context
* Forces a T_SHUTDOWN trap.
*/
ENTRY(CreateShutdownCTXLL, TAG_NO_FRAME_USED)
mfsprg r11,0 /* Get the per_proc address */
lwz r11,PP_TEMPWORK1(r11) /* Restore the return address */
li r3,T_SHUTDOWN /* Set external interrupt value */
mtlr r11 /* Restore the LR */
stw r3,saveexception(r13) /* Modify the exception type to external */
blr /* Return to interrupt handler */
/*
* Create a fake decrementer 'rupt.
* Forces a T_DECREMENTER trap to pretend that an actual decrementer interrupt occurred.
*/
ENTRY(CreateFakeDECLL, TAG_NO_FRAME_USED)
mfsprg r11,0 /* Get the per_proc address */
lwz r11,PP_TEMPWORK1(r11) /* Restore the return address */
li r3,T_DECREMENTER /* Set decrementer interrupt value */
mtlr r11 /* Restore the LR */
stw r3,saveexception(r13) /* Modify the exception type to external */
blr /* Return to interrupt handler */
/*
* Choke the system.
*/
ENTRY(DoChokeLL, TAG_NO_FRAME_USED)
mfsprg r11,0 li r3,T_CHOKE stw r3,saveexception(r13)
/*
* Set the low level trace flags
*/
ENTRY(LLTraceSet, TAG_NO_FRAME_USED)
mfsprg r6,2 mr r4,r3 /* Save the new value */
andi. r3,r12,0x01C0 /* Clear interrupts and translation */
mtcrf 0x04,r6
mtmsr r3 b ltsNoMSRx
ltsNoMSR: li r0,loadMSR
ltsNoMSRx:
lis r5,hi16(EXT(trcWork))
lwz r3,traceMask(r5) /* Get the old trace flags to pass back */
stw r4,traceMask(r5) /* Replace with the new ones */
mtmsr r12 /* Restore the MSR */
isync
blr /* Leave... */
#if 1
/*
#define GDfromright 20
#define GDfontsize 16
ENTRY(GratefulDeb,TAG_NO_FRAME_USED)
mfspr r6,pir /* Get the PIR */
lis r5,HIGH_ADDR(EXT(GratefulDebWork)) /* Point to our work area */
rlwinm r6,r6,8,23,23 /* Get part of the offset to our processors area */
ori r5,r5,LOW_ADDR(EXT(GratefulDebWork)) /* Start building the address */
rlwimi r6,r6,2,21,21 /* Get the rest of the offset to our processors area */
add r6,r6,r5 /* Point at our CPU's work area */
mfmsr r5 /* Get that MSR */
stmw r0,GDsave(r6) /* Save all registers */
lwz r10,GDready(r6) /* See if we're all ready to go */
ori r0,r5,0x2000 /* Turn on the floating point */
mr r31,r6 /* Get a more sane base register */
mr. r10,r10 /* Are we all set? */
mtmsr r0 /* Enable floating point */
isync
stfd f0,GDfp0(r31) /* Save FP */
stfd f1,GDfp1(r31) /* Save FP */
stfd f2,GDfp2(r31) /* Save FP */
stfd f3,GDfp3(r31) /* Save FP */
beq- GDbailout /* Go and bail... */
rlwinm r25,r3,0,16,31 /* Isolate just the row number */
lwz r28,GDtopleft(r31) /* Get the physical address of our line 0 */
rlwinm r3,r3,16,16,31 /* Isolate the column number */
lwz r27,GDrowbytes(r31) /* Get the number of bytes per row */
lwz r9,GDrowchar(r31) /* Get the number of bytes per row of full leaded charactrers */
lwz r26,GDdepth(r31) /* Get the bit depth */
mullw r25,r25,r9 /* get offset to the row to write in bytes */
lwz r24,GDcollgn(r31) /* Get the size of columns in bytes */
add r25,r28,r25 /* Physical address of row */
mullw r3,r3,r24 /* Get byte offset to first output column */
li r9,32 /* Get the initial shift calc */
lis r20,HIGH_ADDR(hexfont) /* Point to the font */
li r18,GDfontsize /* Get the number of rows in the font */
ori r20,r20,LOW_ADDR(hexfont) /* Point to the low part */
add r21,r25,r3 /* Physical address of top left output pixel */
sub r9,r9,r26 /* Get right shift justifier for pixel size */
li r7,32 /* Number of bits per word */
startNybble:
la r6,GDrowbuf1(r31) /* Point to the row buffer */
li r19,8 /* Get the number of characters in a row */
getNybble: rlwinm r10,r4,9,23,26 /* Get the top nybble * 32 */
rlwinm r4,r4,4,0,31 /* Rotate a nybble */
add r10,r20,r10 /* Point to the character in the font */
rlwinm r16,r26,4,0,27 /* Width of row in actual bits */
lhz r15,0(r10) /* Get the next row of the font */
rendrow: rlwinm r17,r15,16,0,0 /* Get the next font pixel in the row */
rlwinm r15,r15,1,16,31 /* Move in the next font pixel */
srawi r17,r17,31 /* Fill with 1s if black and 0s if white (reversed) */
slw r14,r14,r26 /* Make room for our pixel in a register */
srw r17,r17,r9 /* Isolate one pixels worth of black or white */
sub. r7,r7,r26 /* See how may bits are left */
sub r16,r16,r26 /* Count how many bits are left to store for this row */
or r14,r14,r17 /* Put in the pixel */
bne+ notfull /* Finish rendering this word */
not r14,r14 /* Invert to black on white */
stw r14,0(r6) /* Write out the word */
li r7,32 /* Bit per word count */
addi r6,r6,4 /* Point to the next word */
notfull: mr. r16,r16 /* Have we finished the whole character row? */
bne+ rendrow /* Finish rendering the row */
addic. r19,r19,-1 /* Are we finished with a whole display row yet? */
bne+ getNybble /* Not yet... */
la r6,GDrowbuf1(r31) /* Point to the row buffer */
rlwinm r19,r26,31,0,29 /* Number of cache lines (depth/2) */
mr r14,r21 /* Get the frame buffer address */
// BREAKPOINT_TRAP
blitrow: lfd f0,0(r6) /* Load a line */
lfd f1,8(r6)
lfd f2,16(r6)
lfd f3,24(r6)
stfd f0,0(r14) /* Blit a line */
stfd f1,8(r14)
stfd f2,16(r14)
stfd f3,24(r14)
addi r6,r6,32 /* Next buffered line */
dcbst 0,r14 /* Force the line to the screen */
sync /* Make sure the line is on it's way */
eieio /* Make sure we beat the invalidate */
dcbi 0,r14 /* Make sure we leave no paradox */
addic. r19,r19,-1 /* Done all lines yet? */
addi r14,r14,32 /* Point to the next output */
bne+ blitrow /* Nope, do it some more... */
addic. r18,r18,-1 /* Have we done all the rows in character yet? */
addi r20,r20,2 /* Offset the font to the next row */
add r21,r21,r27 /* Point to start of next row */
bne+ startNybble /* Nope, go through the word one more time... */
GDbailout: mr r1,r31 /* Move the workarea base */
lfd f0,GDfp0(r31) /* Restore FP */
lfd f1,GDfp1(r31) /* Restore FP */
lfd f2,GDfp2(r31) /* Restore FP */
lfd f3,GDfp3(r31) /* Restore FP */
mtmsr r5 /* Disable floating point */
isync
lmw r3,GDsave+12(r1) /* Restore most registers */
lwz r0,GDsave(r1) /* Restore R0 */
lwz r1,GDsave+4(r1) /* Finally, R1 */
blr /* Leave... */
/*
* void GratefulDebDisp(unsigned int coord, unsigned int data)
ENTRY(GratefulDebDisp,TAG_NO_FRAME_USED)
mfmsr r9 /* Save the current MSR */
mflr r7 /* Save the return */
andi. r8,r9,0x7FCF /* Clear interrupt and translation */
mtmsr r8 /* Turn 'em really off */
isync /* Make sure about the translation part */
bl EXT(GratefulDeb) /* Display it */
mtmsr r9 /* Restore interrupt and translation */
mtlr r7 /* Restore return */
isync /* Make sure */
blr
#endif
/*
* void checkNMI(void)
ENTRY(checkNMI,TAG_NO_FRAME_USED)
mfmsr r9 /* Save it */
andi. r8,r9,0x7FCF /* Clear it */
mtmsr r8 /* Disable it */
isync /* Fence it */
lis r7,0xF300 /* Find it */
ori r7,r7,0x0020 /* Find it */
dcbi 0,r7 /* Toss it */
sync /* Sync it */
eieio /* Get it */
lwz r6,0x000C(r7) /* Check it */
eieio /* Fence it */
dcbi 0,r7 /* Toss it */
rlwinm. r4,r6,0,19,19 /* Check it */
rlwinm r6,r6,0,20,18 /* Clear it */
sync /* Sync it */
eieio /* Fence it */
beq+ xnonmi /* Branch on it */
stw r6,0x0008(r7) /* Reset it */
sync /* Sync it */
dcbi 0,r6 /* Toss it */
eieio /* Fence it */
mtmsr r9 /* Restore it */
isync /* Hold it */
BREAKPOINT_TRAP /* Kill it */
blr /* Return from it */
xnonmi: /* Label it */
mtmsr r9 /* Restore it */
isync /* Hold it */
blr /* Return from it */
/*
* Early debug code
*/
dumpr7: lis r9,HIGH_ADDR(hexTab) /* (TEST/DEBUG) */
li r5,8 /* (TEST/DEBUG) */
ori r9,r9,LOW_ADDR(hexTab) /* (TEST/DEBUG) */
dumpr7n: rlwinm r7,r7,4,0,31 /* (TEST/DEBUG) */
mr r6,r7 /* (TEST/DEBUG) */
andi. r6,r6,15 /* (TEST/DEBUG) */
lbzx r6,r9,r6 /* (TEST/DEBUG) */
lis r10,0xF301 /* (TEST/DEBUG) */
ori r10,r10,0x2000 /* (TEST/DEBUG) */
#if 0
xqrw2: eieio /* (TEST/DEBUG) */
lbz r7,0(r10) /* (TEST/DEBUG) */
dcbi 0,r10 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
andi. r7,r7,0x04 /* (TEST/DEBUG) */
beq xqrw2 /* (TEST/DEBUG) */
#endif
dcbf 0,r10 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r10 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
stb r6,4(r10) /* (TEST/DEBUG) */
lis r6,10 /* (TEST/DEBUG) */
dumpr7d: addi r6,r6,-1 /* (TEST/DEBUG) */
mr. r6,r6 /* (TEST/DEBUG) */
bne- dumpr7d /* (TEST/DEBUG) */
dcbf 0,r10 /* (TEST/DEBUG) */
sync /* (TEST/DEBUG) */
dcbi 0,r10 /* (TEST/DEBUG) */
eieio /* (TEST/DEBUG) */
addic. r5,r5,-1 /* (TEST/DEBUG) */
bne+ dumpr7n /* (TEST/DEBUG) */
blr /* (TEST/DEBUG) */
ENTRY(dbgLog,TAG_NO_FRAME_USED)
li r11,0 li r9,0 lis r0,0x4000 lwz r2,0(r2) mr. r2,r2 beq- nosavehere lwz r11,8(r2)
mr. r2,r2 beq- nosavehere lwz r10,8(r2)
mr. r2,r2 beq- nosavehere lwz r9,8(r2) nosavehere: mfmsr r8 lis r7,hi16(EXT(mem_actual)) ori r2,r2,lo16(EXT(DebugWork)) ori r7,r7,lo16(EXT(mem_actual))
lwz r0,4(r2) lwz r0,0(r7) bne- waytoofar bne+ gotspot lis r7,hi16(EXT(mem_size)) lwz r7,0(r7) gotspot: cmplw r7,r0 bge- waytoofar stw r0,0(r2)
stw r3,0(r7) stw r4,4(r7) stw r5,8(r7)
stw r12,16(r7) stw r10,24(r7)
waytoofar: mtmsr r8 blr
.align 5
.globl EXT(dbgLog2)
LEXT(dbgLog2)
mfmsr r10 lis r12,hi16(EXT(mem_actual)) ori r2,r2,lo16(EXT(DebugWork)) ori r12,r12,lo16(EXT(mem_actual))
lwz r0,4(r2) lwz r0,0(r12) bne- waytoofar2 bne+ gotspot2 lis r12,hi16(EXT(mem_size)) lwz r12,0(r12) gotspot2: cmplw cr1,r12,r0 bge- cr1,waytoofar2
bne+ nonewline
nonewline: cmplwi r3,68 stw r0,0(r2)
lwz r0,0x17C(br0)
nospcts: mftb r0 nospctt: stw r3,4(r12) stw r5,12(r12)
waytoofar2: mtmsr r10 blr
.align 5
.globl EXT(stFloat)
LEXT(stFloat)
mfmsr r0 ori r4,r4,lo16(MASK(MSR_FP)) isync
stfd f0,0x00(r3)
stfd f1,0x08(r3)
stfd f2,0x10(r3)
stfd f3,0x18(r3)
stfd f4,0x20(r3)
stfd f5,0x28(r3)
stfd f6,0x30(r3)
stfd f7,0x38(r3)
stfd f8,0x40(r3)
stfd f9,0x48(r3)
stfd f10,0x50(r3)
stfd f11,0x58(r3)
stfd f12,0x60(r3)
stfd f13,0x68(r3)
stfd f14,0x70(r3)
stfd f15,0x78(r3)
stfd f16,0x80(r3)
stfd f17,0x88(r3)
stfd f18,0x90(r3)
stfd f19,0x98(r3)
stfd f20,0xA0(r3)
stfd f21,0xA8(r3)
stfd f22,0xB0(r3)
stfd f23,0xB8(r3)
stfd f24,0xC0(r3)
stfd f25,0xC8(r3)
stfd f26,0xD0(r3)
stfd f27,0xD8(r3)
stfd f28,0xE0(r3)
stfd f29,0xE8(r3)
stfd f30,0xF0(r3)
stfd f31,0xF8(r3)
mffs f0
stfd f0,0x100(r3)
lfd f0,0x00(r3)
mtmsr r0
isync
blr
.align 5
.globl EXT(stVectors)
LEXT(stVectors)
#if 0
mfpvr r6 rlwinm r6,r6,16,17,31 cmplwi r6,PROCESSOR_VERSION_7400
mfmsr r0 oris r4,r4,hi16(MASK(MSR_VEC)) isync
stvxl v0,0,r5
addi r5,r5,16
stvxl v1,0,r5
addi r5,r5,16
stvxl v2,0,r5
addi r5,r5,16
stvxl v3,0,r5
addi r5,r5,16
stvxl v4,0,r5
addi r5,r5,16
stvxl v5,0,r5
addi r5,r5,16
stvxl v6,0,r5
addi r5,r5,16
stvxl v7,0,r5
addi r5,r5,16
stvxl v8,0,r5
addi r5,r5,16
stvxl v9,0,r5
addi r5,r5,16
stvxl v10,0,r5
addi r5,r5,16
stvxl v11,0,r5
addi r5,r5,16
stvxl v12,0,r5
addi r5,r5,16
stvxl v13,0,r5
addi r5,r5,16
stvxl v14,0,r5
addi r5,r5,16
stvxl v15,0,r5
addi r5,r5,16
stvxl v16,0,r5
addi r5,r5,16
stvxl v17,0,r5
addi r5,r5,16
stvxl v18,0,r5
addi r5,r5,16
stvxl v19,0,r5
addi r5,r5,16
stvxl v20,0,r5
addi r5,r5,16
stvxl v21,0,r5
addi r5,r5,16
stvxl v22,0,r5
addi r5,r5,16
stvxl v23,0,r5
addi r5,r5,16
stvxl v24,0,r5
addi r5,r5,16
stvxl v25,0,r5
addi r5,r5,16
stvxl v26,0,r5
addi r5,r5,16
stvxl v27,0,r5
addi r5,r5,16
stvxl v28,0,r5
addi r5,r5,16
stvxl v29,0,r5
addi r5,r5,16
stvxl v30,0,r5
addi r5,r5,16
stvxl v31,0,r5
mfvscr v31
addi r6,r5,16
stvxl v31,0,r6
li r3,1
lvxl v31,0,r5
mtmsr r0
isync
#endif
blr
.align 5
.globl EXT(stSpecrs)
LEXT(stSpecrs)
#if 0
mfmsr r0 mtmsr r4
isync
mfpvr r12
stw r12,4(r3)
rlwinm r12,r12,16,16,31
mfdbatu r4,0
mfdbatl r5,0
mfdbatu r6,1
mfdbatl r7,1
mfdbatu r8,2
mfdbatl r9,2
mfdbatu r10,3
mfdbatl r11,3
stw r4,8(r3)
stw r5,12(r3)
stw r6,16(r3)
stw r7,20(r3)
stw r8,24(r3)
stw r9,28(r3)
stw r10,32(r3)
stw r11,36(r3)
mfibatu r4,0
mfibatl r5,0
mfibatu r6,1
mfibatl r7,1
mfibatu r8,2
mfibatl r9,2
mfibatu r10,3
mfibatl r11,3
stw r4,40(r3)
stw r5,44(r3)
stw r6,48(r3)
stw r7,52(r3)
stw r8,56(r3)
stw r9,60(r3)
stw r10,64(r3)
stw r11,68(r3)
mfsprg r4,0
mfsprg r5,1
mfsprg r6,2
mfsprg r7,3
stw r4,72(r3)
stw r5,76(r3)
stw r6,80(r3)
stw r7,84(r3)
mfsdr1 r4
stw r4,88(r3)
la r4,92(r3)
li r5,0
stSnsr: mfsrin r6,r5
addis r5,r5,0x1000
stw r6,0(r4)
mr. r5,r5
addi r4,r4,4
bne+ stSnsr
cmplwi cr1,r12,PROCESSOR_VERSION_604e
cmplwi cr5,r12,PROCESSOR_VERSION_604ev
cror cr1_eq,cr1_eq,cr5_eq mfspr r4,hid0
stw r4,(39*4)(r3)
li r4,0
li r5,0
li r6,0
li r7,0
beq- cr1,before750
blt- before750
mfspr r4,hid1
mfspr r5,l2cr
mfspr r6,msscr0
mfspr r7,msscr1
before750: stw r4,(40*4)(r3)
stw r6,(42*4)(r3)
stw r5,(41*4)(r3)
stw r7,(43*4)(r3)
li r4,0
beq isis750
mfspr r4,pir
isis750: stw r4,0(r3)
li r4,0
li r5,0
li r6,0
li r7,0
beq- cr1,b4750
blt- b4750
mfspr r4,thrm1
mfspr r5,thrm2
mfspr r6,thrm3
mfspr r7,ictc
b4750: stw r4,(44*4)(r3)
stw r5,(45*4)(r3)
stw r6,(46*4)(r3)
stw r7,(47*4)(r3)
li r4,0
cmplwi r12,PROCESSOR_VERSION_7400
bne nnmax
mfpvr r5
rlwinm r5,r5,0,16,31
cmplwi r5,0x1101
beq gnmax
cmplwi r5,0x1102
bne nnmax
gnmax: mfspr r4,1016
nnmax: stw r4,(48*4)(r3)
mtmsr r0
isync
#endif
blr