PrimeDecomp
/
prime
mirror of https://github.com/PrimeDecomp/prime.git
2
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Match and link OSThread.c 

Former-commit-id: 1ccd29a1cd
This commit is contained in:
Phillip Stephens 2022-11-05 03:21:17 -07:00
parent 6f932a5d48
commit c20c3e399c
8 changed files with 946 additions and 66 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
.vscode/settings.json vendored
View File

@ -27,7 +27,15 @@
"db.h": "c",
"ppcarch.h": "c",
"osalarm.h": "c",
"ospriv.h": "c"
"ospriv.h": "c",
"gx.h": "c",
"osthread.h": "c",
"osserial.h": "c",
"osmutex.h": "c",
"osexception.h": "c",
"oserror.h": "c",
"oscontext.h": "c",
"oscache.h": "c"
},
"files.autoSave": "onFocusChange",
"files.insertFinalNewline": true,

108
asm/Dolphin/os/OSThread.s
View File

@ -2,16 +2,16 @@
.section .bss
.balign 8
lbl_805415F8:
RunQueue:
.skip 0x9F8
.section .sbss
.balign 8
lbl_805A9920:
RunQueueBits:
.skip 0x4
lbl_805A9924:
RunQueueHint:
.skip 0x4
lbl_805A9928:
Reschedule:
.skip 0x8
.section .sdata
@ -33,7 +33,7 @@ DefaultSwitchThreadCallback:
.global __OSThreadInit
__OSThreadInit:
/* 8038446C 003813CC 7C 08 02 A6 */ mflr r0
/* 80384470 003813D0 3C 60 80 54 */ lis r3, lbl_805415F8@ha
/* 80384470 003813D0 3C 60 80 54 */ lis r3, RunQueue@ha
/* 80384474 003813D4 90 01 00 04 */ stw r0, 4(r1)
/* 80384478 003813D8 38 00 00 02 */ li r0, 2
/* 8038447C 003813DC 38 80 00 10 */ li r4, 0x10
@ -43,7 +43,7 @@ __OSThreadInit:
/* 8038448C 003813EC 93 A1 00 0C */ stw r29, 0xc(r1)
/* 80384490 003813F0 3B A0 00 00 */ li r29, 0
/* 80384494 003813F4 93 81 00 08 */ stw r28, 8(r1)
/* 80384498 003813F8 3B 83 15 F8 */ addi r28, r3, lbl_805415F8@l
/* 80384498 003813F8 3B 83 15 F8 */ addi r28, r3, RunQueue@l
/* 8038449C 003813FC 3B FC 04 18 */ addi r31, r28, 0x418
/* 803844A0 00381400 B0 1C 06 E0 */ sth r0, 0x6e0(r28)
/* 803844A4 00381404 38 00 00 01 */ li r0, 1
@ -82,10 +82,10 @@ __OSThreadInit:
/* 80384528 00381488 93 FE 00 E4 */ stw r31, 0xe4(r30)
/* 8038452C 0038148C 38 60 00 00 */ li r3, 0
/* 80384530 00381490 48 00 0D CD */ bl OSClearStack
/* 80384534 00381494 93 AD AD 60 */ stw r29, lbl_805A9920@sda21(r13)
/* 80384534 00381494 93 AD AD 60 */ stw r29, RunQueueBits@sda21(r13)
/* 80384538 00381498 3B C0 00 00 */ li r30, 0
/* 8038453C 0038149C 57 C0 18 38 */ slwi r0, r30, 3
/* 80384540 003814A0 93 AD AD 64 */ stw r29, lbl_805A9924@sda21(r13)
/* 80384540 003814A0 93 AD AD 64 */ stw r29, RunQueueHint@sda21(r13)
/* 80384544 003814A4 7F BC 02 14 */ add r29, r28, r0
lbl_80384548:
/* 80384548 003814A8 7F A3 EB 78 */ mr r3, r29
@ -112,7 +112,7 @@ lbl_80384588:
/* 80384594 003814F4 93 DF 02 FC */ stw r30, 0x2fc(r31)
/* 80384598 003814F8 93 E4 00 00 */ stw r31, 0(r4)
/* 8038459C 003814FC 4B FF B0 79 */ bl OSClearContext
/* 803845A0 00381500 93 CD AD 68 */ stw r30, lbl_805A9928@sda21(r13)
/* 803845A0 00381500 93 CD AD 68 */ stw r30, Reschedule@sda21(r13)
/* 803845A4 00381504 80 01 00 1C */ lwz r0, 0x1c(r1)
/* 803845A8 00381508 83 E1 00 14 */ lwz r31, 0x14(r1)
/* 803845AC 0038150C 83 C1 00 10 */ lwz r30, 0x10(r1)
@ -142,9 +142,9 @@ OSDisableScheduler:
/* 803845E8 00381548 94 21 FF F0 */ stwu r1, -0x10(r1)
/* 803845EC 0038154C 93 E1 00 0C */ stw r31, 0xc(r1)
/* 803845F0 00381550 4B FF D0 71 */ bl OSDisableInterrupts
/* 803845F4 00381554 80 8D AD 68 */ lwz r4, lbl_805A9928@sda21(r13)
/* 803845F4 00381554 80 8D AD 68 */ lwz r4, Reschedule@sda21(r13)
/* 803845F8 00381558 38 04 00 01 */ addi r0, r4, 1
/* 803845FC 0038155C 90 0D AD 68 */ stw r0, lbl_805A9928@sda21(r13)
/* 803845FC 0038155C 90 0D AD 68 */ stw r0, Reschedule@sda21(r13)
/* 80384600 00381560 7C 9F 23 78 */ mr r31, r4
/* 80384604 00381564 4B FF D0 85 */ bl OSRestoreInterrupts
/* 80384608 00381568 7F E3 FB 78 */ mr r3, r31
@ -161,9 +161,9 @@ OSEnableScheduler:
/* 80384628 00381588 94 21 FF F0 */ stwu r1, -0x10(r1)
/* 8038462C 0038158C 93 E1 00 0C */ stw r31, 0xc(r1)
/* 80384630 00381590 4B FF D0 31 */ bl OSDisableInterrupts
/* 80384634 00381594 80 8D AD 68 */ lwz r4, lbl_805A9928@sda21(r13)
/* 80384634 00381594 80 8D AD 68 */ lwz r4, Reschedule@sda21(r13)
/* 80384638 00381598 38 04 FF FF */ addi r0, r4, -1
/* 8038463C 0038159C 90 0D AD 68 */ stw r0, lbl_805A9928@sda21(r13)
/* 8038463C 0038159C 90 0D AD 68 */ stw r0, Reschedule@sda21(r13)
/* 80384640 003815A0 7C 9F 23 78 */ mr r31, r4
/* 80384644 003815A4 4B FF D0 45 */ bl OSRestoreInterrupts
/* 80384648 003815A8 7F E3 FB 78 */ mr r3, r31
@ -197,11 +197,11 @@ lbl_80384694:
/* 8038469C 003815FC 40 82 00 20 */ bne lbl_803846BC
/* 803846A0 00381600 80 03 02 D0 */ lwz r0, 0x2d0(r3)
/* 803846A4 00381604 38 80 00 01 */ li r4, 1
/* 803846A8 00381608 80 AD AD 60 */ lwz r5, lbl_805A9920@sda21(r13)
/* 803846A8 00381608 80 AD AD 60 */ lwz r5, RunQueueBits@sda21(r13)
/* 803846AC 0038160C 20 00 00 1F */ subfic r0, r0, 0x1f
/* 803846B0 00381610 7C 80 00 30 */ slw r0, r4, r0
/* 803846B4 00381614 7C A0 00 78 */ andc r0, r5, r0
/* 803846B8 00381618 90 0D AD 60 */ stw r0, lbl_805A9920@sda21(r13)
/* 803846B8 00381618 90 0D AD 60 */ stw r0, RunQueueBits@sda21(r13)
lbl_803846BC:
/* 803846BC 0038161C 38 00 00 00 */ li r0, 0
/* 803846C0 00381620 90 03 02 DC */ stw r0, 0x2dc(r3)
@ -253,8 +253,8 @@ lbl_8038474C:
/* 8038474C 003816AC 7F E3 FB 78 */ mr r3, r31
/* 80384750 003816B0 4B FF FF 11 */ bl UnsetRun
/* 80384754 003816B4 93 DF 02 D0 */ stw r30, 0x2d0(r31)
/* 80384758 003816B8 3C 60 80 54 */ lis r3, lbl_805415F8@ha
/* 8038475C 003816BC 38 03 15 F8 */ addi r0, r3, lbl_805415F8@l
/* 80384758 003816B8 3C 60 80 54 */ lis r3, RunQueue@ha
/* 8038475C 003816BC 38 03 15 F8 */ addi r0, r3, RunQueue@l
/* 80384760 003816C0 80 7F 02 D0 */ lwz r3, 0x2d0(r31)
/* 80384764 003816C4 54 63 18 38 */ slwi r3, r3, 3
/* 80384768 003816C8 7C 00 1A 14 */ add r0, r0, r3
@ -275,12 +275,12 @@ lbl_8038478C:
/* 8038479C 003816FC 80 9F 02 DC */ lwz r4, 0x2dc(r31)
/* 803847A0 00381700 93 E4 00 04 */ stw r31, 4(r4)
/* 803847A4 00381704 80 1F 02 D0 */ lwz r0, 0x2d0(r31)
/* 803847A8 00381708 80 8D AD 60 */ lwz r4, lbl_805A9920@sda21(r13)
/* 803847A8 00381708 80 8D AD 60 */ lwz r4, RunQueueBits@sda21(r13)
/* 803847AC 0038170C 20 00 00 1F */ subfic r0, r0, 0x1f
/* 803847B0 00381710 7C 60 00 30 */ slw r0, r3, r0
/* 803847B4 00381714 7C 80 03 78 */ or r0, r4, r0
/* 803847B8 00381718 90 0D AD 60 */ stw r0, lbl_805A9920@sda21(r13)
/* 803847BC 0038171C 90 6D AD 64 */ stw r3, lbl_805A9924@sda21(r13)
/* 803847B8 00381718 90 0D AD 60 */ stw r0, RunQueueBits@sda21(r13)
/* 803847BC 0038171C 90 6D AD 64 */ stw r3, RunQueueHint@sda21(r13)
/* 803847C0 00381720 48 00 00 E8 */ b lbl_803848A8
lbl_803847C4:
/* 803847C4 00381724 80 9F 02 E0 */ lwz r4, 0x2e0(r31)
@ -351,7 +351,7 @@ lbl_80384888:
/* 80384898 003817F8 48 00 00 14 */ b lbl_803848AC
lbl_8038489C:
/* 8038489C 003817FC 38 00 00 01 */ li r0, 1
/* 803848A0 00381800 90 0D AD 64 */ stw r0, lbl_805A9924@sda21(r13)
/* 803848A0 00381800 90 0D AD 64 */ stw r0, RunQueueHint@sda21(r13)
/* 803848A4 00381804 93 DF 02 D0 */ stw r30, 0x2d0(r31)
lbl_803848A8:
/* 803848A8 00381808 38 60 00 00 */ li r3, 0
@ -366,14 +366,14 @@ lbl_803848AC:
.global SelectThread
SelectThread:
/* 803848C4 00381824 7C 08 02 A6 */ mflr r0
/* 803848C8 00381828 3C 80 80 54 */ lis r4, lbl_805415F8@ha
/* 803848C8 00381828 3C 80 80 54 */ lis r4, RunQueue@ha
/* 803848CC 0038182C 90 01 00 04 */ stw r0, 4(r1)
/* 803848D0 00381830 94 21 FF E8 */ stwu r1, -0x18(r1)
/* 803848D4 00381834 93 E1 00 14 */ stw r31, 0x14(r1)
/* 803848D8 00381838 3B E4 15 F8 */ addi r31, r4, lbl_805415F8@l
/* 803848D8 00381838 3B E4 15 F8 */ addi r31, r4, RunQueue@l
/* 803848DC 0038183C 93 C1 00 10 */ stw r30, 0x10(r1)
/* 803848E0 00381840 3B C3 00 00 */ addi r30, r3, 0
/* 803848E4 00381844 80 0D AD 68 */ lwz r0, lbl_805A9928@sda21(r13)
/* 803848E4 00381844 80 0D AD 68 */ lwz r0, Reschedule@sda21(r13)
/* 803848E8 00381848 2C 00 00 00 */ cmpwi r0, 0
/* 803848EC 0038184C 40 81 00 0C */ ble lbl_803848F8
/* 803848F0 00381850 38 60 00 00 */ li r3, 0
@ -395,7 +395,7 @@ lbl_80384918:
/* 80384928 00381888 40 82 00 90 */ bne lbl_803849B8
/* 8038492C 0038188C 2C 1E 00 00 */ cmpwi r30, 0
/* 80384930 00381890 40 82 00 20 */ bne lbl_80384950
/* 80384934 00381894 80 8D AD 60 */ lwz r4, lbl_805A9920@sda21(r13)
/* 80384934 00381894 80 8D AD 60 */ lwz r4, RunQueueBits@sda21(r13)
/* 80384938 00381898 80 06 02 D0 */ lwz r0, 0x2d0(r6)
/* 8038493C 0038189C 7C 84 00 34 */ cntlzw r4, r4
/* 80384940 003818A0 7C 00 20 00 */ cmpw r0, r4
@ -425,12 +425,12 @@ lbl_80384984:
/* 80384994 003818F4 80 A6 02 DC */ lwz r5, 0x2dc(r6)
/* 80384998 003818F8 90 C5 00 04 */ stw r6, 4(r5)
/* 8038499C 003818FC 80 06 02 D0 */ lwz r0, 0x2d0(r6)
/* 803849A0 00381900 80 AD AD 60 */ lwz r5, lbl_805A9920@sda21(r13)
/* 803849A0 00381900 80 AD AD 60 */ lwz r5, RunQueueBits@sda21(r13)
/* 803849A4 00381904 20 00 00 1F */ subfic r0, r0, 0x1f
/* 803849A8 00381908 7C 80 00 30 */ slw r0, r4, r0
/* 803849AC 0038190C 7C A0 03 78 */ or r0, r5, r0
/* 803849B0 00381910 90 0D AD 60 */ stw r0, lbl_805A9920@sda21(r13)
/* 803849B4 00381914 90 8D AD 64 */ stw r4, lbl_805A9924@sda21(r13)
/* 803849B0 00381910 90 0D AD 60 */ stw r0, RunQueueBits@sda21(r13)
/* 803849B4 00381914 90 8D AD 64 */ stw r4, RunQueueHint@sda21(r13)
lbl_803849B8:
/* 803849B8 00381918 A0 06 01 A2 */ lhz r0, 0x1a2(r6)
/* 803849BC 0038191C 54 00 07 BD */ rlwinm. r0, r0, 0, 0x1e, 0x1e
@ -447,7 +447,7 @@ lbl_803849D8:
/* 803849E4 00381944 38 80 00 00 */ li r4, 0
/* 803849E8 00381948 7D 88 03 A6 */ mtlr r12
/* 803849EC 0038194C 4E 80 00 21 */ blrl
/* 803849F0 00381950 80 0D AD 60 */ lwz r0, lbl_805A9920@sda21(r13)
/* 803849F0 00381950 80 0D AD 60 */ lwz r0, RunQueueBits@sda21(r13)
/* 803849F4 00381954 38 60 00 00 */ li r3, 0
/* 803849F8 00381958 90 7E 00 E4 */ stw r3, 0xe4(r30)
/* 803849FC 0038195C 28 00 00 00 */ cmplwi r0, 0
@ -457,19 +457,19 @@ lbl_803849D8:
lbl_80384A0C:
/* 80384A0C 0038196C 4B FF CC 69 */ bl OSEnableInterrupts
lbl_80384A10:
/* 80384A10 00381970 80 0D AD 60 */ lwz r0, lbl_805A9920@sda21(r13)
/* 80384A10 00381970 80 0D AD 60 */ lwz r0, RunQueueBits@sda21(r13)
/* 80384A14 00381974 28 00 00 00 */ cmplwi r0, 0
/* 80384A18 00381978 41 82 FF F8 */ beq lbl_80384A10
/* 80384A1C 0038197C 4B FF CC 45 */ bl OSDisableInterrupts
/* 80384A20 00381980 80 0D AD 60 */ lwz r0, lbl_805A9920@sda21(r13)
/* 80384A20 00381980 80 0D AD 60 */ lwz r0, RunQueueBits@sda21(r13)
/* 80384A24 00381984 28 00 00 00 */ cmplwi r0, 0
/* 80384A28 00381988 41 82 FF E4 */ beq lbl_80384A0C
/* 80384A2C 0038198C 38 7F 07 30 */ addi r3, r31, 0x730
/* 80384A30 00381990 4B FF AB E5 */ bl OSClearContext
lbl_80384A34:
/* 80384A34 00381994 38 60 00 00 */ li r3, 0
/* 80384A38 00381998 90 6D AD 64 */ stw r3, lbl_805A9924@sda21(r13)
/* 80384A3C 0038199C 80 0D AD 60 */ lwz r0, lbl_805A9920@sda21(r13)
/* 80384A38 00381998 90 6D AD 64 */ stw r3, RunQueueHint@sda21(r13)
/* 80384A3C 0038199C 80 0D AD 60 */ lwz r0, RunQueueBits@sda21(r13)
/* 80384A40 003819A0 7C 07 00 34 */ cntlzw r7, r0
/* 80384A44 003819A4 54 E0 18 38 */ slwi r0, r7, 3
/* 80384A48 003819A8 7C 9F 02 14 */ add r4, r31, r0
@ -488,11 +488,11 @@ lbl_80384A6C:
/* 80384A74 003819D4 28 00 00 00 */ cmplwi r0, 0
/* 80384A78 003819D8 40 82 00 1C */ bne lbl_80384A94
/* 80384A7C 003819DC 20 07 00 1F */ subfic r0, r7, 0x1f
/* 80384A80 003819E0 80 8D AD 60 */ lwz r4, lbl_805A9920@sda21(r13)
/* 80384A80 003819E0 80 8D AD 60 */ lwz r4, RunQueueBits@sda21(r13)
/* 80384A84 003819E4 38 60 00 01 */ li r3, 1
/* 80384A88 003819E8 7C 60 00 30 */ slw r0, r3, r0
/* 80384A8C 003819EC 7C 80 00 78 */ andc r0, r4, r0
/* 80384A90 003819F0 90 0D AD 60 */ stw r0, lbl_805A9920@sda21(r13)
/* 80384A90 003819F0 90 0D AD 60 */ stw r0, RunQueueBits@sda21(r13)
lbl_80384A94:
/* 80384A94 003819F4 38 00 00 00 */ li r0, 0
/* 80384A98 003819F8 90 1E 02 DC */ stw r0, 0x2dc(r30)
@ -523,7 +523,7 @@ __OSReschedule:
/* 80384AEC 00381A4C 7C 08 02 A6 */ mflr r0
/* 80384AF0 00381A50 90 01 00 04 */ stw r0, 4(r1)
/* 80384AF4 00381A54 94 21 FF F8 */ stwu r1, -8(r1)
/* 80384AF8 00381A58 80 0D AD 64 */ lwz r0, lbl_805A9924@sda21(r13)
/* 80384AF8 00381A58 80 0D AD 64 */ lwz r0, RunQueueHint@sda21(r13)
/* 80384AFC 00381A5C 2C 00 00 00 */ cmpwi r0, 0
/* 80384B00 00381A60 41 82 00 0C */ beq lbl_80384B0C
/* 80384B04 00381A64 38 60 00 00 */ li r3, 0
@ -584,7 +584,7 @@ lbl_80384BA8:
/* 80384BBC 00381B1C 48 00 00 B0 */ b lbl_80384C6C
lbl_80384BC0:
/* 80384BC0 00381B20 38 00 00 01 */ li r0, 1
/* 80384BC4 00381B24 90 0D AD 64 */ stw r0, lbl_805A9924@sda21(r13)
/* 80384BC4 00381B24 90 0D AD 64 */ stw r0, RunQueueHint@sda21(r13)
/* 80384BC8 00381B28 48 00 00 A4 */ b lbl_80384C6C
lbl_80384BCC:
/* 80384BCC 00381B2C 80 9E 02 E0 */ lwz r4, 0x2e0(r30)
@ -668,7 +668,7 @@ lbl_80384CCC:
/* 80384CD0 00381C30 4B FF E0 E9 */ bl __OSUnlockAllMutex
/* 80384CD4 00381C34 38 7E 02 E8 */ addi r3, r30, 0x2e8
/* 80384CD8 00381C38 48 00 05 21 */ bl OSWakeupThread
/* 80384CDC 00381C3C 80 0D AD 64 */ lwz r0, lbl_805A9924@sda21(r13)
/* 80384CDC 00381C3C 80 0D AD 64 */ lwz r0, RunQueueHint@sda21(r13)
/* 80384CE0 00381C40 2C 00 00 00 */ cmpwi r0, 0
/* 80384CE4 00381C44 41 82 00 0C */ beq lbl_80384CF0
/* 80384CE8 00381C48 38 60 00 00 */ li r3, 0
@ -733,8 +733,8 @@ lbl_80384DAC:
/* 80384DAC 00381D0C 28 03 00 00 */ cmplwi r3, 0
/* 80384DB0 00381D10 40 82 FF DC */ bne lbl_80384D8C
/* 80384DB4 00381D14 90 1D 02 D0 */ stw r0, 0x2d0(r29)
/* 80384DB8 00381D18 3C 60 80 54 */ lis r3, lbl_805415F8@ha
/* 80384DBC 00381D1C 38 03 15 F8 */ addi r0, r3, lbl_805415F8@l
/* 80384DB8 00381D18 3C 60 80 54 */ lis r3, RunQueue@ha
/* 80384DBC 00381D1C 38 03 15 F8 */ addi r0, r3, RunQueue@l
/* 80384DC0 00381D20 80 7D 02 D0 */ lwz r3, 0x2d0(r29)
/* 80384DC4 00381D24 54 63 18 38 */ slwi r3, r3, 3
/* 80384DC8 00381D28 7C 00 1A 14 */ add r0, r0, r3
@ -755,12 +755,12 @@ lbl_80384DEC:
/* 80384DFC 00381D5C 80 9D 02 DC */ lwz r4, 0x2dc(r29)
/* 80384E00 00381D60 93 A4 00 04 */ stw r29, 4(r4)
/* 80384E04 00381D64 80 1D 02 D0 */ lwz r0, 0x2d0(r29)
/* 80384E08 00381D68 80 8D AD 60 */ lwz r4, lbl_805A9920@sda21(r13)
/* 80384E08 00381D68 80 8D AD 60 */ lwz r4, RunQueueBits@sda21(r13)
/* 80384E0C 00381D6C 20 00 00 1F */ subfic r0, r0, 0x1f
/* 80384E10 00381D70 7C 60 00 30 */ slw r0, r3, r0
/* 80384E14 00381D74 7C 80 03 78 */ or r0, r4, r0
/* 80384E18 00381D78 90 0D AD 60 */ stw r0, lbl_805A9920@sda21(r13)
/* 80384E1C 00381D7C 90 6D AD 64 */ stw r3, lbl_805A9924@sda21(r13)
/* 80384E18 00381D78 90 0D AD 60 */ stw r0, RunQueueBits@sda21(r13)
/* 80384E1C 00381D7C 90 6D AD 64 */ stw r3, RunQueueHint@sda21(r13)
/* 80384E20 00381D80 48 00 01 40 */ b lbl_80384F60
lbl_80384E24:
/* 80384E24 00381D84 80 9D 02 E0 */ lwz r4, 0x2e0(r29)
@ -859,7 +859,7 @@ lbl_80384F2C:
/* 80384F58 00381EB8 7C 7D 1B 79 */ or. r29, r3, r3
/* 80384F5C 00381EBC 40 82 FF D0 */ bne lbl_80384F2C
lbl_80384F60:
/* 80384F60 00381EC0 80 0D AD 64 */ lwz r0, lbl_805A9924@sda21(r13)
/* 80384F60 00381EC0 80 0D AD 64 */ lwz r0, RunQueueHint@sda21(r13)
/* 80384F64 00381EC4 2C 00 00 00 */ cmpwi r0, 0
/* 80384F68 00381EC8 41 82 00 0C */ beq lbl_80384F74
/* 80384F6C 00381ECC 38 60 00 00 */ li r3, 0
@ -906,7 +906,7 @@ lbl_80384FF4:
/* 80384FFC 00381F5C 48 00 00 20 */ b lbl_8038501C
lbl_80385000:
/* 80385000 00381F60 38 00 00 01 */ li r0, 1
/* 80385004 00381F64 90 0D AD 64 */ stw r0, lbl_805A9924@sda21(r13)
/* 80385004 00381F64 90 0D AD 64 */ stw r0, RunQueueHint@sda21(r13)
/* 80385008 00381F68 B0 1D 02 C8 */ sth r0, 0x2c8(r29)
/* 8038500C 00381F6C 48 00 00 C4 */ b lbl_803850D0
lbl_80385010:
@ -967,7 +967,7 @@ lbl_8038509C:
/* 803850C8 00382028 7C 7D 1B 79 */ or. r29, r3, r3
/* 803850CC 0038202C 40 82 FF D0 */ bne lbl_8038509C
lbl_803850D0:
/* 803850D0 00382030 80 0D AD 64 */ lwz r0, lbl_805A9924@sda21(r13)
/* 803850D0 00382030 80 0D AD 64 */ lwz r0, RunQueueHint@sda21(r13)
/* 803850D4 00382034 2C 00 00 00 */ cmpwi r0, 0
/* 803850D8 00382038 41 82 00 0C */ beq lbl_803850E4
/* 803850DC 0038203C 38 60 00 00 */ li r3, 0
@ -1039,8 +1039,8 @@ lbl_803851B8:
/* 803851B8 00382118 90 83 02 E0 */ stw r4, 0x2e0(r3)
lbl_803851BC:
/* 803851BC 0038211C 38 00 00 01 */ li r0, 1
/* 803851C0 00382120 90 0D AD 64 */ stw r0, lbl_805A9924@sda21(r13)
/* 803851C4 00382124 80 0D AD 64 */ lwz r0, lbl_805A9924@sda21(r13)
/* 803851C0 00382120 90 0D AD 64 */ stw r0, RunQueueHint@sda21(r13)
/* 803851C4 00382124 80 0D AD 64 */ lwz r0, RunQueueHint@sda21(r13)
/* 803851C8 00382128 2C 00 00 00 */ cmpwi r0, 0
/* 803851CC 0038212C 41 82 00 0C */ beq lbl_803851D8
/* 803851D0 00382130 38 60 00 00 */ li r3, 0
@ -1064,9 +1064,9 @@ OSWakeupThread:
/* 80385208 00382168 93 C1 00 10 */ stw r30, 0x10(r1)
/* 8038520C 0038216C 7C 7E 1B 78 */ mr r30, r3
/* 80385210 00382170 4B FF C4 51 */ bl OSDisableInterrupts
/* 80385214 00382174 3C 80 80 54 */ lis r4, lbl_805415F8@ha
/* 80385214 00382174 3C 80 80 54 */ lis r4, RunQueue@ha
/* 80385218 00382178 3B E3 00 00 */ addi r31, r3, 0
/* 8038521C 0038217C 38 A4 15 F8 */ addi r5, r4, lbl_805415F8@l
/* 8038521C 0038217C 38 A4 15 F8 */ addi r5, r4, RunQueue@l
/* 80385220 00382180 48 00 00 9C */ b lbl_803852BC
lbl_80385224:
/* 80385224 00382184 80 66 02 E0 */ lwz r3, 0x2e0(r6)
@ -1105,17 +1105,17 @@ lbl_80385288:
/* 80385298 003821F8 80 86 02 DC */ lwz r4, 0x2dc(r6)
/* 8038529C 003821FC 90 C4 00 04 */ stw r6, 4(r4)
/* 803852A0 00382200 80 06 02 D0 */ lwz r0, 0x2d0(r6)
/* 803852A4 00382204 80 8D AD 60 */ lwz r4, lbl_805A9920@sda21(r13)
/* 803852A4 00382204 80 8D AD 60 */ lwz r4, RunQueueBits@sda21(r13)
/* 803852A8 00382208 20 00 00 1F */ subfic r0, r0, 0x1f
/* 803852AC 0038220C 7C 60 00 30 */ slw r0, r3, r0
/* 803852B0 00382210 7C 80 03 78 */ or r0, r4, r0
/* 803852B4 00382214 90 0D AD 60 */ stw r0, lbl_805A9920@sda21(r13)
/* 803852B8 00382218 90 6D AD 64 */ stw r3, lbl_805A9924@sda21(r13)
/* 803852B4 00382214 90 0D AD 60 */ stw r0, RunQueueBits@sda21(r13)
/* 803852B8 00382218 90 6D AD 64 */ stw r3, RunQueueHint@sda21(r13)
lbl_803852BC:
/* 803852BC 0038221C 80 DE 00 00 */ lwz r6, 0(r30)
/* 803852C0 00382220 28 06 00 00 */ cmplwi r6, 0
/* 803852C4 00382224 40 82 FF 60 */ bne lbl_80385224
/* 803852C8 00382228 80 0D AD 64 */ lwz r0, lbl_805A9924@sda21(r13)
/* 803852C8 00382228 80 0D AD 64 */ lwz r0, RunQueueHint@sda21(r13)
/* 803852CC 0038222C 2C 00 00 00 */ cmpwi r0, 0
/* 803852D0 00382230 41 82 00 0C */ beq lbl_803852DC
/* 803852D4 00382234 38 60 00 00 */ li r3, 0

