powermac-rom/NanoKernel/NKIntHandlers.s
Elliot Nunn e11b02a8a8 neaten
neaten structures and delete old files
2018-07-15 18:10:37 +08:00

436 lines
9.1 KiB
ArmAsm

; AUTO-GENERATED SYMBOL LIST
########################################################################
_align 6
IntExternal0
mfsprg r1, 0 ; Init regs and increment ctr
stw r0, EWA.r2(r1)
stw r2, EWA.r2(r1)
lwz r2, KDP.NKInfo.ExternalIntCount(r1)
stw r3, EWA.r3(r1)
addi r2, r2, 1
stw r2, KDP.NKInfo.ExternalIntCount(r1)
mfmsr r2 ; Save a self-ptr to FF880000... why?
lis r3, 0xFF88
_bset r0, r2, bitMsrDR
stw r4, EWA.r4(r1)
stw r5, EWA.r5(r1)
mfsrr0 r4
mfsrr1 r5
mtmsr r0
stw r3, 0(r3)
mtmsr r2
mtsrr0 r4
mtsrr1 r5
lwz r4, EWA.r4(r1)
lwz r5, EWA.r5(r1)
lwz r2, KDP.DebugIntPtr(r1) ; Query the shared mem (debug?) for int num
mfcr r0
lha r2, 0(r2)
lwz r3, KDP.PA_EmulatorIplValue(r1)
rlwinm. r2, r2, 0, 0x80000007
ori r2, r2, 0x8000
sth r2, 0(r3)
mfsprg r2, 2
lwz r3, EWA.r3(r1)
mtlr r2
beq @return ; 0 -> no interrupt
bgt @clear ; negative -> clear interrupt
; positive -> post interrupt
lwz r2, KDP.PostIntMaskInit(r1) ; Post an interrupt via Cond Reg
or r0, r0, r2
@return
mtcr r0 ; Set CR and return
lwz r0, EWA.r0(r1)
lwz r2, EWA.r2(r1)
mfsprg r1, 1
rfi
@clear
lwz r2, KDP.ClearIntMaskInit(r1) ; Clear an interrupt via Cond Reg
and r0, r0, r2
b @return
########################################################################
_align 6
IntLookupTable
dc.l 0, 1, 2, 2, 4, 4, 4, 4
dc.l 3, 3, 3, 3, 4, 4, 4, 4
dc.l 4, 4, 4, 4, 4, 4, 4, 4
dc.l 4, 4, 4, 4, 4, 4, 4, 4
dc.l 7, 7, 7, 7, 7, 7, 7, 7
dc.l 7, 7, 7, 7, 7, 7, 7, 7
dc.l 7, 7, 7, 7, 7, 7, 7, 7
dc.l 7, 7, 7, 7, 7, 7, 7, 7
_align 6
IntExternal1
mfsprg r1, 0 ; Init regs and increment ctr
stw r0, EWA.r2(r1)
stw r2, EWA.r2(r1)
lwz r2, KDP.NKInfo.ExternalIntCount(r1)
stw r3, EWA.r3(r1)
addi r2, r2, 1
stw r2, KDP.NKInfo.ExternalIntCount(r1)
lis r2, 0x50F3 ; Query OpenPIC at 50F2A000
mfmsr r2
_bset r0, r2, bitMsrDR
stw r4, EWA.r4(r1)
stw r5, EWA.r5(r1)
mfsrr0 r4
mfsrr1 r5
mtmsr r0
li r0, 0xC0
stb r0, -0x6000(r2)
eieio
lbz r0, -0x6000(r2)
mtmsr r2
mtsrr0 r4
mtsrr1 r5
lwz r4, EWA.r4(r1)
lwz r5, EWA.r5(r1)
lwz r3, KDP.PA_NanoKernelCode(r1) ; Loop that number up in the table
rlwimi r3, r0, 0, 0x0000003F
lbz r2, IntLookupTable-NKTop(r3)
mfcr r0
lwz r3, KDP.PA_EmulatorIplValue(r1)
clrlwi. r2, r2, 29
sth r2, 0(r3)
mfsprg r2, 2
lwz r3, EWA.r3(r1)
mtlr r2
beq @clear ; 0 -> clear interrupt
; nonzero -> post interrupt
lwz r2, KDP.PostIntMaskInit(r1) ; Post an interrupt via Cond Reg
or r0, r0, r2
@return
mtcr r0 ; Set CR and return
lwz r0, EWA.r0(r1)
lwz r2, EWA.r2(r1)
mfsprg r1, 1
rfi
@clear
lwz r2, KDP.ClearIntMaskInit(r1) ; Clear an interrupt via Cond Reg
and r0, r0, r2
b @return
########################################################################
_align 6
IntExternal2
mfsprg r1, 0 ; Init regs and increment ctr
stw r0, EWA.r2(r1)
stw r2, EWA.r2(r1)
lwz r2, KDP.NKInfo.ExternalIntCount(r1)
stw r3, EWA.r3(r1)
addi r2, r2, 1
stw r2, KDP.NKInfo.ExternalIntCount(r1)
lis r2, 0xF300 ; Query OpenPIC at F3000028/C
mfmsr r2
_bset r3, r2, bitMsrDR
stw r4, EWA.r4(r1)
stw r5, EWA.r5(r1)
mfsrr0 r4
mfsrr1 r5
mtmsr r3
lis r3, 0x8000
stw r3, 0x28(r2)
eieio
lwz r3, 0x2C(r2)
mtmsr r0
mtsrr0 r4
mtsrr1 r5
lwz r4, EWA.r4(r1)
lwz r5, EWA.r5(r1)
mfcr r0
; Interpret OpenPic result:
rlwinm. r2, r3, 0, 11, 11 ; bit 11 -> 7
li r2, 7
bne @gotnum
rlwinm r2, r3, 0, 15, 16 ; bit 15-16/21/31 -> 4
rlwimi. r2, r3, 0, 21, 31
li r2, 4
bne @gotnum
rlwinm. r2, r3, 0, 18, 18 ; bit 18 -> 3
li r2, 3
bne @gotnum
andis. r2, r3, 0x7FEA ; bit 1-10/12/14/19-20 -> 2
rlwimi. r2, r3, 0, 19, 20
li r2, 2
bne @gotnum
extrwi. r2, r3, 1, 13 ; bit 13 -> 1
; else -> 0
@gotnum
lwz r3, KDP.PA_EmulatorIplValue(r1)
sth r2, 0(r3)
mfsprg r2, 2
lwz r3, EWA.r3(r1)
mtlr r2
beq @clear ; 0 -> clear interrupt
; nonzero -> post interrupt
lwz r2, KDP.PostIntMaskInit(r1) ; Post an interrupt via Cond Reg
or r0, r0, r2
@return
mtcr r0 ; Set CR and return
lwz r0, EWA.r0(r1)
lwz r2, EWA.r2(r1)
mfsprg r1, 1
rfi
@clear
lwz r2, KDP.ClearIntMaskInit(r1) ; Clear an interrupt via Cond Reg
and r0, r0, r2
b @return
########################################################################
; Increment the Sys/Alt CPU clocks, and the Dec-int counter
_align 6
IntDecrementerSystem
mfsprg r1, 0
stmw r2, EWA.r2(r1)
mfdec r31
lwz r30, KDP.OtherContextDEC(r1)
DecCommon ; DEC for Alternate=r30, System=r31
mfxer r29 ; we will do carries
lwz r28, KDP.ProcInfo.DecClockRateHz(r1)
stw r28, KDP.OtherContextDEC(r1)
mtdec r28 ; reset Sys and Alt decrementers
subf r31, r31, r28 ; System ticks actually elapsed
subf r30, r30, r28 ; Alternate ticks actually elapsed
lwz r28, KDP.NKInfo.SysContextCpuTime+4(r1)
lwz r27, KDP.NKInfo.SysContextCpuTime(r1)
addc r28, r28, r31
addze r27, r27
stw r28, KDP.NKInfo.SysContextCpuTime+4(r1)
stw r27, KDP.NKInfo.SysContextCpuTime(r1)
lwz r28, KDP.NKInfo.AltContextCpuTime+4(r1)
lwz r27, KDP.NKInfo.AltContextCpuTime(r1)
addc r28, r28, r30
addze r27, r27
stw r28, KDP.NKInfo.AltContextCpuTime+4(r1)
stw r27, KDP.NKInfo.AltContextCpuTime(r1)
mtxer r29
stw r0, EWA.r0(r1)
mfsprg r31, 1
stw r31, EWA.r1(r1)
lwz r31, KDP.NKInfo.DecrementerIntCount(r1)
addi r31, r31, 1
stw r31, KDP.NKInfo.DecrementerIntCount(r1)
lmw r27, EWA.r27(r1)
mfsprg r1, 2
mtlr r1
mfsprg r1, 1
rfi
IntDecrementerAlternate
mfsprg r1, 0
stmw r2, EWA.r2(r1)
lwz r31, KDP.OtherContextDEC(r1)
mfdec r30
b DecCommon
########################################################################
_align 6
IntDSI
mfsprg r1, 0
stmw r2, EWA.r2(r1)
mfsprg r11, 1
stw r0, EWA.r0(r1)
stw r11, EWA.r1(r1)
mfsrr0 r10
mfsrr1 r11
mfsprg r12, 2
mfcr r13
mfmsr r14
_bset r15, r14, bitMsrDR
mtmsr r15
lwz r27, 0(r10)
mtmsr r14
EmulateDataAccess
rlwinm. r18, r27, 18, 25, 29 ; r16 = 4 * rA (r0 wired to 0)
lwz r25, KDP.PA_FDP(r1)
li r21, 0
beq @r0
lwzx r18, r1, r18
@r0
andis. r26, r27, 0xec00
lwz r16, KDP.Flags(r1)
mfsprg r24, 3
rlwinm r17, r27, 0, 6, 15
rlwimi r16, r16, 27, 26, 26
bge @low_opcode
rlwimi r25, r27, 7, 26, 29 ; opcode >= 32
rlwimi r25, r27, 12, 25, 25
lwz r26, 0xb80(r25)
extsh r23, r27
rlwimi r25, r26, 26, 22, 29
mtlr r25
mtcr r26
add r18, r18, r23
rlwimi r17, r26, 6, 26, 5
blr
@low_opcode ; opcode <= 31
rlwimi r25, r27, 27, 26, 29
rlwimi r25, r27, 0, 25, 25
rlwimi r25, r27, 6, 23, 24
lwz r26, 0x800(r25)
rlwinm r23, r27, 23, 25, 29
rlwimi r25, r26, 26, 22, 29
mtlr r25
mtcr r26
lwzx r23, r1, r23
rlwimi r17, r26, 6, 26, 5
add r18, r18, r23
bclr BO_IF_NOT, 13
neg r23, r23
add r18, r18, r23
blr
########################################################################
_align 6
IntAlignment
mfsprg r1, 0
stmw r2, EWA.r2(r1)
lwz r11, KDP.NKInfo.MisalignmentCount(r1)
addi r11, r11, 1
stw r11, KDP.NKInfo.MisalignmentCount(r1)
mfsprg r11, 1
stw r0, EWA.r0(r1)
stw r11, EWA.r1(r1)
mfsrr0 r10
mfsrr1 r11
mfsprg r12, 2
mfcr r13
mfsprg r24, 3
mfdsisr r27
mfdar r18
extrwi. r21, r27, 2, 15 ; evaluate hi two bits of XO (or 0 for d-form?)
lwz r25, KDP.PA_FDP(r1)
rlwinm r17, r27, 16, 0x03FF0000
lwz r16, KDP.Flags(r1)
rlwimi r25, r27, 24, 23, 29 ; add constant fields from dsisr (*4) to FDP
rlwimi r16, r16, 27, 26, 26 ; copy FlagSE to Flag26
bne @X_form
; D- or DS-form (immediate-indexed) instruction
lwz r26, FDP_TableBase + 4*(0x40 + 0x20)(r25) ; use upper quarter of table
mfmsr r14
rlwimi r25, r26, 26, 22, 29 ; third byte of lookup value is a /4 code offset in FDP
mtlr r25 ; so get ready to go there
_bset r15, r14, bitMsrDR
mtcr r26
rlwimi r17, r26, 6, 26, 5 ; wrap some shite around the register values
blr
@X_form
; X-form (register-indexed) instruction
lwz r26, FDP_TableBase(r25)
mfmsr r14
rlwimi r25, r26, 26, 22, 29
mtlr r25
_bset r15, r14, bitMsrDR
mtcr r26
rlwimi r17, r26, 6, 26, 5
bclr BO_IF_NOT, 12
mtmsr r15
lwz r27, 0(r10)
mtmsr r14
blr
########################################################################
; FDP GOES HERE (0xC00)! (just include it as a file?)
; there are some big mistakes in the labels below!
_align 10
FDP
dcb.l (0x1874-0xC00)/4, 0x46445020 ; 'FDP '
########################################################################
IntISI
bl LoadInterruptRegisters
andis. r8, r11, 0x4020 ; what the hell are these MSR bits?
beq major_0x039dc_0x14
stmw r14, EWA.r14(r8)
mr r27, r10
bl PopulateHTAB
bne @not_in_htab
mfsprg r24, 3
mfmsr r14
_bset r15, r14, bitMsrDR
addi r23, r1, KDP.VecTblMemRetry
mtsprg 3, r23
mr r19, r10
mtmsr r15
lbz r23, 0(r19)
sync
mtmsr r14
mtsprg 3, r24
lmw r14, EWA.r14(r8)
b IntReturn
@not_in_htab
lmw r14, EWA.r14(r8)
li r8, ecInstPageFault
blt Exception
li r8, ecInstInvalidAddress
b Exception
major_0x039dc_0x14
andis. r8, r11, 0x800
li r8, ecInstSupAccessViolation
bne Exception
li r8, ecInstHardwareFault
b Exception
########################################################################
IntMachineCheck
bl LoadInterruptRegisters
li r8, ecMachineCheck
b Exception