599 lines
11 KiB
ArmAsm
599 lines
11 KiB
ArmAsm
; Implements two MPCalls that seem to have something to do with COHGs
|
|
|
|
|
|
|
|
; Make conditional calls easier
|
|
Local_Panic set *
|
|
b panic
|
|
|
|
Local_ReturnParamErrFromMPCall
|
|
b ReturnParamErrFromMPCall
|
|
|
|
Local_ReturnInsufficientResourcesErrFromMPCall
|
|
b ReturnMPCallOOM
|
|
|
|
Local_CommonMPCallReturnPath
|
|
b CommonMPCallReturnPath
|
|
|
|
|
|
|
|
DeclareMPCall 102, MPCall_102
|
|
|
|
MPCall_102 ; OUTSIDE REFERER
|
|
mfsprg r9, 0
|
|
lwz r8, EWA.CPUBase + CPU.CgrpList + LLL.Freeform(r9)
|
|
lwz r9, CoherenceGroup.ScheduledCpuCount(r8)
|
|
cmpwi r9, 1
|
|
bgt+ Local_ReturnInsufficientResourcesErrFromMPCall
|
|
bl CoherenceFunc
|
|
mr r4, r8
|
|
mr r5, r9
|
|
b ReturnZeroFromMPCall
|
|
|
|
|
|
|
|
DeclareMPCall 103, MPCall_103
|
|
|
|
MPCall_103 ; OUTSIDE REFERER
|
|
mfsprg r9, 0
|
|
lwz r8, EWA.CPUBase + CPU.CgrpList + LLL.Freeform(r9)
|
|
lwz r9, CoherenceGroup.ScheduledCpuCount(r8)
|
|
cmpwi r9, 1
|
|
bgt+ Local_ReturnInsufficientResourcesErrFromMPCall
|
|
|
|
clrlwi. r8, r5, 20
|
|
bne+ Local_ReturnParamErrFromMPCall
|
|
bl CoherenceFunc
|
|
cmpw r3, r8
|
|
blt+ Local_ReturnParamErrFromMPCall
|
|
cmpw r4, r9
|
|
blt+ Local_ReturnParamErrFromMPCall
|
|
bl PagingFlushTLB
|
|
mfsprg r9, 0
|
|
mfxer r8
|
|
stw r13, 0x00dc(r6)
|
|
stw r8, 0x00d4(r6)
|
|
stw r12, 0x00ec(r6)
|
|
mfctr r8
|
|
stw r10, 0x00fc(r6)
|
|
stw r8, 0x00f4(r6)
|
|
|
|
mfpvr r8
|
|
rlwinm. r8, r8, 0, 0, 14
|
|
bne- @not_601
|
|
mfspr r8, mq
|
|
stw r8, ContextBlock.MQ(r6)
|
|
@not_601
|
|
|
|
lwz r8, EWA.r1(r9)
|
|
stw r8, ContextBlock.r1(r6)
|
|
stw r2, ContextBlock.r2(r6)
|
|
stw r3, ContextBlock.r3(r6)
|
|
andi. r8, r11, MSR_FP
|
|
stw r4, ContextBlock.r4(r6)
|
|
lwz r8, EWA.r6(r9)
|
|
stw r5, ContextBlock.r5(r6)
|
|
stw r8, ContextBlock.r6(r6)
|
|
bnel+ Save_f0_f31
|
|
rlwinm. r8, r7, 0, 12, 12 ; flags
|
|
bnel+ Save_v0_v31
|
|
|
|
lwz r3, ContextBlock.r3(r6)
|
|
lwz r4, ContextBlock.r4(r6)
|
|
lwz r5, ContextBlock.r5(r6)
|
|
|
|
stw r11,ContextBlock.MSR(r6)
|
|
mr r27, r5
|
|
addi r29, r1, 800
|
|
bl PagingFunc3
|
|
beq+ Local_ReturnInsufficientResourcesErrFromMPCall
|
|
rlwimi r27, r31, 0, 0, 19
|
|
mr r17, r27
|
|
addi r15, r17, 0x34
|
|
srwi r3, r3, 12
|
|
|
|
MPCall_103_0xc8
|
|
mr r27, r5
|
|
addi r29, r1, 800
|
|
bl PagingFunc3
|
|
beq+ Local_ReturnInsufficientResourcesErrFromMPCall
|
|
rlwimi r27, r31, 0, 0, 19
|
|
stwu r27, 0x0004(r15)
|
|
addi r3, r3, -0x01
|
|
addi r5, r5, 0x1000
|
|
cmpwi r3, 0x00
|
|
bge+ MPCall_103_0xc8
|
|
addi r15, r15, 0x04
|
|
subf r15, r17, r15
|
|
stw r15, 0x0034(r17)
|
|
mfsprg r15, 0
|
|
stw r15, 0x0024(r17)
|
|
mfsprg r8, 3
|
|
stw r8, 0x0028(r17)
|
|
|
|
MPCall_103_0x10c
|
|
mftbu r8
|
|
mftb r9, 0x10c
|
|
mftbu r16
|
|
cmpw r16, r8
|
|
bne- MPCall_103_0x10c
|
|
stw r8, -0x0278(r15)
|
|
stw r9, -0x0274(r15)
|
|
mr r29, r17
|
|
li r16, 0x06
|
|
stw r16, -0x0238(r15)
|
|
lhz r16, -0x0116(r15)
|
|
stw r16, -0x0234(r15)
|
|
li r8, 0x02
|
|
|
|
; r7 = flags
|
|
; r8 = usually 2?
|
|
bl SIGP
|
|
mr r17, r29
|
|
mfsdr1 r8
|
|
stw r8, 0x002c(r17)
|
|
rlwinm r9, r8, 16, 7, 15
|
|
cntlzw r18, r9
|
|
li r9, -0x01
|
|
srw r9, r9, r18
|
|
addi r9, r9, 0x01
|
|
stw r9, 0x000c(r17)
|
|
rlwinm r8, r8, 0, 0, 15
|
|
stw r8, 0x0010(r17)
|
|
lis r8, 0x00
|
|
ori r8, r8, 0xc000
|
|
stw r8, 0x0018(r17)
|
|
lis r9, 0x00
|
|
ori r9, r9, 0xa000
|
|
subf r8, r9, r1
|
|
stw r8, 0x001c(r17)
|
|
addi r9, r1, 120
|
|
lis r31, 0x00
|
|
li r14, 0x00
|
|
lwz r29, 0x0034(r17)
|
|
add r29, r29, r17
|
|
|
|
MPCall_103_0x1a0
|
|
lwzu r30, 0x0008(r9)
|
|
|
|
MPCall_103_0x1a4
|
|
lwz r18, 0x0004(r30)
|
|
lhz r15, 0x0000(r30)
|
|
andi. r19, r18, 0xe00
|
|
lhz r16, 0x0002(r30)
|
|
cmplwi r19, 0xc00
|
|
bne- MPCall_103_0x1dc
|
|
addi r16, r16, 0x01
|
|
slwi r16, r16, 2
|
|
stw r16, 0x0000(r29)
|
|
rlwinm r18, r18, 22, 0, 29
|
|
stw r18, 0x0004(r29)
|
|
addi r29, r29, 0x0c
|
|
addi r14, r14, 0x01
|
|
b MPCall_103_0x1fc
|
|
|
|
MPCall_103_0x1dc
|
|
cmpwi r15, 0x00
|
|
bne- MPCall_103_0x1fc
|
|
cmplwi r16, 0xffff
|
|
bne- MPCall_103_0x1fc
|
|
addis r31, r31, 0x1000
|
|
cmpwi r31, 0x00
|
|
bne+ MPCall_103_0x1a0
|
|
b MPCall_103_0x204
|
|
|
|
MPCall_103_0x1fc
|
|
addi r30, r30, 0x08
|
|
b MPCall_103_0x1a4
|
|
|
|
MPCall_103_0x204
|
|
lwz r16, -0x0aa0(r1)
|
|
|
|
MPCall_103_0x208
|
|
lwz r31, 0x0000(r16)
|
|
add r18, r31, r16
|
|
lwz r19, 0x0000(r18)
|
|
addi r31, r31, 0x18
|
|
stw r31, 0x0000(r29)
|
|
stw r16, 0x0004(r29)
|
|
addi r29, r29, 0x0c
|
|
addi r14, r14, 0x01
|
|
cmpwi r19, 0x00
|
|
beq- MPCall_103_0x238
|
|
add r16, r19, r18
|
|
b MPCall_103_0x208
|
|
|
|
MPCall_103_0x238
|
|
addi r19, r1, -0x450
|
|
lwz r31, -0x0448(r1)
|
|
|
|
MPCall_103_0x240
|
|
cmpw r31, r19
|
|
beq- MPCall_103_0x264
|
|
li r18, 0x10
|
|
stw r18, 0x0000(r29)
|
|
stw r31, 0x0004(r29)
|
|
addi r29, r29, 0x0c
|
|
addi r14, r14, 0x01
|
|
lwz r31, 0x0008(r31)
|
|
b MPCall_103_0x240
|
|
|
|
MPCall_103_0x264
|
|
stw r14, 0x0030(r17)
|
|
lwz r30, 0x0034(r17)
|
|
add r30, r30, r17
|
|
|
|
MPCall_103_0x270
|
|
subf r8, r17, r29
|
|
stw r8, 0x0008(r30)
|
|
lwz r24, 0x0004(r30)
|
|
mr r25, r8
|
|
lwz r26, 0x0000(r30)
|
|
add r29, r29, r26
|
|
bl AnotherCoherenceFunc
|
|
addi r30, r30, 0x0c
|
|
addi r14, r14, -0x01
|
|
cmpwi r14, 0x00
|
|
bne+ MPCall_103_0x270
|
|
subf r8, r17, r29
|
|
stw r8, 0x0020(r17)
|
|
lwz r24, 0x001c(r17)
|
|
mr r25, r8
|
|
lwz r26, 0x0018(r17)
|
|
add r29, r29, r26
|
|
bl AnotherCoherenceFunc
|
|
subf r8, r17, r29
|
|
stw r8, 0x0014(r17)
|
|
lwz r24, 0x0010(r17)
|
|
mr r25, r8
|
|
lwz r26, 0x000c(r17)
|
|
add r29, r29, r26
|
|
bl AnotherCoherenceFunc
|
|
bl LoadStateRestoreFunc
|
|
mflr r9
|
|
stw r9, 0x0000(r17)
|
|
lwz r8, -0x0900(r1)
|
|
stw r8, 0x0008(r17)
|
|
li r8, 0x00
|
|
stw r8, 0x0004(r17)
|
|
mfsprg r15, 0
|
|
li r16, 0x11
|
|
stw r16, -0x0238(r15)
|
|
lhz r16, -0x0116(r15)
|
|
stw r16, -0x0234(r15)
|
|
li r8, 0x02
|
|
|
|
; r7 = flags
|
|
; r8 = usually 2?
|
|
bl SIGP
|
|
li r3, 0x00
|
|
b Local_CommonMPCallReturnPath
|
|
|
|
|
|
|
|
LoadStateRestoreFunc
|
|
blrl
|
|
|
|
mr r17, r3
|
|
lwz r24, 0x0014(r17)
|
|
lwz r25, 0x0010(r17)
|
|
lwz r26, 0x000c(r17)
|
|
bl YetAnotherCoherenceFunc
|
|
lwz r24, 0x002c(r17)
|
|
mtsdr1 r24
|
|
lwz r24, 0x0020(r17)
|
|
lwz r25, 0x001c(r17)
|
|
lwz r26, 0x0018(r17)
|
|
bl YetAnotherCoherenceFunc
|
|
lwz r14, 0x0030(r17)
|
|
lwz r30, 0x0034(r17)
|
|
add r30, r30, r17
|
|
|
|
RestoreKernelState_0x38
|
|
lwz r24, 0x0008(r30)
|
|
lwz r25, 0x0004(r30)
|
|
lwz r26, 0x0000(r30)
|
|
bl YetAnotherCoherenceFunc
|
|
addi r30, r30, 0x0c
|
|
addi r14, r14, -0x01
|
|
cmpwi r14, 0x00
|
|
bne+ RestoreKernelState_0x38
|
|
lwz r16, 0x0024(r17)
|
|
mtsprg 0, r16
|
|
lwz r8, 0x0028(r17)
|
|
mtsprg 3, r8
|
|
lwz r1, -0x0004(r16)
|
|
lwz r6, -0x0014(r16)
|
|
lwz r7, -0x0010(r16)
|
|
li r8, -0x01
|
|
stw r8, 0x0004(r17)
|
|
lwz r8, -0x0278(r16)
|
|
lwz r9, -0x0274(r16)
|
|
li r16, 0x01
|
|
mttb r16
|
|
mttbu r8
|
|
mttb r9
|
|
mtdec r16
|
|
_log 'Resuming saved kernel state^n'
|
|
lwz r8, 0x00d4(r6)
|
|
lwz r13, 0x00dc(r6)
|
|
mtxer r8
|
|
lwz r12, 0x00ec(r6)
|
|
lwz r8, 0x00f4(r6)
|
|
lwz r10, 0x00fc(r6)
|
|
mtctr r8
|
|
lwz r11, 0x00a4(r6)
|
|
mfpvr r8
|
|
rlwinm. r8, r8, 0, 0, 14
|
|
bne- RestoreKernelState_0xf8
|
|
lwz r8, 0x00c4(r6)
|
|
DIALECT POWER
|
|
mtmq r8
|
|
DIALECT PowerPC
|
|
|
|
RestoreKernelState_0xf8
|
|
lwz r4, -0x0020(r1)
|
|
li r2, 0x01
|
|
sth r2, 0x0910(r1)
|
|
li r2, -0x01
|
|
stw r2, 0x0912(r1)
|
|
stw r2, 0x0f90(r4)
|
|
xoris r2, r2, 0x100
|
|
stw r2, 0x0f8c(r4)
|
|
li r2, 0x00
|
|
stw r2, 0x0f28(r4)
|
|
stw r2, 0x0f2c(r4)
|
|
lwz r2, 0x0114(r6)
|
|
lwz r4, 0x0124(r6)
|
|
lwz r5, 0x012c(r6)
|
|
lwz r29, 0x00d8(r6)
|
|
cmpwi r29, 0x00
|
|
lwz r8, 0x0210(r29)
|
|
beq- RestoreKernelState_0x144
|
|
mtspr vrsave, r8
|
|
|
|
RestoreKernelState_0x144
|
|
bl PagingFlushTLB
|
|
addi r29, r1, 0x5e0
|
|
bl PagingFunc2AndAHalf
|
|
mfsprg r15, 0
|
|
lwz r8, -0x001c(r15)
|
|
li r9, 0x00
|
|
bl SetAddrSpcRegisters
|
|
isync
|
|
mfsprg r15, 0
|
|
li r16, 0x07
|
|
stw r16, -0x0238(r15)
|
|
lhz r16, -0x0116(r15)
|
|
stw r16, -0x0234(r15)
|
|
li r8, 0x02
|
|
|
|
; r7 = flags
|
|
; r8 = usually 2?
|
|
bl SIGP
|
|
mfsprg r15, 0
|
|
li r16, 0x11
|
|
stw r16, -0x0238(r15)
|
|
lhz r16, -0x0116(r15)
|
|
stw r16, -0x0234(r15)
|
|
li r8, 0x02
|
|
|
|
; r7 = flags
|
|
; r8 = usually 2?
|
|
bl SIGP
|
|
li r3, 0x00
|
|
b Local_CommonMPCallReturnPath
|
|
|
|
|
|
|
|
; Xrefs:
|
|
; MPCall_102
|
|
; MPCall_103
|
|
; AnotherCoherenceFunc
|
|
; YetAnotherCoherenceFunc
|
|
|
|
CoherenceFunc ; OUTSIDE REFERER
|
|
li r24, 0x00
|
|
mfsdr1 r16
|
|
rlwinm r16, r16, 16, 7, 15
|
|
cntlzw r17, r16
|
|
li r16, -0x01
|
|
srw r16, r16, r17
|
|
addi r8, r16, 0x01
|
|
addi r9, r1, 120
|
|
lis r31, 0x00
|
|
li r19, 0x00
|
|
li r14, 0x00
|
|
|
|
CoherenceFunc_0x2c
|
|
lwzu r17, 0x0008(r9)
|
|
|
|
CoherenceFunc_0x30
|
|
lwz r18, 0x0004(r17)
|
|
lhz r15, 0x0000(r17)
|
|
andi. r18, r18, 0xe00
|
|
lhz r16, 0x0002(r17)
|
|
cmplwi r18, 0xc00
|
|
bne- CoherenceFunc_0x58
|
|
addi r16, r16, 0x01
|
|
add r19, r19, r16
|
|
addi r14, r14, 0x01
|
|
b CoherenceFunc_0x78
|
|
|
|
CoherenceFunc_0x58
|
|
cmpwi r15, 0x00
|
|
bne- CoherenceFunc_0x78
|
|
cmplwi r16, 0xffff
|
|
bne- CoherenceFunc_0x78
|
|
addis r31, r31, 0x1000
|
|
cmpwi r31, 0x00
|
|
bne+ CoherenceFunc_0x2c
|
|
b CoherenceFunc_0x80
|
|
|
|
CoherenceFunc_0x78
|
|
addi r17, r17, 0x08
|
|
b CoherenceFunc_0x30
|
|
|
|
CoherenceFunc_0x80
|
|
slwi r19, r19, 2
|
|
add r8, r8, r19
|
|
cmpwi r14, 0x00
|
|
beq+ Local_ReturnInsufficientResourcesErrFromMPCall
|
|
mulli r9, r14, 0x0c
|
|
add r8, r8, r9
|
|
add r24, r24, r9
|
|
li r9, 0x00
|
|
li r14, 0x00
|
|
lwz r16, -0x0aa0(r1)
|
|
|
|
CoherenceFunc_0xa8
|
|
lwz r17, 0x0000(r16)
|
|
add r18, r17, r16
|
|
lwz r19, 0x0000(r18)
|
|
add r9, r9, r17
|
|
addi r9, r9, 0x18
|
|
addi r14, r14, 0x01
|
|
cmpwi r19, 0x00
|
|
add r16, r19, r18
|
|
beq- CoherenceFunc_0xd0
|
|
b CoherenceFunc_0xa8
|
|
|
|
CoherenceFunc_0xd0
|
|
addi r16, r1, -0x450
|
|
lwz r18, -0x0448(r1)
|
|
|
|
CoherenceFunc_0xd8
|
|
cmpw r18, r16
|
|
beq- CoherenceFunc_0xf0
|
|
addi r9, r9, 0x10
|
|
addi r14, r14, 0x01
|
|
lwz r18, 0x0008(r18)
|
|
b CoherenceFunc_0xd8
|
|
|
|
CoherenceFunc_0xf0
|
|
add r8, r8, r9
|
|
mulli r9, r14, 0x0c
|
|
add r8, r8, r9
|
|
add r24, r24, r9
|
|
lis r9, 0x00
|
|
ori r9, r9, 0xc000
|
|
add r8, r8, r9
|
|
lis r9, 0x00
|
|
ori r9, r9, 0x3c
|
|
add r8, r8, r9
|
|
add r24, r24, r9
|
|
srwi r9, r8, 12
|
|
slwi r9, r9, 2
|
|
addi r9, r9, 0x04
|
|
add r8, r8, r9
|
|
add r24, r24, r9
|
|
mr r9, r24
|
|
blr
|
|
|
|
CoherenceFunc_0x138 ; OUTSIDE REFERER
|
|
srwi r23, r28, 12
|
|
slwi r23, r23, 2
|
|
add r23, r23, r17
|
|
lwz r23, 0x0038(r23)
|
|
rlwimi r23, r28, 0, 20, 31
|
|
blr
|
|
|
|
|
|
|
|
; Xrefs:
|
|
; MPCall_103
|
|
|
|
AnotherCoherenceFunc ; OUTSIDE REFERER
|
|
cmpwi r26, 0x00
|
|
beqlr-
|
|
mflr r22
|
|
addi r24, r24, -0x01
|
|
mr r28, r25
|
|
|
|
AnotherCoherenceFunc_0x14
|
|
bl CoherenceFunc_0x138
|
|
clrlwi r25, r23, 0x14
|
|
subfic r25, r25, 0x1000
|
|
cmplw r25, r26
|
|
blt- AnotherCoherenceFunc_0x2c
|
|
mr r25, r26
|
|
|
|
AnotherCoherenceFunc_0x2c
|
|
mr r19, r23
|
|
mr r20, r25
|
|
addi r23, r23, -0x01
|
|
mtctr r25
|
|
|
|
AnotherCoherenceFunc_0x3c
|
|
lbzu r27, 0x0001(r24)
|
|
stbu r27, 0x0001(r23)
|
|
bdnz+ AnotherCoherenceFunc_0x3c
|
|
bl YetAnotherCoherenceFunc_0x64
|
|
subf r26, r25, r26
|
|
add r28, r28, r25
|
|
cmpwi r26, 0x00
|
|
bne+ AnotherCoherenceFunc_0x14
|
|
mtlr r22
|
|
blr
|
|
|
|
|
|
|
|
; Xrefs:
|
|
; RestoreKernelState
|
|
; AnotherCoherenceFunc
|
|
|
|
YetAnotherCoherenceFunc ; OUTSIDE REFERER
|
|
cmpwi r26, 0x00
|
|
beqlr-
|
|
mr r19, r25
|
|
mr r20, r26
|
|
mflr r22
|
|
addi r25, r25, -0x01
|
|
mr r28, r24
|
|
|
|
YetAnotherCoherenceFunc_0x1c
|
|
bl CoherenceFunc_0x138
|
|
clrlwi r24, r23, 0x14
|
|
subfic r24, r24, 0x1000
|
|
cmplw r24, r26
|
|
blt- YetAnotherCoherenceFunc_0x34
|
|
mr r24, r26
|
|
|
|
YetAnotherCoherenceFunc_0x34
|
|
addi r23, r23, -0x01
|
|
mtctr r24
|
|
|
|
YetAnotherCoherenceFunc_0x3c
|
|
lbzu r27, 0x0001(r23)
|
|
stbu r27, 0x0001(r25)
|
|
bdnz+ YetAnotherCoherenceFunc_0x3c
|
|
add r28, r28, r24
|
|
subf r26, r24, r26
|
|
cmpwi r26, 0x00
|
|
bne+ YetAnotherCoherenceFunc_0x1c
|
|
bl YetAnotherCoherenceFunc_0x64
|
|
mtlr r22
|
|
blr
|
|
|
|
YetAnotherCoherenceFunc_0x64 ; OUTSIDE REFERER
|
|
sync
|
|
isync
|
|
lhz r21, 0x0f4a(r1)
|
|
addi r15, r21, -0x01
|
|
add r20, r19, r20
|
|
add r20, r20, r15
|
|
neg r15, r21
|
|
and r19, r19, r15
|
|
and r20, r20, r15
|
|
|
|
YetAnotherCoherenceFunc_0x88
|
|
dcbst 0, r19
|
|
sync
|
|
icbi 0, r19
|
|
add r19, r19, r21
|
|
cmpw r19, r20
|
|
blt+ YetAnotherCoherenceFunc_0x88
|
|
sync
|
|
isync
|
|
blr
|