2
configure.py
View File

@ -841,7 +841,7 @@ LIBS = [
"Dolphin/os/OSResetSW",
["Dolphin/os/OSRtc", False],
["Dolphin/os/OSSync", True],
"Dolphin/os/OSThread",
["Dolphin/os/OSThread", True],
["Dolphin/os/OSTime", True],
["Dolphin/os/__ppc_eabi_init", True],
],

14
include/dolphin/os.h
View File

@ -67,10 +67,10 @@ OSTime OSGetTime();
OSTick OSGetTick();
typedef struct OSCalendarTime {
int sec; // seconds after the minute [0, 61]
int min; // minutes after the hour [0, 59]
int hour; // hours since midnight [0, 23]
int mday; // day of the month [1, 31]
int sec; // seconds after the minute [0, 61]
int min; // minutes after the hour [0, 59]
int hour; // hours since midnight [0, 23]
int mday; // day of the month [1, 31]
int mon; // month since January [0, 11]
int year; // years in AD [1, ...]
int wday; // days since Sunday [0, 6]
@ -80,9 +80,8 @@ typedef struct OSCalendarTime {
int usec; // microseconds after the millisecond [0,999]
} OSCalendarTime;
OSTime OSCalendarTimeToTicks( OSCalendarTime* td );
void OSTicksToCalendarTime( OSTime ticks, OSCalendarTime* td );
OSTime OSCalendarTimeToTicks(OSCalendarTime* td);
void OSTicksToCalendarTime(OSTime ticks, OSCalendarTime* td);
#define OS_CONSOLE_MASK 0xf0000000
#define OS_CONSOLE_RETAIL 0x00000000
@ -157,6 +156,7 @@ void OSFatal(GXColor fg, GXColor bg, const char* msg);
#include <dolphin/os/OSException.h>
#include <dolphin/os/OSFont.h>
#include <dolphin/os/OSInterrupt.h>
#include <dolphin/os/OSMutex.h>
#include <dolphin/os/OSReset.h>
#include <dolphin/os/OSSerial.h>
#include <dolphin/os/OSThread.h>

5
include/dolphin/os/OSContext.h
View File

@ -80,7 +80,7 @@ extern "C" {
#define OS_CONTEXT_FPR30 384
#define OS_CONTEXT_FPR31 392
#define OS_CONTEXT_FPSCR 400
#define OS_CONTEXT_FPSCR 400
#define OS_CONTEXT_SRR0 408
#define OS_CONTEXT_SRR1 412
@ -130,6 +130,7 @@ extern "C" {
#define OS_CONTEXT_PSF29 688
#define OS_CONTEXT_PSF30 696
#define OS_CONTEXT_PSF31 704
#define OS_CONTEXT_STATE_EXC 0x02u
typedef struct OSContext {
u32 gpr[32];
@ -155,7 +156,7 @@ typedef struct OSContext {
} OSContext;
void OSSaveContext(OSContext* context);
u32 OSSaveContext(OSContext* context);
void OSClearContext(OSContext* context);
OSContext* OSGetCurrentContext();
void OSSetCurrentContext(OSContext* context);

42
include/dolphin/os/OSThread.h
View File

@ -62,7 +62,49 @@ struct OSThread {
void* specific[OS_THREAD_SPECIFIC_MAX];
};
enum OS_THREAD_STATE {
OS_THREAD_STATE_READY = 1,
OS_THREAD_STATE_RUNNING = 2,
OS_THREAD_STATE_WAITING = 4,
OS_THREAD_STATE_MORIBUND = 8
};
#define OS_THREAD_ATTR_DETACH 0x0001u
#define OS_THREAD_STACK_MAGIC 0xDEADBABE
#define OS_PRIORITY_MIN 0 // highest
#define OS_PRIORITY_MAX 31 // lowest
#define OS_PRIORITY_IDLE OS_PRIORITY_MAX
void OSInitThreadQueue(OSThreadQueue* queue);
OSThread* OSGetCurrentThread(void);
BOOL OSIsThreadSuspended(OSThread* thread);
BOOL OSIsThreadTerminated(OSThread* thread);
s32 OSDisableScheduler(void);
s32 OSEnableScheduler(void);
void OSYieldThread(void);
BOOL OSCreateThread(OSThread* thread, void* (*func)(void*), void* param, void* stack, u32 stackSize,
OSPriority priority, u16 attr);
void OSExitThread(void* val);
void OSCancelThread(OSThread* thread);
BOOL OSJoinThread(OSThread* thread, void** val);
void OSDetachThread(OSThread* thread);
s32 OSResumeThread(OSThread* thread);
s32 OSSuspendThread(OSThread* thread);
BOOL OSSetThreadPriority(OSThread* thread, OSPriority priority);
OSPriority OSGetThreadPriority(OSThread* thread);
void OSSleepThread(OSThreadQueue* queue);
void OSWakeupThread(OSThreadQueue* queue);
void* OSGetThreadSpecific(s32 index);
void OSSetThreadSpecific(s32 index, void* ptr);
OSThread* OSSetIdleFunction(OSIdleFunction idleFunction, void* param, void* stack, u32 stackSize);
OSThread* OSGetIdleFunction(void);
void OSClearStack(u8 val);
long OSCheckActiveThreads(void);
#ifdef __cplusplus
}

2
obj_files.mk
View File

@ -706,7 +706,7 @@ OS_FILES :=\
$(BUILD_DIR)/asm/Dolphin/os/OSResetSW.o\
$(BUILD_DIR)/asm/Dolphin/os/OSRtc.o\
$(BUILD_DIR)/src/Dolphin/os/OSSync.o\
$(BUILD_DIR)/asm/Dolphin/os/OSThread.o\
$(BUILD_DIR)/src/Dolphin/os/OSThread.ep.o\
$(BUILD_DIR)/src/Dolphin/os/OSTime.ep.o\
$(BUILD_DIR)/src/Dolphin/os/__ppc_eabi_init.ep.o\

829
src/Dolphin/os/OSThread.c Normal file
View File

@ -0,0 +1,829 @@
#include "dolphin/os/OSPriv.h"
static vu32 RunQueueBits;
static volatile BOOL RunQueueHint;
static vs32 Reschedule;
static OSThreadQueue RunQueue[32];
static OSThread IdleThread;
static OSThread DefaultThread;
static OSContext IdleContext;
static void DefaultSwitchThreadCallback(OSThread* from, OSThread* to);
static OSSwitchThreadCallback SwitchThreadCallback = DefaultSwitchThreadCallback;
OSThread* __OSCurrentThread : OS_BASE_CACHED + 0x00E4;
OSThreadQueue __OSActiveThreadQueue : OS_BASE_CACHED + 0x00DC;
volatile OSContext __OSCurrentContext : OS_BASE_CACHED + 0x00D4;
volatile OSContext* __OSFPUContext : OS_BASE_CACHED + 0x00D8;
static void DefaultSwitchThreadCallback(OSThread* from, OSThread* to) {}
extern u8 _stack_addr[];
extern u8 _stack_end[];
#define AddTail(queue, thread, link) \
do { \
OSThread* prev; \
\
prev = (queue)->tail; \
if (prev == NULL) \
(queue)->head = (thread); \
else \
prev->link.next = (thread); \
(thread)->link.prev = prev; \
(thread)->link.next = NULL; \
(queue)->tail = (thread); \
} while (0)
#define AddPrio(queue, thread, link) \
do { \
OSThread *prev, *next; \
\
for (next = (queue)->head; next && next->priority <= thread->priority; next = next->link.next) \
; \
if (next == NULL) \
AddTail(queue, thread, link); \
else { \
(thread)->link.next = next; \
prev = next->link.prev; \
next->link.prev = (thread); \
(thread)->link.prev = prev; \
if (prev == NULL) \
(queue)->head = (thread); \
else \
prev->link.next = (thread); \
} \
} while (0)
#define RemoveItem(queue, thread, link) \
do { \
OSThread *next, *prev; \
next = (thread)->link.next; \
prev = (thread)->link.prev; \
if (next == NULL) \
(queue)->tail = prev; \
else \
next->link.prev = prev; \
if (prev == NULL) \
(queue)->head = next; \
else \
prev->link.next = next; \
} while (0)
#define RemoveHead(queue, thread, link) \
do { \
OSThread* __next; \
(thread) = (queue)->head; \
__next = (thread)->link.next; \
if (__next == NULL) \
(queue)->tail = NULL; \
else \
__next->link.prev = NULL; \
(queue)->head = __next; \
} while (0)
static inline void OSInitMutexQueue(OSMutexQueue* queue) { queue->head = queue->tail = NULL; }
static inline void OSSetCurrentThread(OSThread* thread) {
SwitchThreadCallback(__OSCurrentThread, thread);
__OSCurrentThread = thread;
}
void __OSThreadInit() {
OSThread* thread = &DefaultThread;
int prio;
thread->state = OS_THREAD_STATE_RUNNING;
thread->attr = OS_THREAD_ATTR_DETACH;
thread->priority = thread->base = 16;
thread->suspend = 0;
thread->val = (void*)-1;
thread->mutex = NULL;
OSInitThreadQueue(&thread->queueJoin);
OSInitMutexQueue(&thread->queueMutex);
__OSFPUContext = &thread->context;
OSClearContext(&thread->context);
OSSetCurrentContext(&thread->context);
thread->stackBase = (void*)_stack_addr;
thread->stackEnd = (void*)_stack_end;
*(thread->stackEnd) = OS_THREAD_STACK_MAGIC;
OSSetCurrentThread(thread);
OSClearStack(0);
RunQueueBits = 0;
RunQueueHint = FALSE;
for (prio = OS_PRIORITY_MIN; prio <= OS_PRIORITY_MAX; ++prio) {
OSInitThreadQueue(&RunQueue[prio]);
}
OSInitThreadQueue(&__OSActiveThreadQueue);
AddTail(&__OSActiveThreadQueue, thread, linkActive);
OSClearContext(&IdleContext);
Reschedule = 0;
}
void OSInitThreadQueue(OSThreadQueue* queue) { queue->head = queue->tail = NULL; }
OSThread* OSGetCurrentThread() { return __OSCurrentThread; }
#if NONMATCHING
/* Code matches, stack epilogue bug*/
s32 OSDisableScheduler() {
BOOL enabled;
s32 count;
enabled = OSDisableInterrupts();
count = Reschedule++;
OSRestoreInterrupts(enabled);
return count;
}
#else
/* clang-format off */
#pragma push
#pragma optimization_level
#pragma optimizewithasm off
asm s32 OSDisableScheduler() {
nofralloc
mflr r0
stw r0, 4(r1)
stwu r1, -0x10(r1)
stw r31, 0xc(r1)
bl OSDisableInterrupts
lwz r4, Reschedule
addi r0, r4, 1
stw r0, Reschedule
mr r31, r4
bl OSRestoreInterrupts
mr r3, r31
lwz r0, 0x14(r1)
lwz r31, 0xc(r1)
addi r1, r1, 0x10
mtlr r0
blr
}
/* clang-format on */
#pragma pop
#endif
#if NONMATCHING
/* Code matches, stack epilogue bug*/
s32 OSEnableScheduler() {
BOOL enabled;
s32 count;
enabled = OSDisableInterrupts();
count = Reschedule--;
OSRestoreInterrupts(enabled);
return count;
}
#else
/* clang-format off */
#pragma push
#pragma optimization_level
#pragma optimizewithasm off
asm s32 OSEnableScheduler() {
nofralloc
mflr r0
stw r0, 4(r1)
stwu r1, -0x10(r1)
stw r31, 0xc(r1)
bl OSDisableInterrupts
lwz r4, Reschedule
subi r0, r4, 1
stw r0, Reschedule
mr r31, r4
bl OSRestoreInterrupts
mr r3, r31
lwz r0, 0x14(r1)
lwz r31, 0xc(r1)
addi r1, r1, 0x10
mtlr r0
blr
}
/* clang-format on */
#pragma pop
#endif
static void SetRun(OSThread* thread) {
thread->queue = &RunQueue[thread->priority];
AddTail(thread->queue, thread, link);
RunQueueBits |= 1u << (OS_PRIORITY_MAX - thread->priority);
RunQueueHint = TRUE;
}
#pragma dont_inline on
static void UnsetRun(OSThread* thread) {
OSThreadQueue* queue;
queue = thread->queue;
RemoveItem(queue, thread, link);
if (queue->head == 0)
RunQueueBits &= ~(1u << (OS_PRIORITY_MAX - thread->priority));
thread->queue = NULL;
}
#pragma dont_inline reset
OSPriority __OSGetEffectivePriority(OSThread* thread) {
OSPriority priority;
OSMutex* mutex;
OSThread* blocked;
priority = thread->base;
for (mutex = thread->queueMutex.head; mutex; mutex = mutex->link.next) {
blocked = mutex->queue.head;
if (blocked && blocked->priority < priority) {
priority = blocked->priority;
}
}
return priority;
}
static OSThread* SetEffectivePriority(OSThread* thread, OSPriority priority) {
switch (thread->state) {
case OS_THREAD_STATE_READY:
UnsetRun(thread);
thread->priority = priority;
SetRun(thread);
break;
case OS_THREAD_STATE_WAITING:
RemoveItem(thread->queue, thread, link);
thread->priority = priority;
AddPrio(thread->queue, thread, link);
if (thread->mutex) {
return thread->mutex->thread;
}
break;
case OS_THREAD_STATE_RUNNING:
RunQueueHint = TRUE;
thread->priority = priority;
break;
}
return NULL;
}
static void UpdatePriority(OSThread* thread) {
OSPriority priority;
do {
if (0 < thread->suspend) {
break;
}
priority = __OSGetEffectivePriority(thread);
if (thread->priority == priority) {
break;
}
thread = SetEffectivePriority(thread, priority);
} while (thread);
}
static void __OSSwitchThread(OSThread* nextThread) {
OSSetCurrentThread(nextThread);
OSSetCurrentContext(&nextThread->context);
OSLoadContext(&nextThread->context);
}
static OSThread* SelectThread(BOOL yield) {
OSContext* currentContext;
OSThread* currentThread;
OSThread* nextThread;
OSPriority priority;
OSThreadQueue* queue;
if (0 < Reschedule) {
return 0;
}
currentContext = OSGetCurrentContext();
currentThread = OSGetCurrentThread();
if (currentContext != &currentThread->context) {
return 0;
}
if (currentThread) {
if (currentThread->state == OS_THREAD_STATE_RUNNING) {
if (!yield) {
priority = __cntlzw(RunQueueBits);
if (currentThread->priority <= priority) {
return 0;
}
}
currentThread->state = OS_THREAD_STATE_READY;
SetRun(currentThread);
}
if (!(currentThread->context.state & OS_CONTEXT_STATE_EXC) &&
OSSaveContext(&currentThread->context)) {
return 0;
}
}
OSSetCurrentThread(NULL);
if (RunQueueBits == 0) {
OSSetCurrentContext(&IdleContext);
do {
OSEnableInterrupts();
while (RunQueueBits == 0)
;
OSDisableInterrupts();
} while (RunQueueBits == 0);
OSClearContext(&IdleContext);
}
RunQueueHint = FALSE;
priority = __cntlzw(RunQueueBits);
queue = &RunQueue[priority];
RemoveHead(queue, nextThread, link);
if (queue->head == 0) {
RunQueueBits &= ~(1u << (OS_PRIORITY_MAX - priority));
}
nextThread->queue = NULL;
nextThread->state = OS_THREAD_STATE_RUNNING;
__OSSwitchThread(nextThread);
return nextThread;
}
void __OSReschedule() {
if (!RunQueueHint) {
return;
}
SelectThread(FALSE);
}
void OSYieldThread(void) {
BOOL enabled;
enabled = OSDisableInterrupts();
SelectThread(TRUE);
OSRestoreInterrupts(enabled);
}
void OSCancelThread(OSThread* thread) {
BOOL enabled;
enabled = OSDisableInterrupts();
switch (thread->state) {
case OS_THREAD_STATE_READY:
if (!(0 < thread->suspend)) {
UnsetRun(thread);
}
break;
case OS_THREAD_STATE_RUNNING:
RunQueueHint = TRUE;
break;
case OS_THREAD_STATE_WAITING:
RemoveItem(thread->queue, thread, link);
thread->queue = NULL;
if (!(0 < thread->suspend) && thread->mutex) {
UpdatePriority(thread->mutex->thread);
}
break;
default:
OSRestoreInterrupts(enabled);
return;
}
OSClearContext(&thread->context);
if (thread->attr & OS_THREAD_ATTR_DETACH) {
RemoveItem(&__OSActiveThreadQueue, thread, linkActive);
thread->state = 0;
} else {
thread->state = OS_THREAD_STATE_MORIBUND;
}
__OSUnlockAllMutex(thread);
OSWakeupThread(&thread->queueJoin);
__OSReschedule();
OSRestoreInterrupts(enabled);
return;
}
#if NONMATCHING
/* Code matches, stack epilogue bug*/
s32 OSResumeThread(OSThread* thread) {
BOOL enabled;
s32 suspendCount;
enabled = OSDisableInterrupts();
suspendCount = thread->suspend--;
if (thread->suspend < 0) {
thread->suspend = 0;
} else if (thread->suspend == 0) {
switch (thread->state) {
case OS_THREAD_STATE_READY:
thread->priority = __OSGetEffectivePriority(thread);
SetRun(thread);
break;
case OS_THREAD_STATE_WAITING:
RemoveItem(thread->queue, thread, link);
thread->priority = __OSGetEffectivePriority(thread);
AddPrio(thread->queue, thread, link);
if (thread->mutex) {
UpdatePriority(thread->mutex->thread);
}
break;
}
__OSReschedule();
}
OSRestoreInterrupts(enabled);
return suspendCount;
}
#else
/* clang-format off */
#pragma push
#pragma optimization_level 0
#pragma optimizewithasm off
asm s32 OSResumeThread(OSThread* thread) {
nofralloc
mflr r0
stw r0, 4(r1)
stwu r1, -0x28(r1)
stw r31, 0x24(r1)
stw r30, 0x20(r1)
stw r29, 0x1c(r1)
mr r29, r3
bl OSDisableInterrupts
lwz r4, 0x2cc(r29)
addi r31, r3, 0
addi r0, r4, -1
stw r0, 0x2cc(r29)
mr r30, r4
lwz r0, 0x2cc(r29)
cmpwi r0, 0
bge lbl_80384D60
li r0, 0
stw r0, 0x2cc(r29)
b lbl_80384F74
lbl_80384D60:
bne lbl_80384F74
lhz r0, 0x2c8(r29)
cmpwi r0, 4
beq lbl_80384E24
bge lbl_80384F60
cmpwi r0, 1
beq lbl_80384D80
b lbl_80384F60
lbl_80384D80:
lwz r0, 0x2d4(r29)
lwz r3, 0x2f4(r29)
b lbl_80384DAC
lbl_80384D8C:
lwz r4, 0(r3)
cmplwi r4, 0
beq lbl_80384DA8
lwz r4, 0x2d0(r4)
cmpw r4, r0
bge lbl_80384DA8
mr r0, r4
lbl_80384DA8:
lwz r3, 0x10(r3)
lbl_80384DAC:
cmplwi r3, 0
bne lbl_80384D8C
stw r0, 0x2d0(r29)
lis r3, RunQueue@ha
addi r0, r3, RunQueue@l
lwz r3, 0x2d0(r29)
slwi r3, r3, 3
add r0, r0, r3
stw r0, 0x2dc(r29)
lwz r4, 0x2dc(r29)
lwz r3, 4(r4)
cmplwi r3, 0
bne lbl_80384DE8
stw r29, 0(r4)
b lbl_80384DEC
lbl_80384DE8:
stw r29, 0x2e0(r3)
lbl_80384DEC:
stw r3, 0x2e4(r29)
li r0, 0
li r3, 1
stw r0, 0x2e0(r29)
lwz r4, 0x2dc(r29)
stw r29, 4(r4)
lwz r0, 0x2d0(r29)
lwz r4, RunQueueBits
subfic r0, r0, 0x1f
slw r0, r3, r0
or r0, r4, r0
stw r0, RunQueueBits
stw r3, RunQueueHint
b lbl_80384F60
lbl_80384E24:
lwz r4, 0x2e0(r29)
lwz r5, 0x2e4(r29)
cmplwi r4, 0
bne lbl_80384E40
lwz r3, 0x2dc(r29)
stw r5, 4(r3)
b lbl_80384E44
lbl_80384E40:
stw r5, 0x2e4(r4)
lbl_80384E44:
cmplwi r5, 0
bne lbl_80384E58
lwz r3, 0x2dc(r29)
stw r4, 0(r3)
b lbl_80384E5C
lbl_80384E58:
stw r4, 0x2e0(r5)
lbl_80384E5C:
lwz r0, 0x2d4(r29)
lwz r3, 0x2f4(r29)
b lbl_80384E88
lbl_80384E68:
lwz r4, 0(r3)
cmplwi r4, 0
beq lbl_80384E84
lwz r4, 0x2d0(r4)
cmpw r4, r0
bge lbl_80384E84
mr r0, r4
lbl_80384E84:
lwz r3, 0x10(r3)
lbl_80384E88:
cmplwi r3, 0
bne lbl_80384E68
stw r0, 0x2d0(r29)
lwz r4, 0x2dc(r29)
lwz r5, 0(r4)
b lbl_80384EA4
lbl_80384EA0:
lwz r5, 0x2e0(r5)
lbl_80384EA4:
cmplwi r5, 0
beq lbl_80384EBC
lwz r3, 0x2d0(r5)
lwz r0, 0x2d0(r29)
cmpw r3, r0
ble lbl_80384EA0
lbl_80384EBC:
cmplwi r5, 0
bne lbl_80384EF4
lwz r3, 4(r4)
cmplwi r3, 0
bne lbl_80384ED8
stw r29, 0(r4)
b lbl_80384EDC
lbl_80384ED8:
stw r29, 0x2e0(r3)
lbl_80384EDC:
stw r3, 0x2e4(r29)
li r0, 0
stw r0, 0x2e0(r29)
lwz r3, 0x2dc(r29)
stw r29, 4(r3)
b lbl_80384F1C
lbl_80384EF4:
stw r5, 0x2e0(r29)
lwz r3, 0x2e4(r5)
stw r29, 0x2e4(r5)
cmplwi r3, 0
stw r3, 0x2e4(r29)
bne lbl_80384F18
lwz r3, 0x2dc(r29)
stw r29, 0(r3)
b lbl_80384F1C
lbl_80384F18:
stw r29, 0x2e0(r3)
lbl_80384F1C:
lwz r3, 0x2f0(r29)
cmplwi r3, 0
beq lbl_80384F60
lwz r29, 8(r3)
lbl_80384F2C:
lwz r0, 0x2cc(r29)
cmpwi r0, 0
bgt lbl_80384F60
mr r3, r29
bl __OSGetEffectivePriority
lwz r0, 0x2d0(r29)
addi r4, r3, 0
cmpw r0, r4
beq lbl_80384F60
mr r3, r29
bl SetEffectivePriority
or. r29, r3, r3
bne lbl_80384F2C
lbl_80384F60:
lwz r0, RunQueueHint
cmpwi r0, 0
beq lbl_80384F74
li r3, 0
bl SelectThread
lbl_80384F74:
mr r3, r31
bl OSRestoreInterrupts
mr r3, r30
lwz r0, 0x2c(r1)
lwz r31, 0x24(r1)
lwz r30, 0x20(r1)
lwz r29, 0x1c(r1)
addi r1, r1, 0x28
mtlr r0
blr
}
#pragma pop
/* clang-format on */
#endif
#if NONMATCHING
/* Code matches, stack epilogue bug*/
s32 OSSuspendThread(OSThread* thread) {
BOOL enabled;
s32 suspendCount;
enabled = OSDisableInterrupts();
suspendCount = thread->suspend++;
if (suspendCount == 0) {
switch (thread->state) {
case OS_THREAD_STATE_RUNNING:
RunQueueHint = TRUE;
thread->state = OS_THREAD_STATE_READY;
break;
case OS_THREAD_STATE_READY:
UnsetRun(thread);
break;
case OS_THREAD_STATE_WAITING:
RemoveItem(thread->queue, thread, link);
thread->priority = 32;
AddTail(thread->queue, thread, link);
if (thread->mutex) {
UpdatePriority(thread->mutex->thread);
}
break;
}
__OSReschedule();
}
OSRestoreInterrupts(enabled);
return suspendCount;
}
#else
/* clang-format off */
#pragma push
#pragma optimization_level 0
#pragma optimizewithasm off
asm s32 OSSuspendThread(OSThread* thread) {
nofralloc
mflr r0
stw r0, 4(r1)
stwu r1, -0x20(r1)
stw r31, 0x1c(r1)
stw r30, 0x18(r1)
stw r29, 0x14(r1)
mr r29, r3
bl OSDisableInterrupts
lwz r4, 0x2cc(r29)
addi r31, r3, 0
addi r0, r4, 1
or. r30, r4, r4
stw r0, 0x2cc(r29)
bne lbl_803850E4
lhz r0, 0x2c8(r29)
cmpwi r0, 3
beq lbl_803850D0
bge lbl_80384FF4
cmpwi r0, 1
beq lbl_80385010
bge lbl_80385000
b lbl_803850D0
lbl_80384FF4:
cmpwi r0, 5
bge lbl_803850D0
b lbl_8038501C
lbl_80385000:
li r0, 1
stw r0, RunQueueHint
sth r0, 0x2c8(r29)
b lbl_803850D0
lbl_80385010:
mr r3, r29
bl UnsetRun
b lbl_803850D0
lbl_8038501C:
lwz r4, 0x2e0(r29)
lwz r5, 0x2e4(r29)
cmplwi r4, 0
bne lbl_80385038
lwz r3, 0x2dc(r29)
stw r5, 4(r3)
b lbl_8038503C
lbl_80385038:
stw r5, 0x2e4(r4)
lbl_8038503C:
cmplwi r5, 0
bne lbl_80385050
lwz r3, 0x2dc(r29)
stw r4, 0(r3)
b lbl_80385054
lbl_80385050:
stw r4, 0x2e0(r5)
lbl_80385054:
li r0, 0x20
stw r0, 0x2d0(r29)
lwz r4, 0x2dc(r29)
lwz r3, 4(r4)
cmplwi r3, 0
bne lbl_80385074
stw r29, 0(r4)
b lbl_80385078
lbl_80385074:
stw r29, 0x2e0(r3)
lbl_80385078:
stw r3, 0x2e4(r29)
li r0, 0
stw r0, 0x2e0(r29)
lwz r3, 0x2dc(r29)
stw r29, 4(r3)
lwz r3, 0x2f0(r29)
cmplwi r3, 0
beq lbl_803850D0
lwz r29, 8(r3)
lbl_8038509C:
lwz r0, 0x2cc(r29)
cmpwi r0, 0
bgt lbl_803850D0
mr r3, r29
bl __OSGetEffectivePriority
lwz r0, 0x2d0(r29)
addi r4, r3, 0
cmpw r0, r4
beq lbl_803850D0
mr r3, r29
bl SetEffectivePriority
or. r29, r3, r3
bne lbl_8038509C
lbl_803850D0:
lwz r0, RunQueueHint
cmpwi r0, 0
beq lbl_803850E4
li r3, 0
bl SelectThread
lbl_803850E4:
mr r3, r31
bl OSRestoreInterrupts
mr r3, r30
lwz r0, 0x24(r1)
lwz r31, 0x1c(r1)
lwz r30, 0x18(r1)
lwz r29, 0x14(r1)
addi r1, r1, 0x20
mtlr r0
blr
}
#pragma pop
/* clang-format on */
#endif
void OSSleepThread(OSThreadQueue* queue) {
BOOL enabled;
OSThread* currentThread;
enabled = OSDisableInterrupts();
currentThread = OSGetCurrentThread();
currentThread->state = OS_THREAD_STATE_WAITING;
currentThread->queue = queue;
AddPrio(queue, currentThread, link);
RunQueueHint = TRUE;
__OSReschedule();
OSRestoreInterrupts(enabled);
}
void OSWakeupThread(OSThreadQueue* queue) {
BOOL enabled;
OSThread* thread;
enabled = OSDisableInterrupts();
while (queue->head) {
RemoveHead(queue, thread, link);
thread->state = OS_THREAD_STATE_READY;
if (!(0 < thread->suspend)) {
SetRun(thread);
}
}
__OSReschedule();
OSRestoreInterrupts(enabled);
}
void OSClearStack(u8 val) {
register u32 sp;
register u32* p;
register u32 pattern;
pattern = ((u32)val << 24) | ((u32)val << 16) | ((u32)val << 8) | (u32)val;
sp = OSGetStackPointer();
for (p = __OSCurrentThread->stackEnd + 1; p < (u32*)sp; ++p) {
*p = pattern;
}
}