donut-decomp/asm/kpad/KPAD.s
2022-10-17 09:33:28 +01:00

6623 lines
301 KiB
ArmAsm

.include "macros.inc"
.section .text, "ax" # 0x80006A00 - 0x80406260 ; 0x003FF860
.global KPADSetBtnRepeat
KPADSetBtnRepeat:
/* 8006B280 000670C0 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006B284 000670C4 3C 80 80 4C */ lis r4, inside_kpads@ha
/* 8006B288 000670C8 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006B28C 000670CC 94 21 FF E0 */ stwu r1, -0x20(r1)
/* 8006B290 000670D0 FC 02 00 00 */ fcmpu cr0, f2, f0
/* 8006B294 000670D4 38 84 7C 08 */ addi r4, r4, inside_kpads@l
/* 8006B298 000670D8 7C 84 02 14 */ add r4, r4, r0
/* 8006B29C 000670DC 41 82 00 40 */ beq lbl_8006B2DC
/* 8006B2A0 000670E0 C0 02 88 58 */ lfs f0, "@4537"@sda21(r2)
/* 8006B2A4 000670E4 C0 62 88 54 */ lfs f3, "@4536"@sda21(r2)
/* 8006B2A8 000670E8 EC 20 00 72 */ fmuls f1, f0, f1
/* 8006B2AC 000670EC EC 00 00 B2 */ fmuls f0, f0, f2
/* 8006B2B0 000670F0 EC 23 08 2A */ fadds f1, f3, f1
/* 8006B2B4 000670F4 EC 03 00 2A */ fadds f0, f3, f0
/* 8006B2B8 000670F8 FC 20 08 1E */ fctiwz f1, f1
/* 8006B2BC 000670FC FC 00 00 1E */ fctiwz f0, f0
/* 8006B2C0 00067100 D8 21 00 08 */ stfd f1, 0x8(r1)
/* 8006B2C4 00067104 80 01 00 0C */ lwz r0, 0xc(r1)
/* 8006B2C8 00067108 D8 01 00 10 */ stfd f0, 0x10(r1)
/* 8006B2CC 0006710C B0 04 05 F0 */ sth r0, 0x5f0(r4)
/* 8006B2D0 00067110 80 01 00 14 */ lwz r0, 0x14(r1)
/* 8006B2D4 00067114 B0 04 05 F2 */ sth r0, 0x5f2(r4)
/* 8006B2D8 00067118 48 00 00 18 */ b lbl_8006B2F0
.global lbl_8006B2DC
lbl_8006B2DC:
/* 8006B2DC 0006711C 3C 60 00 01 */ lis r3, 0x1
/* 8006B2E0 00067120 38 00 00 00 */ li r0, 0x0
/* 8006B2E4 00067124 38 63 9C 40 */ addi r3, r3, -0x63c0
/* 8006B2E8 00067128 B0 64 05 F0 */ sth r3, 0x5f0(r4)
/* 8006B2EC 0006712C B0 04 05 F2 */ sth r0, 0x5f2(r4)
.global lbl_8006B2F0
lbl_8006B2F0:
/* 8006B2F0 00067130 38 60 00 00 */ li r3, 0x0
/* 8006B2F4 00067134 B0 64 05 EC */ sth r3, 0x5ec(r4)
/* 8006B2F8 00067138 A0 04 05 F0 */ lhz r0, 0x5f0(r4)
/* 8006B2FC 0006713C B0 04 05 EE */ sth r0, 0x5ee(r4)
/* 8006B300 00067140 B0 64 05 F4 */ sth r3, 0x5f4(r4)
/* 8006B304 00067144 B0 04 05 F6 */ sth r0, 0x5f6(r4)
/* 8006B308 00067148 38 21 00 20 */ addi r1, r1, 0x20
/* 8006B30C 0006714C 4E 80 00 20 */ blr
.global KPADSetPosParam
KPADSetPosParam:
/* 8006B310 00067150 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006B314 00067154 3C 60 80 4C */ lis r3, inside_kpads@ha
/* 8006B318 00067158 38 63 7C 08 */ addi r3, r3, inside_kpads@l
/* 8006B31C 0006715C 7C 63 02 14 */ add r3, r3, r0
/* 8006B320 00067160 D0 23 00 F0 */ stfs f1, 0xf0(r3)
/* 8006B324 00067164 D0 43 00 F4 */ stfs f2, 0xf4(r3)
/* 8006B328 00067168 4E 80 00 20 */ blr
/* 8006B32C 0006716C 00 00 00 00 */ .4byte 0x00000000
.global KPADSetDistParam
KPADSetDistParam:
/* 8006B330 00067170 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006B334 00067174 3C 60 80 4C */ lis r3, inside_kpads@ha
/* 8006B338 00067178 38 63 7C 08 */ addi r3, r3, inside_kpads@l
/* 8006B33C 0006717C 7C 63 02 14 */ add r3, r3, r0
/* 8006B340 00067180 D0 23 01 00 */ stfs f1, 0x100(r3)
/* 8006B344 00067184 D0 43 01 04 */ stfs f2, 0x104(r3)
/* 8006B348 00067188 4E 80 00 20 */ blr
/* 8006B34C 0006718C 00 00 00 00 */ .4byte 0x00000000
.global KPADSetAccParam
KPADSetAccParam:
/* 8006B350 00067190 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006B354 00067194 3C 60 80 4C */ lis r3, inside_kpads@ha
/* 8006B358 00067198 38 63 7C 08 */ addi r3, r3, inside_kpads@l
/* 8006B35C 0006719C 7C 63 02 14 */ add r3, r3, r0
/* 8006B360 000671A0 D0 23 01 08 */ stfs f1, 0x108(r3)
/* 8006B364 000671A4 D0 43 01 0C */ stfs f2, 0x10c(r3)
/* 8006B368 000671A8 4E 80 00 20 */ blr
/* 8006B36C 000671AC 00 00 00 00 */ .4byte 0x00000000
.global reset_kpad
reset_kpad:
/* 8006B370 000671B0 C1 22 88 60 */ lfs f9, "@4581"@sda21(r2)
/* 8006B374 000671B4 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006B378 000671B8 C0 2D 84 1C */ lfs f1, kp_err_dist_speed@sda21(r13)
/* 8006B37C 000671BC 3C 80 80 4C */ lis r4, inside_kpads@ha
/* 8006B380 000671C0 C1 62 88 5C */ lfs f11, "@4580"@sda21(r2)
/* 8006B384 000671C4 39 00 00 00 */ li r8, 0x0
/* 8006B388 000671C8 EC C9 08 24 */ fdivs f6, f9, f1
/* 8006B38C 000671CC C1 4D 84 14 */ lfs f10, kp_err_outside_frame@sda21(r13)
/* 8006B390 000671D0 38 84 7C 08 */ addi r4, r4, inside_kpads@l
/* 8006B394 000671D4 7D 24 02 14 */ add r9, r4, r0
/* 8006B398 000671D8 C0 82 88 64 */ lfs f4, "@4582"@sda21(r2)
/* 8006B39C 000671DC 99 09 06 40 */ stb r8, 0x640(r9)
/* 8006B3A0 000671E0 EC AB 08 24 */ fdivs f5, f11, f1
/* 8006B3A4 000671E4 C0 42 88 68 */ lfs f2, "@4583"@sda21(r2)
/* 8006B3A8 000671E8 C0 0D 84 08 */ lfs f0, kp_ah_circle_radius@sda21(r13)
/* 8006B3AC 000671EC 39 49 01 54 */ addi r10, r9, 0x154
/* 8006B3B0 000671F0 C0 6D EA 90 */ lfs f3, kp_err_dist_min@sda21(r13)
/* 8006B3B4 000671F4 38 09 01 30 */ addi r0, r9, 0x130
/* 8006B3B8 000671F8 ED 0B 50 2A */ fadds f8, f11, f10
/* 8006B3BC 000671FC C0 2D EA 8C */ lfs f1, kp_dist_vv1@sda21(r13)
/* 8006B3C0 00067200 EC E9 50 28 */ fsubs f7, f9, f10
/* 8006B3C4 00067204 80 CD EA 58 */ lwz r6, Vec2_0@sda21(r13)
/* 8006B3C8 00067208 D1 09 06 14 */ stfs f8, 0x614(r9)
/* 8006B3CC 0006720C ED 04 50 2A */ fadds f8, f4, f10
/* 8006B3D0 00067210 D0 E9 06 1C */ stfs f7, 0x61c(r9)
/* 8006B3D4 00067214 EC E2 50 28 */ fsubs f7, f2, f10
/* 8006B3D8 00067218 EC 80 00 32 */ fmuls f4, f0, f0
/* 8006B3DC 0006721C 80 AD EA 5C */ lwz r5, lbl_8055CE7C@sda21(r13)
/* 8006B3E0 00067220 D1 09 06 18 */ stfs f8, 0x618(r9)
/* 8006B3E4 00067224 FC 00 08 18 */ frsp f0, f1
/* 8006B3E8 00067228 C0 42 88 50 */ lfs f2, "@4535"@sda21(r2)
/* 8006B3EC 0006722C D0 E9 06 20 */ stfs f7, 0x620(r9)
/* 8006B3F0 00067230 A0 8D 84 10 */ lhz r4, kp_ah_circle_ct@sda21(r13)
/* 8006B3F4 00067234 38 60 FF FF */ li r3, -0x1
/* 8006B3F8 00067238 D0 C9 06 24 */ stfs f6, 0x624(r9)
/* 8006B3FC 0006723C D0 A9 06 28 */ stfs f5, 0x628(r9)
/* 8006B400 00067240 D0 89 06 2C */ stfs f4, 0x62c(r9)
/* 8006B404 00067244 D0 69 06 34 */ stfs f3, 0x634(r9)
/* 8006B408 00067248 D0 29 06 30 */ stfs f1, 0x630(r9)
/* 8006B40C 0006724C 91 09 00 08 */ stw r8, 0x8(r9)
/* 8006B410 00067250 91 09 00 04 */ stw r8, 0x4(r9)
/* 8006B414 00067254 91 09 00 00 */ stw r8, 0x0(r9)
/* 8006B418 00067258 B1 09 05 EC */ sth r8, 0x5ec(r9)
/* 8006B41C 0006725C A0 E9 05 F0 */ lhz r7, 0x5f0(r9)
/* 8006B420 00067260 B0 E9 05 EE */ sth r7, 0x5ee(r9)
/* 8006B424 00067264 99 09 00 5E */ stb r8, 0x5e(r9)
/* 8006B428 00067268 99 09 05 EA */ stb r8, 0x5ea(r9)
/* 8006B42C 0006726C 90 C9 00 28 */ stw r6, 0x28(r9)
/* 8006B430 00067270 90 A9 00 2C */ stw r5, 0x2c(r9)
/* 8006B434 00067274 90 C9 00 20 */ stw r6, 0x20(r9)
/* 8006B438 00067278 90 A9 00 24 */ stw r5, 0x24(r9)
/* 8006B43C 0006727C D0 49 00 30 */ stfs f2, 0x30(r9)
/* 8006B440 00067280 D1 29 05 C8 */ stfs f9, 0x5c8(r9)
/* 8006B444 00067284 D1 29 05 D0 */ stfs f9, 0x5d0(r9)
/* 8006B448 00067288 D1 29 00 34 */ stfs f9, 0x34(r9)
/* 8006B44C 0006728C D0 49 05 CC */ stfs f2, 0x5cc(r9)
/* 8006B450 00067290 D0 49 05 D4 */ stfs f2, 0x5d4(r9)
/* 8006B454 00067294 D0 49 00 38 */ stfs f2, 0x38(r9)
/* 8006B458 00067298 90 C9 00 3C */ stw r6, 0x3c(r9)
/* 8006B45C 0006729C 90 A9 00 40 */ stw r5, 0x40(r9)
/* 8006B460 000672A0 D0 49 00 44 */ stfs f2, 0x44(r9)
/* 8006B464 000672A4 D1 29 00 54 */ stfs f9, 0x54(r9)
/* 8006B468 000672A8 D0 49 00 58 */ stfs f2, 0x58(r9)
/* 8006B46C 000672AC C0 29 01 10 */ lfs f1, 0x110(r9)
/* 8006B470 000672B0 D0 29 00 48 */ stfs f1, 0x48(r9)
/* 8006B474 000672B4 EC 00 08 24 */ fdivs f0, f0, f1
/* 8006B478 000672B8 D0 49 00 50 */ stfs f2, 0x50(r9)
/* 8006B47C 000672BC D0 49 00 4C */ stfs f2, 0x4c(r9)
/* 8006B480 000672C0 D0 29 05 B4 */ stfs f1, 0x5b4(r9)
/* 8006B484 000672C4 D0 09 05 B8 */ stfs f0, 0x5b8(r9)
/* 8006B488 000672C8 D0 09 05 A8 */ stfs f0, 0x5a8(r9)
/* 8006B48C 000672CC 80 A9 01 20 */ lwz r5, 0x120(r9)
/* 8006B490 000672D0 80 C9 01 1C */ lwz r6, 0x11c(r9)
/* 8006B494 000672D4 90 C9 05 AC */ stw r6, 0x5ac(r9)
/* 8006B498 000672D8 90 A9 05 B0 */ stw r5, 0x5b0(r9)
/* 8006B49C 000672DC D0 49 00 14 */ stfs f2, 0x14(r9)
/* 8006B4A0 000672E0 D0 49 00 0C */ stfs f2, 0xc(r9)
/* 8006B4A4 000672E4 D1 69 00 10 */ stfs f11, 0x10(r9)
/* 8006B4A8 000672E8 D1 29 00 18 */ stfs f9, 0x18(r9)
/* 8006B4AC 000672EC D0 49 00 1C */ stfs f2, 0x1c(r9)
/* 8006B4B0 000672F0 80 A9 00 10 */ lwz r5, 0x10(r9)
/* 8006B4B4 000672F4 80 C9 00 0C */ lwz r6, 0xc(r9)
/* 8006B4B8 000672F8 90 C9 05 BC */ stw r6, 0x5bc(r9)
/* 8006B4BC 000672FC 90 A9 05 C0 */ stw r5, 0x5c0(r9)
/* 8006B4C0 00067300 80 A9 00 14 */ lwz r5, 0x14(r9)
/* 8006B4C4 00067304 90 A9 05 C4 */ stw r5, 0x5c4(r9)
/* 8006B4C8 00067308 80 A9 05 D4 */ lwz r5, 0x5d4(r9)
/* 8006B4CC 0006730C 80 C9 05 D0 */ lwz r6, 0x5d0(r9)
/* 8006B4D0 00067310 90 C9 05 E0 */ stw r6, 0x5e0(r9)
/* 8006B4D4 00067314 90 A9 05 E4 */ stw r5, 0x5e4(r9)
/* 8006B4D8 00067318 B0 89 05 E8 */ sth r4, 0x5e8(r9)
/* 8006B4DC 0006731C B1 09 01 78 */ sth r8, 0x178(r9)
.global lbl_8006B4E0
lbl_8006B4E0:
/* 8006B4E0 00067320 98 6A 00 08 */ stb r3, 0x8(r10)
/* 8006B4E4 00067324 39 4A FF F4 */ addi r10, r10, -0xc
/* 8006B4E8 00067328 7C 0A 00 40 */ cmplw r10, r0
/* 8006B4EC 0006732C 40 80 FF F4 */ bge lbl_8006B4E0
/* 8006B4F0 00067330 38 89 01 6C */ addi r4, r9, 0x16c
/* 8006B4F4 00067334 38 09 01 60 */ addi r0, r9, 0x160
/* 8006B4F8 00067338 38 60 FF FF */ li r3, -0x1
/* 8006B4FC 0006733C 60 00 00 00 */ nop
.global lbl_8006B500
lbl_8006B500:
/* 8006B500 00067340 98 64 00 08 */ stb r3, 0x8(r4)
/* 8006B504 00067344 38 84 FF F4 */ addi r4, r4, -0xc
/* 8006B508 00067348 7C 04 00 40 */ cmplw r4, r0
/* 8006B50C 0006734C 40 80 FF F4 */ bge lbl_8006B500
/* 8006B510 00067350 38 00 00 00 */ li r0, 0x0
/* 8006B514 00067354 98 09 01 7B */ stb r0, 0x17b(r9)
/* 8006B518 00067358 38 00 00 01 */ li r0, 0x1
/* 8006B51C 0006735C 98 09 06 41 */ stb r0, 0x641(r9)
/* 8006B520 00067360 4E 80 00 20 */ blr
/* 8006B524 00067364 00 00 00 00 */ .4byte 0x00000000
/* 8006B528 00067368 00 00 00 00 */ .4byte 0x00000000
/* 8006B52C 0006736C 00 00 00 00 */ .4byte 0x00000000
.global KPADEnableAimingMode
KPADEnableAimingMode:
/* 8006B530 00067370 1C 83 06 88 */ mulli r4, r3, 0x688
/* 8006B534 00067374 3C 60 80 4C */ lis r3, inside_kpads@ha
/* 8006B538 00067378 38 00 00 01 */ li r0, 0x1
/* 8006B53C 0006737C 38 63 7C 08 */ addi r3, r3, inside_kpads@l
/* 8006B540 00067380 7C 63 22 14 */ add r3, r3, r4
/* 8006B544 00067384 98 03 06 48 */ stb r0, 0x648(r3)
/* 8006B548 00067388 98 03 06 49 */ stb r0, 0x649(r3)
/* 8006B54C 0006738C 4E 80 00 20 */ blr
.global KPADIsEnableAimingMode
KPADIsEnableAimingMode:
/* 8006B550 00067390 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006B554 00067394 3C 60 80 4C */ lis r3, inside_kpads@ha
/* 8006B558 00067398 38 63 7C 08 */ addi r3, r3, inside_kpads@l
/* 8006B55C 0006739C 7C 63 02 14 */ add r3, r3, r0
/* 8006B560 000673A0 88 63 06 49 */ lbz r3, 0x649(r3)
/* 8006B564 000673A4 4E 80 00 20 */ blr
/* 8006B568 000673A8 00 00 00 00 */ .4byte 0x00000000
/* 8006B56C 000673AC 00 00 00 00 */ .4byte 0x00000000
.global KPADGetSensorHeight
KPADGetSensorHeight:
/* 8006B570 000673B0 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006B574 000673B4 3C 60 80 4C */ lis r3, inside_kpads@ha
/* 8006B578 000673B8 38 63 7C 08 */ addi r3, r3, inside_kpads@l
/* 8006B57C 000673BC 7C 63 02 14 */ add r3, r3, r0
/* 8006B580 000673C0 C0 23 01 28 */ lfs f1, 0x128(r3)
/* 8006B584 000673C4 4E 80 00 20 */ blr
/* 8006B588 000673C8 00 00 00 00 */ .4byte 0x00000000
/* 8006B58C 000673CC 00 00 00 00 */ .4byte 0x00000000
.global calc_button_repeat
calc_button_repeat:
/* 8006B590 000673D0 80 03 00 04 */ lwz r0, 0x4(r3)
/* 8006B594 000673D4 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B598 000673D8 40 82 00 10 */ bne lbl_8006B5A8
/* 8006B59C 000673DC 80 03 00 08 */ lwz r0, 0x8(r3)
/* 8006B5A0 000673E0 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B5A4 000673E4 41 82 00 3C */ beq lbl_8006B5E0
.global lbl_8006B5A8
lbl_8006B5A8:
/* 8006B5A8 000673E8 80 03 00 04 */ lwz r0, 0x4(r3)
/* 8006B5AC 000673EC 38 E0 00 00 */ li r7, 0x0
/* 8006B5B0 000673F0 A0 C3 05 F0 */ lhz r6, 0x5f0(r3)
/* 8006B5B4 000673F4 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B5B8 000673F8 B0 E3 05 EC */ sth r7, 0x5ec(r3)
/* 8006B5BC 000673FC B0 C3 05 EE */ sth r6, 0x5ee(r3)
/* 8006B5C0 00067400 41 82 00 94 */ beq lbl_8006B654
/* 8006B5C4 00067404 A0 03 05 F2 */ lhz r0, 0x5f2(r3)
/* 8006B5C8 00067408 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B5CC 0006740C 41 82 00 88 */ beq lbl_8006B654
/* 8006B5D0 00067410 80 03 00 00 */ lwz r0, 0x0(r3)
/* 8006B5D4 00067414 64 00 80 00 */ oris r0, r0, 0x8000
/* 8006B5D8 00067418 90 03 00 00 */ stw r0, 0x0(r3)
/* 8006B5DC 0006741C 48 00 00 78 */ b lbl_8006B654
.global lbl_8006B5E0
lbl_8006B5E0:
/* 8006B5E0 00067420 80 03 00 00 */ lwz r0, 0x0(r3)
/* 8006B5E4 00067424 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B5E8 00067428 41 82 00 6C */ beq lbl_8006B654
/* 8006B5EC 0006742C A0 03 05 EC */ lhz r0, 0x5ec(r3)
/* 8006B5F0 00067430 7C 00 2A 14 */ add r0, r0, r5
/* 8006B5F4 00067434 B0 03 05 EC */ sth r0, 0x5ec(r3)
/* 8006B5F8 00067438 54 06 04 3E */ clrlwi r6, r0, 16
/* 8006B5FC 0006743C 28 06 9C 40 */ cmplwi r6, 0x9c40
/* 8006B600 00067440 41 80 00 10 */ blt lbl_8006B610
/* 8006B604 00067444 3C C6 FF FF */ addis r6, r6, 0xffff
/* 8006B608 00067448 38 06 63 C0 */ addi r0, r6, 0x63c0
/* 8006B60C 0006744C B0 03 05 EC */ sth r0, 0x5ec(r3)
.global lbl_8006B610
lbl_8006B610:
/* 8006B610 00067450 A1 03 05 EC */ lhz r8, 0x5ec(r3)
/* 8006B614 00067454 A0 E3 05 EE */ lhz r7, 0x5ee(r3)
/* 8006B618 00067458 7C 08 38 40 */ cmplw r8, r7
/* 8006B61C 0006745C 41 80 00 38 */ blt lbl_8006B654
/* 8006B620 00067460 80 C3 00 00 */ lwz r6, 0x0(r3)
/* 8006B624 00067464 28 08 4E 20 */ cmplwi r8, 0x4e20
/* 8006B628 00067468 A0 03 05 F2 */ lhz r0, 0x5f2(r3)
/* 8006B62C 0006746C 64 C6 80 00 */ oris r6, r6, 0x8000
/* 8006B630 00067470 90 C3 00 00 */ stw r6, 0x0(r3)
/* 8006B634 00067474 7C 07 02 14 */ add r0, r7, r0
/* 8006B638 00067478 B0 03 05 EE */ sth r0, 0x5ee(r3)
/* 8006B63C 0006747C 41 80 00 18 */ blt lbl_8006B654
/* 8006B640 00067480 54 06 04 3E */ clrlwi r6, r0, 16
/* 8006B644 00067484 38 E8 B1 E0 */ addi r7, r8, -0x4e20
/* 8006B648 00067488 38 06 B1 E0 */ addi r0, r6, -0x4e20
/* 8006B64C 0006748C B0 E3 05 EC */ sth r7, 0x5ec(r3)
/* 8006B650 00067490 B0 03 05 EE */ sth r0, 0x5ee(r3)
.global lbl_8006B654
lbl_8006B654:
/* 8006B654 00067494 38 04 FF F0 */ addi r0, r4, -0x10
/* 8006B658 00067498 28 00 00 03 */ cmplwi r0, 0x3
/* 8006B65C 0006749C 40 81 00 14 */ ble lbl_8006B670
/* 8006B660 000674A0 28 04 00 02 */ cmplwi r4, 0x2
/* 8006B664 000674A4 41 82 00 0C */ beq lbl_8006B670
/* 8006B668 000674A8 28 04 00 07 */ cmplwi r4, 0x7
/* 8006B66C 000674AC 4C 82 00 20 */ bnelr
.global lbl_8006B670
lbl_8006B670:
/* 8006B670 000674B0 80 03 00 64 */ lwz r0, 0x64(r3)
/* 8006B674 000674B4 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B678 000674B8 40 82 00 10 */ bne lbl_8006B688
/* 8006B67C 000674BC 80 03 00 68 */ lwz r0, 0x68(r3)
/* 8006B680 000674C0 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B684 000674C4 41 82 00 3C */ beq lbl_8006B6C0
.global lbl_8006B688
lbl_8006B688:
/* 8006B688 000674C8 80 03 00 64 */ lwz r0, 0x64(r3)
/* 8006B68C 000674CC 38 A0 00 00 */ li r5, 0x0
/* 8006B690 000674D0 A0 83 05 F0 */ lhz r4, 0x5f0(r3)
/* 8006B694 000674D4 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B698 000674D8 B0 A3 05 F4 */ sth r5, 0x5f4(r3)
/* 8006B69C 000674DC B0 83 05 F6 */ sth r4, 0x5f6(r3)
/* 8006B6A0 000674E0 4D 82 00 20 */ beqlr
/* 8006B6A4 000674E4 A0 03 05 F2 */ lhz r0, 0x5f2(r3)
/* 8006B6A8 000674E8 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B6AC 000674EC 4D 82 00 20 */ beqlr
/* 8006B6B0 000674F0 80 03 00 60 */ lwz r0, 0x60(r3)
/* 8006B6B4 000674F4 64 00 80 00 */ oris r0, r0, 0x8000
/* 8006B6B8 000674F8 90 03 00 60 */ stw r0, 0x60(r3)
/* 8006B6BC 000674FC 4E 80 00 20 */ blr
.global lbl_8006B6C0
lbl_8006B6C0:
/* 8006B6C0 00067500 80 03 00 60 */ lwz r0, 0x60(r3)
/* 8006B6C4 00067504 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B6C8 00067508 4D 82 00 20 */ beqlr
/* 8006B6CC 0006750C A0 03 05 F4 */ lhz r0, 0x5f4(r3)
/* 8006B6D0 00067510 7C 00 2A 14 */ add r0, r0, r5
/* 8006B6D4 00067514 B0 03 05 F4 */ sth r0, 0x5f4(r3)
/* 8006B6D8 00067518 54 04 04 3E */ clrlwi r4, r0, 16
/* 8006B6DC 0006751C 28 04 9C 40 */ cmplwi r4, 0x9c40
/* 8006B6E0 00067520 41 80 00 10 */ blt lbl_8006B6F0
/* 8006B6E4 00067524 3C 84 FF FF */ addis r4, r4, 0xffff
/* 8006B6E8 00067528 38 04 63 C0 */ addi r0, r4, 0x63c0
/* 8006B6EC 0006752C B0 03 05 F4 */ sth r0, 0x5f4(r3)
.global lbl_8006B6F0
lbl_8006B6F0:
/* 8006B6F0 00067530 A0 C3 05 F4 */ lhz r6, 0x5f4(r3)
/* 8006B6F4 00067534 A0 A3 05 F6 */ lhz r5, 0x5f6(r3)
/* 8006B6F8 00067538 7C 06 28 40 */ cmplw r6, r5
/* 8006B6FC 0006753C 4D 80 00 20 */ bltlr
/* 8006B700 00067540 80 83 00 60 */ lwz r4, 0x60(r3)
/* 8006B704 00067544 28 06 4E 20 */ cmplwi r6, 0x4e20
/* 8006B708 00067548 A0 03 05 F2 */ lhz r0, 0x5f2(r3)
/* 8006B70C 0006754C 64 84 80 00 */ oris r4, r4, 0x8000
/* 8006B710 00067550 90 83 00 60 */ stw r4, 0x60(r3)
/* 8006B714 00067554 7C 05 02 14 */ add r0, r5, r0
/* 8006B718 00067558 B0 03 05 F6 */ sth r0, 0x5f6(r3)
/* 8006B71C 0006755C 4D 80 00 20 */ bltlr
/* 8006B720 00067560 54 04 04 3E */ clrlwi r4, r0, 16
/* 8006B724 00067564 38 A6 B1 E0 */ addi r5, r6, -0x4e20
/* 8006B728 00067568 38 04 B1 E0 */ addi r0, r4, -0x4e20
/* 8006B72C 0006756C B0 A3 05 F4 */ sth r5, 0x5f4(r3)
/* 8006B730 00067570 B0 03 05 F6 */ sth r0, 0x5f6(r3)
/* 8006B734 00067574 4E 80 00 20 */ blr
/* 8006B738 00067578 00 00 00 00 */ .4byte 0x00000000
/* 8006B73C 0006757C 00 00 00 00 */ .4byte 0x00000000
.global read_kpad_button
read_kpad_button:
/* 8006B740 00067580 81 23 00 00 */ lwz r9, 0x0(r3)
/* 8006B744 00067584 70 C0 9F FF */ andi. r0, r6, 0x9fff
/* 8006B748 00067588 28 04 00 01 */ cmplwi r4, 0x1
/* 8006B74C 0006758C 90 03 00 00 */ stw r0, 0x0(r3)
/* 8006B750 00067590 55 2A 04 3E */ clrlwi r10, r9, 16
/* 8006B754 00067594 41 82 00 0C */ beq lbl_8006B760
/* 8006B758 00067598 28 04 00 06 */ cmplwi r4, 0x6
/* 8006B75C 0006759C 40 82 00 28 */ bne lbl_8006B784
.global lbl_8006B760
lbl_8006B760:
/* 8006B760 000675A0 88 C3 06 41 */ lbz r6, 0x641(r3)
/* 8006B764 000675A4 81 23 00 00 */ lwz r9, 0x0(r3)
/* 8006B768 000675A8 7C 06 00 D0 */ neg r0, r6
/* 8006B76C 000675AC 7C 00 33 78 */ or r0, r0, r6
/* 8006B770 000675B0 7C 00 FE 70 */ srawi r0, r0, 31
/* 8006B774 000675B4 7C E0 00 78 */ andc r0, r7, r0
/* 8006B778 000675B8 54 00 04 64 */ rlwinm r0, r0, 0, 17, 18
/* 8006B77C 000675BC 7D 20 03 78 */ or r0, r9, r0
/* 8006B780 000675C0 90 03 00 00 */ stw r0, 0x0(r3)
.global lbl_8006B784
lbl_8006B784:
/* 8006B784 000675C4 80 C3 00 00 */ lwz r6, 0x0(r3)
/* 8006B788 000675C8 38 04 FF F0 */ addi r0, r4, -0x10
/* 8006B78C 000675CC 28 00 00 03 */ cmplwi r0, 0x3
/* 8006B790 000675D0 7C C7 52 78 */ xor r7, r6, r10
/* 8006B794 000675D4 7C E0 30 38 */ and r0, r7, r6
/* 8006B798 000675D8 90 03 00 04 */ stw r0, 0x4(r3)
/* 8006B79C 000675DC 7C E0 50 38 */ and r0, r7, r10
/* 8006B7A0 000675E0 90 03 00 08 */ stw r0, 0x8(r3)
/* 8006B7A4 000675E4 40 81 00 14 */ ble lbl_8006B7B8
/* 8006B7A8 000675E8 28 04 00 02 */ cmplwi r4, 0x2
/* 8006B7AC 000675EC 41 82 00 0C */ beq lbl_8006B7B8
/* 8006B7B0 000675F0 28 04 00 07 */ cmplwi r4, 0x7
/* 8006B7B4 000675F4 40 82 00 3C */ bne lbl_8006B7F0
.global lbl_8006B7B8
lbl_8006B7B8:
/* 8006B7B8 000675F8 88 E3 06 41 */ lbz r7, 0x641(r3)
/* 8006B7BC 000675FC 80 03 00 60 */ lwz r0, 0x60(r3)
/* 8006B7C0 00067600 7C C7 00 D0 */ neg r6, r7
/* 8006B7C4 00067604 7C C6 3B 78 */ or r6, r6, r7
/* 8006B7C8 00067608 54 07 04 3E */ clrlwi r7, r0, 16
/* 8006B7CC 0006760C 7C C0 FE 70 */ srawi r0, r6, 31
/* 8006B7D0 00067610 7D 00 00 78 */ andc r0, r8, r0
/* 8006B7D4 00067614 54 00 04 3E */ clrlwi r0, r0, 16
/* 8006B7D8 00067618 90 03 00 60 */ stw r0, 0x60(r3)
/* 8006B7DC 0006761C 7C 06 3A 78 */ xor r6, r0, r7
/* 8006B7E0 00067620 7C C0 00 38 */ and r0, r6, r0
/* 8006B7E4 00067624 90 03 00 64 */ stw r0, 0x64(r3)
/* 8006B7E8 00067628 7C C0 38 38 */ and r0, r6, r7
/* 8006B7EC 0006762C 90 03 00 68 */ stw r0, 0x68(r3)
.global lbl_8006B7F0
lbl_8006B7F0:
/* 8006B7F0 00067630 4B FF FD A0 */ b calc_button_repeat
/* 8006B7F4 00067634 00 00 00 00 */ .4byte 0x00000000
/* 8006B7F8 00067638 00 00 00 00 */ .4byte 0x00000000
/* 8006B7FC 0006763C 00 00 00 00 */ .4byte 0x00000000
.global calc_acc
calc_acc:
/* 8006B800 00067640 C0 44 00 00 */ lfs f2, 0x0(r4)
/* 8006B804 00067644 80 03 06 58 */ lwz r0, 0x658(r3)
/* 8006B808 00067648 EC 61 10 28 */ fsubs f3, f1, f2
/* 8006B80C 0006764C 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006B810 00067650 40 82 00 5C */ bne lbl_8006B86C
/* 8006B814 00067654 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006B818 00067658 FC 03 00 40 */ fcmpo cr0, f3, f0
/* 8006B81C 0006765C 40 80 00 0C */ bge lbl_8006B828
/* 8006B820 00067660 FC 40 18 50 */ fneg f2, f3
/* 8006B824 00067664 48 00 00 08 */ b lbl_8006B82C
.global lbl_8006B828
lbl_8006B828:
/* 8006B828 00067668 FC 40 18 90 */ fmr f2, f3
.global lbl_8006B82C
lbl_8006B82C:
/* 8006B82C 0006766C C0 03 01 08 */ lfs f0, 0x108(r3)
/* 8006B830 00067670 FC 02 00 40 */ fcmpo cr0, f2, f0
/* 8006B834 00067674 4C 41 13 82 */ cror eq, gt, eq
/* 8006B838 00067678 40 82 00 0C */ bne lbl_8006B844
/* 8006B83C 0006767C C0 42 88 60 */ lfs f2, "@4581"@sda21(r2)
/* 8006B840 00067680 48 00 00 10 */ b lbl_8006B850
.global lbl_8006B844
lbl_8006B844:
/* 8006B844 00067684 EC 42 00 24 */ fdivs f2, f2, f0
/* 8006B848 00067688 EC 42 00 B2 */ fmuls f2, f2, f2
/* 8006B84C 0006768C EC 42 00 B2 */ fmuls f2, f2, f2
.global lbl_8006B850
lbl_8006B850:
/* 8006B850 00067690 C0 23 01 0C */ lfs f1, 0x10c(r3)
/* 8006B854 00067694 C0 04 00 00 */ lfs f0, 0x0(r4)
/* 8006B858 00067698 EC 42 00 72 */ fmuls f2, f2, f1
/* 8006B85C 0006769C EC 22 00 F2 */ fmuls f1, f2, f3
/* 8006B860 000676A0 EC 00 08 2A */ fadds f0, f0, f1
/* 8006B864 000676A4 D0 04 00 00 */ stfs f0, 0x0(r4)
/* 8006B868 000676A8 4E 80 00 20 */ blr
.global lbl_8006B86C
lbl_8006B86C:
/* 8006B86C 000676AC C0 23 01 08 */ lfs f1, 0x108(r3)
/* 8006B870 000676B0 FC 00 08 50 */ fneg f0, f1
/* 8006B874 000676B4 FC 03 00 40 */ fcmpo cr0, f3, f0
/* 8006B878 000676B8 40 80 00 1C */ bge lbl_8006B894
/* 8006B87C 000676BC EC 23 08 2A */ fadds f1, f3, f1
/* 8006B880 000676C0 C0 03 01 0C */ lfs f0, 0x10c(r3)
/* 8006B884 000676C4 EC 00 00 72 */ fmuls f0, f0, f1
/* 8006B888 000676C8 EC 02 00 2A */ fadds f0, f2, f0
/* 8006B88C 000676CC D0 04 00 00 */ stfs f0, 0x0(r4)
/* 8006B890 000676D0 4E 80 00 20 */ blr
.global lbl_8006B894
lbl_8006B894:
/* 8006B894 000676D4 FC 03 08 40 */ fcmpo cr0, f3, f1
/* 8006B898 000676D8 4C 81 00 20 */ blelr
/* 8006B89C 000676DC EC 23 08 28 */ fsubs f1, f3, f1
/* 8006B8A0 000676E0 C0 03 01 0C */ lfs f0, 0x10c(r3)
/* 8006B8A4 000676E4 EC 00 00 72 */ fmuls f0, f0, f1
/* 8006B8A8 000676E8 EC 02 00 2A */ fadds f0, f2, f0
/* 8006B8AC 000676EC D0 04 00 00 */ stfs f0, 0x0(r4)
/* 8006B8B0 000676F0 4E 80 00 20 */ blr
/* 8006B8B4 000676F4 00 00 00 00 */ .4byte 0x00000000
/* 8006B8B8 000676F8 00 00 00 00 */ .4byte 0x00000000
/* 8006B8BC 000676FC 00 00 00 00 */ .4byte 0x00000000
.global calc_acc_horizon
calc_acc_horizon:
/* 8006B8C0 00067700 94 21 FF D0 */ stwu r1, -0x30(r1)
/* 8006B8C4 00067704 7C 08 02 A6 */ mflr r0
/* 8006B8C8 00067708 90 01 00 34 */ stw r0, 0x34(r1)
/* 8006B8CC 0006770C DB E1 00 20 */ stfd f31, 0x20(r1)
/* 8006B8D0 00067710 F3 E1 00 28 */ psq_st f31, 0x28(r1), 0, qr0
/* 8006B8D4 00067714 DB C1 00 10 */ stfd f30, 0x10(r1)
/* 8006B8D8 00067718 F3 C1 00 18 */ psq_st f30, 0x18(r1), 0, qr0
/* 8006B8DC 0006771C 93 E1 00 0C */ stw r31, 0xc(r1)
/* 8006B8E0 00067720 7C 7F 1B 78 */ mr r31, r3
/* 8006B8E4 00067724 C0 23 05 BC */ lfs f1, 0x5bc(r3)
/* 8006B8E8 00067728 C0 03 05 C0 */ lfs f0, 0x5c0(r3)
/* 8006B8EC 0006772C EC 21 00 72 */ fmuls f1, f1, f1
/* 8006B8F0 00067730 EC 00 00 32 */ fmuls f0, f0, f0
/* 8006B8F4 00067734 EC 21 00 2A */ fadds f1, f1, f0
/* 8006B8F8 00067738 4B FA 8E F1 */ bl sqrt
/* 8006B8FC 0006773C FD 00 08 18 */ frsp f8, f1
/* 8006B900 00067740 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006B904 00067744 FC 00 40 00 */ fcmpu cr0, f0, f8
/* 8006B908 00067748 41 82 01 28 */ beq lbl_8006BA30
/* 8006B90C 0006774C C0 42 88 6C */ lfs f2, "@4712"@sda21(r2)
/* 8006B910 00067750 FC 08 10 40 */ fcmpo cr0, f8, f2
/* 8006B914 00067754 4C 41 13 82 */ cror eq, gt, eq
/* 8006B918 00067758 40 82 00 08 */ bne lbl_8006B920
/* 8006B91C 0006775C 48 00 01 14 */ b lbl_8006BA30
.global lbl_8006B920
lbl_8006B920:
/* 8006B920 00067760 C0 1F 05 BC */ lfs f0, 0x5bc(r31)
/* 8006B924 00067764 C0 3F 05 C0 */ lfs f1, 0x5c0(r31)
/* 8006B928 00067768 ED 20 40 24 */ fdivs f9, f0, f8
/* 8006B92C 0006776C C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006B930 00067770 ED 41 40 24 */ fdivs f10, f1, f8
/* 8006B934 00067774 FC 08 00 40 */ fcmpo cr0, f8, f0
/* 8006B938 00067778 40 81 00 08 */ ble lbl_8006B940
/* 8006B93C 0006777C ED 02 40 28 */ fsubs f8, f2, f8
.global lbl_8006B940
lbl_8006B940:
/* 8006B940 00067780 C0 1F 01 18 */ lfs f0, 0x118(r31)
/* 8006B944 00067784 C0 DF 01 14 */ lfs f6, 0x114(r31)
/* 8006B948 00067788 EC 80 02 B2 */ fmuls f4, f0, f10
/* 8006B94C 0006778C C0 ED 84 04 */ lfs f7, kp_acc_horizon_pw@sda21(r13)
/* 8006B950 00067790 EC A6 02 72 */ fmuls f5, f6, f9
/* 8006B954 00067794 C0 7F 05 D0 */ lfs f3, 0x5d0(r31)
/* 8006B958 00067798 EC 40 02 72 */ fmuls f2, f0, f9
/* 8006B95C 0006779C C0 3F 05 D4 */ lfs f1, 0x5d4(r31)
/* 8006B960 000677A0 EC 06 02 B2 */ fmuls f0, f6, f10
/* 8006B964 000677A4 EC C8 01 F2 */ fmuls f6, f8, f7
/* 8006B968 000677A8 EC 85 20 2A */ fadds f4, f5, f4
/* 8006B96C 000677AC EC 02 00 28 */ fsubs f0, f2, f0
/* 8006B970 000677B0 ED 08 01 B2 */ fmuls f8, f8, f6
/* 8006B974 000677B4 EC 44 18 28 */ fsubs f2, f4, f3
/* 8006B978 000677B8 EC 00 08 28 */ fsubs f0, f0, f1
/* 8006B97C 000677BC EC 48 00 B2 */ fmuls f2, f8, f2
/* 8006B980 000677C0 EC 08 00 32 */ fmuls f0, f8, f0
/* 8006B984 000677C4 EF E3 10 2A */ fadds f31, f3, f2
/* 8006B988 000677C8 EF C1 00 2A */ fadds f30, f1, f0
/* 8006B98C 000677CC EC 3F 07 F2 */ fmuls f1, f31, f31
/* 8006B990 000677D0 EC 1E 07 B2 */ fmuls f0, f30, f30
/* 8006B994 000677D4 EC 21 00 2A */ fadds f1, f1, f0
/* 8006B998 000677D8 4B FA 8E 51 */ bl sqrt
/* 8006B99C 000677DC FC 20 08 18 */ frsp f1, f1
/* 8006B9A0 000677E0 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006B9A4 000677E4 FC 00 08 00 */ fcmpu cr0, f0, f1
/* 8006B9A8 000677E8 41 82 00 88 */ beq lbl_8006BA30
/* 8006B9AC 000677EC EC FF 08 24 */ fdivs f7, f31, f1
/* 8006B9B0 000677F0 C0 BF 05 E0 */ lfs f5, 0x5e0(r31)
/* 8006B9B4 000677F4 C0 7F 05 E4 */ lfs f3, 0x5e4(r31)
/* 8006B9B8 000677F8 C0 1F 06 2C */ lfs f0, 0x62c(r31)
/* 8006B9BC 000677FC D0 FF 05 D0 */ stfs f7, 0x5d0(r31)
/* 8006B9C0 00067800 EC DE 08 24 */ fdivs f6, f30, f1
/* 8006B9C4 00067804 D0 DF 05 D4 */ stfs f6, 0x5d4(r31)
/* 8006B9C8 00067808 EC 87 28 28 */ fsubs f4, f7, f5
/* 8006B9CC 0006780C C0 2D 84 0C */ lfs f1, kp_ah_circle_pw@sda21(r13)
/* 8006B9D0 00067810 EC 46 18 28 */ fsubs f2, f6, f3
/* 8006B9D4 00067814 EC 21 01 32 */ fmuls f1, f1, f4
/* 8006B9D8 00067818 EC 25 08 2A */ fadds f1, f5, f1
/* 8006B9DC 0006781C D0 3F 05 E0 */ stfs f1, 0x5e0(r31)
/* 8006B9E0 00067820 EC 87 08 28 */ fsubs f4, f7, f1
/* 8006B9E4 00067824 C0 2D 84 0C */ lfs f1, kp_ah_circle_pw@sda21(r13)
/* 8006B9E8 00067828 EC 21 00 B2 */ fmuls f1, f1, f2
/* 8006B9EC 0006782C EC 44 01 32 */ fmuls f2, f4, f4
/* 8006B9F0 00067830 EC 23 08 2A */ fadds f1, f3, f1
/* 8006B9F4 00067834 D0 3F 05 E4 */ stfs f1, 0x5e4(r31)
/* 8006B9F8 00067838 EC 26 08 28 */ fsubs f1, f6, f1
/* 8006B9FC 0006783C EC 21 00 72 */ fmuls f1, f1, f1
/* 8006BA00 00067840 EC 22 08 2A */ fadds f1, f2, f1
/* 8006BA04 00067844 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006BA08 00067848 4C 40 13 82 */ cror eq, lt, eq
/* 8006BA0C 0006784C 40 82 00 1C */ bne lbl_8006BA28
/* 8006BA10 00067850 A0 7F 05 E8 */ lhz r3, 0x5e8(r31)
/* 8006BA14 00067854 2C 03 00 00 */ cmpwi r3, 0x0
/* 8006BA18 00067858 41 82 00 18 */ beq lbl_8006BA30
/* 8006BA1C 0006785C 38 03 FF FF */ addi r0, r3, -0x1
/* 8006BA20 00067860 B0 1F 05 E8 */ sth r0, 0x5e8(r31)
/* 8006BA24 00067864 48 00 00 0C */ b lbl_8006BA30
.global lbl_8006BA28
lbl_8006BA28:
/* 8006BA28 00067868 A0 0D 84 10 */ lhz r0, kp_ah_circle_ct@sda21(r13)
/* 8006BA2C 0006786C B0 1F 05 E8 */ sth r0, 0x5e8(r31)
.global lbl_8006BA30
lbl_8006BA30:
/* 8006BA30 00067870 80 01 00 34 */ lwz r0, 0x34(r1)
/* 8006BA34 00067874 E3 E1 00 28 */ psq_l f31, 0x28(r1), 0, qr0
/* 8006BA38 00067878 CB E1 00 20 */ lfd f31, 0x20(r1)
/* 8006BA3C 0006787C E3 C1 00 18 */ psq_l f30, 0x18(r1), 0, qr0
/* 8006BA40 00067880 CB C1 00 10 */ lfd f30, 0x10(r1)
/* 8006BA44 00067884 83 E1 00 0C */ lwz r31, 0xc(r1)
/* 8006BA48 00067888 7C 08 03 A6 */ mtlr r0
/* 8006BA4C 0006788C 38 21 00 30 */ addi r1, r1, 0x30
/* 8006BA50 00067890 4E 80 00 20 */ blr
/* 8006BA54 00067894 00 00 00 00 */ .4byte 0x00000000
/* 8006BA58 00067898 00 00 00 00 */ .4byte 0x00000000
/* 8006BA5C 0006789C 00 00 00 00 */ .4byte 0x00000000
.global calc_acc_vertical
calc_acc_vertical:
/* 8006BA60 000678A0 94 21 FF C0 */ stwu r1, -0x40(r1)
/* 8006BA64 000678A4 7C 08 02 A6 */ mflr r0
/* 8006BA68 000678A8 90 01 00 44 */ stw r0, 0x44(r1)
/* 8006BA6C 000678AC DB E1 00 30 */ stfd f31, 0x30(r1)
/* 8006BA70 000678B0 F3 E1 00 38 */ psq_st f31, 0x38(r1), 0, qr0
/* 8006BA74 000678B4 DB C1 00 20 */ stfd f30, 0x20(r1)
/* 8006BA78 000678B8 F3 C1 00 28 */ psq_st f30, 0x28(r1), 0, qr0
/* 8006BA7C 000678BC DB A1 00 10 */ stfd f29, 0x10(r1)
/* 8006BA80 000678C0 F3 A1 00 18 */ psq_st f29, 0x18(r1), 0, qr0
/* 8006BA84 000678C4 93 E1 00 0C */ stw r31, 0xc(r1)
/* 8006BA88 000678C8 7C 7F 1B 78 */ mr r31, r3
/* 8006BA8C 000678CC C0 23 05 BC */ lfs f1, 0x5bc(r3)
/* 8006BA90 000678D0 C0 03 05 C0 */ lfs f0, 0x5c0(r3)
/* 8006BA94 000678D4 EC 21 00 72 */ fmuls f1, f1, f1
/* 8006BA98 000678D8 EC 00 00 32 */ fmuls f0, f0, f0
/* 8006BA9C 000678DC EF C1 00 2A */ fadds f30, f1, f0
/* 8006BAA0 000678E0 FC 20 F0 90 */ fmr f1, f30
/* 8006BAA4 000678E4 4B FA 8D 45 */ bl sqrt
/* 8006BAA8 000678E8 C0 1F 05 C4 */ lfs f0, 0x5c4(r31)
/* 8006BAAC 000678EC FF E0 08 18 */ frsp f31, f1
/* 8006BAB0 000678F0 FF A0 00 50 */ fneg f29, f0
/* 8006BAB4 000678F4 EC 1D 07 72 */ fmuls f0, f29, f29
/* 8006BAB8 000678F8 EC 3E 00 2A */ fadds f1, f30, f0
/* 8006BABC 000678FC 4B FA 8D 2D */ bl sqrt
/* 8006BAC0 00067900 FC A0 08 18 */ frsp f5, f1
/* 8006BAC4 00067904 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BAC8 00067908 FC 00 28 00 */ fcmpu cr0, f0, f5
/* 8006BACC 0006790C 41 82 00 8C */ beq lbl_8006BB58
/* 8006BAD0 00067910 C0 22 88 6C */ lfs f1, "@4712"@sda21(r2)
/* 8006BAD4 00067914 FC 05 08 40 */ fcmpo cr0, f5, f1
/* 8006BAD8 00067918 4C 41 13 82 */ cror eq, gt, eq
/* 8006BADC 0006791C 40 82 00 08 */ bne lbl_8006BAE4
/* 8006BAE0 00067920 48 00 00 78 */ b lbl_8006BB58
.global lbl_8006BAE4
lbl_8006BAE4:
/* 8006BAE4 00067924 EC 5F 28 24 */ fdivs f2, f31, f5
/* 8006BAE8 00067928 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006BAEC 0006792C EF BD 28 24 */ fdivs f29, f29, f5
/* 8006BAF0 00067930 FC 05 00 40 */ fcmpo cr0, f5, f0
/* 8006BAF4 00067934 40 81 00 08 */ ble lbl_8006BAFC
/* 8006BAF8 00067938 EC A1 28 28 */ fsubs f5, f1, f5
.global lbl_8006BAFC
lbl_8006BAFC:
/* 8006BAFC 0006793C C0 0D 84 04 */ lfs f0, kp_acc_horizon_pw@sda21(r13)
/* 8006BB00 00067940 C0 7F 00 54 */ lfs f3, 0x54(r31)
/* 8006BB04 00067944 EC 85 00 32 */ fmuls f4, f5, f0
/* 8006BB08 00067948 C0 3F 00 58 */ lfs f1, 0x58(r31)
/* 8006BB0C 0006794C EC 42 18 28 */ fsubs f2, f2, f3
/* 8006BB10 00067950 EC 1D 08 28 */ fsubs f0, f29, f1
/* 8006BB14 00067954 EC A5 01 32 */ fmuls f5, f5, f4
/* 8006BB18 00067958 EC 45 00 B2 */ fmuls f2, f5, f2
/* 8006BB1C 0006795C EC 05 00 32 */ fmuls f0, f5, f0
/* 8006BB20 00067960 EF E3 10 2A */ fadds f31, f3, f2
/* 8006BB24 00067964 EF C1 00 2A */ fadds f30, f1, f0
/* 8006BB28 00067968 EC 3F 07 F2 */ fmuls f1, f31, f31
/* 8006BB2C 0006796C EC 1E 07 B2 */ fmuls f0, f30, f30
/* 8006BB30 00067970 EC 21 00 2A */ fadds f1, f1, f0
/* 8006BB34 00067974 4B FA 8C B5 */ bl sqrt
/* 8006BB38 00067978 FC 20 08 18 */ frsp f1, f1
/* 8006BB3C 0006797C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BB40 00067980 FC 00 08 00 */ fcmpu cr0, f0, f1
/* 8006BB44 00067984 41 82 00 14 */ beq lbl_8006BB58
/* 8006BB48 00067988 EC 1F 08 24 */ fdivs f0, f31, f1
/* 8006BB4C 0006798C D0 1F 00 54 */ stfs f0, 0x54(r31)
/* 8006BB50 00067990 EC 1E 08 24 */ fdivs f0, f30, f1
/* 8006BB54 00067994 D0 1F 00 58 */ stfs f0, 0x58(r31)
.global lbl_8006BB58
lbl_8006BB58:
/* 8006BB58 00067998 80 01 00 44 */ lwz r0, 0x44(r1)
/* 8006BB5C 0006799C E3 E1 00 38 */ psq_l f31, 0x38(r1), 0, qr0
/* 8006BB60 000679A0 CB E1 00 30 */ lfd f31, 0x30(r1)
/* 8006BB64 000679A4 E3 C1 00 28 */ psq_l f30, 0x28(r1), 0, qr0
/* 8006BB68 000679A8 CB C1 00 20 */ lfd f30, 0x20(r1)
/* 8006BB6C 000679AC E3 A1 00 18 */ psq_l f29, 0x18(r1), 0, qr0
/* 8006BB70 000679B0 CB A1 00 10 */ lfd f29, 0x10(r1)
/* 8006BB74 000679B4 83 E1 00 0C */ lwz r31, 0xc(r1)
/* 8006BB78 000679B8 7C 08 03 A6 */ mtlr r0
/* 8006BB7C 000679BC 38 21 00 40 */ addi r1, r1, 0x40
/* 8006BB80 000679C0 4E 80 00 20 */ blr
/* 8006BB84 000679C4 00 00 00 00 */ .4byte 0x00000000
/* 8006BB88 000679C8 00 00 00 00 */ .4byte 0x00000000
/* 8006BB8C 000679CC 00 00 00 00 */ .4byte 0x00000000
.global read_kpad_acc
read_kpad_acc:
/* 8006BB90 000679D0 94 21 FF B0 */ stwu r1, -0x50(r1)
/* 8006BB94 000679D4 7C 08 02 A6 */ mflr r0
/* 8006BB98 000679D8 3C A0 43 30 */ lis r5, 0x4330
/* 8006BB9C 000679DC 90 01 00 54 */ stw r0, 0x54(r1)
/* 8006BBA0 000679E0 93 E1 00 4C */ stw r31, 0x4c(r1)
/* 8006BBA4 000679E4 7C 9F 23 78 */ mr r31, r4
/* 8006BBA8 000679E8 93 C1 00 48 */ stw r30, 0x48(r1)
/* 8006BBAC 000679EC 7C 7E 1B 78 */ mr r30, r3
/* 8006BBB0 000679F0 88 04 00 40 */ lbz r0, 0x40(r4)
/* 8006BBB4 000679F4 90 A1 00 30 */ stw r5, 0x30(r1)
/* 8006BBB8 000679F8 28 00 00 14 */ cmplwi r0, 0x14
/* 8006BBBC 000679FC 90 A1 00 38 */ stw r5, 0x38(r1)
/* 8006BBC0 00067A00 41 81 05 40 */ bgt lbl_8006C100
/* 8006BBC4 00067A04 3C A0 80 44 */ lis r5, "@4805"@ha
/* 8006BBC8 00067A08 54 00 10 3A */ slwi r0, r0, 2
/* 8006BBCC 00067A0C 38 A5 9F 48 */ addi r5, r5, "@4805"@l
/* 8006BBD0 00067A10 7C A5 00 2E */ lwzx r5, r5, r0
/* 8006BBD4 00067A14 7C A9 03 A6 */ mtctr r5
/* 8006BBD8 00067A18 4E 80 04 20 */ bctr
.global lbl_8006BBDC
lbl_8006BBDC:
/* 8006BBDC 00067A1C 48 00 05 24 */ b lbl_8006C100
.global lbl_8006BBE0
lbl_8006BBE0:
/* 8006BBE0 00067A20 A8 04 00 02 */ lha r0, 0x2(r4)
/* 8006BBE4 00067A24 C8 62 88 70 */ lfd f3, "@4806"@sda21(r2)
/* 8006BBE8 00067A28 7C 00 00 D0 */ neg r0, r0
/* 8006BBEC 00067A2C C0 23 05 FC */ lfs f1, 0x5fc(r3)
/* 8006BBF0 00067A30 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006BBF4 00067A34 90 01 00 34 */ stw r0, 0x34(r1)
/* 8006BBF8 00067A38 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BBFC 00067A3C C8 41 00 30 */ lfd f2, 0x30(r1)
/* 8006BC00 00067A40 C0 8D 84 4C */ lfs f4, kp_rm_acc_max@sda21(r13)
/* 8006BC04 00067A44 EC 42 18 28 */ fsubs f2, f2, f3
/* 8006BC08 00067A48 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006BC0C 00067A4C FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006BC10 00067A50 40 80 00 14 */ bge lbl_8006BC24
/* 8006BC14 00067A54 FC 80 20 50 */ fneg f4, f4
/* 8006BC18 00067A58 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BC1C 00067A5C 40 80 00 14 */ bge lbl_8006BC30
/* 8006BC20 00067A60 48 00 00 14 */ b lbl_8006BC34
.global lbl_8006BC24
lbl_8006BC24:
/* 8006BC24 00067A64 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BC28 00067A68 40 81 00 08 */ ble lbl_8006BC30
/* 8006BC2C 00067A6C 48 00 00 08 */ b lbl_8006BC34
.global lbl_8006BC30
lbl_8006BC30:
/* 8006BC30 00067A70 FC 80 08 90 */ fmr f4, f1
.global lbl_8006BC34
lbl_8006BC34:
/* 8006BC34 00067A74 D0 83 05 BC */ stfs f4, 0x5bc(r3)
/* 8006BC38 00067A78 C8 62 88 70 */ lfd f3, "@4806"@sda21(r2)
/* 8006BC3C 00067A7C A8 04 00 06 */ lha r0, 0x6(r4)
/* 8006BC40 00067A80 C0 23 06 04 */ lfs f1, 0x604(r3)
/* 8006BC44 00067A84 7C 00 00 D0 */ neg r0, r0
/* 8006BC48 00067A88 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BC4C 00067A8C 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006BC50 00067A90 90 01 00 3C */ stw r0, 0x3c(r1)
/* 8006BC54 00067A94 C0 8D 84 4C */ lfs f4, kp_rm_acc_max@sda21(r13)
/* 8006BC58 00067A98 C8 41 00 38 */ lfd f2, 0x38(r1)
/* 8006BC5C 00067A9C EC 42 18 28 */ fsubs f2, f2, f3
/* 8006BC60 00067AA0 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006BC64 00067AA4 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006BC68 00067AA8 40 80 00 14 */ bge lbl_8006BC7C
/* 8006BC6C 00067AAC FC 80 20 50 */ fneg f4, f4
/* 8006BC70 00067AB0 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BC74 00067AB4 40 80 00 14 */ bge lbl_8006BC88
/* 8006BC78 00067AB8 48 00 00 14 */ b lbl_8006BC8C
.global lbl_8006BC7C
lbl_8006BC7C:
/* 8006BC7C 00067ABC FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BC80 00067AC0 40 81 00 08 */ ble lbl_8006BC88
/* 8006BC84 00067AC4 48 00 00 08 */ b lbl_8006BC8C
.global lbl_8006BC88
lbl_8006BC88:
/* 8006BC88 00067AC8 FC 80 08 90 */ fmr f4, f1
.global lbl_8006BC8C
lbl_8006BC8C:
/* 8006BC8C 00067ACC D0 83 05 C0 */ stfs f4, 0x5c0(r3)
/* 8006BC90 00067AD0 C8 62 88 70 */ lfd f3, "@4806"@sda21(r2)
/* 8006BC94 00067AD4 A8 04 00 04 */ lha r0, 0x4(r4)
/* 8006BC98 00067AD8 C0 23 06 00 */ lfs f1, 0x600(r3)
/* 8006BC9C 00067ADC 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006BCA0 00067AE0 90 01 00 34 */ stw r0, 0x34(r1)
/* 8006BCA4 00067AE4 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BCA8 00067AE8 C8 41 00 30 */ lfd f2, 0x30(r1)
/* 8006BCAC 00067AEC C0 8D 84 4C */ lfs f4, kp_rm_acc_max@sda21(r13)
/* 8006BCB0 00067AF0 EC 42 18 28 */ fsubs f2, f2, f3
/* 8006BCB4 00067AF4 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006BCB8 00067AF8 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006BCBC 00067AFC 40 80 00 14 */ bge lbl_8006BCD0
/* 8006BCC0 00067B00 FC 80 20 50 */ fneg f4, f4
/* 8006BCC4 00067B04 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BCC8 00067B08 40 80 00 14 */ bge lbl_8006BCDC
/* 8006BCCC 00067B0C 48 00 00 14 */ b lbl_8006BCE0
.global lbl_8006BCD0
lbl_8006BCD0:
/* 8006BCD0 00067B10 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BCD4 00067B14 40 81 00 08 */ ble lbl_8006BCDC
/* 8006BCD8 00067B18 48 00 00 08 */ b lbl_8006BCE0
.global lbl_8006BCDC
lbl_8006BCDC:
/* 8006BCDC 00067B1C FC 80 08 90 */ fmr f4, f1
.global lbl_8006BCE0
lbl_8006BCE0:
/* 8006BCE0 00067B20 80 C3 00 0C */ lwz r6, 0xc(r3)
/* 8006BCE4 00067B24 38 9E 00 0C */ addi r4, r30, 0xc
/* 8006BCE8 00067B28 80 A3 00 10 */ lwz r5, 0x10(r3)
/* 8006BCEC 00067B2C 80 03 00 14 */ lwz r0, 0x14(r3)
/* 8006BCF0 00067B30 D0 83 05 C4 */ stfs f4, 0x5c4(r3)
/* 8006BCF4 00067B34 7F C3 F3 78 */ mr r3, r30
/* 8006BCF8 00067B38 C0 3E 05 BC */ lfs f1, 0x5bc(r30)
/* 8006BCFC 00067B3C 90 C1 00 14 */ stw r6, 0x14(r1)
/* 8006BD00 00067B40 90 A1 00 18 */ stw r5, 0x18(r1)
/* 8006BD04 00067B44 90 01 00 1C */ stw r0, 0x1c(r1)
/* 8006BD08 00067B48 4B FF FA F9 */ bl calc_acc
/* 8006BD0C 00067B4C C0 3E 05 C0 */ lfs f1, 0x5c0(r30)
/* 8006BD10 00067B50 7F C3 F3 78 */ mr r3, r30
/* 8006BD14 00067B54 38 9E 00 10 */ addi r4, r30, 0x10
/* 8006BD18 00067B58 4B FF FA E9 */ bl calc_acc
/* 8006BD1C 00067B5C C0 3E 05 C4 */ lfs f1, 0x5c4(r30)
/* 8006BD20 00067B60 7F C3 F3 78 */ mr r3, r30
/* 8006BD24 00067B64 38 9E 00 14 */ addi r4, r30, 0x14
/* 8006BD28 00067B68 4B FF FA D9 */ bl calc_acc
/* 8006BD2C 00067B6C C0 3E 00 0C */ lfs f1, 0xc(r30)
/* 8006BD30 00067B70 C0 1E 00 10 */ lfs f0, 0x10(r30)
/* 8006BD34 00067B74 EC 21 00 72 */ fmuls f1, f1, f1
/* 8006BD38 00067B78 C0 5E 00 14 */ lfs f2, 0x14(r30)
/* 8006BD3C 00067B7C EC 00 00 32 */ fmuls f0, f0, f0
/* 8006BD40 00067B80 EC 42 00 B2 */ fmuls f2, f2, f2
/* 8006BD44 00067B84 EC 01 00 2A */ fadds f0, f1, f0
/* 8006BD48 00067B88 EC 22 00 2A */ fadds f1, f2, f0
/* 8006BD4C 00067B8C 4B FA 8A 9D */ bl sqrt
/* 8006BD50 00067B90 C0 41 00 14 */ lfs f2, 0x14(r1)
/* 8006BD54 00067B94 FC C0 08 18 */ frsp f6, f1
/* 8006BD58 00067B98 C0 1E 00 0C */ lfs f0, 0xc(r30)
/* 8006BD5C 00067B9C C0 21 00 18 */ lfs f1, 0x18(r1)
/* 8006BD60 00067BA0 EC A2 00 28 */ fsubs f5, f2, f0
/* 8006BD64 00067BA4 C0 1E 00 10 */ lfs f0, 0x10(r30)
/* 8006BD68 00067BA8 C0 41 00 1C */ lfs f2, 0x1c(r1)
/* 8006BD6C 00067BAC EC 81 00 28 */ fsubs f4, f1, f0
/* 8006BD70 00067BB0 C0 1E 00 14 */ lfs f0, 0x14(r30)
/* 8006BD74 00067BB4 EC 25 01 72 */ fmuls f1, f5, f5
/* 8006BD78 00067BB8 EC 62 00 28 */ fsubs f3, f2, f0
/* 8006BD7C 00067BBC D0 DE 00 18 */ stfs f6, 0x18(r30)
/* 8006BD80 00067BC0 EC 04 01 32 */ fmuls f0, f4, f4
/* 8006BD84 00067BC4 D0 A1 00 14 */ stfs f5, 0x14(r1)
/* 8006BD88 00067BC8 EC 43 00 F2 */ fmuls f2, f3, f3
/* 8006BD8C 00067BCC EC 01 00 2A */ fadds f0, f1, f0
/* 8006BD90 00067BD0 D0 81 00 18 */ stfs f4, 0x18(r1)
/* 8006BD94 00067BD4 D0 61 00 1C */ stfs f3, 0x1c(r1)
/* 8006BD98 00067BD8 EC 22 00 2A */ fadds f1, f2, f0
/* 8006BD9C 00067BDC 4B FA 8A 4D */ bl sqrt
/* 8006BDA0 00067BE0 FC 00 08 18 */ frsp f0, f1
/* 8006BDA4 00067BE4 7F C3 F3 78 */ mr r3, r30
/* 8006BDA8 00067BE8 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006BDAC 00067BEC 4B FF FB 15 */ bl calc_acc_horizon
/* 8006BDB0 00067BF0 7F C3 F3 78 */ mr r3, r30
/* 8006BDB4 00067BF4 4B FF FC AD */ bl calc_acc_vertical
/* 8006BDB8 00067BF8 88 1F 00 29 */ lbz r0, 0x29(r31)
/* 8006BDBC 00067BFC 7C 00 07 75 */ extsb. r0, r0
/* 8006BDC0 00067C00 40 82 00 24 */ bne lbl_8006BDE4
/* 8006BDC4 00067C04 88 7F 00 28 */ lbz r3, 0x28(r31)
/* 8006BDC8 00067C08 28 03 00 01 */ cmplwi r3, 0x1
/* 8006BDCC 00067C0C 40 82 00 18 */ bne lbl_8006BDE4
/* 8006BDD0 00067C10 88 1F 00 40 */ lbz r0, 0x40(r31)
/* 8006BDD4 00067C14 28 00 00 04 */ cmplwi r0, 0x4
/* 8006BDD8 00067C18 41 82 00 30 */ beq lbl_8006BE08
/* 8006BDDC 00067C1C 28 00 00 05 */ cmplwi r0, 0x5
/* 8006BDE0 00067C20 41 82 00 28 */ beq lbl_8006BE08
.global lbl_8006BDE4
lbl_8006BDE4:
/* 8006BDE4 00067C24 88 7F 00 28 */ lbz r3, 0x28(r31)
/* 8006BDE8 00067C28 28 03 00 06 */ cmplwi r3, 0x6
/* 8006BDEC 00067C2C 40 82 03 14 */ bne lbl_8006C100
/* 8006BDF0 00067C30 88 1F 00 40 */ lbz r0, 0x40(r31)
/* 8006BDF4 00067C34 28 00 00 10 */ cmplwi r0, 0x10
/* 8006BDF8 00067C38 40 82 03 08 */ bne lbl_8006C100
/* 8006BDFC 00067C3C 88 1F 00 36 */ lbz r0, 0x36(r31)
/* 8006BE00 00067C40 54 00 06 73 */ rlwinm. r0, r0, 0, 25, 25
/* 8006BE04 00067C44 41 82 02 FC */ beq lbl_8006C100
.global lbl_8006BE08
lbl_8006BE08:
/* 8006BE08 00067C48 28 03 00 01 */ cmplwi r3, 0x1
/* 8006BE0C 00067C4C 40 82 01 0C */ bne lbl_8006BF18
/* 8006BE10 00067C50 A8 1F 00 2A */ lha r0, 0x2a(r31)
/* 8006BE14 00067C54 C8 62 88 70 */ lfd f3, "@4806"@sda21(r2)
/* 8006BE18 00067C58 7C 00 00 D0 */ neg r0, r0
/* 8006BE1C 00067C5C C0 3E 06 08 */ lfs f1, 0x608(r30)
/* 8006BE20 00067C60 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006BE24 00067C64 90 01 00 3C */ stw r0, 0x3c(r1)
/* 8006BE28 00067C68 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BE2C 00067C6C C8 41 00 38 */ lfd f2, 0x38(r1)
/* 8006BE30 00067C70 C0 8D 84 50 */ lfs f4, kp_fs_acc_max@sda21(r13)
/* 8006BE34 00067C74 EC 42 18 28 */ fsubs f2, f2, f3
/* 8006BE38 00067C78 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006BE3C 00067C7C FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006BE40 00067C80 40 80 00 14 */ bge lbl_8006BE54
/* 8006BE44 00067C84 FC 80 20 50 */ fneg f4, f4
/* 8006BE48 00067C88 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BE4C 00067C8C 40 80 00 14 */ bge lbl_8006BE60
/* 8006BE50 00067C90 48 00 00 14 */ b lbl_8006BE64
.global lbl_8006BE54
lbl_8006BE54:
/* 8006BE54 00067C94 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BE58 00067C98 40 81 00 08 */ ble lbl_8006BE60
/* 8006BE5C 00067C9C 48 00 00 08 */ b lbl_8006BE64
.global lbl_8006BE60
lbl_8006BE60:
/* 8006BE60 00067CA0 FC 80 08 90 */ fmr f4, f1
.global lbl_8006BE64
lbl_8006BE64:
/* 8006BE64 00067CA4 D0 81 00 20 */ stfs f4, 0x20(r1)
/* 8006BE68 00067CA8 C8 62 88 70 */ lfd f3, "@4806"@sda21(r2)
/* 8006BE6C 00067CAC A8 1F 00 2E */ lha r0, 0x2e(r31)
/* 8006BE70 00067CB0 C0 3E 06 10 */ lfs f1, 0x610(r30)
/* 8006BE74 00067CB4 7C 00 00 D0 */ neg r0, r0
/* 8006BE78 00067CB8 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BE7C 00067CBC 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006BE80 00067CC0 90 01 00 34 */ stw r0, 0x34(r1)
/* 8006BE84 00067CC4 C0 8D 84 50 */ lfs f4, kp_fs_acc_max@sda21(r13)
/* 8006BE88 00067CC8 C8 41 00 30 */ lfd f2, 0x30(r1)
/* 8006BE8C 00067CCC EC 42 18 28 */ fsubs f2, f2, f3
/* 8006BE90 00067CD0 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006BE94 00067CD4 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006BE98 00067CD8 40 80 00 14 */ bge lbl_8006BEAC
/* 8006BE9C 00067CDC FC 80 20 50 */ fneg f4, f4
/* 8006BEA0 00067CE0 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BEA4 00067CE4 40 80 00 14 */ bge lbl_8006BEB8
/* 8006BEA8 00067CE8 48 00 00 14 */ b lbl_8006BEBC
.global lbl_8006BEAC
lbl_8006BEAC:
/* 8006BEAC 00067CEC FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BEB0 00067CF0 40 81 00 08 */ ble lbl_8006BEB8
/* 8006BEB4 00067CF4 48 00 00 08 */ b lbl_8006BEBC
.global lbl_8006BEB8
lbl_8006BEB8:
/* 8006BEB8 00067CF8 FC 80 08 90 */ fmr f4, f1
.global lbl_8006BEBC
lbl_8006BEBC:
/* 8006BEBC 00067CFC D0 81 00 24 */ stfs f4, 0x24(r1)
/* 8006BEC0 00067D00 C8 62 88 70 */ lfd f3, "@4806"@sda21(r2)
/* 8006BEC4 00067D04 A8 1F 00 2C */ lha r0, 0x2c(r31)
/* 8006BEC8 00067D08 C0 3E 06 0C */ lfs f1, 0x60c(r30)
/* 8006BECC 00067D0C 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006BED0 00067D10 90 01 00 3C */ stw r0, 0x3c(r1)
/* 8006BED4 00067D14 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BED8 00067D18 C8 41 00 38 */ lfd f2, 0x38(r1)
/* 8006BEDC 00067D1C C0 8D 84 50 */ lfs f4, kp_fs_acc_max@sda21(r13)
/* 8006BEE0 00067D20 EC 42 18 28 */ fsubs f2, f2, f3
/* 8006BEE4 00067D24 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006BEE8 00067D28 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006BEEC 00067D2C 40 80 00 14 */ bge lbl_8006BF00
/* 8006BEF0 00067D30 FC 80 20 50 */ fneg f4, f4
/* 8006BEF4 00067D34 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BEF8 00067D38 40 80 00 14 */ bge lbl_8006BF0C
/* 8006BEFC 00067D3C 48 00 00 14 */ b lbl_8006BF10
.global lbl_8006BF00
lbl_8006BF00:
/* 8006BF00 00067D40 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BF04 00067D44 40 81 00 08 */ ble lbl_8006BF0C
/* 8006BF08 00067D48 48 00 00 08 */ b lbl_8006BF10
.global lbl_8006BF0C
lbl_8006BF0C:
/* 8006BF0C 00067D4C FC 80 08 90 */ fmr f4, f1
.global lbl_8006BF10
lbl_8006BF10:
/* 8006BF10 00067D50 D0 81 00 28 */ stfs f4, 0x28(r1)
/* 8006BF14 00067D54 48 00 01 08 */ b lbl_8006C01C
.global lbl_8006BF18
lbl_8006BF18:
/* 8006BF18 00067D58 A8 1F 00 2A */ lha r0, 0x2a(r31)
/* 8006BF1C 00067D5C C8 62 88 70 */ lfd f3, "@4806"@sda21(r2)
/* 8006BF20 00067D60 7C 00 00 D0 */ neg r0, r0
/* 8006BF24 00067D64 C0 3E 06 08 */ lfs f1, 0x608(r30)
/* 8006BF28 00067D68 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006BF2C 00067D6C 90 01 00 34 */ stw r0, 0x34(r1)
/* 8006BF30 00067D70 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BF34 00067D74 C8 41 00 30 */ lfd f2, 0x30(r1)
/* 8006BF38 00067D78 C0 8D 84 50 */ lfs f4, kp_fs_acc_max@sda21(r13)
/* 8006BF3C 00067D7C EC 42 18 28 */ fsubs f2, f2, f3
/* 8006BF40 00067D80 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006BF44 00067D84 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006BF48 00067D88 40 80 00 14 */ bge lbl_8006BF5C
/* 8006BF4C 00067D8C FC 80 20 50 */ fneg f4, f4
/* 8006BF50 00067D90 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BF54 00067D94 40 80 00 14 */ bge lbl_8006BF68
/* 8006BF58 00067D98 48 00 00 14 */ b lbl_8006BF6C
.global lbl_8006BF5C
lbl_8006BF5C:
/* 8006BF5C 00067D9C FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BF60 00067DA0 40 81 00 08 */ ble lbl_8006BF68
/* 8006BF64 00067DA4 48 00 00 08 */ b lbl_8006BF6C
.global lbl_8006BF68
lbl_8006BF68:
/* 8006BF68 00067DA8 FC 80 08 90 */ fmr f4, f1
.global lbl_8006BF6C
lbl_8006BF6C:
/* 8006BF6C 00067DAC D0 81 00 20 */ stfs f4, 0x20(r1)
/* 8006BF70 00067DB0 C8 62 88 70 */ lfd f3, "@4806"@sda21(r2)
/* 8006BF74 00067DB4 A8 1F 00 2E */ lha r0, 0x2e(r31)
/* 8006BF78 00067DB8 C0 3E 06 10 */ lfs f1, 0x610(r30)
/* 8006BF7C 00067DBC 7C 00 00 D0 */ neg r0, r0
/* 8006BF80 00067DC0 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BF84 00067DC4 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006BF88 00067DC8 90 01 00 3C */ stw r0, 0x3c(r1)
/* 8006BF8C 00067DCC C0 8D 84 50 */ lfs f4, kp_fs_acc_max@sda21(r13)
/* 8006BF90 00067DD0 C8 41 00 38 */ lfd f2, 0x38(r1)
/* 8006BF94 00067DD4 EC 42 18 28 */ fsubs f2, f2, f3
/* 8006BF98 00067DD8 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006BF9C 00067DDC FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006BFA0 00067DE0 40 80 00 14 */ bge lbl_8006BFB4
/* 8006BFA4 00067DE4 FC 80 20 50 */ fneg f4, f4
/* 8006BFA8 00067DE8 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BFAC 00067DEC 40 80 00 14 */ bge lbl_8006BFC0
/* 8006BFB0 00067DF0 48 00 00 14 */ b lbl_8006BFC4
.global lbl_8006BFB4
lbl_8006BFB4:
/* 8006BFB4 00067DF4 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006BFB8 00067DF8 40 81 00 08 */ ble lbl_8006BFC0
/* 8006BFBC 00067DFC 48 00 00 08 */ b lbl_8006BFC4
.global lbl_8006BFC0
lbl_8006BFC0:
/* 8006BFC0 00067E00 FC 80 08 90 */ fmr f4, f1
.global lbl_8006BFC4
lbl_8006BFC4:
/* 8006BFC4 00067E04 D0 81 00 24 */ stfs f4, 0x24(r1)
/* 8006BFC8 00067E08 C8 62 88 70 */ lfd f3, "@4806"@sda21(r2)
/* 8006BFCC 00067E0C A8 1F 00 2C */ lha r0, 0x2c(r31)
/* 8006BFD0 00067E10 C0 3E 06 0C */ lfs f1, 0x60c(r30)
/* 8006BFD4 00067E14 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006BFD8 00067E18 90 01 00 34 */ stw r0, 0x34(r1)
/* 8006BFDC 00067E1C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006BFE0 00067E20 C8 41 00 30 */ lfd f2, 0x30(r1)
/* 8006BFE4 00067E24 C0 8D 84 50 */ lfs f4, kp_fs_acc_max@sda21(r13)
/* 8006BFE8 00067E28 EC 42 18 28 */ fsubs f2, f2, f3
/* 8006BFEC 00067E2C EC 22 00 72 */ fmuls f1, f2, f1
/* 8006BFF0 00067E30 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006BFF4 00067E34 40 80 00 14 */ bge lbl_8006C008
/* 8006BFF8 00067E38 FC 80 20 50 */ fneg f4, f4
/* 8006BFFC 00067E3C FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006C000 00067E40 40 80 00 14 */ bge lbl_8006C014
/* 8006C004 00067E44 48 00 00 14 */ b lbl_8006C018
.global lbl_8006C008
lbl_8006C008:
/* 8006C008 00067E48 FC 01 20 40 */ fcmpo cr0, f1, f4
/* 8006C00C 00067E4C 40 81 00 08 */ ble lbl_8006C014
/* 8006C010 00067E50 48 00 00 08 */ b lbl_8006C018
.global lbl_8006C014
lbl_8006C014:
/* 8006C014 00067E54 FC 80 08 90 */ fmr f4, f1
.global lbl_8006C018
lbl_8006C018:
/* 8006C018 00067E58 D0 81 00 28 */ stfs f4, 0x28(r1)
.global lbl_8006C01C
lbl_8006C01C:
/* 8006C01C 00067E5C 88 1E 06 4A */ lbz r0, 0x64a(r30)
/* 8006C020 00067E60 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006C024 00067E64 41 82 00 18 */ beq lbl_8006C03C
/* 8006C028 00067E68 38 81 00 20 */ addi r4, r1, 0x20
/* 8006C02C 00067E6C 3C 60 80 4D */ lis r3, kp_fs_rot@ha
/* 8006C030 00067E70 7C 85 23 78 */ mr r5, r4
/* 8006C034 00067E74 38 63 96 28 */ addi r3, r3, kp_fs_rot@l
/* 8006C038 00067E78 4B FC 50 B9 */ bl PSMTXMultVec
.global lbl_8006C03C
lbl_8006C03C:
/* 8006C03C 00067E7C 80 DE 00 68 */ lwz r6, 0x68(r30)
/* 8006C040 00067E80 7F C3 F3 78 */ mr r3, r30
/* 8006C044 00067E84 80 BE 00 6C */ lwz r5, 0x6c(r30)
/* 8006C048 00067E88 38 9E 00 68 */ addi r4, r30, 0x68
/* 8006C04C 00067E8C 80 1E 00 70 */ lwz r0, 0x70(r30)
/* 8006C050 00067E90 90 C1 00 08 */ stw r6, 0x8(r1)
/* 8006C054 00067E94 C0 21 00 20 */ lfs f1, 0x20(r1)
/* 8006C058 00067E98 90 A1 00 0C */ stw r5, 0xc(r1)
/* 8006C05C 00067E9C 90 01 00 10 */ stw r0, 0x10(r1)
/* 8006C060 00067EA0 4B FF F7 A1 */ bl calc_acc
/* 8006C064 00067EA4 C0 21 00 24 */ lfs f1, 0x24(r1)
/* 8006C068 00067EA8 7F C3 F3 78 */ mr r3, r30
/* 8006C06C 00067EAC 38 9E 00 6C */ addi r4, r30, 0x6c
/* 8006C070 00067EB0 4B FF F7 91 */ bl calc_acc
/* 8006C074 00067EB4 C0 21 00 28 */ lfs f1, 0x28(r1)
/* 8006C078 00067EB8 7F C3 F3 78 */ mr r3, r30
/* 8006C07C 00067EBC 38 9E 00 70 */ addi r4, r30, 0x70
/* 8006C080 00067EC0 4B FF F7 81 */ bl calc_acc
/* 8006C084 00067EC4 C0 3E 00 68 */ lfs f1, 0x68(r30)
/* 8006C088 00067EC8 C0 1E 00 6C */ lfs f0, 0x6c(r30)
/* 8006C08C 00067ECC EC 21 00 72 */ fmuls f1, f1, f1
/* 8006C090 00067ED0 C0 5E 00 70 */ lfs f2, 0x70(r30)
/* 8006C094 00067ED4 EC 00 00 32 */ fmuls f0, f0, f0
/* 8006C098 00067ED8 EC 42 00 B2 */ fmuls f2, f2, f2
/* 8006C09C 00067EDC EC 01 00 2A */ fadds f0, f1, f0
/* 8006C0A0 00067EE0 EC 22 00 2A */ fadds f1, f2, f0
/* 8006C0A4 00067EE4 4B FA 87 45 */ bl sqrt
/* 8006C0A8 00067EE8 C0 41 00 08 */ lfs f2, 0x8(r1)
/* 8006C0AC 00067EEC FC C0 08 18 */ frsp f6, f1
/* 8006C0B0 00067EF0 C0 1E 00 68 */ lfs f0, 0x68(r30)
/* 8006C0B4 00067EF4 C0 21 00 0C */ lfs f1, 0xc(r1)
/* 8006C0B8 00067EF8 EC A2 00 28 */ fsubs f5, f2, f0
/* 8006C0BC 00067EFC C0 1E 00 6C */ lfs f0, 0x6c(r30)
/* 8006C0C0 00067F00 C0 41 00 10 */ lfs f2, 0x10(r1)
/* 8006C0C4 00067F04 EC 81 00 28 */ fsubs f4, f1, f0
/* 8006C0C8 00067F08 C0 1E 00 70 */ lfs f0, 0x70(r30)
/* 8006C0CC 00067F0C EC 25 01 72 */ fmuls f1, f5, f5
/* 8006C0D0 00067F10 EC 62 00 28 */ fsubs f3, f2, f0
/* 8006C0D4 00067F14 D0 DE 00 74 */ stfs f6, 0x74(r30)
/* 8006C0D8 00067F18 EC 04 01 32 */ fmuls f0, f4, f4
/* 8006C0DC 00067F1C D0 A1 00 08 */ stfs f5, 0x8(r1)
/* 8006C0E0 00067F20 EC 43 00 F2 */ fmuls f2, f3, f3
/* 8006C0E4 00067F24 EC 01 00 2A */ fadds f0, f1, f0
/* 8006C0E8 00067F28 D0 81 00 0C */ stfs f4, 0xc(r1)
/* 8006C0EC 00067F2C D0 61 00 10 */ stfs f3, 0x10(r1)
/* 8006C0F0 00067F30 EC 22 00 2A */ fadds f1, f2, f0
/* 8006C0F4 00067F34 4B FA 86 F5 */ bl sqrt
/* 8006C0F8 00067F38 FC 00 08 18 */ frsp f0, f1
/* 8006C0FC 00067F3C D0 1E 00 78 */ stfs f0, 0x78(r30)
.global lbl_8006C100
lbl_8006C100:
/* 8006C100 00067F40 80 01 00 54 */ lwz r0, 0x54(r1)
/* 8006C104 00067F44 83 E1 00 4C */ lwz r31, 0x4c(r1)
/* 8006C108 00067F48 83 C1 00 48 */ lwz r30, 0x48(r1)
/* 8006C10C 00067F4C 7C 08 03 A6 */ mtlr r0
/* 8006C110 00067F50 38 21 00 50 */ addi r1, r1, 0x50
/* 8006C114 00067F54 4E 80 00 20 */ blr
/* 8006C118 00067F58 00 00 00 00 */ .4byte 0x00000000
/* 8006C11C 00067F5C 00 00 00 00 */ .4byte 0x00000000
.global select_2obj_first
select_2obj_first:
/* 8006C120 00067F60 94 21 FF 80 */ stwu r1, -0x80(r1)
/* 8006C124 00067F64 7C 08 02 A6 */ mflr r0
/* 8006C128 00067F68 90 01 00 84 */ stw r0, 0x84(r1)
/* 8006C12C 00067F6C 39 61 00 30 */ addi r11, r1, 0x30
/* 8006C130 00067F70 DB E1 00 70 */ stfd f31, 0x70(r1)
/* 8006C134 00067F74 F3 E1 00 78 */ psq_st f31, 0x78(r1), 0, qr0
/* 8006C138 00067F78 DB C1 00 60 */ stfd f30, 0x60(r1)
/* 8006C13C 00067F7C F3 C1 00 68 */ psq_st f30, 0x68(r1), 0, qr0
/* 8006C140 00067F80 DB A1 00 50 */ stfd f29, 0x50(r1)
/* 8006C144 00067F84 F3 A1 00 58 */ psq_st f29, 0x58(r1), 0, qr0
/* 8006C148 00067F88 DB 81 00 40 */ stfd f28, 0x40(r1)
/* 8006C14C 00067F8C F3 81 00 48 */ psq_st f28, 0x48(r1), 0, qr0
/* 8006C150 00067F90 DB 61 00 30 */ stfd f27, 0x30(r1)
/* 8006C154 00067F94 F3 61 00 38 */ psq_st f27, 0x38(r1), 0, qr0
/* 8006C158 00067F98 4B F9 B1 DD */ bl lbl_80007334
/* 8006C15C 00067F9C C3 CD 84 20 */ lfs f30, kp_err_first_inpr@sda21(r13)
/* 8006C160 00067FA0 7C 79 1B 78 */ mr r25, r3
/* 8006C164 00067FA4 C3 A2 88 50 */ lfs f29, "@4535"@sda21(r2)
/* 8006C168 00067FA8 3B A3 01 30 */ addi r29, r3, 0x130
/* 8006C16C 00067FAC C3 E2 88 60 */ lfs f31, "@4581"@sda21(r2)
/* 8006C170 00067FB0 3B E3 01 54 */ addi r31, r3, 0x154
.global lbl_8006C174
lbl_8006C174:
/* 8006C174 00067FB4 88 1D 00 08 */ lbz r0, 0x8(r29)
/* 8006C178 00067FB8 7C 00 07 75 */ extsb. r0, r0
/* 8006C17C 00067FBC 40 82 00 F8 */ bne lbl_8006C274
/* 8006C180 00067FC0 3B 9D 00 0C */ addi r28, r29, 0xc
/* 8006C184 00067FC4 3B D9 01 54 */ addi r30, r25, 0x154
.global lbl_8006C188
lbl_8006C188:
/* 8006C188 00067FC8 88 1C 00 08 */ lbz r0, 0x8(r28)
/* 8006C18C 00067FCC 7C 00 07 75 */ extsb. r0, r0
/* 8006C190 00067FD0 40 82 00 D8 */ bne lbl_8006C268
/* 8006C194 00067FD4 C0 7C 00 00 */ lfs f3, 0x0(r28)
/* 8006C198 00067FD8 C0 5D 00 00 */ lfs f2, 0x0(r29)
/* 8006C19C 00067FDC C0 3C 00 04 */ lfs f1, 0x4(r28)
/* 8006C1A0 00067FE0 C0 1D 00 04 */ lfs f0, 0x4(r29)
/* 8006C1A4 00067FE4 EF 63 10 28 */ fsubs f27, f3, f2
/* 8006C1A8 00067FE8 EF 81 00 28 */ fsubs f28, f1, f0
/* 8006C1AC 00067FEC EC 3B 06 F2 */ fmuls f1, f27, f27
/* 8006C1B0 00067FF0 EC 1C 07 32 */ fmuls f0, f28, f28
/* 8006C1B4 00067FF4 EC 21 00 2A */ fadds f1, f1, f0
/* 8006C1B8 00067FF8 4B FA 86 31 */ bl sqrt
/* 8006C1BC 00067FFC FC 00 08 18 */ frsp f0, f1
/* 8006C1C0 00068000 C0 B9 01 1C */ lfs f5, 0x11c(r25)
/* 8006C1C4 00068004 C0 59 01 20 */ lfs f2, 0x120(r25)
/* 8006C1C8 00068008 C0 39 06 30 */ lfs f1, 0x630(r25)
/* 8006C1CC 0006800C EC 7F 00 24 */ fdivs f3, f31, f0
/* 8006C1D0 00068010 C0 19 06 34 */ lfs f0, 0x634(r25)
/* 8006C1D4 00068014 EF 7B 00 F2 */ fmuls f27, f27, f3
/* 8006C1D8 00068018 EF 9C 00 F2 */ fmuls f28, f28, f3
/* 8006C1DC 0006801C EC C1 00 F2 */ fmuls f6, f1, f3
/* 8006C1E0 00068020 EC 85 06 F2 */ fmuls f4, f5, f27
/* 8006C1E4 00068024 EC 62 07 32 */ fmuls f3, f2, f28
/* 8006C1E8 00068028 EC 42 06 F2 */ fmuls f2, f2, f27
/* 8006C1EC 0006802C EC 25 07 32 */ fmuls f1, f5, f28
/* 8006C1F0 00068030 EC 64 18 2A */ fadds f3, f4, f3
/* 8006C1F4 00068034 FC 06 00 40 */ fcmpo cr0, f6, f0
/* 8006C1F8 00068038 EC 42 08 28 */ fsubs f2, f2, f1
/* 8006C1FC 0006803C D0 61 00 08 */ stfs f3, 0x8(r1)
/* 8006C200 00068040 D0 41 00 0C */ stfs f2, 0xc(r1)
/* 8006C204 00068044 4C 40 13 82 */ cror eq, lt, eq
/* 8006C208 00068048 41 82 00 60 */ beq lbl_8006C268
/* 8006C20C 0006804C C0 0D 84 18 */ lfs f0, kp_err_dist_max@sda21(r13)
/* 8006C210 00068050 FC 06 00 40 */ fcmpo cr0, f6, f0
/* 8006C214 00068054 4C 41 13 82 */ cror eq, gt, eq
/* 8006C218 00068058 41 82 00 50 */ beq lbl_8006C268
/* 8006C21C 0006805C C0 39 05 D0 */ lfs f1, 0x5d0(r25)
/* 8006C220 00068060 C0 19 05 D4 */ lfs f0, 0x5d4(r25)
/* 8006C224 00068064 EC 21 00 F2 */ fmuls f1, f1, f3
/* 8006C228 00068068 EC 00 00 B2 */ fmuls f0, f0, f2
/* 8006C22C 0006806C EC 01 00 2A */ fadds f0, f1, f0
/* 8006C230 00068070 FC 00 E8 40 */ fcmpo cr0, f0, f29
/* 8006C234 00068074 40 80 00 20 */ bge lbl_8006C254
/* 8006C238 00068078 FC 00 00 50 */ fneg f0, f0
/* 8006C23C 0006807C FC 00 F0 40 */ fcmpo cr0, f0, f30
/* 8006C240 00068080 40 81 00 28 */ ble lbl_8006C268
/* 8006C244 00068084 FF C0 00 90 */ fmr f30, f0
/* 8006C248 00068088 7F 9B E3 78 */ mr r27, r28
/* 8006C24C 0006808C 7F BA EB 78 */ mr r26, r29
/* 8006C250 00068090 48 00 00 18 */ b lbl_8006C268
.global lbl_8006C254
lbl_8006C254:
/* 8006C254 00068094 FC 00 F0 40 */ fcmpo cr0, f0, f30
/* 8006C258 00068098 40 81 00 10 */ ble lbl_8006C268
/* 8006C25C 0006809C FF C0 00 90 */ fmr f30, f0
/* 8006C260 000680A0 7F BB EB 78 */ mr r27, r29
/* 8006C264 000680A4 7F 9A E3 78 */ mr r26, r28
.global lbl_8006C268
lbl_8006C268:
/* 8006C268 000680A8 3B 9C 00 0C */ addi r28, r28, 0xc
/* 8006C26C 000680AC 7C 1C F0 40 */ cmplw r28, r30
/* 8006C270 000680B0 40 81 FF 18 */ ble lbl_8006C188
.global lbl_8006C274
lbl_8006C274:
/* 8006C274 000680B4 3B BD 00 0C */ addi r29, r29, 0xc
/* 8006C278 000680B8 7C 1D F8 40 */ cmplw r29, r31
/* 8006C27C 000680BC 41 80 FE F8 */ blt lbl_8006C174
/* 8006C280 000680C0 C0 0D 84 20 */ lfs f0, kp_err_first_inpr@sda21(r13)
/* 8006C284 000680C4 FC 1E 00 00 */ fcmpu cr0, f30, f0
/* 8006C288 000680C8 40 82 00 0C */ bne lbl_8006C294
/* 8006C28C 000680CC 38 60 00 00 */ li r3, 0x0
/* 8006C290 000680D0 48 00 00 38 */ b lbl_8006C2C8
.global lbl_8006C294
lbl_8006C294:
/* 8006C294 000680D4 80 9B 00 00 */ lwz r4, 0x0(r27)
/* 8006C298 000680D8 38 60 00 02 */ li r3, 0x2
/* 8006C29C 000680DC 80 1B 00 04 */ lwz r0, 0x4(r27)
/* 8006C2A0 000680E0 90 19 01 64 */ stw r0, 0x164(r25)
/* 8006C2A4 000680E4 90 99 01 60 */ stw r4, 0x160(r25)
/* 8006C2A8 000680E8 80 1B 00 08 */ lwz r0, 0x8(r27)
/* 8006C2AC 000680EC 90 19 01 68 */ stw r0, 0x168(r25)
/* 8006C2B0 000680F0 80 9A 00 00 */ lwz r4, 0x0(r26)
/* 8006C2B4 000680F4 80 1A 00 04 */ lwz r0, 0x4(r26)
/* 8006C2B8 000680F8 90 19 01 70 */ stw r0, 0x170(r25)
/* 8006C2BC 000680FC 90 99 01 6C */ stw r4, 0x16c(r25)
/* 8006C2C0 00068100 80 1A 00 08 */ lwz r0, 0x8(r26)
/* 8006C2C4 00068104 90 19 01 74 */ stw r0, 0x174(r25)
.global lbl_8006C2C8
lbl_8006C2C8:
/* 8006C2C8 00068108 39 61 00 30 */ addi r11, r1, 0x30
/* 8006C2CC 0006810C E3 E1 00 78 */ psq_l f31, 0x78(r1), 0, qr0
/* 8006C2D0 00068110 CB E1 00 70 */ lfd f31, 0x70(r1)
/* 8006C2D4 00068114 E3 C1 00 68 */ psq_l f30, 0x68(r1), 0, qr0
/* 8006C2D8 00068118 CB C1 00 60 */ lfd f30, 0x60(r1)
/* 8006C2DC 0006811C E3 A1 00 58 */ psq_l f29, 0x58(r1), 0, qr0
/* 8006C2E0 00068120 CB A1 00 50 */ lfd f29, 0x50(r1)
/* 8006C2E4 00068124 E3 81 00 48 */ psq_l f28, 0x48(r1), 0, qr0
/* 8006C2E8 00068128 CB 81 00 40 */ lfd f28, 0x40(r1)
/* 8006C2EC 0006812C E3 61 00 38 */ psq_l f27, 0x38(r1), 0, qr0
/* 8006C2F0 00068130 CB 61 00 30 */ lfd f27, 0x30(r1)
/* 8006C2F4 00068134 4B F9 B0 8D */ bl lbl_80007380
/* 8006C2F8 00068138 80 01 00 84 */ lwz r0, 0x84(r1)
/* 8006C2FC 0006813C 7C 08 03 A6 */ mtlr r0
/* 8006C300 00068140 38 21 00 80 */ addi r1, r1, 0x80
/* 8006C304 00068144 4E 80 00 20 */ blr
/* 8006C308 00068148 00 00 00 00 */ .4byte 0x00000000
/* 8006C30C 0006814C 00 00 00 00 */ .4byte 0x00000000
.global select_2obj_continue
select_2obj_continue:
/* 8006C310 00068150 94 21 FF 80 */ stwu r1, -0x80(r1)
/* 8006C314 00068154 7C 08 02 A6 */ mflr r0
/* 8006C318 00068158 90 01 00 84 */ stw r0, 0x84(r1)
/* 8006C31C 0006815C 39 61 00 30 */ addi r11, r1, 0x30
/* 8006C320 00068160 DB E1 00 70 */ stfd f31, 0x70(r1)
/* 8006C324 00068164 F3 E1 00 78 */ psq_st f31, 0x78(r1), 0, qr0
/* 8006C328 00068168 DB C1 00 60 */ stfd f30, 0x60(r1)
/* 8006C32C 0006816C F3 C1 00 68 */ psq_st f30, 0x68(r1), 0, qr0
/* 8006C330 00068170 DB A1 00 50 */ stfd f29, 0x50(r1)
/* 8006C334 00068174 F3 A1 00 58 */ psq_st f29, 0x58(r1), 0, qr0
/* 8006C338 00068178 DB 81 00 40 */ stfd f28, 0x40(r1)
/* 8006C33C 0006817C F3 81 00 48 */ psq_st f28, 0x48(r1), 0, qr0
/* 8006C340 00068180 DB 61 00 30 */ stfd f27, 0x30(r1)
/* 8006C344 00068184 F3 61 00 38 */ psq_st f27, 0x38(r1), 0, qr0
/* 8006C348 00068188 4B F9 AF ED */ bl lbl_80007334
/* 8006C34C 0006818C C3 E2 88 6C */ lfs f31, "@4712"@sda21(r2)
/* 8006C350 00068190 7C 7F 1B 78 */ mr r31, r3
/* 8006C354 00068194 C3 A2 88 50 */ lfs f29, "@4535"@sda21(r2)
/* 8006C358 00068198 3B 83 01 30 */ addi r28, r3, 0x130
/* 8006C35C 0006819C C3 C2 88 60 */ lfs f30, "@4581"@sda21(r2)
/* 8006C360 000681A0 3B C3 01 54 */ addi r30, r3, 0x154
.global lbl_8006C364
lbl_8006C364:
/* 8006C364 000681A4 88 1C 00 08 */ lbz r0, 0x8(r28)
/* 8006C368 000681A8 7C 00 07 75 */ extsb. r0, r0
/* 8006C36C 000681AC 40 82 01 38 */ bne lbl_8006C4A4
/* 8006C370 000681B0 3B 7C 00 0C */ addi r27, r28, 0xc
/* 8006C374 000681B4 3B BF 01 54 */ addi r29, r31, 0x154
.global lbl_8006C378
lbl_8006C378:
/* 8006C378 000681B8 88 1B 00 08 */ lbz r0, 0x8(r27)
/* 8006C37C 000681BC 7C 00 07 75 */ extsb. r0, r0
/* 8006C380 000681C0 40 82 01 18 */ bne lbl_8006C498
/* 8006C384 000681C4 C0 7B 00 00 */ lfs f3, 0x0(r27)
/* 8006C388 000681C8 C0 5C 00 00 */ lfs f2, 0x0(r28)
/* 8006C38C 000681CC C0 3B 00 04 */ lfs f1, 0x4(r27)
/* 8006C390 000681D0 C0 1C 00 04 */ lfs f0, 0x4(r28)
/* 8006C394 000681D4 EF 83 10 28 */ fsubs f28, f3, f2
/* 8006C398 000681D8 EF 61 00 28 */ fsubs f27, f1, f0
/* 8006C39C 000681DC EC 3C 07 32 */ fmuls f1, f28, f28
/* 8006C3A0 000681E0 EC 1B 06 F2 */ fmuls f0, f27, f27
/* 8006C3A4 000681E4 EC 21 00 2A */ fadds f1, f1, f0
/* 8006C3A8 000681E8 4B FA 84 41 */ bl sqrt
/* 8006C3AC 000681EC FC 40 08 18 */ frsp f2, f1
/* 8006C3B0 000681F0 C0 3F 06 30 */ lfs f1, 0x630(r31)
/* 8006C3B4 000681F4 C0 1F 06 34 */ lfs f0, 0x634(r31)
/* 8006C3B8 000681F8 EC 9E 10 24 */ fdivs f4, f30, f2
/* 8006C3BC 000681FC EC 7C 01 32 */ fmuls f3, f28, f4
/* 8006C3C0 00068200 EC 5B 01 32 */ fmuls f2, f27, f4
/* 8006C3C4 00068204 EC 84 00 72 */ fmuls f4, f4, f1
/* 8006C3C8 00068208 D0 61 00 08 */ stfs f3, 0x8(r1)
/* 8006C3CC 0006820C D0 41 00 0C */ stfs f2, 0xc(r1)
/* 8006C3D0 00068210 FC 04 00 40 */ fcmpo cr0, f4, f0
/* 8006C3D4 00068214 4C 40 13 82 */ cror eq, lt, eq
/* 8006C3D8 00068218 41 82 00 C0 */ beq lbl_8006C498
/* 8006C3DC 0006821C C0 0D 84 18 */ lfs f0, kp_err_dist_max@sda21(r13)
/* 8006C3E0 00068220 FC 04 00 40 */ fcmpo cr0, f4, f0
/* 8006C3E4 00068224 4C 41 13 82 */ cror eq, gt, eq
/* 8006C3E8 00068228 41 82 00 B0 */ beq lbl_8006C498
/* 8006C3EC 0006822C C0 1F 05 B4 */ lfs f0, 0x5b4(r31)
/* 8006C3F0 00068230 EC 84 00 28 */ fsubs f4, f4, f0
/* 8006C3F4 00068234 FC 04 E8 40 */ fcmpo cr0, f4, f29
/* 8006C3F8 00068238 40 80 00 10 */ bge lbl_8006C408
/* 8006C3FC 0006823C C0 1F 06 28 */ lfs f0, 0x628(r31)
/* 8006C400 00068240 EC 84 00 32 */ fmuls f4, f4, f0
/* 8006C404 00068244 48 00 00 0C */ b lbl_8006C410
.global lbl_8006C408
lbl_8006C408:
/* 8006C408 00068248 C0 1F 06 24 */ lfs f0, 0x624(r31)
/* 8006C40C 0006824C EC 84 00 32 */ fmuls f4, f4, f0
.global lbl_8006C410
lbl_8006C410:
/* 8006C410 00068250 FC 04 F0 40 */ fcmpo cr0, f4, f30
/* 8006C414 00068254 4C 41 13 82 */ cror eq, gt, eq
/* 8006C418 00068258 41 82 00 80 */ beq lbl_8006C498
/* 8006C41C 0006825C C0 7F 05 AC */ lfs f3, 0x5ac(r31)
/* 8006C420 00068260 C0 41 00 08 */ lfs f2, 0x8(r1)
/* 8006C424 00068264 C0 3F 05 B0 */ lfs f1, 0x5b0(r31)
/* 8006C428 00068268 C0 01 00 0C */ lfs f0, 0xc(r1)
/* 8006C42C 0006826C EC 43 00 B2 */ fmuls f2, f3, f2
/* 8006C430 00068270 EC 01 00 32 */ fmuls f0, f1, f0
/* 8006C434 00068274 EC 22 00 2A */ fadds f1, f2, f0
/* 8006C438 00068278 FC 01 E8 40 */ fcmpo cr0, f1, f29
/* 8006C43C 0006827C 40 80 00 10 */ bge lbl_8006C44C
/* 8006C440 00068280 FC 20 08 50 */ fneg f1, f1
/* 8006C444 00068284 38 00 00 01 */ li r0, 0x1
/* 8006C448 00068288 48 00 00 08 */ b lbl_8006C450
.global lbl_8006C44C
lbl_8006C44C:
/* 8006C44C 0006828C 38 00 00 00 */ li r0, 0x0
.global lbl_8006C450
lbl_8006C450:
/* 8006C450 00068290 C0 0D 84 24 */ lfs f0, kp_err_next_inpr@sda21(r13)
/* 8006C454 00068294 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006C458 00068298 4C 40 13 82 */ cror eq, lt, eq
/* 8006C45C 0006829C 41 82 00 3C */ beq lbl_8006C498
/* 8006C460 000682A0 EC 3E 08 28 */ fsubs f1, f30, f1
/* 8006C464 000682A4 EC 1E 00 28 */ fsubs f0, f30, f0
/* 8006C468 000682A8 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006C46C 000682AC EC 84 00 2A */ fadds f4, f4, f0
/* 8006C470 000682B0 FC 04 F8 40 */ fcmpo cr0, f4, f31
/* 8006C474 000682B4 40 80 00 24 */ bge lbl_8006C498
/* 8006C478 000682B8 FF E0 20 90 */ fmr f31, f4
/* 8006C47C 000682BC 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006C480 000682C0 41 82 00 10 */ beq lbl_8006C490
/* 8006C484 000682C4 7F 7A DB 78 */ mr r26, r27
/* 8006C488 000682C8 7F 99 E3 78 */ mr r25, r28
/* 8006C48C 000682CC 48 00 00 0C */ b lbl_8006C498
.global lbl_8006C490
lbl_8006C490:
/* 8006C490 000682D0 7F 9A E3 78 */ mr r26, r28
/* 8006C494 000682D4 7F 79 DB 78 */ mr r25, r27
.global lbl_8006C498
lbl_8006C498:
/* 8006C498 000682D8 3B 7B 00 0C */ addi r27, r27, 0xc
/* 8006C49C 000682DC 7C 1B E8 40 */ cmplw r27, r29
/* 8006C4A0 000682E0 40 81 FE D8 */ ble lbl_8006C378
.global lbl_8006C4A4
lbl_8006C4A4:
/* 8006C4A4 000682E4 3B 9C 00 0C */ addi r28, r28, 0xc
/* 8006C4A8 000682E8 7C 1C F0 40 */ cmplw r28, r30
/* 8006C4AC 000682EC 41 80 FE B8 */ blt lbl_8006C364
/* 8006C4B0 000682F0 C0 02 88 6C */ lfs f0, "@4712"@sda21(r2)
/* 8006C4B4 000682F4 FC 00 F8 00 */ fcmpu cr0, f0, f31
/* 8006C4B8 000682F8 40 82 00 0C */ bne lbl_8006C4C4
/* 8006C4BC 000682FC 38 60 00 00 */ li r3, 0x0
/* 8006C4C0 00068300 48 00 00 38 */ b lbl_8006C4F8
.global lbl_8006C4C4
lbl_8006C4C4:
/* 8006C4C4 00068304 80 9A 00 00 */ lwz r4, 0x0(r26)
/* 8006C4C8 00068308 38 60 00 02 */ li r3, 0x2
/* 8006C4CC 0006830C 80 1A 00 04 */ lwz r0, 0x4(r26)
/* 8006C4D0 00068310 90 1F 01 64 */ stw r0, 0x164(r31)
/* 8006C4D4 00068314 90 9F 01 60 */ stw r4, 0x160(r31)
/* 8006C4D8 00068318 80 1A 00 08 */ lwz r0, 0x8(r26)
/* 8006C4DC 0006831C 90 1F 01 68 */ stw r0, 0x168(r31)
/* 8006C4E0 00068320 80 99 00 00 */ lwz r4, 0x0(r25)
/* 8006C4E4 00068324 80 19 00 04 */ lwz r0, 0x4(r25)
/* 8006C4E8 00068328 90 1F 01 70 */ stw r0, 0x170(r31)
/* 8006C4EC 0006832C 90 9F 01 6C */ stw r4, 0x16c(r31)
/* 8006C4F0 00068330 80 19 00 08 */ lwz r0, 0x8(r25)
/* 8006C4F4 00068334 90 1F 01 74 */ stw r0, 0x174(r31)
.global lbl_8006C4F8
lbl_8006C4F8:
/* 8006C4F8 00068338 39 61 00 30 */ addi r11, r1, 0x30
/* 8006C4FC 0006833C E3 E1 00 78 */ psq_l f31, 0x78(r1), 0, qr0
/* 8006C500 00068340 CB E1 00 70 */ lfd f31, 0x70(r1)
/* 8006C504 00068344 E3 C1 00 68 */ psq_l f30, 0x68(r1), 0, qr0
/* 8006C508 00068348 CB C1 00 60 */ lfd f30, 0x60(r1)
/* 8006C50C 0006834C E3 A1 00 58 */ psq_l f29, 0x58(r1), 0, qr0
/* 8006C510 00068350 CB A1 00 50 */ lfd f29, 0x50(r1)
/* 8006C514 00068354 E3 81 00 48 */ psq_l f28, 0x48(r1), 0, qr0
/* 8006C518 00068358 CB 81 00 40 */ lfd f28, 0x40(r1)
/* 8006C51C 0006835C E3 61 00 38 */ psq_l f27, 0x38(r1), 0, qr0
/* 8006C520 00068360 CB 61 00 30 */ lfd f27, 0x30(r1)
/* 8006C524 00068364 4B F9 AE 5D */ bl lbl_80007380
/* 8006C528 00068368 80 01 00 84 */ lwz r0, 0x84(r1)
/* 8006C52C 0006836C 7C 08 03 A6 */ mtlr r0
/* 8006C530 00068370 38 21 00 80 */ addi r1, r1, 0x80
/* 8006C534 00068374 4E 80 00 20 */ blr
/* 8006C538 00068378 00 00 00 00 */ .4byte 0x00000000
/* 8006C53C 0006837C 00 00 00 00 */ .4byte 0x00000000
.global select_1obj_first
select_1obj_first:
/* 8006C540 00068380 94 21 FF E0 */ stwu r1, -0x20(r1)
/* 8006C544 00068384 39 03 01 30 */ addi r8, r3, 0x130
/* 8006C548 00068388 38 03 01 60 */ addi r0, r3, 0x160
/* 8006C54C 0006838C C0 A3 01 1C */ lfs f5, 0x11c(r3)
/* 8006C550 00068390 C0 03 05 D0 */ lfs f0, 0x5d0(r3)
/* 8006C554 00068394 C0 63 01 20 */ lfs f3, 0x120(r3)
/* 8006C558 00068398 C0 23 05 D4 */ lfs f1, 0x5d4(r3)
/* 8006C55C 0006839C EC 85 00 32 */ fmuls f4, f5, f0
/* 8006C560 000683A0 EC 43 00 32 */ fmuls f2, f3, f0
/* 8006C564 000683A4 C0 03 05 B8 */ lfs f0, 0x5b8(r3)
/* 8006C568 000683A8 EC 63 00 72 */ fmuls f3, f3, f1
/* 8006C56C 000683AC EC 25 00 72 */ fmuls f1, f5, f1
/* 8006C570 000683B0 EC E4 18 2A */ fadds f7, f4, f3
/* 8006C574 000683B4 ED 02 08 28 */ fsubs f8, f2, f1
/* 8006C578 000683B8 EC E7 00 32 */ fmuls f7, f7, f0
/* 8006C57C 000683BC ED 08 00 32 */ fmuls f8, f8, f0
.global lbl_8006C580
lbl_8006C580:
/* 8006C580 000683C0 88 88 00 08 */ lbz r4, 0x8(r8)
/* 8006C584 000683C4 7C 84 07 75 */ extsb. r4, r4
/* 8006C588 000683C8 40 82 01 54 */ bne lbl_8006C6DC
/* 8006C58C 000683CC C0 48 00 00 */ lfs f2, 0x0(r8)
/* 8006C590 000683D0 C0 08 00 04 */ lfs f0, 0x4(r8)
/* 8006C594 000683D4 EC 22 38 28 */ fsubs f1, f2, f7
/* 8006C598 000683D8 C0 63 06 14 */ lfs f3, 0x614(r3)
/* 8006C59C 000683DC EC C0 40 28 */ fsubs f6, f0, f8
/* 8006C5A0 000683E0 EC A2 38 2A */ fadds f5, f2, f7
/* 8006C5A4 000683E4 D0 21 00 10 */ stfs f1, 0x10(r1)
/* 8006C5A8 000683E8 EC 80 40 2A */ fadds f4, f0, f8
/* 8006C5AC 000683EC FC 01 18 40 */ fcmpo cr0, f1, f3
/* 8006C5B0 000683F0 D0 C1 00 14 */ stfs f6, 0x14(r1)
/* 8006C5B4 000683F4 D0 A1 00 08 */ stfs f5, 0x8(r1)
/* 8006C5B8 000683F8 D0 81 00 0C */ stfs f4, 0xc(r1)
/* 8006C5BC 000683FC 4C 40 13 82 */ cror eq, lt, eq
/* 8006C5C0 00068400 41 82 00 34 */ beq lbl_8006C5F4
/* 8006C5C4 00068404 C0 43 06 1C */ lfs f2, 0x61c(r3)
/* 8006C5C8 00068408 FC 01 10 40 */ fcmpo cr0, f1, f2
/* 8006C5CC 0006840C 4C 41 13 82 */ cror eq, gt, eq
/* 8006C5D0 00068410 41 82 00 24 */ beq lbl_8006C5F4
/* 8006C5D4 00068414 C0 23 06 18 */ lfs f1, 0x618(r3)
/* 8006C5D8 00068418 FC 06 08 40 */ fcmpo cr0, f6, f1
/* 8006C5DC 0006841C 4C 40 13 82 */ cror eq, lt, eq
/* 8006C5E0 00068420 41 82 00 14 */ beq lbl_8006C5F4
/* 8006C5E4 00068424 C0 03 06 20 */ lfs f0, 0x620(r3)
/* 8006C5E8 00068428 FC 06 00 40 */ fcmpo cr0, f6, f0
/* 8006C5EC 0006842C 4C 41 13 82 */ cror eq, gt, eq
/* 8006C5F0 00068430 40 82 00 7C */ bne lbl_8006C66C
.global lbl_8006C5F4
lbl_8006C5F4:
/* 8006C5F4 00068434 C0 21 00 08 */ lfs f1, 0x8(r1)
/* 8006C5F8 00068438 C0 03 06 14 */ lfs f0, 0x614(r3)
/* 8006C5FC 0006843C FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006C600 00068440 40 81 00 DC */ ble lbl_8006C6DC
/* 8006C604 00068444 C0 03 06 1C */ lfs f0, 0x61c(r3)
/* 8006C608 00068448 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006C60C 0006844C 40 80 00 D0 */ bge lbl_8006C6DC
/* 8006C610 00068450 C0 21 00 0C */ lfs f1, 0xc(r1)
/* 8006C614 00068454 C0 03 06 18 */ lfs f0, 0x618(r3)
/* 8006C618 00068458 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006C61C 0006845C 40 81 00 C0 */ ble lbl_8006C6DC
/* 8006C620 00068460 C0 03 06 20 */ lfs f0, 0x620(r3)
/* 8006C624 00068464 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006C628 00068468 40 80 00 B4 */ bge lbl_8006C6DC
/* 8006C62C 0006846C 80 E8 00 00 */ lwz r7, 0x0(r8)
/* 8006C630 00068470 38 80 00 00 */ li r4, 0x0
/* 8006C634 00068474 80 A8 00 04 */ lwz r5, 0x4(r8)
/* 8006C638 00068478 38 00 FF FF */ li r0, -0x1
/* 8006C63C 0006847C 90 A3 01 70 */ stw r5, 0x170(r3)
/* 8006C640 00068480 80 C1 00 10 */ lwz r6, 0x10(r1)
/* 8006C644 00068484 90 E3 01 6C */ stw r7, 0x16c(r3)
/* 8006C648 00068488 80 A1 00 14 */ lwz r5, 0x14(r1)
/* 8006C64C 0006848C 80 E8 00 08 */ lwz r7, 0x8(r8)
/* 8006C650 00068490 90 E3 01 74 */ stw r7, 0x174(r3)
/* 8006C654 00068494 90 C3 01 60 */ stw r6, 0x160(r3)
/* 8006C658 00068498 90 A3 01 64 */ stw r5, 0x164(r3)
/* 8006C65C 0006849C 98 83 01 68 */ stb r4, 0x168(r3)
/* 8006C660 000684A0 98 03 01 69 */ stb r0, 0x169(r3)
/* 8006C664 000684A4 38 60 FF FF */ li r3, -0x1
/* 8006C668 000684A8 48 00 00 84 */ b lbl_8006C6EC
.global lbl_8006C66C
lbl_8006C66C:
/* 8006C66C 000684AC FC 05 18 40 */ fcmpo cr0, f5, f3
/* 8006C670 000684B0 4C 40 13 82 */ cror eq, lt, eq
/* 8006C674 000684B4 41 82 00 28 */ beq lbl_8006C69C
/* 8006C678 000684B8 FC 05 10 40 */ fcmpo cr0, f5, f2
/* 8006C67C 000684BC 4C 41 13 82 */ cror eq, gt, eq
/* 8006C680 000684C0 41 82 00 1C */ beq lbl_8006C69C
/* 8006C684 000684C4 FC 04 08 40 */ fcmpo cr0, f4, f1
/* 8006C688 000684C8 4C 40 13 82 */ cror eq, lt, eq
/* 8006C68C 000684CC 41 82 00 10 */ beq lbl_8006C69C
/* 8006C690 000684D0 FC 04 00 40 */ fcmpo cr0, f4, f0
/* 8006C694 000684D4 4C 41 13 82 */ cror eq, gt, eq
/* 8006C698 000684D8 40 82 00 44 */ bne lbl_8006C6DC
.global lbl_8006C69C
lbl_8006C69C:
/* 8006C69C 000684DC 80 E8 00 00 */ lwz r7, 0x0(r8)
/* 8006C6A0 000684E0 38 80 00 00 */ li r4, 0x0
/* 8006C6A4 000684E4 80 A8 00 04 */ lwz r5, 0x4(r8)
/* 8006C6A8 000684E8 38 00 FF FF */ li r0, -0x1
/* 8006C6AC 000684EC 90 A3 01 64 */ stw r5, 0x164(r3)
/* 8006C6B0 000684F0 80 C1 00 08 */ lwz r6, 0x8(r1)
/* 8006C6B4 000684F4 90 E3 01 60 */ stw r7, 0x160(r3)
/* 8006C6B8 000684F8 80 A1 00 0C */ lwz r5, 0xc(r1)
/* 8006C6BC 000684FC 80 E8 00 08 */ lwz r7, 0x8(r8)
/* 8006C6C0 00068500 90 E3 01 68 */ stw r7, 0x168(r3)
/* 8006C6C4 00068504 90 C3 01 6C */ stw r6, 0x16c(r3)
/* 8006C6C8 00068508 90 A3 01 70 */ stw r5, 0x170(r3)
/* 8006C6CC 0006850C 98 83 01 74 */ stb r4, 0x174(r3)
/* 8006C6D0 00068510 98 03 01 75 */ stb r0, 0x175(r3)
/* 8006C6D4 00068514 38 60 FF FF */ li r3, -0x1
/* 8006C6D8 00068518 48 00 00 14 */ b lbl_8006C6EC
.global lbl_8006C6DC
lbl_8006C6DC:
/* 8006C6DC 0006851C 39 08 00 0C */ addi r8, r8, 0xc
/* 8006C6E0 00068520 7C 08 00 40 */ cmplw r8, r0
/* 8006C6E4 00068524 41 80 FE 9C */ blt lbl_8006C580
/* 8006C6E8 00068528 38 60 00 00 */ li r3, 0x0
.global lbl_8006C6EC
lbl_8006C6EC:
/* 8006C6EC 0006852C 38 21 00 20 */ addi r1, r1, 0x20
/* 8006C6F0 00068530 4E 80 00 20 */ blr
/* 8006C6F4 00068534 00 00 00 00 */ .4byte 0x00000000
/* 8006C6F8 00068538 00 00 00 00 */ .4byte 0x00000000
/* 8006C6FC 0006853C 00 00 00 00 */ .4byte 0x00000000
.global select_1obj_continue
select_1obj_continue:
/* 8006C700 00068540 C0 0D 84 30 */ lfs f0, kp_err_near_pos@sda21(r13)
/* 8006C704 00068544 38 C3 01 60 */ addi r6, r3, 0x160
/* 8006C708 00068548 38 03 01 78 */ addi r0, r3, 0x178
/* 8006C70C 0006854C EC 80 00 32 */ fmuls f4, f0, f0
.global lbl_8006C710
lbl_8006C710:
/* 8006C710 00068550 88 86 00 08 */ lbz r4, 0x8(r6)
/* 8006C714 00068554 7C 84 07 75 */ extsb. r4, r4
/* 8006C718 00068558 40 82 00 68 */ bne lbl_8006C780
/* 8006C71C 0006855C 88 86 00 09 */ lbz r4, 0x9(r6)
/* 8006C720 00068560 7C 84 07 75 */ extsb. r4, r4
/* 8006C724 00068564 40 82 00 5C */ bne lbl_8006C780
/* 8006C728 00068568 38 E3 01 30 */ addi r7, r3, 0x130
/* 8006C72C 0006856C 38 83 01 60 */ addi r4, r3, 0x160
.global lbl_8006C730
lbl_8006C730:
/* 8006C730 00068570 88 A7 00 08 */ lbz r5, 0x8(r7)
/* 8006C734 00068574 7C A5 07 75 */ extsb. r5, r5
/* 8006C738 00068578 40 82 00 3C */ bne lbl_8006C774
/* 8006C73C 0006857C C0 66 00 00 */ lfs f3, 0x0(r6)
/* 8006C740 00068580 C0 47 00 00 */ lfs f2, 0x0(r7)
/* 8006C744 00068584 C0 26 00 04 */ lfs f1, 0x4(r6)
/* 8006C748 00068588 C0 07 00 04 */ lfs f0, 0x4(r7)
/* 8006C74C 0006858C EC 43 10 28 */ fsubs f2, f3, f2
/* 8006C750 00068590 EC 01 00 28 */ fsubs f0, f1, f0
/* 8006C754 00068594 EC 22 00 B2 */ fmuls f1, f2, f2
/* 8006C758 00068598 EC 00 00 32 */ fmuls f0, f0, f0
/* 8006C75C 0006859C EC 01 00 2A */ fadds f0, f1, f0
/* 8006C760 000685A0 FC 00 20 40 */ fcmpo cr0, f0, f4
/* 8006C764 000685A4 40 80 00 10 */ bge lbl_8006C774
/* 8006C768 000685A8 FC 80 00 90 */ fmr f4, f0
/* 8006C76C 000685AC 7C C8 33 78 */ mr r8, r6
/* 8006C770 000685B0 7C E9 3B 78 */ mr r9, r7
.global lbl_8006C774
lbl_8006C774:
/* 8006C774 000685B4 38 E7 00 0C */ addi r7, r7, 0xc
/* 8006C778 000685B8 7C 07 20 40 */ cmplw r7, r4
/* 8006C77C 000685BC 41 80 FF B4 */ blt lbl_8006C730
.global lbl_8006C780
lbl_8006C780:
/* 8006C780 000685C0 38 C6 00 0C */ addi r6, r6, 0xc
/* 8006C784 000685C4 7C 06 00 40 */ cmplw r6, r0
/* 8006C788 000685C8 41 80 FF 88 */ blt lbl_8006C710
/* 8006C78C 000685CC C0 0D 84 30 */ lfs f0, kp_err_near_pos@sda21(r13)
/* 8006C790 000685D0 EC 00 00 32 */ fmuls f0, f0, f0
/* 8006C794 000685D4 FC 04 00 00 */ fcmpu cr0, f4, f0
/* 8006C798 000685D8 40 82 00 0C */ bne lbl_8006C7A4
/* 8006C79C 000685DC 38 60 00 00 */ li r3, 0x0
/* 8006C7A0 000685E0 4E 80 00 20 */ blr
.global lbl_8006C7A4
lbl_8006C7A4:
/* 8006C7A4 000685E4 80 89 00 04 */ lwz r4, 0x4(r9)
/* 8006C7A8 000685E8 38 03 01 60 */ addi r0, r3, 0x160
/* 8006C7AC 000685EC 80 A9 00 00 */ lwz r5, 0x0(r9)
/* 8006C7B0 000685F0 7C 08 00 40 */ cmplw r8, r0
/* 8006C7B4 000685F4 90 A8 00 00 */ stw r5, 0x0(r8)
/* 8006C7B8 000685F8 90 88 00 04 */ stw r4, 0x4(r8)
/* 8006C7BC 000685FC 80 09 00 08 */ lwz r0, 0x8(r9)
/* 8006C7C0 00068600 90 08 00 08 */ stw r0, 0x8(r8)
/* 8006C7C4 00068604 C0 A3 01 1C */ lfs f5, 0x11c(r3)
/* 8006C7C8 00068608 C0 03 05 D0 */ lfs f0, 0x5d0(r3)
/* 8006C7CC 0006860C C0 63 01 20 */ lfs f3, 0x120(r3)
/* 8006C7D0 00068610 C0 23 05 D4 */ lfs f1, 0x5d4(r3)
/* 8006C7D4 00068614 EC 85 00 32 */ fmuls f4, f5, f0
/* 8006C7D8 00068618 EC 43 00 32 */ fmuls f2, f3, f0
/* 8006C7DC 0006861C C0 03 05 A8 */ lfs f0, 0x5a8(r3)
/* 8006C7E0 00068620 EC 63 00 72 */ fmuls f3, f3, f1
/* 8006C7E4 00068624 EC 25 00 72 */ fmuls f1, f5, f1
/* 8006C7E8 00068628 EC 64 18 2A */ fadds f3, f4, f3
/* 8006C7EC 0006862C EC 22 08 28 */ fsubs f1, f2, f1
/* 8006C7F0 00068630 D0 63 05 AC */ stfs f3, 0x5ac(r3)
/* 8006C7F4 00068634 EC 40 00 F2 */ fmuls f2, f0, f3
/* 8006C7F8 00068638 EC 60 00 72 */ fmuls f3, f0, f1
/* 8006C7FC 0006863C D0 23 05 B0 */ stfs f1, 0x5b0(r3)
/* 8006C800 00068640 40 82 00 30 */ bne lbl_8006C830
/* 8006C804 00068644 C0 08 00 00 */ lfs f0, 0x0(r8)
/* 8006C808 00068648 38 80 00 00 */ li r4, 0x0
/* 8006C80C 0006864C 38 00 FF FF */ li r0, -0x1
/* 8006C810 00068650 EC 00 10 2A */ fadds f0, f0, f2
/* 8006C814 00068654 D0 03 01 6C */ stfs f0, 0x16c(r3)
/* 8006C818 00068658 C0 08 00 04 */ lfs f0, 0x4(r8)
/* 8006C81C 0006865C EC 00 18 2A */ fadds f0, f0, f3
/* 8006C820 00068660 98 83 01 74 */ stb r4, 0x174(r3)
/* 8006C824 00068664 D0 03 01 70 */ stfs f0, 0x170(r3)
/* 8006C828 00068668 98 03 01 75 */ stb r0, 0x175(r3)
/* 8006C82C 0006866C 48 00 00 2C */ b lbl_8006C858
.global lbl_8006C830
lbl_8006C830:
/* 8006C830 00068670 C0 08 00 00 */ lfs f0, 0x0(r8)
/* 8006C834 00068674 38 80 00 00 */ li r4, 0x0
/* 8006C838 00068678 38 00 FF FF */ li r0, -0x1
/* 8006C83C 0006867C EC 00 10 28 */ fsubs f0, f0, f2
/* 8006C840 00068680 D0 03 01 60 */ stfs f0, 0x160(r3)
/* 8006C844 00068684 C0 08 00 04 */ lfs f0, 0x4(r8)
/* 8006C848 00068688 EC 00 18 28 */ fsubs f0, f0, f3
/* 8006C84C 0006868C 98 83 01 68 */ stb r4, 0x168(r3)
/* 8006C850 00068690 D0 03 01 64 */ stfs f0, 0x164(r3)
/* 8006C854 00068694 98 03 01 69 */ stb r0, 0x169(r3)
.global lbl_8006C858
lbl_8006C858:
/* 8006C858 00068698 88 03 00 5E */ lbz r0, 0x5e(r3)
/* 8006C85C 0006869C 7C 00 07 75 */ extsb. r0, r0
/* 8006C860 000686A0 40 80 00 0C */ bge lbl_8006C86C
/* 8006C864 000686A4 38 60 FF FF */ li r3, -0x1
/* 8006C868 000686A8 4E 80 00 20 */ blr
.global lbl_8006C86C
lbl_8006C86C:
/* 8006C86C 000686AC 38 60 00 01 */ li r3, 0x1
/* 8006C870 000686B0 4E 80 00 20 */ blr
/* 8006C874 000686B4 00 00 00 00 */ .4byte 0x00000000
/* 8006C878 000686B8 00 00 00 00 */ .4byte 0x00000000
/* 8006C87C 000686BC 00 00 00 00 */ .4byte 0x00000000
.global calc_dpd_variable
calc_dpd_variable:
/* 8006C880 000686C0 94 21 FF E0 */ stwu r1, -0x20(r1)
/* 8006C884 000686C4 7C 08 02 A6 */ mflr r0
/* 8006C888 000686C8 90 01 00 24 */ stw r0, 0x24(r1)
/* 8006C88C 000686CC 7C 80 07 75 */ extsb. r0, r4
/* 8006C890 000686D0 93 E1 00 1C */ stw r31, 0x1c(r1)
/* 8006C894 000686D4 7C 9F 23 78 */ mr r31, r4
/* 8006C898 000686D8 93 C1 00 18 */ stw r30, 0x18(r1)
/* 8006C89C 000686DC 7C 7E 1B 78 */ mr r30, r3
/* 8006C8A0 000686E0 40 82 00 10 */ bne lbl_8006C8B0
/* 8006C8A4 000686E4 38 00 00 00 */ li r0, 0x0
/* 8006C8A8 000686E8 98 03 00 5E */ stb r0, 0x5e(r3)
/* 8006C8AC 000686EC 48 00 05 90 */ b lbl_8006CE3C
.global lbl_8006C8B0
lbl_8006C8B0:
/* 8006C8B0 000686F0 C0 83 01 1C */ lfs f4, 0x11c(r3)
/* 8006C8B4 000686F4 C0 23 05 AC */ lfs f1, 0x5ac(r3)
/* 8006C8B8 000686F8 C0 43 01 20 */ lfs f2, 0x120(r3)
/* 8006C8BC 000686FC EC 64 00 72 */ fmuls f3, f4, f1
/* 8006C8C0 00068700 C0 03 05 B0 */ lfs f0, 0x5b0(r3)
/* 8006C8C4 00068704 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006C8C8 00068708 88 03 00 5E */ lbz r0, 0x5e(r3)
/* 8006C8CC 0006870C EC 42 00 32 */ fmuls f2, f2, f0
/* 8006C8D0 00068710 EC 04 00 32 */ fmuls f0, f4, f0
/* 8006C8D4 00068714 7C 00 07 75 */ extsb. r0, r0
/* 8006C8D8 00068718 EC 63 10 2A */ fadds f3, f3, f2
/* 8006C8DC 0006871C EC 41 00 28 */ fsubs f2, f1, f0
/* 8006C8E0 00068720 D0 61 00 10 */ stfs f3, 0x10(r1)
/* 8006C8E4 00068724 D0 41 00 14 */ stfs f2, 0x14(r1)
/* 8006C8E8 00068728 40 82 00 30 */ bne lbl_8006C918
/* 8006C8EC 0006872C 80 81 00 10 */ lwz r4, 0x10(r1)
/* 8006C8F0 00068730 80 01 00 14 */ lwz r0, 0x14(r1)
/* 8006C8F4 00068734 90 83 00 34 */ stw r4, 0x34(r3)
/* 8006C8F8 00068738 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006C8FC 0006873C 90 03 00 38 */ stw r0, 0x38(r3)
/* 8006C900 00068740 80 8D EA 58 */ lwz r4, Vec2_0@sda21(r13)
/* 8006C904 00068744 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006C908 00068748 90 03 00 40 */ stw r0, 0x40(r3)
/* 8006C90C 0006874C 90 83 00 3C */ stw r4, 0x3c(r3)
/* 8006C910 00068750 D0 03 00 44 */ stfs f0, 0x44(r3)
/* 8006C914 00068754 48 00 01 CC */ b lbl_8006CAE0
.global lbl_8006C918
lbl_8006C918:
/* 8006C918 00068758 C0 23 00 34 */ lfs f1, 0x34(r3)
/* 8006C91C 0006875C C0 03 00 38 */ lfs f0, 0x38(r3)
/* 8006C920 00068760 EC 23 08 28 */ fsubs f1, f3, f1
/* 8006C924 00068764 EC 42 00 28 */ fsubs f2, f2, f0
/* 8006C928 00068768 D0 21 00 08 */ stfs f1, 0x8(r1)
/* 8006C92C 0006876C EC 21 00 72 */ fmuls f1, f1, f1
/* 8006C930 00068770 EC 02 00 B2 */ fmuls f0, f2, f2
/* 8006C934 00068774 D0 41 00 0C */ stfs f2, 0xc(r1)
/* 8006C938 00068778 EC 21 00 2A */ fadds f1, f1, f0
/* 8006C93C 0006877C 4B FA 7E AD */ bl sqrt
/* 8006C940 00068780 80 1E 06 50 */ lwz r0, 0x650(r30)
/* 8006C944 00068784 FC 40 08 18 */ frsp f2, f1
/* 8006C948 00068788 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006C94C 0006878C 40 82 00 C8 */ bne lbl_8006CA14
/* 8006C950 00068790 C0 1E 00 F8 */ lfs f0, 0xf8(r30)
/* 8006C954 00068794 FC 02 00 40 */ fcmpo cr0, f2, f0
/* 8006C958 00068798 4C 41 13 82 */ cror eq, gt, eq
/* 8006C95C 0006879C 40 82 00 0C */ bne lbl_8006C968
/* 8006C960 000687A0 C0 82 88 60 */ lfs f4, "@4581"@sda21(r2)
/* 8006C964 000687A4 48 00 00 10 */ b lbl_8006C974
.global lbl_8006C968
lbl_8006C968:
/* 8006C968 000687A8 EC 82 00 24 */ fdivs f4, f2, f0
/* 8006C96C 000687AC EC 84 01 32 */ fmuls f4, f4, f4
/* 8006C970 000687B0 EC 84 01 32 */ fmuls f4, f4, f4
.global lbl_8006C974
lbl_8006C974:
/* 8006C974 000687B4 C0 1E 00 FC */ lfs f0, 0xfc(r30)
/* 8006C978 000687B8 C0 61 00 08 */ lfs f3, 0x8(r1)
/* 8006C97C 000687BC EC 84 00 32 */ fmuls f4, f4, f0
/* 8006C980 000687C0 C0 21 00 0C */ lfs f1, 0xc(r1)
/* 8006C984 000687C4 C0 5E 00 34 */ lfs f2, 0x34(r30)
/* 8006C988 000687C8 C0 1E 00 38 */ lfs f0, 0x38(r30)
/* 8006C98C 000687CC EC 64 00 F2 */ fmuls f3, f4, f3
/* 8006C990 000687D0 EC 24 00 72 */ fmuls f1, f4, f1
/* 8006C994 000687D4 EC 62 18 2A */ fadds f3, f2, f3
/* 8006C998 000687D8 EC 40 08 2A */ fadds f2, f0, f1
/* 8006C99C 000687DC D0 61 00 08 */ stfs f3, 0x8(r1)
/* 8006C9A0 000687E0 EC 23 00 F2 */ fmuls f1, f3, f3
/* 8006C9A4 000687E4 EC 02 00 B2 */ fmuls f0, f2, f2
/* 8006C9A8 000687E8 D0 41 00 0C */ stfs f2, 0xc(r1)
/* 8006C9AC 000687EC EC 21 00 2A */ fadds f1, f1, f0
/* 8006C9B0 000687F0 4B FA 7E 39 */ bl sqrt
/* 8006C9B4 000687F4 FC 80 08 18 */ frsp f4, f1
/* 8006C9B8 000687F8 C0 01 00 08 */ lfs f0, 0x8(r1)
/* 8006C9BC 000687FC C0 41 00 0C */ lfs f2, 0xc(r1)
/* 8006C9C0 00068800 C0 3E 00 34 */ lfs f1, 0x34(r30)
/* 8006C9C4 00068804 EC 60 20 24 */ fdivs f3, f0, f4
/* 8006C9C8 00068808 C0 1E 00 38 */ lfs f0, 0x38(r30)
/* 8006C9CC 0006880C D0 61 00 08 */ stfs f3, 0x8(r1)
/* 8006C9D0 00068810 EC 42 20 24 */ fdivs f2, f2, f4
/* 8006C9D4 00068814 D0 41 00 0C */ stfs f2, 0xc(r1)
/* 8006C9D8 00068818 EC 42 00 28 */ fsubs f2, f2, f0
/* 8006C9DC 0006881C EC 23 08 28 */ fsubs f1, f3, f1
/* 8006C9E0 00068820 D0 5E 00 40 */ stfs f2, 0x40(r30)
/* 8006C9E4 00068824 EC 02 00 B2 */ fmuls f0, f2, f2
/* 8006C9E8 00068828 D0 3E 00 3C */ stfs f1, 0x3c(r30)
/* 8006C9EC 0006882C EC 21 00 72 */ fmuls f1, f1, f1
/* 8006C9F0 00068830 EC 21 00 2A */ fadds f1, f1, f0
/* 8006C9F4 00068834 4B FA 7D F5 */ bl sqrt
/* 8006C9F8 00068838 FC 00 08 18 */ frsp f0, f1
/* 8006C9FC 0006883C 80 61 00 08 */ lwz r3, 0x8(r1)
/* 8006CA00 00068840 80 01 00 0C */ lwz r0, 0xc(r1)
/* 8006CA04 00068844 D0 1E 00 44 */ stfs f0, 0x44(r30)
/* 8006CA08 00068848 90 7E 00 34 */ stw r3, 0x34(r30)
/* 8006CA0C 0006884C 90 1E 00 38 */ stw r0, 0x38(r30)
/* 8006CA10 00068850 48 00 00 D0 */ b lbl_8006CAE0
.global lbl_8006CA14
lbl_8006CA14:
/* 8006CA14 00068854 C0 1E 00 F8 */ lfs f0, 0xf8(r30)
/* 8006CA18 00068858 FC 02 00 40 */ fcmpo cr0, f2, f0
/* 8006CA1C 0006885C 40 81 00 AC */ ble lbl_8006CAC8
/* 8006CA20 00068860 EC 02 00 28 */ fsubs f0, f2, f0
/* 8006CA24 00068864 C0 9E 00 FC */ lfs f4, 0xfc(r30)
/* 8006CA28 00068868 C0 61 00 08 */ lfs f3, 0x8(r1)
/* 8006CA2C 0006886C C0 21 00 0C */ lfs f1, 0xc(r1)
/* 8006CA30 00068870 EC A0 10 24 */ fdivs f5, f0, f2
/* 8006CA34 00068874 C0 5E 00 34 */ lfs f2, 0x34(r30)
/* 8006CA38 00068878 C0 1E 00 38 */ lfs f0, 0x38(r30)
/* 8006CA3C 0006887C EC 84 01 72 */ fmuls f4, f4, f5
/* 8006CA40 00068880 EC 63 01 32 */ fmuls f3, f3, f4
/* 8006CA44 00068884 EC 21 01 32 */ fmuls f1, f1, f4
/* 8006CA48 00068888 EC 62 18 2A */ fadds f3, f2, f3
/* 8006CA4C 0006888C EC 40 08 2A */ fadds f2, f0, f1
/* 8006CA50 00068890 D0 61 00 08 */ stfs f3, 0x8(r1)
/* 8006CA54 00068894 EC 23 00 F2 */ fmuls f1, f3, f3
/* 8006CA58 00068898 EC 02 00 B2 */ fmuls f0, f2, f2
/* 8006CA5C 0006889C D0 41 00 0C */ stfs f2, 0xc(r1)
/* 8006CA60 000688A0 EC 21 00 2A */ fadds f1, f1, f0
/* 8006CA64 000688A4 4B FA 7D 85 */ bl sqrt
/* 8006CA68 000688A8 FC 80 08 18 */ frsp f4, f1
/* 8006CA6C 000688AC C0 01 00 08 */ lfs f0, 0x8(r1)
/* 8006CA70 000688B0 C0 41 00 0C */ lfs f2, 0xc(r1)
/* 8006CA74 000688B4 C0 3E 00 34 */ lfs f1, 0x34(r30)
/* 8006CA78 000688B8 EC 60 20 24 */ fdivs f3, f0, f4
/* 8006CA7C 000688BC C0 1E 00 38 */ lfs f0, 0x38(r30)
/* 8006CA80 000688C0 D0 61 00 08 */ stfs f3, 0x8(r1)
/* 8006CA84 000688C4 EC 42 20 24 */ fdivs f2, f2, f4
/* 8006CA88 000688C8 D0 41 00 0C */ stfs f2, 0xc(r1)
/* 8006CA8C 000688CC EC 42 00 28 */ fsubs f2, f2, f0
/* 8006CA90 000688D0 EC 23 08 28 */ fsubs f1, f3, f1
/* 8006CA94 000688D4 D0 5E 00 40 */ stfs f2, 0x40(r30)
/* 8006CA98 000688D8 EC 02 00 B2 */ fmuls f0, f2, f2
/* 8006CA9C 000688DC D0 3E 00 3C */ stfs f1, 0x3c(r30)
/* 8006CAA0 000688E0 EC 21 00 72 */ fmuls f1, f1, f1
/* 8006CAA4 000688E4 EC 21 00 2A */ fadds f1, f1, f0
/* 8006CAA8 000688E8 4B FA 7D 41 */ bl sqrt
/* 8006CAAC 000688EC FC 00 08 18 */ frsp f0, f1
/* 8006CAB0 000688F0 80 61 00 08 */ lwz r3, 0x8(r1)
/* 8006CAB4 000688F4 80 01 00 0C */ lwz r0, 0xc(r1)
/* 8006CAB8 000688F8 D0 1E 00 44 */ stfs f0, 0x44(r30)
/* 8006CABC 000688FC 90 7E 00 34 */ stw r3, 0x34(r30)
/* 8006CAC0 00068900 90 1E 00 38 */ stw r0, 0x38(r30)
/* 8006CAC4 00068904 48 00 00 1C */ b lbl_8006CAE0
.global lbl_8006CAC8
lbl_8006CAC8:
/* 8006CAC8 00068908 80 6D EA 58 */ lwz r3, Vec2_0@sda21(r13)
/* 8006CACC 0006890C 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006CAD0 00068910 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006CAD4 00068914 90 7E 00 3C */ stw r3, 0x3c(r30)
/* 8006CAD8 00068918 90 1E 00 40 */ stw r0, 0x40(r30)
/* 8006CADC 0006891C D0 1E 00 44 */ stfs f0, 0x44(r30)
.global lbl_8006CAE0
lbl_8006CAE0:
/* 8006CAE0 00068920 C0 3E 06 30 */ lfs f1, 0x630(r30)
/* 8006CAE4 00068924 C0 1E 05 A8 */ lfs f0, 0x5a8(r30)
/* 8006CAE8 00068928 88 1E 00 5E */ lbz r0, 0x5e(r30)
/* 8006CAEC 0006892C EC 41 00 24 */ fdivs f2, f1, f0
/* 8006CAF0 00068930 7C 00 07 75 */ extsb. r0, r0
/* 8006CAF4 00068934 40 82 00 18 */ bne lbl_8006CB0C
/* 8006CAF8 00068938 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006CAFC 0006893C D0 5E 00 48 */ stfs f2, 0x48(r30)
/* 8006CB00 00068940 D0 1E 00 4C */ stfs f0, 0x4c(r30)
/* 8006CB04 00068944 D0 1E 00 50 */ stfs f0, 0x50(r30)
/* 8006CB08 00068948 48 00 00 F4 */ b lbl_8006CBFC
.global lbl_8006CB0C
lbl_8006CB0C:
/* 8006CB0C 0006894C C0 3E 00 48 */ lfs f1, 0x48(r30)
/* 8006CB10 00068950 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006CB14 00068954 EC 82 08 28 */ fsubs f4, f2, f1
/* 8006CB18 00068958 FC 04 00 40 */ fcmpo cr0, f4, f0
/* 8006CB1C 0006895C 40 80 00 0C */ bge lbl_8006CB28
/* 8006CB20 00068960 FC 60 20 50 */ fneg f3, f4
/* 8006CB24 00068964 48 00 00 08 */ b lbl_8006CB2C
.global lbl_8006CB28
lbl_8006CB28:
/* 8006CB28 00068968 FC 60 20 90 */ fmr f3, f4
.global lbl_8006CB2C
lbl_8006CB2C:
/* 8006CB2C 0006896C 80 1E 06 54 */ lwz r0, 0x654(r30)
/* 8006CB30 00068970 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006CB34 00068974 40 82 00 68 */ bne lbl_8006CB9C
/* 8006CB38 00068978 C0 1E 01 00 */ lfs f0, 0x100(r30)
/* 8006CB3C 0006897C FC 03 00 40 */ fcmpo cr0, f3, f0
/* 8006CB40 00068980 4C 41 13 82 */ cror eq, gt, eq
/* 8006CB44 00068984 40 82 00 0C */ bne lbl_8006CB50
/* 8006CB48 00068988 C0 62 88 60 */ lfs f3, "@4581"@sda21(r2)
/* 8006CB4C 0006898C 48 00 00 10 */ b lbl_8006CB5C
.global lbl_8006CB50
lbl_8006CB50:
/* 8006CB50 00068990 EC 63 00 24 */ fdivs f3, f3, f0
/* 8006CB54 00068994 EC 63 00 F2 */ fmuls f3, f3, f3
/* 8006CB58 00068998 EC 63 00 F2 */ fmuls f3, f3, f3
.global lbl_8006CB5C
lbl_8006CB5C:
/* 8006CB5C 0006899C C0 3E 01 04 */ lfs f1, 0x104(r30)
/* 8006CB60 000689A0 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006CB64 000689A4 EC 63 00 72 */ fmuls f3, f3, f1
/* 8006CB68 000689A8 EC 23 01 32 */ fmuls f1, f3, f4
/* 8006CB6C 000689AC D0 3E 00 4C */ stfs f1, 0x4c(r30)
/* 8006CB70 000689B0 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006CB74 000689B4 40 80 00 10 */ bge lbl_8006CB84
/* 8006CB78 000689B8 FC 00 08 50 */ fneg f0, f1
/* 8006CB7C 000689BC D0 1E 00 50 */ stfs f0, 0x50(r30)
/* 8006CB80 000689C0 48 00 00 08 */ b lbl_8006CB88
.global lbl_8006CB84
lbl_8006CB84:
/* 8006CB84 000689C4 D0 3E 00 50 */ stfs f1, 0x50(r30)
.global lbl_8006CB88
lbl_8006CB88:
/* 8006CB88 000689C8 C0 3E 00 48 */ lfs f1, 0x48(r30)
/* 8006CB8C 000689CC C0 1E 00 4C */ lfs f0, 0x4c(r30)
/* 8006CB90 000689D0 EC 01 00 2A */ fadds f0, f1, f0
/* 8006CB94 000689D4 D0 1E 00 48 */ stfs f0, 0x48(r30)
/* 8006CB98 000689D8 48 00 00 64 */ b lbl_8006CBFC
.global lbl_8006CB9C
lbl_8006CB9C:
/* 8006CB9C 000689DC C0 1E 01 00 */ lfs f0, 0x100(r30)
/* 8006CBA0 000689E0 FC 03 00 40 */ fcmpo cr0, f3, f0
/* 8006CBA4 000689E4 40 81 00 4C */ ble lbl_8006CBF0
/* 8006CBA8 000689E8 EC 43 00 28 */ fsubs f2, f3, f0
/* 8006CBAC 000689EC C0 3E 01 04 */ lfs f1, 0x104(r30)
/* 8006CBB0 000689F0 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006CBB4 000689F4 EC 42 18 24 */ fdivs f2, f2, f3
/* 8006CBB8 000689F8 EC 21 00 B2 */ fmuls f1, f1, f2
/* 8006CBBC 000689FC EC 21 01 32 */ fmuls f1, f1, f4
/* 8006CBC0 00068A00 D0 3E 00 4C */ stfs f1, 0x4c(r30)
/* 8006CBC4 00068A04 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006CBC8 00068A08 40 80 00 10 */ bge lbl_8006CBD8
/* 8006CBCC 00068A0C FC 00 08 50 */ fneg f0, f1
/* 8006CBD0 00068A10 D0 1E 00 50 */ stfs f0, 0x50(r30)
/* 8006CBD4 00068A14 48 00 00 08 */ b lbl_8006CBDC
.global lbl_8006CBD8
lbl_8006CBD8:
/* 8006CBD8 00068A18 D0 3E 00 50 */ stfs f1, 0x50(r30)
.global lbl_8006CBDC
lbl_8006CBDC:
/* 8006CBDC 00068A1C C0 3E 00 48 */ lfs f1, 0x48(r30)
/* 8006CBE0 00068A20 C0 1E 00 4C */ lfs f0, 0x4c(r30)
/* 8006CBE4 00068A24 EC 01 00 2A */ fadds f0, f1, f0
/* 8006CBE8 00068A28 D0 1E 00 48 */ stfs f0, 0x48(r30)
/* 8006CBEC 00068A2C 48 00 00 10 */ b lbl_8006CBFC
.global lbl_8006CBF0
lbl_8006CBF0:
/* 8006CBF0 00068A30 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006CBF4 00068A34 D0 1E 00 4C */ stfs f0, 0x4c(r30)
/* 8006CBF8 00068A38 D0 1E 00 50 */ stfs f0, 0x50(r30)
.global lbl_8006CBFC
lbl_8006CBFC:
/* 8006CBFC 00068A3C C0 5E 05 B0 */ lfs f2, 0x5b0(r30)
/* 8006CC00 00068A40 C0 1E 01 20 */ lfs f0, 0x120(r30)
/* 8006CC04 00068A44 FC 20 10 50 */ fneg f1, f2
/* 8006CC08 00068A48 88 1E 00 5E */ lbz r0, 0x5e(r30)
/* 8006CC0C 00068A4C C0 BE 05 AC */ lfs f5, 0x5ac(r30)
/* 8006CC10 00068A50 EC 62 00 32 */ fmuls f3, f2, f0
/* 8006CC14 00068A54 C0 9E 01 1C */ lfs f4, 0x11c(r30)
/* 8006CC18 00068A58 7C 00 07 75 */ extsb. r0, r0
/* 8006CC1C 00068A5C EC 05 00 32 */ fmuls f0, f5, f0
/* 8006CC20 00068A60 C0 FE 01 60 */ lfs f7, 0x160(r30)
/* 8006CC24 00068A64 EC 41 01 32 */ fmuls f2, f1, f4
/* 8006CC28 00068A68 C0 DE 01 6C */ lfs f6, 0x16c(r30)
/* 8006CC2C 00068A6C EC A5 01 32 */ fmuls f5, f5, f4
/* 8006CC30 00068A70 C0 9E 01 64 */ lfs f4, 0x164(r30)
/* 8006CC34 00068A74 C0 3E 01 70 */ lfs f1, 0x170(r30)
/* 8006CC38 00068A78 EC E7 30 2A */ fadds f7, f7, f6
/* 8006CC3C 00068A7C C1 02 88 54 */ lfs f8, "@4536"@sda21(r2)
/* 8006CC40 00068A80 EC 65 18 2A */ fadds f3, f5, f3
/* 8006CC44 00068A84 EC C4 08 2A */ fadds f6, f4, f1
/* 8006CC48 00068A88 C0 9E 01 18 */ lfs f4, 0x118(r30)
/* 8006CC4C 00068A8C EC E8 01 F2 */ fmuls f7, f8, f7
/* 8006CC50 00068A90 EC 42 00 2A */ fadds f2, f2, f0
/* 8006CC54 00068A94 C0 3E 01 14 */ lfs f1, 0x114(r30)
/* 8006CC58 00068A98 EC A8 01 B2 */ fmuls f5, f8, f6
/* 8006CC5C 00068A9C ED 23 01 F2 */ fmuls f9, f3, f7
/* 8006CC60 00068AA0 C0 DE 01 24 */ lfs f6, 0x124(r30)
/* 8006CC64 00068AA4 EC E2 01 F2 */ fmuls f7, f2, f7
/* 8006CC68 00068AA8 EC 03 01 72 */ fmuls f0, f3, f5
/* 8006CC6C 00068AAC C0 7E 01 28 */ lfs f3, 0x128(r30)
/* 8006CC70 00068AB0 ED 02 01 72 */ fmuls f8, f2, f5
/* 8006CC74 00068AB4 C0 BE 01 2C */ lfs f5, 0x12c(r30)
/* 8006CC78 00068AB8 FC 40 20 50 */ fneg f2, f4
/* 8006CC7C 00068ABC EC E7 00 2A */ fadds f7, f7, f0
/* 8006CC80 00068AC0 ED 09 40 28 */ fsubs f8, f9, f8
/* 8006CC84 00068AC4 FC 00 08 50 */ fneg f0, f1
/* 8006CC88 00068AC8 EC 63 38 28 */ fsubs f3, f3, f7
/* 8006CC8C 00068ACC EC C6 40 28 */ fsubs f6, f6, f8
/* 8006CC90 00068AD0 EC C5 01 B2 */ fmuls f6, f5, f6
/* 8006CC94 00068AD4 EC A5 00 F2 */ fmuls f5, f5, f3
/* 8006CC98 00068AD8 D0 C1 00 08 */ stfs f6, 0x8(r1)
/* 8006CC9C 00068ADC EC 62 01 B2 */ fmuls f3, f2, f6
/* 8006CCA0 00068AE0 EC 41 01 72 */ fmuls f2, f1, f5
/* 8006CCA4 00068AE4 D0 A1 00 0C */ stfs f5, 0xc(r1)
/* 8006CCA8 00068AE8 EC 20 01 B2 */ fmuls f1, f0, f6
/* 8006CCAC 00068AEC EC 04 01 72 */ fmuls f0, f4, f5
/* 8006CCB0 00068AF0 EC 63 10 2A */ fadds f3, f3, f2
/* 8006CCB4 00068AF4 EC 41 00 28 */ fsubs f2, f1, f0
/* 8006CCB8 00068AF8 D0 61 00 10 */ stfs f3, 0x10(r1)
/* 8006CCBC 00068AFC D0 41 00 14 */ stfs f2, 0x14(r1)
/* 8006CCC0 00068B00 80 61 00 10 */ lwz r3, 0x10(r1)
/* 8006CCC4 00068B04 80 01 00 14 */ lwz r0, 0x14(r1)
/* 8006CCC8 00068B08 90 7E 05 D8 */ stw r3, 0x5d8(r30)
/* 8006CCCC 00068B0C 90 1E 05 DC */ stw r0, 0x5dc(r30)
/* 8006CCD0 00068B10 40 82 00 28 */ bne lbl_8006CCF8
/* 8006CCD4 00068B14 90 7E 00 20 */ stw r3, 0x20(r30)
/* 8006CCD8 00068B18 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006CCDC 00068B1C 90 1E 00 24 */ stw r0, 0x24(r30)
/* 8006CCE0 00068B20 80 6D EA 58 */ lwz r3, Vec2_0@sda21(r13)
/* 8006CCE4 00068B24 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006CCE8 00068B28 90 1E 00 2C */ stw r0, 0x2c(r30)
/* 8006CCEC 00068B2C 90 7E 00 28 */ stw r3, 0x28(r30)
/* 8006CCF0 00068B30 D0 1E 00 30 */ stfs f0, 0x30(r30)
/* 8006CCF4 00068B34 48 00 01 44 */ b lbl_8006CE38
.global lbl_8006CCF8
lbl_8006CCF8:
/* 8006CCF8 00068B38 C0 3E 00 20 */ lfs f1, 0x20(r30)
/* 8006CCFC 00068B3C C0 1E 00 24 */ lfs f0, 0x24(r30)
/* 8006CD00 00068B40 EC 23 08 28 */ fsubs f1, f3, f1
/* 8006CD04 00068B44 EC 42 00 28 */ fsubs f2, f2, f0
/* 8006CD08 00068B48 D0 21 00 08 */ stfs f1, 0x8(r1)
/* 8006CD0C 00068B4C EC 21 00 72 */ fmuls f1, f1, f1
/* 8006CD10 00068B50 EC 02 00 B2 */ fmuls f0, f2, f2
/* 8006CD14 00068B54 D0 41 00 0C */ stfs f2, 0xc(r1)
/* 8006CD18 00068B58 EC 21 00 2A */ fadds f1, f1, f0
/* 8006CD1C 00068B5C 4B FA 7A CD */ bl sqrt
/* 8006CD20 00068B60 80 1E 06 4C */ lwz r0, 0x64c(r30)
/* 8006CD24 00068B64 FC 80 08 18 */ frsp f4, f1
/* 8006CD28 00068B68 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006CD2C 00068B6C 40 82 00 84 */ bne lbl_8006CDB0
/* 8006CD30 00068B70 C0 1E 00 F0 */ lfs f0, 0xf0(r30)
/* 8006CD34 00068B74 FC 04 00 40 */ fcmpo cr0, f4, f0
/* 8006CD38 00068B78 4C 41 13 82 */ cror eq, gt, eq
/* 8006CD3C 00068B7C 40 82 00 0C */ bne lbl_8006CD48
/* 8006CD40 00068B80 C0 42 88 60 */ lfs f2, "@4581"@sda21(r2)
/* 8006CD44 00068B84 48 00 00 10 */ b lbl_8006CD54
.global lbl_8006CD48
lbl_8006CD48:
/* 8006CD48 00068B88 EC 44 00 24 */ fdivs f2, f4, f0
/* 8006CD4C 00068B8C EC 42 00 B2 */ fmuls f2, f2, f2
/* 8006CD50 00068B90 EC 42 00 B2 */ fmuls f2, f2, f2
.global lbl_8006CD54
lbl_8006CD54:
/* 8006CD54 00068B94 C0 1E 00 F4 */ lfs f0, 0xf4(r30)
/* 8006CD58 00068B98 C0 21 00 08 */ lfs f1, 0x8(r1)
/* 8006CD5C 00068B9C EC 42 00 32 */ fmuls f2, f2, f0
/* 8006CD60 00068BA0 C0 01 00 0C */ lfs f0, 0xc(r1)
/* 8006CD64 00068BA4 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006CD68 00068BA8 EC 42 00 32 */ fmuls f2, f2, f0
/* 8006CD6C 00068BAC D0 3E 00 28 */ stfs f1, 0x28(r30)
/* 8006CD70 00068BB0 EC 21 00 72 */ fmuls f1, f1, f1
/* 8006CD74 00068BB4 EC 02 00 B2 */ fmuls f0, f2, f2
/* 8006CD78 00068BB8 D0 5E 00 2C */ stfs f2, 0x2c(r30)
/* 8006CD7C 00068BBC EC 21 00 2A */ fadds f1, f1, f0
/* 8006CD80 00068BC0 4B FA 7A 69 */ bl sqrt
/* 8006CD84 00068BC4 FC 80 08 18 */ frsp f4, f1
/* 8006CD88 00068BC8 C0 7E 00 20 */ lfs f3, 0x20(r30)
/* 8006CD8C 00068BCC C0 5E 00 28 */ lfs f2, 0x28(r30)
/* 8006CD90 00068BD0 C0 3E 00 24 */ lfs f1, 0x24(r30)
/* 8006CD94 00068BD4 C0 1E 00 2C */ lfs f0, 0x2c(r30)
/* 8006CD98 00068BD8 EC 43 10 2A */ fadds f2, f3, f2
/* 8006CD9C 00068BDC D0 9E 00 30 */ stfs f4, 0x30(r30)
/* 8006CDA0 00068BE0 EC 01 00 2A */ fadds f0, f1, f0
/* 8006CDA4 00068BE4 D0 5E 00 20 */ stfs f2, 0x20(r30)
/* 8006CDA8 00068BE8 D0 1E 00 24 */ stfs f0, 0x24(r30)
/* 8006CDAC 00068BEC 48 00 00 8C */ b lbl_8006CE38
.global lbl_8006CDB0
lbl_8006CDB0:
/* 8006CDB0 00068BF0 C0 1E 00 F0 */ lfs f0, 0xf0(r30)
/* 8006CDB4 00068BF4 FC 04 00 40 */ fcmpo cr0, f4, f0
/* 8006CDB8 00068BF8 40 81 00 68 */ ble lbl_8006CE20
/* 8006CDBC 00068BFC EC 64 00 28 */ fsubs f3, f4, f0
/* 8006CDC0 00068C00 C0 5E 00 F4 */ lfs f2, 0xf4(r30)
/* 8006CDC4 00068C04 C0 21 00 08 */ lfs f1, 0x8(r1)
/* 8006CDC8 00068C08 C0 01 00 0C */ lfs f0, 0xc(r1)
/* 8006CDCC 00068C0C EC 63 20 24 */ fdivs f3, f3, f4
/* 8006CDD0 00068C10 EC 42 00 F2 */ fmuls f2, f2, f3
/* 8006CDD4 00068C14 EC 22 00 72 */ fmuls f1, f2, f1
/* 8006CDD8 00068C18 EC 42 00 32 */ fmuls f2, f2, f0
/* 8006CDDC 00068C1C D0 3E 00 28 */ stfs f1, 0x28(r30)
/* 8006CDE0 00068C20 EC 21 00 72 */ fmuls f1, f1, f1
/* 8006CDE4 00068C24 EC 02 00 B2 */ fmuls f0, f2, f2
/* 8006CDE8 00068C28 D0 5E 00 2C */ stfs f2, 0x2c(r30)
/* 8006CDEC 00068C2C EC 21 00 2A */ fadds f1, f1, f0
/* 8006CDF0 00068C30 4B FA 79 F9 */ bl sqrt
/* 8006CDF4 00068C34 FC 80 08 18 */ frsp f4, f1
/* 8006CDF8 00068C38 C0 7E 00 20 */ lfs f3, 0x20(r30)
/* 8006CDFC 00068C3C C0 5E 00 28 */ lfs f2, 0x28(r30)
/* 8006CE00 00068C40 C0 3E 00 24 */ lfs f1, 0x24(r30)
/* 8006CE04 00068C44 C0 1E 00 2C */ lfs f0, 0x2c(r30)
/* 8006CE08 00068C48 EC 43 10 2A */ fadds f2, f3, f2
/* 8006CE0C 00068C4C D0 9E 00 30 */ stfs f4, 0x30(r30)
/* 8006CE10 00068C50 EC 01 00 2A */ fadds f0, f1, f0
/* 8006CE14 00068C54 D0 5E 00 20 */ stfs f2, 0x20(r30)
/* 8006CE18 00068C58 D0 1E 00 24 */ stfs f0, 0x24(r30)
/* 8006CE1C 00068C5C 48 00 00 1C */ b lbl_8006CE38
.global lbl_8006CE20
lbl_8006CE20:
/* 8006CE20 00068C60 80 6D EA 58 */ lwz r3, Vec2_0@sda21(r13)
/* 8006CE24 00068C64 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006CE28 00068C68 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006CE2C 00068C6C 90 7E 00 28 */ stw r3, 0x28(r30)
/* 8006CE30 00068C70 90 1E 00 2C */ stw r0, 0x2c(r30)
/* 8006CE34 00068C74 D0 1E 00 30 */ stfs f0, 0x30(r30)
.global lbl_8006CE38
lbl_8006CE38:
/* 8006CE38 00068C78 9B FE 00 5E */ stb r31, 0x5e(r30)
.global lbl_8006CE3C
lbl_8006CE3C:
/* 8006CE3C 00068C7C 80 01 00 24 */ lwz r0, 0x24(r1)
/* 8006CE40 00068C80 83 E1 00 1C */ lwz r31, 0x1c(r1)
/* 8006CE44 00068C84 83 C1 00 18 */ lwz r30, 0x18(r1)
/* 8006CE48 00068C88 7C 08 03 A6 */ mtlr r0
/* 8006CE4C 00068C8C 38 21 00 20 */ addi r1, r1, 0x20
/* 8006CE50 00068C90 4E 80 00 20 */ blr
/* 8006CE54 00068C94 00 00 00 00 */ .4byte 0x00000000
/* 8006CE58 00068C98 00 00 00 00 */ .4byte 0x00000000
/* 8006CE5C 00068C9C 00 00 00 00 */ .4byte 0x00000000
.global read_kpad_dpd
read_kpad_dpd:
/* 8006CE60 00068CA0 94 21 FF C0 */ stwu r1, -0x40(r1)
/* 8006CE64 00068CA4 7C 08 02 A6 */ mflr r0
/* 8006CE68 00068CA8 90 01 00 44 */ stw r0, 0x44(r1)
/* 8006CE6C 00068CAC DB E1 00 30 */ stfd f31, 0x30(r1)
/* 8006CE70 00068CB0 F3 E1 00 38 */ psq_st f31, 0x38(r1), 0, qr0
/* 8006CE74 00068CB4 DB C1 00 20 */ stfd f30, 0x20(r1)
/* 8006CE78 00068CB8 F3 C1 00 28 */ psq_st f30, 0x28(r1), 0, qr0
/* 8006CE7C 00068CBC 93 E1 00 1C */ stw r31, 0x1c(r1)
/* 8006CE80 00068CC0 7C 7F 1B 78 */ mr r31, r3
/* 8006CE84 00068CC4 93 C1 00 18 */ stw r30, 0x18(r1)
/* 8006CE88 00068CC8 88 A4 00 40 */ lbz r5, 0x40(r4)
/* 8006CE8C 00068CCC 28 05 00 02 */ cmplwi r5, 0x2
/* 8006CE90 00068CD0 41 82 00 64 */ beq lbl_8006CEF4
/* 8006CE94 00068CD4 28 05 00 05 */ cmplwi r5, 0x5
/* 8006CE98 00068CD8 41 82 00 5C */ beq lbl_8006CEF4
/* 8006CE9C 00068CDC 28 05 00 08 */ cmplwi r5, 0x8
/* 8006CEA0 00068CE0 41 82 00 54 */ beq lbl_8006CEF4
/* 8006CEA4 00068CE4 28 05 00 0B */ cmplwi r5, 0xb
/* 8006CEA8 00068CE8 40 82 00 10 */ bne lbl_8006CEB8
/* 8006CEAC 00068CEC 88 03 06 43 */ lbz r0, 0x643(r3)
/* 8006CEB0 00068CF0 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006CEB4 00068CF4 40 82 00 40 */ bne lbl_8006CEF4
.global lbl_8006CEB8
lbl_8006CEB8:
/* 8006CEB8 00068CF8 28 05 00 0F */ cmplwi r5, 0xf
/* 8006CEBC 00068CFC 40 82 00 10 */ bne lbl_8006CECC
/* 8006CEC0 00068D00 88 03 06 43 */ lbz r0, 0x643(r3)
/* 8006CEC4 00068D04 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006CEC8 00068D08 40 82 00 2C */ bne lbl_8006CEF4
.global lbl_8006CECC
lbl_8006CECC:
/* 8006CECC 00068D0C 28 05 00 11 */ cmplwi r5, 0x11
/* 8006CED0 00068D10 40 82 00 10 */ bne lbl_8006CEE0
/* 8006CED4 00068D14 88 03 06 43 */ lbz r0, 0x643(r3)
/* 8006CED8 00068D18 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006CEDC 00068D1C 40 82 00 18 */ bne lbl_8006CEF4
.global lbl_8006CEE0
lbl_8006CEE0:
/* 8006CEE0 00068D20 28 05 00 10 */ cmplwi r5, 0x10
/* 8006CEE4 00068D24 40 82 00 B4 */ bne lbl_8006CF98
/* 8006CEE8 00068D28 88 03 06 43 */ lbz r0, 0x643(r3)
/* 8006CEEC 00068D2C 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006CEF0 00068D30 41 82 00 A8 */ beq lbl_8006CF98
.global lbl_8006CEF4
lbl_8006CEF4:
/* 8006CEF4 00068D34 C8 82 88 70 */ lfd f4, "@4806"@sda21(r2)
/* 8006CEF8 00068D38 39 04 00 20 */ addi r8, r4, 0x20
/* 8006CEFC 00068D3C C0 62 88 78 */ lfs f3, "@5024"@sda21(r2)
/* 8006CF00 00068D40 39 23 01 54 */ addi r9, r3, 0x154
/* 8006CF04 00068D44 C0 42 88 7C */ lfs f2, "@5025_8055E7FC"@sda21(r2)
/* 8006CF08 00068D48 38 03 01 30 */ addi r0, r3, 0x130
/* 8006CF0C 00068D4C C0 22 88 80 */ lfs f1, "@5026_8055E800"@sda21(r2)
/* 8006CF10 00068D50 38 80 FF FF */ li r4, -0x1
/* 8006CF14 00068D54 3C E0 43 30 */ lis r7, 0x4330
/* 8006CF18 00068D58 38 A0 00 00 */ li r5, 0x0
/* 8006CF1C 00068D5C 60 00 00 00 */ nop
.global lbl_8006CF20
lbl_8006CF20:
/* 8006CF20 00068D60 A0 C8 00 04 */ lhz r6, 0x4(r8)
/* 8006CF24 00068D64 2C 06 00 00 */ cmpwi r6, 0x0
/* 8006CF28 00068D68 41 82 00 58 */ beq lbl_8006CF80
/* 8006CF2C 00068D6C A8 C8 00 00 */ lha r6, 0x0(r8)
/* 8006CF30 00068D70 90 E1 00 08 */ stw r7, 0x8(r1)
/* 8006CF34 00068D74 6C C6 80 00 */ xoris r6, r6, 0x8000
/* 8006CF38 00068D78 90 C1 00 0C */ stw r6, 0xc(r1)
/* 8006CF3C 00068D7C C8 01 00 08 */ lfd f0, 0x8(r1)
/* 8006CF40 00068D80 90 E1 00 10 */ stw r7, 0x10(r1)
/* 8006CF44 00068D84 EC 00 20 28 */ fsubs f0, f0, f4
/* 8006CF48 00068D88 EC 03 00 32 */ fmuls f0, f3, f0
/* 8006CF4C 00068D8C EC 00 10 28 */ fsubs f0, f0, f2
/* 8006CF50 00068D90 D0 09 00 00 */ stfs f0, 0x0(r9)
/* 8006CF54 00068D94 A8 C8 00 02 */ lha r6, 0x2(r8)
/* 8006CF58 00068D98 6C C6 80 00 */ xoris r6, r6, 0x8000
/* 8006CF5C 00068D9C 90 C1 00 14 */ stw r6, 0x14(r1)
/* 8006CF60 00068DA0 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006CF64 00068DA4 EC 00 20 28 */ fsubs f0, f0, f4
/* 8006CF68 00068DA8 EC 03 00 32 */ fmuls f0, f3, f0
/* 8006CF6C 00068DAC EC 00 08 28 */ fsubs f0, f0, f1
/* 8006CF70 00068DB0 D0 09 00 04 */ stfs f0, 0x4(r9)
/* 8006CF74 00068DB4 98 A9 00 08 */ stb r5, 0x8(r9)
/* 8006CF78 00068DB8 98 A9 00 09 */ stb r5, 0x9(r9)
/* 8006CF7C 00068DBC 48 00 00 08 */ b lbl_8006CF84
.global lbl_8006CF80
lbl_8006CF80:
/* 8006CF80 00068DC0 98 89 00 08 */ stb r4, 0x8(r9)
.global lbl_8006CF84
lbl_8006CF84:
/* 8006CF84 00068DC4 39 29 FF F4 */ addi r9, r9, -0xc
/* 8006CF88 00068DC8 39 08 FF F8 */ addi r8, r8, -0x8
/* 8006CF8C 00068DCC 7C 09 00 40 */ cmplw r9, r0
/* 8006CF90 00068DD0 40 80 FF 90 */ bge lbl_8006CF20
/* 8006CF94 00068DD4 48 00 00 24 */ b lbl_8006CFB8
.global lbl_8006CF98
lbl_8006CF98:
/* 8006CF98 00068DD8 38 A3 01 54 */ addi r5, r3, 0x154
/* 8006CF9C 00068DDC 38 03 01 30 */ addi r0, r3, 0x130
/* 8006CFA0 00068DE0 38 80 FF FF */ li r4, -0x1
/* 8006CFA4 00068DE4 60 00 00 00 */ nop
.global lbl_8006CFA8
lbl_8006CFA8:
/* 8006CFA8 00068DE8 98 85 00 08 */ stb r4, 0x8(r5)
/* 8006CFAC 00068DEC 38 A5 FF F4 */ addi r5, r5, -0xc
/* 8006CFB0 00068DF0 7C 05 00 40 */ cmplw r5, r0
/* 8006CFB4 00068DF4 40 80 FF F4 */ bge lbl_8006CFA8
.global lbl_8006CFB8
lbl_8006CFB8:
/* 8006CFB8 00068DF8 38 E3 01 54 */ addi r7, r3, 0x154
/* 8006CFBC 00068DFC 38 C3 01 30 */ addi r6, r3, 0x130
/* 8006CFC0 00068E00 7C E4 3B 78 */ mr r4, r7
/* 8006CFC4 00068E04 60 00 00 00 */ nop
.global lbl_8006CFC8
lbl_8006CFC8:
/* 8006CFC8 00068E08 88 04 00 08 */ lbz r0, 0x8(r4)
/* 8006CFCC 00068E0C 7C 00 07 75 */ extsb. r0, r0
/* 8006CFD0 00068E10 41 80 00 58 */ blt lbl_8006D028
/* 8006CFD4 00068E14 C0 24 00 00 */ lfs f1, 0x0(r4)
/* 8006CFD8 00068E18 C0 03 06 14 */ lfs f0, 0x614(r3)
/* 8006CFDC 00068E1C FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006CFE0 00068E20 4C 40 13 82 */ cror eq, lt, eq
/* 8006CFE4 00068E24 41 82 00 38 */ beq lbl_8006D01C
/* 8006CFE8 00068E28 C0 03 06 1C */ lfs f0, 0x61c(r3)
/* 8006CFEC 00068E2C FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006CFF0 00068E30 4C 41 13 82 */ cror eq, gt, eq
/* 8006CFF4 00068E34 41 82 00 28 */ beq lbl_8006D01C
/* 8006CFF8 00068E38 C0 24 00 04 */ lfs f1, 0x4(r4)
/* 8006CFFC 00068E3C C0 03 06 18 */ lfs f0, 0x618(r3)
/* 8006D000 00068E40 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006D004 00068E44 4C 40 13 82 */ cror eq, lt, eq
/* 8006D008 00068E48 41 82 00 14 */ beq lbl_8006D01C
/* 8006D00C 00068E4C C0 03 06 20 */ lfs f0, 0x620(r3)
/* 8006D010 00068E50 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006D014 00068E54 4C 41 13 82 */ cror eq, gt, eq
/* 8006D018 00068E58 40 82 00 10 */ bne lbl_8006D028
.global lbl_8006D01C
lbl_8006D01C:
/* 8006D01C 00068E5C 88 04 00 08 */ lbz r0, 0x8(r4)
/* 8006D020 00068E60 60 00 00 01 */ ori r0, r0, 0x1
/* 8006D024 00068E64 98 04 00 08 */ stb r0, 0x8(r4)
.global lbl_8006D028
lbl_8006D028:
/* 8006D028 00068E68 38 84 FF F4 */ addi r4, r4, -0xc
/* 8006D02C 00068E6C 7C 04 30 40 */ cmplw r4, r6
/* 8006D030 00068E70 40 80 FF 98 */ bge lbl_8006CFC8
/* 8006D034 00068E74 60 00 00 00 */ nop
.global lbl_8006D038
lbl_8006D038:
/* 8006D038 00068E78 88 06 00 08 */ lbz r0, 0x8(r6)
/* 8006D03C 00068E7C 7C 00 07 75 */ extsb. r0, r0
/* 8006D040 00068E80 40 82 00 48 */ bne lbl_8006D088
/* 8006D044 00068E84 38 A6 00 0C */ addi r5, r6, 0xc
.global lbl_8006D048
lbl_8006D048:
/* 8006D048 00068E88 88 85 00 08 */ lbz r4, 0x8(r5)
/* 8006D04C 00068E8C 7C 80 07 75 */ extsb. r0, r4
/* 8006D050 00068E90 40 82 00 2C */ bne lbl_8006D07C
/* 8006D054 00068E94 C0 26 00 00 */ lfs f1, 0x0(r6)
/* 8006D058 00068E98 C0 05 00 00 */ lfs f0, 0x0(r5)
/* 8006D05C 00068E9C FC 01 00 00 */ fcmpu cr0, f1, f0
/* 8006D060 00068EA0 40 82 00 1C */ bne lbl_8006D07C
/* 8006D064 00068EA4 C0 26 00 04 */ lfs f1, 0x4(r6)
/* 8006D068 00068EA8 C0 05 00 04 */ lfs f0, 0x4(r5)
/* 8006D06C 00068EAC FC 01 00 00 */ fcmpu cr0, f1, f0
/* 8006D070 00068EB0 40 82 00 0C */ bne lbl_8006D07C
/* 8006D074 00068EB4 60 80 00 02 */ ori r0, r4, 0x2
/* 8006D078 00068EB8 98 05 00 08 */ stb r0, 0x8(r5)
.global lbl_8006D07C
lbl_8006D07C:
/* 8006D07C 00068EBC 38 A5 00 0C */ addi r5, r5, 0xc
/* 8006D080 00068EC0 7C 05 38 40 */ cmplw r5, r7
/* 8006D084 00068EC4 40 81 FF C4 */ ble lbl_8006D048
.global lbl_8006D088
lbl_8006D088:
/* 8006D088 00068EC8 38 C6 00 0C */ addi r6, r6, 0xc
/* 8006D08C 00068ECC 7C 06 38 40 */ cmplw r6, r7
/* 8006D090 00068ED0 41 80 FF A8 */ blt lbl_8006D038
/* 8006D094 00068ED4 38 00 00 00 */ li r0, 0x0
/* 8006D098 00068ED8 B0 03 01 78 */ sth r0, 0x178(r3)
/* 8006D09C 00068EDC 38 A3 01 54 */ addi r5, r3, 0x154
/* 8006D0A0 00068EE0 38 03 01 30 */ addi r0, r3, 0x130
/* 8006D0A4 00068EE4 60 00 00 00 */ nop
.global lbl_8006D0A8
lbl_8006D0A8:
/* 8006D0A8 00068EE8 88 85 00 08 */ lbz r4, 0x8(r5)
/* 8006D0AC 00068EEC 7C 84 07 75 */ extsb. r4, r4
/* 8006D0B0 00068EF0 40 82 00 10 */ bne lbl_8006D0C0
/* 8006D0B4 00068EF4 A8 83 01 78 */ lha r4, 0x178(r3)
/* 8006D0B8 00068EF8 38 84 00 01 */ addi r4, r4, 0x1
/* 8006D0BC 00068EFC B0 83 01 78 */ sth r4, 0x178(r3)
.global lbl_8006D0C0
lbl_8006D0C0:
/* 8006D0C0 00068F00 38 A5 FF F4 */ addi r5, r5, -0xc
/* 8006D0C4 00068F04 7C 05 00 40 */ cmplw r5, r0
/* 8006D0C8 00068F08 40 80 FF E0 */ bge lbl_8006D0A8
/* 8006D0CC 00068F0C C0 23 00 54 */ lfs f1, 0x54(r3)
/* 8006D0D0 00068F10 C0 0D 84 2C */ lfs f0, kp_err_up_inpr@sda21(r13)
/* 8006D0D4 00068F14 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006D0D8 00068F18 4C 40 13 82 */ cror eq, lt, eq
/* 8006D0DC 00068F1C 41 82 00 F4 */ beq lbl_8006D1D0
/* 8006D0E0 00068F20 88 03 00 5E */ lbz r0, 0x5e(r3)
/* 8006D0E4 00068F24 7C 00 07 74 */ extsb r0, r0
/* 8006D0E8 00068F28 2C 00 00 02 */ cmpwi r0, 0x2
/* 8006D0EC 00068F2C 41 82 00 0C */ beq lbl_8006D0F8
/* 8006D0F0 00068F30 2C 00 FF FE */ cmpwi r0, -0x2
/* 8006D0F4 00068F34 40 82 00 48 */ bne lbl_8006D13C
.global lbl_8006D0F8
lbl_8006D0F8:
/* 8006D0F8 00068F38 A8 03 01 78 */ lha r0, 0x178(r3)
/* 8006D0FC 00068F3C 2C 00 00 02 */ cmpwi r0, 0x2
/* 8006D100 00068F40 41 80 00 18 */ blt lbl_8006D118
/* 8006D104 00068F44 7F E3 FB 78 */ mr r3, r31
/* 8006D108 00068F48 4B FF F2 09 */ bl select_2obj_continue
/* 8006D10C 00068F4C 7C 60 07 75 */ extsb. r0, r3
/* 8006D110 00068F50 7C 7E 1B 78 */ mr r30, r3
/* 8006D114 00068F54 40 82 00 C0 */ bne lbl_8006D1D4
.global lbl_8006D118
lbl_8006D118:
/* 8006D118 00068F58 A8 1F 01 78 */ lha r0, 0x178(r31)
/* 8006D11C 00068F5C 2C 00 00 01 */ cmpwi r0, 0x1
/* 8006D120 00068F60 41 80 00 B0 */ blt lbl_8006D1D0
/* 8006D124 00068F64 7F E3 FB 78 */ mr r3, r31
/* 8006D128 00068F68 4B FF F5 D9 */ bl select_1obj_continue
/* 8006D12C 00068F6C 7C 60 07 75 */ extsb. r0, r3
/* 8006D130 00068F70 7C 7E 1B 78 */ mr r30, r3
/* 8006D134 00068F74 40 82 00 A0 */ bne lbl_8006D1D4
/* 8006D138 00068F78 48 00 00 98 */ b lbl_8006D1D0
.global lbl_8006D13C
lbl_8006D13C:
/* 8006D13C 00068F7C 2C 00 00 01 */ cmpwi r0, 0x1
/* 8006D140 00068F80 41 82 00 0C */ beq lbl_8006D14C
/* 8006D144 00068F84 2C 00 FF FF */ cmpwi r0, -0x1
/* 8006D148 00068F88 40 82 00 48 */ bne lbl_8006D190
.global lbl_8006D14C
lbl_8006D14C:
/* 8006D14C 00068F8C A8 03 01 78 */ lha r0, 0x178(r3)
/* 8006D150 00068F90 2C 00 00 02 */ cmpwi r0, 0x2
/* 8006D154 00068F94 41 80 00 18 */ blt lbl_8006D16C
/* 8006D158 00068F98 7F E3 FB 78 */ mr r3, r31
/* 8006D15C 00068F9C 4B FF EF C5 */ bl select_2obj_first
/* 8006D160 00068FA0 7C 60 07 75 */ extsb. r0, r3
/* 8006D164 00068FA4 7C 7E 1B 78 */ mr r30, r3
/* 8006D168 00068FA8 40 82 00 6C */ bne lbl_8006D1D4
.global lbl_8006D16C
lbl_8006D16C:
/* 8006D16C 00068FAC A8 1F 01 78 */ lha r0, 0x178(r31)
/* 8006D170 00068FB0 2C 00 00 01 */ cmpwi r0, 0x1
/* 8006D174 00068FB4 41 80 00 5C */ blt lbl_8006D1D0
/* 8006D178 00068FB8 7F E3 FB 78 */ mr r3, r31
/* 8006D17C 00068FBC 4B FF F5 85 */ bl select_1obj_continue
/* 8006D180 00068FC0 7C 60 07 75 */ extsb. r0, r3
/* 8006D184 00068FC4 7C 7E 1B 78 */ mr r30, r3
/* 8006D188 00068FC8 40 82 00 4C */ bne lbl_8006D1D4
/* 8006D18C 00068FCC 48 00 00 44 */ b lbl_8006D1D0
.global lbl_8006D190
lbl_8006D190:
/* 8006D190 00068FD0 A8 03 01 78 */ lha r0, 0x178(r3)
/* 8006D194 00068FD4 2C 00 00 02 */ cmpwi r0, 0x2
/* 8006D198 00068FD8 41 80 00 18 */ blt lbl_8006D1B0
/* 8006D19C 00068FDC 7F E3 FB 78 */ mr r3, r31
/* 8006D1A0 00068FE0 4B FF EF 81 */ bl select_2obj_first
/* 8006D1A4 00068FE4 7C 60 07 75 */ extsb. r0, r3
/* 8006D1A8 00068FE8 7C 7E 1B 78 */ mr r30, r3
/* 8006D1AC 00068FEC 40 82 00 28 */ bne lbl_8006D1D4
.global lbl_8006D1B0
lbl_8006D1B0:
/* 8006D1B0 00068FF0 A8 1F 01 78 */ lha r0, 0x178(r31)
/* 8006D1B4 00068FF4 2C 00 00 01 */ cmpwi r0, 0x1
/* 8006D1B8 00068FF8 40 82 00 18 */ bne lbl_8006D1D0
/* 8006D1BC 00068FFC 7F E3 FB 78 */ mr r3, r31
/* 8006D1C0 00069000 4B FF F3 81 */ bl select_1obj_first
/* 8006D1C4 00069004 7C 60 07 75 */ extsb. r0, r3
/* 8006D1C8 00069008 7C 7E 1B 78 */ mr r30, r3
/* 8006D1CC 0006900C 40 82 00 08 */ bne lbl_8006D1D4
.global lbl_8006D1D0
lbl_8006D1D0:
/* 8006D1D0 00069010 3B C0 00 00 */ li r30, 0x0
.global lbl_8006D1D4
lbl_8006D1D4:
/* 8006D1D4 00069014 7F C0 07 75 */ extsb. r0, r30
/* 8006D1D8 00069018 41 82 01 08 */ beq lbl_8006D2E0
/* 8006D1DC 0006901C C0 7F 01 6C */ lfs f3, 0x16c(r31)
/* 8006D1E0 00069020 C0 5F 01 60 */ lfs f2, 0x160(r31)
/* 8006D1E4 00069024 C0 3F 01 70 */ lfs f1, 0x170(r31)
/* 8006D1E8 00069028 C0 1F 01 64 */ lfs f0, 0x164(r31)
/* 8006D1EC 0006902C EF C3 10 28 */ fsubs f30, f3, f2
/* 8006D1F0 00069030 EF E1 00 28 */ fsubs f31, f1, f0
/* 8006D1F4 00069034 EC 3E 07 B2 */ fmuls f1, f30, f30
/* 8006D1F8 00069038 EC 1F 07 F2 */ fmuls f0, f31, f31
/* 8006D1FC 0006903C EC 21 00 2A */ fadds f1, f1, f0
/* 8006D200 00069040 4B FA 75 E9 */ bl sqrt
/* 8006D204 00069044 FC 60 08 18 */ frsp f3, f1
/* 8006D208 00069048 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006D20C 0006904C A0 1F 05 E8 */ lhz r0, 0x5e8(r31)
/* 8006D210 00069050 C0 3F 06 30 */ lfs f1, 0x630(r31)
/* 8006D214 00069054 EC 40 18 24 */ fdivs f2, f0, f3
/* 8006D218 00069058 C0 9F 01 1C */ lfs f4, 0x11c(r31)
/* 8006D21C 0006905C C0 1F 01 20 */ lfs f0, 0x120(r31)
/* 8006D220 00069060 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006D224 00069064 D0 7F 05 A8 */ stfs f3, 0x5a8(r31)
/* 8006D228 00069068 EF DE 00 B2 */ fmuls f30, f30, f2
/* 8006D22C 0006906C EF FF 00 B2 */ fmuls f31, f31, f2
/* 8006D230 00069070 EC 21 00 B2 */ fmuls f1, f1, f2
/* 8006D234 00069074 D3 DF 05 AC */ stfs f30, 0x5ac(r31)
/* 8006D238 00069078 EC 64 07 B2 */ fmuls f3, f4, f30
/* 8006D23C 0006907C EC 40 07 F2 */ fmuls f2, f0, f31
/* 8006D240 00069080 D0 3F 05 B4 */ stfs f1, 0x5b4(r31)
/* 8006D244 00069084 EC 20 07 B2 */ fmuls f1, f0, f30
/* 8006D248 00069088 EC 04 07 F2 */ fmuls f0, f4, f31
/* 8006D24C 0006908C D3 FF 05 B0 */ stfs f31, 0x5b0(r31)
/* 8006D250 00069090 EC 43 10 2A */ fadds f2, f3, f2
/* 8006D254 00069094 EC 61 00 28 */ fsubs f3, f1, f0
/* 8006D258 00069098 D0 5F 05 C8 */ stfs f2, 0x5c8(r31)
/* 8006D25C 0006909C D0 7F 05 CC */ stfs f3, 0x5cc(r31)
/* 8006D260 000690A0 40 82 00 38 */ bne lbl_8006D298
/* 8006D264 000690A4 C0 1F 05 D0 */ lfs f0, 0x5d0(r31)
/* 8006D268 000690A8 C0 3F 05 D4 */ lfs f1, 0x5d4(r31)
/* 8006D26C 000690AC EC 42 00 32 */ fmuls f2, f2, f0
/* 8006D270 000690B0 C0 0D 84 28 */ lfs f0, kp_err_acc_inpr@sda21(r13)
/* 8006D274 000690B4 EC 23 00 72 */ fmuls f1, f3, f1
/* 8006D278 000690B8 EC 22 08 2A */ fadds f1, f2, f1
/* 8006D27C 000690BC FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006D280 000690C0 4C 40 13 82 */ cror eq, lt, eq
/* 8006D284 000690C4 40 82 00 14 */ bne lbl_8006D298
/* 8006D288 000690C8 38 00 00 01 */ li r0, 0x1
/* 8006D28C 000690CC 98 1F 01 74 */ stb r0, 0x174(r31)
/* 8006D290 000690D0 3B C0 00 00 */ li r30, 0x0
/* 8006D294 000690D4 98 1F 01 68 */ stb r0, 0x168(r31)
.global lbl_8006D298
lbl_8006D298:
/* 8006D298 000690D8 88 1F 00 5E */ lbz r0, 0x5e(r31)
/* 8006D29C 000690DC 2C 00 00 02 */ cmpwi r0, 0x2
/* 8006D2A0 000690E0 40 82 00 34 */ bne lbl_8006D2D4
/* 8006D2A4 000690E4 7F C0 07 74 */ extsb r0, r30
/* 8006D2A8 000690E8 2C 00 00 02 */ cmpwi r0, 0x2
/* 8006D2AC 000690EC 40 82 00 28 */ bne lbl_8006D2D4
/* 8006D2B0 000690F0 88 7F 05 EA */ lbz r3, 0x5ea(r31)
/* 8006D2B4 000690F4 28 03 00 C8 */ cmplwi r3, 0xc8
/* 8006D2B8 000690F8 40 82 00 10 */ bne lbl_8006D2C8
/* 8006D2BC 000690FC C0 1F 05 A8 */ lfs f0, 0x5a8(r31)
/* 8006D2C0 00069100 D0 1F 05 B8 */ stfs f0, 0x5b8(r31)
/* 8006D2C4 00069104 48 00 00 24 */ b lbl_8006D2E8
.global lbl_8006D2C8
lbl_8006D2C8:
/* 8006D2C8 00069108 38 03 00 01 */ addi r0, r3, 0x1
/* 8006D2CC 0006910C 98 1F 05 EA */ stb r0, 0x5ea(r31)
/* 8006D2D0 00069110 48 00 00 18 */ b lbl_8006D2E8
.global lbl_8006D2D4
lbl_8006D2D4:
/* 8006D2D4 00069114 38 00 00 00 */ li r0, 0x0
/* 8006D2D8 00069118 98 1F 05 EA */ stb r0, 0x5ea(r31)
/* 8006D2DC 0006911C 48 00 00 0C */ b lbl_8006D2E8
.global lbl_8006D2E0
lbl_8006D2E0:
/* 8006D2E0 00069120 38 00 00 00 */ li r0, 0x0
/* 8006D2E4 00069124 98 1F 05 EA */ stb r0, 0x5ea(r31)
.global lbl_8006D2E8
lbl_8006D2E8:
/* 8006D2E8 00069128 7F E3 FB 78 */ mr r3, r31
/* 8006D2EC 0006912C 7F C4 07 74 */ extsb r4, r30
/* 8006D2F0 00069130 4B FF F5 91 */ bl calc_dpd_variable
/* 8006D2F4 00069134 80 01 00 44 */ lwz r0, 0x44(r1)
/* 8006D2F8 00069138 E3 E1 00 38 */ psq_l f31, 0x38(r1), 0, qr0
/* 8006D2FC 0006913C CB E1 00 30 */ lfd f31, 0x30(r1)
/* 8006D300 00069140 E3 C1 00 28 */ psq_l f30, 0x28(r1), 0, qr0
/* 8006D304 00069144 CB C1 00 20 */ lfd f30, 0x20(r1)
/* 8006D308 00069148 83 E1 00 1C */ lwz r31, 0x1c(r1)
/* 8006D30C 0006914C 83 C1 00 18 */ lwz r30, 0x18(r1)
/* 8006D310 00069150 7C 08 03 A6 */ mtlr r0
/* 8006D314 00069154 38 21 00 40 */ addi r1, r1, 0x40
/* 8006D318 00069158 4E 80 00 20 */ blr
/* 8006D31C 0006915C 00 00 00 00 */ .4byte 0x00000000
.global clamp_stick_circle
clamp_stick_circle:
/* 8006D320 00069160 94 21 FF A0 */ stwu r1, -0x60(r1)
/* 8006D324 00069164 7C 08 02 A6 */ mflr r0
/* 8006D328 00069168 3D 00 43 30 */ lis r8, 0x4330
/* 8006D32C 0006916C 6C A5 80 00 */ xoris r5, r5, 0x8000
/* 8006D330 00069170 90 01 00 64 */ stw r0, 0x64(r1)
/* 8006D334 00069174 6C 80 80 00 */ xoris r0, r4, 0x8000
/* 8006D338 00069178 C8 82 88 70 */ lfd f4, "@4806"@sda21(r2)
/* 8006D33C 0006917C 6C C4 80 00 */ xoris r4, r6, 0x8000
/* 8006D340 00069180 90 01 00 0C */ stw r0, 0xc(r1)
/* 8006D344 00069184 6C E0 80 00 */ xoris r0, r7, 0x8000
/* 8006D348 00069188 91 01 00 08 */ stw r8, 0x8(r1)
/* 8006D34C 0006918C DB E1 00 50 */ stfd f31, 0x50(r1)
/* 8006D350 00069190 C8 01 00 08 */ lfd f0, 0x8(r1)
/* 8006D354 00069194 F3 E1 00 58 */ psq_st f31, 0x58(r1), 0, qr0
/* 8006D358 00069198 EF E0 20 28 */ fsubs f31, f0, f4
/* 8006D35C 0006919C DB C1 00 40 */ stfd f30, 0x40(r1)
/* 8006D360 000691A0 F3 C1 00 48 */ psq_st f30, 0x48(r1), 0, qr0
/* 8006D364 000691A4 EC 3F 07 F2 */ fmuls f1, f31, f31
/* 8006D368 000691A8 DB A1 00 30 */ stfd f29, 0x30(r1)
/* 8006D36C 000691AC F3 A1 00 38 */ psq_st f29, 0x38(r1), 0, qr0
/* 8006D370 000691B0 90 81 00 0C */ stw r4, 0xc(r1)
/* 8006D374 000691B4 DB 81 00 20 */ stfd f28, 0x20(r1)
/* 8006D378 000691B8 C8 61 00 08 */ lfd f3, 0x8(r1)
/* 8006D37C 000691BC F3 81 00 28 */ psq_st f28, 0x28(r1), 0, qr0
/* 8006D380 000691C0 EF A3 20 28 */ fsubs f29, f3, f4
/* 8006D384 000691C4 93 E1 00 1C */ stw r31, 0x1c(r1)
/* 8006D388 000691C8 7C 7F 1B 78 */ mr r31, r3
/* 8006D38C 000691CC 91 01 00 10 */ stw r8, 0x10(r1)
/* 8006D390 000691D0 90 A1 00 14 */ stw r5, 0x14(r1)
/* 8006D394 000691D4 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006D398 000691D8 EF C0 20 28 */ fsubs f30, f0, f4
/* 8006D39C 000691DC 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006D3A0 000691E0 C8 41 00 10 */ lfd f2, 0x10(r1)
/* 8006D3A4 000691E4 EC 1E 07 B2 */ fmuls f0, f30, f30
/* 8006D3A8 000691E8 EF 82 20 28 */ fsubs f28, f2, f4
/* 8006D3AC 000691EC EC 21 00 2A */ fadds f1, f1, f0
/* 8006D3B0 000691F0 4B FA 74 39 */ bl sqrt
/* 8006D3B4 000691F4 FC 40 08 18 */ frsp f2, f1
/* 8006D3B8 000691F8 FC 02 E8 40 */ fcmpo cr0, f2, f29
/* 8006D3BC 000691FC 4C 40 13 82 */ cror eq, lt, eq
/* 8006D3C0 00069200 40 82 00 14 */ bne lbl_8006D3D4
/* 8006D3C4 00069204 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006D3C8 00069208 D0 1F 00 04 */ stfs f0, 0x4(r31)
/* 8006D3CC 0006920C D0 1F 00 00 */ stfs f0, 0x0(r31)
/* 8006D3D0 00069210 48 00 00 44 */ b lbl_8006D414
.global lbl_8006D3D4
lbl_8006D3D4:
/* 8006D3D4 00069214 FC 02 E0 40 */ fcmpo cr0, f2, f28
/* 8006D3D8 00069218 4C 41 13 82 */ cror eq, gt, eq
/* 8006D3DC 0006921C 40 82 00 18 */ bne lbl_8006D3F4
/* 8006D3E0 00069220 EC 1F 10 24 */ fdivs f0, f31, f2
/* 8006D3E4 00069224 D0 1F 00 00 */ stfs f0, 0x0(r31)
/* 8006D3E8 00069228 EC 1E 10 24 */ fdivs f0, f30, f2
/* 8006D3EC 0006922C D0 1F 00 04 */ stfs f0, 0x4(r31)
/* 8006D3F0 00069230 48 00 00 24 */ b lbl_8006D414
.global lbl_8006D3F4
lbl_8006D3F4:
/* 8006D3F4 00069234 EC 22 E8 28 */ fsubs f1, f2, f29
/* 8006D3F8 00069238 EC 1C E8 28 */ fsubs f0, f28, f29
/* 8006D3FC 0006923C EC 01 00 24 */ fdivs f0, f1, f0
/* 8006D400 00069240 EC 00 10 24 */ fdivs f0, f0, f2
/* 8006D404 00069244 EC 3F 00 32 */ fmuls f1, f31, f0
/* 8006D408 00069248 EC 1E 00 32 */ fmuls f0, f30, f0
/* 8006D40C 0006924C D0 3F 00 00 */ stfs f1, 0x0(r31)
/* 8006D410 00069250 D0 1F 00 04 */ stfs f0, 0x4(r31)
.global lbl_8006D414
lbl_8006D414:
/* 8006D414 00069254 80 01 00 64 */ lwz r0, 0x64(r1)
/* 8006D418 00069258 E3 E1 00 58 */ psq_l f31, 0x58(r1), 0, qr0
/* 8006D41C 0006925C CB E1 00 50 */ lfd f31, 0x50(r1)
/* 8006D420 00069260 E3 C1 00 48 */ psq_l f30, 0x48(r1), 0, qr0
/* 8006D424 00069264 CB C1 00 40 */ lfd f30, 0x40(r1)
/* 8006D428 00069268 E3 A1 00 38 */ psq_l f29, 0x38(r1), 0, qr0
/* 8006D42C 0006926C CB A1 00 30 */ lfd f29, 0x30(r1)
/* 8006D430 00069270 E3 81 00 28 */ psq_l f28, 0x28(r1), 0, qr0
/* 8006D434 00069274 CB 81 00 20 */ lfd f28, 0x20(r1)
/* 8006D438 00069278 83 E1 00 1C */ lwz r31, 0x1c(r1)
/* 8006D43C 0006927C 7C 08 03 A6 */ mtlr r0
/* 8006D440 00069280 38 21 00 60 */ addi r1, r1, 0x60
/* 8006D444 00069284 4E 80 00 20 */ blr
/* 8006D448 00069288 00 00 00 00 */ .4byte 0x00000000
/* 8006D44C 0006928C 00 00 00 00 */ .4byte 0x00000000
.global clamp_stick_cross
clamp_stick_cross:
/* 8006D450 00069290 94 21 FF E0 */ stwu r1, -0x20(r1)
/* 8006D454 00069294 7C 08 02 A6 */ mflr r0
/* 8006D458 00069298 2C 04 00 00 */ cmpwi r4, 0x0
/* 8006D45C 0006929C 90 01 00 24 */ stw r0, 0x24(r1)
/* 8006D460 000692A0 3C 00 43 30 */ lis r0, 0x4330
/* 8006D464 000692A4 93 E1 00 1C */ stw r31, 0x1c(r1)
/* 8006D468 000692A8 7C 7F 1B 78 */ mr r31, r3
/* 8006D46C 000692AC 90 01 00 08 */ stw r0, 0x8(r1)
/* 8006D470 000692B0 90 01 00 10 */ stw r0, 0x10(r1)
/* 8006D474 000692B4 40 80 00 78 */ bge lbl_8006D4EC
/* 8006D478 000692B8 7C 04 00 D0 */ neg r0, r4
/* 8006D47C 000692BC 7C 00 30 00 */ cmpw r0, r6
/* 8006D480 000692C0 41 81 00 10 */ bgt lbl_8006D490
/* 8006D484 000692C4 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006D488 000692C8 D0 03 00 00 */ stfs f0, 0x0(r3)
/* 8006D48C 000692CC 48 00 00 50 */ b lbl_8006D4DC
.global lbl_8006D490
lbl_8006D490:
/* 8006D490 000692D0 7C 00 38 00 */ cmpw r0, r7
/* 8006D494 000692D4 41 80 00 10 */ blt lbl_8006D4A4
/* 8006D498 000692D8 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006D49C 000692DC D0 03 00 00 */ stfs f0, 0x0(r3)
/* 8006D4A0 000692E0 48 00 00 3C */ b lbl_8006D4DC
.global lbl_8006D4A4
lbl_8006D4A4:
/* 8006D4A4 000692E4 7C 84 32 14 */ add r4, r4, r6
/* 8006D4A8 000692E8 7C 06 38 50 */ subf r0, r6, r7
/* 8006D4AC 000692EC 7C 84 00 D0 */ neg r4, r4
/* 8006D4B0 000692F0 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006D4B4 000692F4 6C 84 80 00 */ xoris r4, r4, 0x8000
/* 8006D4B8 000692F8 90 81 00 0C */ stw r4, 0xc(r1)
/* 8006D4BC 000692FC 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006D4C0 00069300 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006D4C4 00069304 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006D4C8 00069308 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006D4CC 0006930C EC 21 10 28 */ fsubs f1, f1, f2
/* 8006D4D0 00069310 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006D4D4 00069314 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006D4D8 00069318 D0 03 00 00 */ stfs f0, 0x0(r3)
.global lbl_8006D4DC
lbl_8006D4DC:
/* 8006D4DC 0006931C C0 03 00 00 */ lfs f0, 0x0(r3)
/* 8006D4E0 00069320 FC 00 00 50 */ fneg f0, f0
/* 8006D4E4 00069324 D0 03 00 00 */ stfs f0, 0x0(r3)
/* 8006D4E8 00069328 48 00 00 60 */ b lbl_8006D548
.global lbl_8006D4EC
lbl_8006D4EC:
/* 8006D4EC 0006932C 7C 04 30 00 */ cmpw r4, r6
/* 8006D4F0 00069330 41 81 00 10 */ bgt lbl_8006D500
/* 8006D4F4 00069334 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006D4F8 00069338 D0 03 00 00 */ stfs f0, 0x0(r3)
/* 8006D4FC 0006933C 48 00 00 4C */ b lbl_8006D548
.global lbl_8006D500
lbl_8006D500:
/* 8006D500 00069340 7C 04 38 00 */ cmpw r4, r7
/* 8006D504 00069344 41 80 00 10 */ blt lbl_8006D514
/* 8006D508 00069348 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006D50C 0006934C D0 03 00 00 */ stfs f0, 0x0(r3)
/* 8006D510 00069350 48 00 00 38 */ b lbl_8006D548
.global lbl_8006D514
lbl_8006D514:
/* 8006D514 00069354 7C 86 20 50 */ subf r4, r6, r4
/* 8006D518 00069358 7C 06 38 50 */ subf r0, r6, r7
/* 8006D51C 0006935C 6C 84 80 00 */ xoris r4, r4, 0x8000
/* 8006D520 00069360 90 81 00 0C */ stw r4, 0xc(r1)
/* 8006D524 00069364 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006D528 00069368 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006D52C 0006936C 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006D530 00069370 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006D534 00069374 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006D538 00069378 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006D53C 0006937C EC 00 10 28 */ fsubs f0, f0, f2
/* 8006D540 00069380 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006D544 00069384 D0 03 00 00 */ stfs f0, 0x0(r3)
.global lbl_8006D548
lbl_8006D548:
/* 8006D548 00069388 2C 05 00 00 */ cmpwi r5, 0x0
/* 8006D54C 0006938C 40 80 00 78 */ bge lbl_8006D5C4
/* 8006D550 00069390 7C 05 00 D0 */ neg r0, r5
/* 8006D554 00069394 7C 00 30 00 */ cmpw r0, r6
/* 8006D558 00069398 41 81 00 10 */ bgt lbl_8006D568
/* 8006D55C 0006939C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006D560 000693A0 D0 03 00 04 */ stfs f0, 0x4(r3)
/* 8006D564 000693A4 48 00 00 50 */ b lbl_8006D5B4
.global lbl_8006D568
lbl_8006D568:
/* 8006D568 000693A8 7C 00 38 00 */ cmpw r0, r7
/* 8006D56C 000693AC 41 80 00 10 */ blt lbl_8006D57C
/* 8006D570 000693B0 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006D574 000693B4 D0 03 00 04 */ stfs f0, 0x4(r3)
/* 8006D578 000693B8 48 00 00 3C */ b lbl_8006D5B4
.global lbl_8006D57C
lbl_8006D57C:
/* 8006D57C 000693BC 7C 85 32 14 */ add r4, r5, r6
/* 8006D580 000693C0 7C 06 38 50 */ subf r0, r6, r7
/* 8006D584 000693C4 7C 84 00 D0 */ neg r4, r4
/* 8006D588 000693C8 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006D58C 000693CC 6C 84 80 00 */ xoris r4, r4, 0x8000
/* 8006D590 000693D0 90 81 00 0C */ stw r4, 0xc(r1)
/* 8006D594 000693D4 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006D598 000693D8 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006D59C 000693DC C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006D5A0 000693E0 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006D5A4 000693E4 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006D5A8 000693E8 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006D5AC 000693EC EC 01 00 24 */ fdivs f0, f1, f0
/* 8006D5B0 000693F0 D0 03 00 04 */ stfs f0, 0x4(r3)
.global lbl_8006D5B4
lbl_8006D5B4:
/* 8006D5B4 000693F4 C0 03 00 04 */ lfs f0, 0x4(r3)
/* 8006D5B8 000693F8 FC 00 00 50 */ fneg f0, f0
/* 8006D5BC 000693FC D0 03 00 04 */ stfs f0, 0x4(r3)
/* 8006D5C0 00069400 48 00 00 60 */ b lbl_8006D620
.global lbl_8006D5C4
lbl_8006D5C4:
/* 8006D5C4 00069404 7C 05 30 00 */ cmpw r5, r6
/* 8006D5C8 00069408 41 81 00 10 */ bgt lbl_8006D5D8
/* 8006D5CC 0006940C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006D5D0 00069410 D0 03 00 04 */ stfs f0, 0x4(r3)
/* 8006D5D4 00069414 48 00 00 4C */ b lbl_8006D620
.global lbl_8006D5D8
lbl_8006D5D8:
/* 8006D5D8 00069418 7C 05 38 00 */ cmpw r5, r7
/* 8006D5DC 0006941C 41 80 00 10 */ blt lbl_8006D5EC
/* 8006D5E0 00069420 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006D5E4 00069424 D0 03 00 04 */ stfs f0, 0x4(r3)
/* 8006D5E8 00069428 48 00 00 38 */ b lbl_8006D620
.global lbl_8006D5EC
lbl_8006D5EC:
/* 8006D5EC 0006942C 7C 86 28 50 */ subf r4, r6, r5
/* 8006D5F0 00069430 7C 06 38 50 */ subf r0, r6, r7
/* 8006D5F4 00069434 6C 84 80 00 */ xoris r4, r4, 0x8000
/* 8006D5F8 00069438 90 81 00 0C */ stw r4, 0xc(r1)
/* 8006D5FC 0006943C 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006D600 00069440 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006D604 00069444 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006D608 00069448 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006D60C 0006944C C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006D610 00069450 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006D614 00069454 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006D618 00069458 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006D61C 0006945C D0 03 00 04 */ stfs f0, 0x4(r3)
.global lbl_8006D620
lbl_8006D620:
/* 8006D620 00069460 C0 03 00 00 */ lfs f0, 0x0(r3)
/* 8006D624 00069464 C0 23 00 04 */ lfs f1, 0x4(r3)
/* 8006D628 00069468 EC 40 00 32 */ fmuls f2, f0, f0
/* 8006D62C 0006946C C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006D630 00069470 EC 21 00 72 */ fmuls f1, f1, f1
/* 8006D634 00069474 EC 22 08 2A */ fadds f1, f2, f1
/* 8006D638 00069478 FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006D63C 0006947C 40 81 00 24 */ ble lbl_8006D660
/* 8006D640 00069480 4B FA 71 A9 */ bl sqrt
/* 8006D644 00069484 FC 40 08 18 */ frsp f2, f1
/* 8006D648 00069488 C0 3F 00 00 */ lfs f1, 0x0(r31)
/* 8006D64C 0006948C C0 1F 00 04 */ lfs f0, 0x4(r31)
/* 8006D650 00069490 EC 21 10 24 */ fdivs f1, f1, f2
/* 8006D654 00069494 D0 3F 00 00 */ stfs f1, 0x0(r31)
/* 8006D658 00069498 EC 00 10 24 */ fdivs f0, f0, f2
/* 8006D65C 0006949C D0 1F 00 04 */ stfs f0, 0x4(r31)
.global lbl_8006D660
lbl_8006D660:
/* 8006D660 000694A0 80 01 00 24 */ lwz r0, 0x24(r1)
/* 8006D664 000694A4 83 E1 00 1C */ lwz r31, 0x1c(r1)
/* 8006D668 000694A8 7C 08 03 A6 */ mtlr r0
/* 8006D66C 000694AC 38 21 00 20 */ addi r1, r1, 0x20
/* 8006D670 000694B0 4E 80 00 20 */ blr
/* 8006D674 000694B4 00 00 00 00 */ .4byte 0x00000000
/* 8006D678 000694B8 00 00 00 00 */ .4byte 0x00000000
/* 8006D67C 000694BC 00 00 00 00 */ .4byte 0x00000000
.global read_kpad_ext
read_kpad_ext:
/* 8006D680 000694C0 94 21 FF D0 */ stwu r1, -0x30(r1)
/* 8006D684 000694C4 7C 08 02 A6 */ mflr r0
/* 8006D688 000694C8 3C A0 43 30 */ lis r5, 0x4330
/* 8006D68C 000694CC 90 01 00 34 */ stw r0, 0x34(r1)
/* 8006D690 000694D0 93 E1 00 2C */ stw r31, 0x2c(r1)
/* 8006D694 000694D4 3F E0 80 07 */ lis r31, clamp_stick_circle@ha
/* 8006D698 000694D8 3B FF D3 20 */ addi r31, r31, clamp_stick_circle@l
/* 8006D69C 000694DC 93 C1 00 28 */ stw r30, 0x28(r1)
/* 8006D6A0 000694E0 3B C3 00 60 */ addi r30, r3, 0x60
/* 8006D6A4 000694E4 93 A1 00 24 */ stw r29, 0x24(r1)
/* 8006D6A8 000694E8 7C 9D 23 78 */ mr r29, r4
/* 8006D6AC 000694EC 80 0D EA 48 */ lwz r0, kp_stick_clamp_cross@sda21(r13)
/* 8006D6B0 000694F0 90 A1 00 08 */ stw r5, 0x8(r1)
/* 8006D6B4 000694F4 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006D6B8 000694F8 90 A1 00 10 */ stw r5, 0x10(r1)
/* 8006D6BC 000694FC 41 82 00 0C */ beq lbl_8006D6C8
/* 8006D6C0 00069500 3F E0 80 07 */ lis r31, clamp_stick_cross@ha
/* 8006D6C4 00069504 3B FF D4 50 */ addi r31, r31, clamp_stick_cross@l
.global lbl_8006D6C8
lbl_8006D6C8:
/* 8006D6C8 00069508 88 C4 00 28 */ lbz r6, 0x28(r4)
/* 8006D6CC 0006950C 28 06 00 01 */ cmplwi r6, 0x1
/* 8006D6D0 00069510 40 82 00 88 */ bne lbl_8006D758
/* 8006D6D4 00069514 88 A4 00 40 */ lbz r5, 0x40(r4)
/* 8006D6D8 00069518 38 05 00 FD */ addi r0, r5, 0xfd
/* 8006D6DC 0006951C 54 00 06 3E */ clrlwi r0, r0, 24
/* 8006D6E0 00069520 28 00 00 02 */ cmplwi r0, 0x2
/* 8006D6E4 00069524 41 81 00 74 */ bgt lbl_8006D758
/* 8006D6E8 00069528 88 03 06 41 */ lbz r0, 0x641(r3)
/* 8006D6EC 0006952C 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006D6F0 00069530 41 82 00 3C */ beq lbl_8006D72C
/* 8006D6F4 00069534 38 00 00 00 */ li r0, 0x0
/* 8006D6F8 00069538 98 03 06 41 */ stb r0, 0x641(r3)
/* 8006D6FC 0006953C C0 42 88 50 */ lfs f2, "@4535"@sda21(r2)
/* 8006D700 00069540 80 6D EA 58 */ lwz r3, Vec2_0@sda21(r13)
/* 8006D704 00069544 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006D708 00069548 C0 22 88 5C */ lfs f1, "@4580"@sda21(r2)
/* 8006D70C 0006954C C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006D710 00069550 90 7E 00 00 */ stw r3, 0x0(r30)
/* 8006D714 00069554 90 1E 00 04 */ stw r0, 0x4(r30)
/* 8006D718 00069558 D0 5E 00 10 */ stfs f2, 0x10(r30)
/* 8006D71C 0006955C D0 5E 00 08 */ stfs f2, 0x8(r30)
/* 8006D720 00069560 D0 3E 00 0C */ stfs f1, 0xc(r30)
/* 8006D724 00069564 D0 1E 00 14 */ stfs f0, 0x14(r30)
/* 8006D728 00069568 D0 5E 00 18 */ stfs f2, 0x18(r30)
.global lbl_8006D72C
lbl_8006D72C:
/* 8006D72C 0006956C 88 84 00 30 */ lbz r4, 0x30(r4)
/* 8006D730 00069570 7F EC FB 78 */ mr r12, r31
/* 8006D734 00069574 88 BD 00 31 */ lbz r5, 0x31(r29)
/* 8006D738 00069578 7F C3 F3 78 */ mr r3, r30
/* 8006D73C 0006957C 7C 84 07 74 */ extsb r4, r4
/* 8006D740 00069580 80 CD 84 34 */ lwz r6, kp_fs_fstick_min@sda21(r13)
/* 8006D744 00069584 7C A5 07 74 */ extsb r5, r5
/* 8006D748 00069588 80 ED 84 38 */ lwz r7, kp_fs_fstick_max@sda21(r13)
/* 8006D74C 0006958C 7D 89 03 A6 */ mtctr r12
/* 8006D750 00069590 4E 80 04 21 */ bctrl
/* 8006D754 00069594 48 00 0F 4C */ b lbl_8006E6A0
.global lbl_8006D758
lbl_8006D758:
/* 8006D758 00069598 28 06 00 02 */ cmplwi r6, 0x2
/* 8006D75C 0006959C 40 82 01 84 */ bne lbl_8006D8E0
/* 8006D760 000695A0 88 A4 00 40 */ lbz r5, 0x40(r4)
/* 8006D764 000695A4 38 05 00 FA */ addi r0, r5, 0xfa
/* 8006D768 000695A8 54 00 06 3E */ clrlwi r0, r0, 24
/* 8006D76C 000695AC 28 00 00 02 */ cmplwi r0, 0x2
/* 8006D770 000695B0 41 81 01 70 */ bgt lbl_8006D8E0
/* 8006D774 000695B4 88 03 06 41 */ lbz r0, 0x641(r3)
/* 8006D778 000695B8 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006D77C 000695BC 41 82 00 50 */ beq lbl_8006D7CC
/* 8006D780 000695C0 38 E0 00 00 */ li r7, 0x0
/* 8006D784 000695C4 98 E3 06 41 */ stb r7, 0x641(r3)
/* 8006D788 000695C8 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006D78C 000695CC 80 AD EA 58 */ lwz r5, Vec2_0@sda21(r13)
/* 8006D790 000695D0 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006D794 000695D4 90 1E 00 10 */ stw r0, 0x10(r30)
/* 8006D798 000695D8 A0 03 05 F0 */ lhz r0, 0x5f0(r3)
/* 8006D79C 000695DC 90 BE 00 0C */ stw r5, 0xc(r30)
/* 8006D7A0 000695E0 80 CD EA 58 */ lwz r6, Vec2_0@sda21(r13)
/* 8006D7A4 000695E4 80 AD EA 5C */ lwz r5, lbl_8055CE7C@sda21(r13)
/* 8006D7A8 000695E8 90 BE 00 18 */ stw r5, 0x18(r30)
/* 8006D7AC 000695EC 90 DE 00 14 */ stw r6, 0x14(r30)
/* 8006D7B0 000695F0 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006D7B4 000695F4 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006D7B8 000695F8 90 FE 00 08 */ stw r7, 0x8(r30)
/* 8006D7BC 000695FC 90 FE 00 04 */ stw r7, 0x4(r30)
/* 8006D7C0 00069600 90 FE 00 00 */ stw r7, 0x0(r30)
/* 8006D7C4 00069604 B0 E3 05 F4 */ sth r7, 0x5f4(r3)
/* 8006D7C8 00069608 B0 03 05 F6 */ sth r0, 0x5f6(r3)
.global lbl_8006D7CC
lbl_8006D7CC:
/* 8006D7CC 0006960C 7F EC FB 78 */ mr r12, r31
/* 8006D7D0 00069610 38 7E 00 0C */ addi r3, r30, 0xc
/* 8006D7D4 00069614 A8 84 00 2C */ lha r4, 0x2c(r4)
/* 8006D7D8 00069618 A8 BD 00 2E */ lha r5, 0x2e(r29)
/* 8006D7DC 0006961C 80 CD 84 3C */ lwz r6, kp_cl_stick_min@sda21(r13)
/* 8006D7E0 00069620 80 ED 84 40 */ lwz r7, kp_cl_stick_max@sda21(r13)
/* 8006D7E4 00069624 7D 89 03 A6 */ mtctr r12
/* 8006D7E8 00069628 4E 80 04 21 */ bctrl
/* 8006D7EC 0006962C 7F EC FB 78 */ mr r12, r31
/* 8006D7F0 00069630 38 7E 00 14 */ addi r3, r30, 0x14
/* 8006D7F4 00069634 A8 9D 00 30 */ lha r4, 0x30(r29)
/* 8006D7F8 00069638 A8 BD 00 32 */ lha r5, 0x32(r29)
/* 8006D7FC 0006963C 80 CD 84 3C */ lwz r6, kp_cl_stick_min@sda21(r13)
/* 8006D800 00069640 80 ED 84 40 */ lwz r7, kp_cl_stick_max@sda21(r13)
/* 8006D804 00069644 7D 89 03 A6 */ mtctr r12
/* 8006D808 00069648 4E 80 04 21 */ bctrl
/* 8006D80C 0006964C 80 8D 84 44 */ lwz r4, kp_cl_trigger_min@sda21(r13)
/* 8006D810 00069650 88 7D 00 34 */ lbz r3, 0x34(r29)
/* 8006D814 00069654 80 0D 84 48 */ lwz r0, kp_cl_trigger_max@sda21(r13)
/* 8006D818 00069658 7C 03 20 00 */ cmpw r3, r4
/* 8006D81C 0006965C 41 81 00 10 */ bgt lbl_8006D82C
/* 8006D820 00069660 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006D824 00069664 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006D828 00069668 48 00 00 4C */ b lbl_8006D874
.global lbl_8006D82C
lbl_8006D82C:
/* 8006D82C 0006966C 7C 03 00 00 */ cmpw r3, r0
/* 8006D830 00069670 41 80 00 10 */ blt lbl_8006D840
/* 8006D834 00069674 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006D838 00069678 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006D83C 0006967C 48 00 00 38 */ b lbl_8006D874
.global lbl_8006D840
lbl_8006D840:
/* 8006D840 00069680 7C 64 18 50 */ subf r3, r4, r3
/* 8006D844 00069684 7C 04 00 50 */ subf r0, r4, r0
/* 8006D848 00069688 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006D84C 0006968C 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006D850 00069690 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006D854 00069694 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006D858 00069698 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006D85C 0006969C C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006D860 000696A0 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006D864 000696A4 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006D868 000696A8 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006D86C 000696AC EC 01 00 24 */ fdivs f0, f1, f0
/* 8006D870 000696B0 D0 1E 00 1C */ stfs f0, 0x1c(r30)
.global lbl_8006D874
lbl_8006D874:
/* 8006D874 000696B4 80 8D 84 44 */ lwz r4, kp_cl_trigger_min@sda21(r13)
/* 8006D878 000696B8 88 7D 00 35 */ lbz r3, 0x35(r29)
/* 8006D87C 000696BC 80 0D 84 48 */ lwz r0, kp_cl_trigger_max@sda21(r13)
/* 8006D880 000696C0 7C 03 20 00 */ cmpw r3, r4
/* 8006D884 000696C4 41 81 00 10 */ bgt lbl_8006D894
/* 8006D888 000696C8 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006D88C 000696CC D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006D890 000696D0 48 00 0E 10 */ b lbl_8006E6A0
.global lbl_8006D894
lbl_8006D894:
/* 8006D894 000696D4 7C 03 00 00 */ cmpw r3, r0
/* 8006D898 000696D8 41 80 00 10 */ blt lbl_8006D8A8
/* 8006D89C 000696DC C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006D8A0 000696E0 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006D8A4 000696E4 48 00 0D FC */ b lbl_8006E6A0
.global lbl_8006D8A8
lbl_8006D8A8:
/* 8006D8A8 000696E8 7C 64 18 50 */ subf r3, r4, r3
/* 8006D8AC 000696EC 7C 04 00 50 */ subf r0, r4, r0
/* 8006D8B0 000696F0 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006D8B4 000696F4 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006D8B8 000696F8 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006D8BC 000696FC C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006D8C0 00069700 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006D8C4 00069704 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006D8C8 00069708 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006D8CC 0006970C EC 21 10 28 */ fsubs f1, f1, f2
/* 8006D8D0 00069710 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006D8D4 00069714 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006D8D8 00069718 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006D8DC 0006971C 48 00 0D C4 */ b lbl_8006E6A0
.global lbl_8006D8E0
lbl_8006D8E0:
/* 8006D8E0 00069720 28 06 00 11 */ cmplwi r6, 0x11
/* 8006D8E4 00069724 40 82 00 10 */ bne lbl_8006D8F4
/* 8006D8E8 00069728 88 04 00 40 */ lbz r0, 0x40(r4)
/* 8006D8EC 0006972C 28 00 00 0B */ cmplwi r0, 0xb
/* 8006D8F0 00069730 41 82 00 18 */ beq lbl_8006D908
.global lbl_8006D8F4
lbl_8006D8F4:
/* 8006D8F4 00069734 28 06 00 12 */ cmplwi r6, 0x12
/* 8006D8F8 00069738 40 82 02 2C */ bne lbl_8006DB24
/* 8006D8FC 0006973C 88 04 00 40 */ lbz r0, 0x40(r4)
/* 8006D900 00069740 28 00 00 0F */ cmplwi r0, 0xf
/* 8006D904 00069744 40 82 02 20 */ bne lbl_8006DB24
.global lbl_8006D908
lbl_8006D908:
/* 8006D908 00069748 88 03 06 41 */ lbz r0, 0x641(r3)
/* 8006D90C 0006974C 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006D910 00069750 41 82 00 50 */ beq lbl_8006D960
/* 8006D914 00069754 38 E0 00 00 */ li r7, 0x0
/* 8006D918 00069758 98 E3 06 41 */ stb r7, 0x641(r3)
/* 8006D91C 0006975C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006D920 00069760 80 AD EA 58 */ lwz r5, Vec2_0@sda21(r13)
/* 8006D924 00069764 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006D928 00069768 90 1E 00 10 */ stw r0, 0x10(r30)
/* 8006D92C 0006976C A0 03 05 F0 */ lhz r0, 0x5f0(r3)
/* 8006D930 00069770 90 BE 00 0C */ stw r5, 0xc(r30)
/* 8006D934 00069774 80 CD EA 58 */ lwz r6, Vec2_0@sda21(r13)
/* 8006D938 00069778 80 AD EA 5C */ lwz r5, lbl_8055CE7C@sda21(r13)
/* 8006D93C 0006977C 90 BE 00 18 */ stw r5, 0x18(r30)
/* 8006D940 00069780 90 DE 00 14 */ stw r6, 0x14(r30)
/* 8006D944 00069784 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006D948 00069788 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006D94C 0006978C 90 FE 00 08 */ stw r7, 0x8(r30)
/* 8006D950 00069790 90 FE 00 04 */ stw r7, 0x4(r30)
/* 8006D954 00069794 90 FE 00 00 */ stw r7, 0x0(r30)
/* 8006D958 00069798 B0 E3 05 F4 */ sth r7, 0x5f4(r3)
/* 8006D95C 0006979C B0 03 05 F6 */ sth r0, 0x5f6(r3)
.global lbl_8006D960
lbl_8006D960:
/* 8006D960 000697A0 7F EC FB 78 */ mr r12, r31
/* 8006D964 000697A4 38 7E 00 0C */ addi r3, r30, 0xc
/* 8006D968 000697A8 A8 84 00 2C */ lha r4, 0x2c(r4)
/* 8006D96C 000697AC A8 BD 00 2E */ lha r5, 0x2e(r29)
/* 8006D970 000697B0 80 CD 84 3C */ lwz r6, kp_cl_stick_min@sda21(r13)
/* 8006D974 000697B4 80 ED 84 40 */ lwz r7, kp_cl_stick_max@sda21(r13)
/* 8006D978 000697B8 7D 89 03 A6 */ mtctr r12
/* 8006D97C 000697BC 4E 80 04 21 */ bctrl
/* 8006D980 000697C0 80 8D EA 50 */ lwz r4, kp_ex_analog_min@sda21(r13)
/* 8006D984 000697C4 A8 7D 00 30 */ lha r3, 0x30(r29)
/* 8006D988 000697C8 80 0D 84 58 */ lwz r0, kp_ex_analog_max@sda21(r13)
/* 8006D98C 000697CC 7C 03 20 00 */ cmpw r3, r4
/* 8006D990 000697D0 41 81 00 10 */ bgt lbl_8006D9A0
/* 8006D994 000697D4 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006D998 000697D8 D0 1E 00 14 */ stfs f0, 0x14(r30)
/* 8006D99C 000697DC 48 00 00 4C */ b lbl_8006D9E8
.global lbl_8006D9A0
lbl_8006D9A0:
/* 8006D9A0 000697E0 7C 03 00 00 */ cmpw r3, r0
/* 8006D9A4 000697E4 41 80 00 10 */ blt lbl_8006D9B4
/* 8006D9A8 000697E8 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006D9AC 000697EC D0 1E 00 14 */ stfs f0, 0x14(r30)
/* 8006D9B0 000697F0 48 00 00 38 */ b lbl_8006D9E8
.global lbl_8006D9B4
lbl_8006D9B4:
/* 8006D9B4 000697F4 7C 64 18 50 */ subf r3, r4, r3
/* 8006D9B8 000697F8 7C 04 00 50 */ subf r0, r4, r0
/* 8006D9BC 000697FC 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006D9C0 00069800 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006D9C4 00069804 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006D9C8 00069808 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006D9CC 0006980C 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006D9D0 00069810 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006D9D4 00069814 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006D9D8 00069818 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006D9DC 0006981C EC 00 10 28 */ fsubs f0, f0, f2
/* 8006D9E0 00069820 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006D9E4 00069824 D0 1E 00 14 */ stfs f0, 0x14(r30)
.global lbl_8006D9E8
lbl_8006D9E8:
/* 8006D9E8 00069828 80 8D EA 50 */ lwz r4, kp_ex_analog_min@sda21(r13)
/* 8006D9EC 0006982C A8 7D 00 32 */ lha r3, 0x32(r29)
/* 8006D9F0 00069830 80 0D 84 58 */ lwz r0, kp_ex_analog_max@sda21(r13)
/* 8006D9F4 00069834 7C 03 20 00 */ cmpw r3, r4
/* 8006D9F8 00069838 41 81 00 10 */ bgt lbl_8006DA08
/* 8006D9FC 0006983C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DA00 00069840 D0 1E 00 18 */ stfs f0, 0x18(r30)
/* 8006DA04 00069844 48 00 00 4C */ b lbl_8006DA50
.global lbl_8006DA08
lbl_8006DA08:
/* 8006DA08 00069848 7C 03 00 00 */ cmpw r3, r0
/* 8006DA0C 0006984C 41 80 00 10 */ blt lbl_8006DA1C
/* 8006DA10 00069850 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DA14 00069854 D0 1E 00 18 */ stfs f0, 0x18(r30)
/* 8006DA18 00069858 48 00 00 38 */ b lbl_8006DA50
.global lbl_8006DA1C
lbl_8006DA1C:
/* 8006DA1C 0006985C 7C 64 18 50 */ subf r3, r4, r3
/* 8006DA20 00069860 7C 04 00 50 */ subf r0, r4, r0
/* 8006DA24 00069864 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DA28 00069868 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DA2C 0006986C 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DA30 00069870 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DA34 00069874 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DA38 00069878 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DA3C 0006987C C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DA40 00069880 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DA44 00069884 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DA48 00069888 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DA4C 0006988C D0 1E 00 18 */ stfs f0, 0x18(r30)
.global lbl_8006DA50
lbl_8006DA50:
/* 8006DA50 00069890 80 8D EA 4C */ lwz r4, kp_ex_trigger_min@sda21(r13)
/* 8006DA54 00069894 88 7D 00 34 */ lbz r3, 0x34(r29)
/* 8006DA58 00069898 80 0D 84 54 */ lwz r0, kp_ex_trigger_max@sda21(r13)
/* 8006DA5C 0006989C 7C 03 20 00 */ cmpw r3, r4
/* 8006DA60 000698A0 41 81 00 10 */ bgt lbl_8006DA70
/* 8006DA64 000698A4 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DA68 000698A8 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006DA6C 000698AC 48 00 00 4C */ b lbl_8006DAB8
.global lbl_8006DA70
lbl_8006DA70:
/* 8006DA70 000698B0 7C 03 00 00 */ cmpw r3, r0
/* 8006DA74 000698B4 41 80 00 10 */ blt lbl_8006DA84
/* 8006DA78 000698B8 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DA7C 000698BC D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006DA80 000698C0 48 00 00 38 */ b lbl_8006DAB8
.global lbl_8006DA84
lbl_8006DA84:
/* 8006DA84 000698C4 7C 64 18 50 */ subf r3, r4, r3
/* 8006DA88 000698C8 7C 04 00 50 */ subf r0, r4, r0
/* 8006DA8C 000698CC 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DA90 000698D0 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DA94 000698D4 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DA98 000698D8 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DA9C 000698DC 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DAA0 000698E0 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DAA4 000698E4 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DAA8 000698E8 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DAAC 000698EC EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DAB0 000698F0 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DAB4 000698F4 D0 1E 00 1C */ stfs f0, 0x1c(r30)
.global lbl_8006DAB8
lbl_8006DAB8:
/* 8006DAB8 000698F8 80 8D EA 4C */ lwz r4, kp_ex_trigger_min@sda21(r13)
/* 8006DABC 000698FC 88 7D 00 35 */ lbz r3, 0x35(r29)
/* 8006DAC0 00069900 80 0D 84 54 */ lwz r0, kp_ex_trigger_max@sda21(r13)
/* 8006DAC4 00069904 7C 03 20 00 */ cmpw r3, r4
/* 8006DAC8 00069908 41 81 00 10 */ bgt lbl_8006DAD8
/* 8006DACC 0006990C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DAD0 00069910 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DAD4 00069914 48 00 0B CC */ b lbl_8006E6A0
.global lbl_8006DAD8
lbl_8006DAD8:
/* 8006DAD8 00069918 7C 03 00 00 */ cmpw r3, r0
/* 8006DADC 0006991C 41 80 00 10 */ blt lbl_8006DAEC
/* 8006DAE0 00069920 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DAE4 00069924 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DAE8 00069928 48 00 0B B8 */ b lbl_8006E6A0
.global lbl_8006DAEC
lbl_8006DAEC:
/* 8006DAEC 0006992C 7C 64 18 50 */ subf r3, r4, r3
/* 8006DAF0 00069930 7C 04 00 50 */ subf r0, r4, r0
/* 8006DAF4 00069934 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DAF8 00069938 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DAFC 0006993C 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DB00 00069940 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DB04 00069944 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DB08 00069948 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DB0C 0006994C C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DB10 00069950 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DB14 00069954 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DB18 00069958 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DB1C 0006995C D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DB20 00069960 48 00 0B 80 */ b lbl_8006E6A0
.global lbl_8006DB24
lbl_8006DB24:
/* 8006DB24 00069964 28 06 00 10 */ cmplwi r6, 0x10
/* 8006DB28 00069968 40 82 01 4C */ bne lbl_8006DC74
/* 8006DB2C 0006996C 88 04 00 40 */ lbz r0, 0x40(r4)
/* 8006DB30 00069970 28 00 00 0A */ cmplwi r0, 0xa
/* 8006DB34 00069974 40 82 01 40 */ bne lbl_8006DC74
/* 8006DB38 00069978 88 03 06 41 */ lbz r0, 0x641(r3)
/* 8006DB3C 0006997C 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006DB40 00069980 41 82 00 50 */ beq lbl_8006DB90
/* 8006DB44 00069984 38 E0 00 00 */ li r7, 0x0
/* 8006DB48 00069988 98 E3 06 41 */ stb r7, 0x641(r3)
/* 8006DB4C 0006998C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DB50 00069990 80 AD EA 58 */ lwz r5, Vec2_0@sda21(r13)
/* 8006DB54 00069994 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006DB58 00069998 90 1E 00 10 */ stw r0, 0x10(r30)
/* 8006DB5C 0006999C A0 03 05 F0 */ lhz r0, 0x5f0(r3)
/* 8006DB60 000699A0 90 BE 00 0C */ stw r5, 0xc(r30)
/* 8006DB64 000699A4 80 CD EA 58 */ lwz r6, Vec2_0@sda21(r13)
/* 8006DB68 000699A8 80 AD EA 5C */ lwz r5, lbl_8055CE7C@sda21(r13)
/* 8006DB6C 000699AC 90 BE 00 18 */ stw r5, 0x18(r30)
/* 8006DB70 000699B0 90 DE 00 14 */ stw r6, 0x14(r30)
/* 8006DB74 000699B4 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DB78 000699B8 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006DB7C 000699BC 90 FE 00 08 */ stw r7, 0x8(r30)
/* 8006DB80 000699C0 90 FE 00 04 */ stw r7, 0x4(r30)
/* 8006DB84 000699C4 90 FE 00 00 */ stw r7, 0x0(r30)
/* 8006DB88 000699C8 B0 E3 05 F4 */ sth r7, 0x5f4(r3)
/* 8006DB8C 000699CC B0 03 05 F6 */ sth r0, 0x5f6(r3)
.global lbl_8006DB90
lbl_8006DB90:
/* 8006DB90 000699D0 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DB94 000699D4 D0 1E 00 10 */ stfs f0, 0x10(r30)
/* 8006DB98 000699D8 D0 1E 00 0C */ stfs f0, 0xc(r30)
/* 8006DB9C 000699DC D0 1E 00 18 */ stfs f0, 0x18(r30)
/* 8006DBA0 000699E0 D0 1E 00 14 */ stfs f0, 0x14(r30)
/* 8006DBA4 000699E4 80 AD EA 4C */ lwz r5, kp_ex_trigger_min@sda21(r13)
/* 8006DBA8 000699E8 88 64 00 2C */ lbz r3, 0x2c(r4)
/* 8006DBAC 000699EC 80 0D 84 54 */ lwz r0, kp_ex_trigger_max@sda21(r13)
/* 8006DBB0 000699F0 7C 03 28 00 */ cmpw r3, r5
/* 8006DBB4 000699F4 41 81 00 0C */ bgt lbl_8006DBC0
/* 8006DBB8 000699F8 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006DBBC 000699FC 48 00 00 4C */ b lbl_8006DC08
.global lbl_8006DBC0
lbl_8006DBC0:
/* 8006DBC0 00069A00 7C 03 00 00 */ cmpw r3, r0
/* 8006DBC4 00069A04 41 80 00 10 */ blt lbl_8006DBD4
/* 8006DBC8 00069A08 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DBCC 00069A0C D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006DBD0 00069A10 48 00 00 38 */ b lbl_8006DC08
.global lbl_8006DBD4
lbl_8006DBD4:
/* 8006DBD4 00069A14 7C 65 18 50 */ subf r3, r5, r3
/* 8006DBD8 00069A18 7C 05 00 50 */ subf r0, r5, r0
/* 8006DBDC 00069A1C 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DBE0 00069A20 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DBE4 00069A24 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DBE8 00069A28 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DBEC 00069A2C 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DBF0 00069A30 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DBF4 00069A34 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DBF8 00069A38 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DBFC 00069A3C EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DC00 00069A40 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DC04 00069A44 D0 1E 00 1C */ stfs f0, 0x1c(r30)
.global lbl_8006DC08
lbl_8006DC08:
/* 8006DC08 00069A48 80 AD EA 4C */ lwz r5, kp_ex_trigger_min@sda21(r13)
/* 8006DC0C 00069A4C 88 64 00 2D */ lbz r3, 0x2d(r4)
/* 8006DC10 00069A50 80 0D 84 54 */ lwz r0, kp_ex_trigger_max@sda21(r13)
/* 8006DC14 00069A54 7C 03 28 00 */ cmpw r3, r5
/* 8006DC18 00069A58 41 81 00 10 */ bgt lbl_8006DC28
/* 8006DC1C 00069A5C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DC20 00069A60 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DC24 00069A64 48 00 0A 7C */ b lbl_8006E6A0
.global lbl_8006DC28
lbl_8006DC28:
/* 8006DC28 00069A68 7C 03 00 00 */ cmpw r3, r0
/* 8006DC2C 00069A6C 41 80 00 10 */ blt lbl_8006DC3C
/* 8006DC30 00069A70 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DC34 00069A74 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DC38 00069A78 48 00 0A 68 */ b lbl_8006E6A0
.global lbl_8006DC3C
lbl_8006DC3C:
/* 8006DC3C 00069A7C 7C 65 18 50 */ subf r3, r5, r3
/* 8006DC40 00069A80 7C 05 00 50 */ subf r0, r5, r0
/* 8006DC44 00069A84 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DC48 00069A88 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DC4C 00069A8C 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DC50 00069A90 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DC54 00069A94 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DC58 00069A98 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DC5C 00069A9C C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DC60 00069AA0 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DC64 00069AA4 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DC68 00069AA8 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DC6C 00069AAC D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DC70 00069AB0 48 00 0A 30 */ b lbl_8006E6A0
.global lbl_8006DC74
lbl_8006DC74:
/* 8006DC74 00069AB4 28 06 00 13 */ cmplwi r6, 0x13
/* 8006DC78 00069AB8 40 82 02 DC */ bne lbl_8006DF54
/* 8006DC7C 00069ABC 88 04 00 40 */ lbz r0, 0x40(r4)
/* 8006DC80 00069AC0 28 00 00 11 */ cmplwi r0, 0x11
/* 8006DC84 00069AC4 40 82 02 D0 */ bne lbl_8006DF54
/* 8006DC88 00069AC8 88 03 06 41 */ lbz r0, 0x641(r3)
/* 8006DC8C 00069ACC 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006DC90 00069AD0 41 82 00 50 */ beq lbl_8006DCE0
/* 8006DC94 00069AD4 38 E0 00 00 */ li r7, 0x0
/* 8006DC98 00069AD8 98 E3 06 41 */ stb r7, 0x641(r3)
/* 8006DC9C 00069ADC C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DCA0 00069AE0 80 AD EA 58 */ lwz r5, Vec2_0@sda21(r13)
/* 8006DCA4 00069AE4 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006DCA8 00069AE8 90 1E 00 10 */ stw r0, 0x10(r30)
/* 8006DCAC 00069AEC A0 03 05 F0 */ lhz r0, 0x5f0(r3)
/* 8006DCB0 00069AF0 90 BE 00 0C */ stw r5, 0xc(r30)
/* 8006DCB4 00069AF4 80 CD EA 58 */ lwz r6, Vec2_0@sda21(r13)
/* 8006DCB8 00069AF8 80 AD EA 5C */ lwz r5, lbl_8055CE7C@sda21(r13)
/* 8006DCBC 00069AFC 90 BE 00 18 */ stw r5, 0x18(r30)
/* 8006DCC0 00069B00 90 DE 00 14 */ stw r6, 0x14(r30)
/* 8006DCC4 00069B04 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DCC8 00069B08 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006DCCC 00069B0C 90 FE 00 08 */ stw r7, 0x8(r30)
/* 8006DCD0 00069B10 90 FE 00 04 */ stw r7, 0x4(r30)
/* 8006DCD4 00069B14 90 FE 00 00 */ stw r7, 0x0(r30)
/* 8006DCD8 00069B18 B0 E3 05 F4 */ sth r7, 0x5f4(r3)
/* 8006DCDC 00069B1C B0 03 05 F6 */ sth r0, 0x5f6(r3)
.global lbl_8006DCE0
lbl_8006DCE0:
/* 8006DCE0 00069B20 80 AD EA 50 */ lwz r5, kp_ex_analog_min@sda21(r13)
/* 8006DCE4 00069B24 A8 64 00 2C */ lha r3, 0x2c(r4)
/* 8006DCE8 00069B28 80 0D 84 58 */ lwz r0, kp_ex_analog_max@sda21(r13)
/* 8006DCEC 00069B2C 7C 03 28 00 */ cmpw r3, r5
/* 8006DCF0 00069B30 41 81 00 10 */ bgt lbl_8006DD00
/* 8006DCF4 00069B34 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DCF8 00069B38 D0 1E 00 0C */ stfs f0, 0xc(r30)
/* 8006DCFC 00069B3C 48 00 00 4C */ b lbl_8006DD48
.global lbl_8006DD00
lbl_8006DD00:
/* 8006DD00 00069B40 7C 03 00 00 */ cmpw r3, r0
/* 8006DD04 00069B44 41 80 00 10 */ blt lbl_8006DD14
/* 8006DD08 00069B48 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DD0C 00069B4C D0 1E 00 0C */ stfs f0, 0xc(r30)
/* 8006DD10 00069B50 48 00 00 38 */ b lbl_8006DD48
.global lbl_8006DD14
lbl_8006DD14:
/* 8006DD14 00069B54 7C 65 18 50 */ subf r3, r5, r3
/* 8006DD18 00069B58 7C 05 00 50 */ subf r0, r5, r0
/* 8006DD1C 00069B5C 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DD20 00069B60 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DD24 00069B64 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DD28 00069B68 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DD2C 00069B6C 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DD30 00069B70 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DD34 00069B74 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DD38 00069B78 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DD3C 00069B7C EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DD40 00069B80 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DD44 00069B84 D0 1E 00 0C */ stfs f0, 0xc(r30)
.global lbl_8006DD48
lbl_8006DD48:
/* 8006DD48 00069B88 80 AD EA 50 */ lwz r5, kp_ex_analog_min@sda21(r13)
/* 8006DD4C 00069B8C A8 64 00 2E */ lha r3, 0x2e(r4)
/* 8006DD50 00069B90 80 0D 84 58 */ lwz r0, kp_ex_analog_max@sda21(r13)
/* 8006DD54 00069B94 7C 03 28 00 */ cmpw r3, r5
/* 8006DD58 00069B98 41 81 00 10 */ bgt lbl_8006DD68
/* 8006DD5C 00069B9C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DD60 00069BA0 D0 1E 00 10 */ stfs f0, 0x10(r30)
/* 8006DD64 00069BA4 48 00 00 4C */ b lbl_8006DDB0
.global lbl_8006DD68
lbl_8006DD68:
/* 8006DD68 00069BA8 7C 03 00 00 */ cmpw r3, r0
/* 8006DD6C 00069BAC 41 80 00 10 */ blt lbl_8006DD7C
/* 8006DD70 00069BB0 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DD74 00069BB4 D0 1E 00 10 */ stfs f0, 0x10(r30)
/* 8006DD78 00069BB8 48 00 00 38 */ b lbl_8006DDB0
.global lbl_8006DD7C
lbl_8006DD7C:
/* 8006DD7C 00069BBC 7C 65 18 50 */ subf r3, r5, r3
/* 8006DD80 00069BC0 7C 05 00 50 */ subf r0, r5, r0
/* 8006DD84 00069BC4 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DD88 00069BC8 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DD8C 00069BCC 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DD90 00069BD0 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DD94 00069BD4 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DD98 00069BD8 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DD9C 00069BDC C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DDA0 00069BE0 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DDA4 00069BE4 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DDA8 00069BE8 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DDAC 00069BEC D0 1E 00 10 */ stfs f0, 0x10(r30)
.global lbl_8006DDB0
lbl_8006DDB0:
/* 8006DDB0 00069BF0 80 AD EA 50 */ lwz r5, kp_ex_analog_min@sda21(r13)
/* 8006DDB4 00069BF4 A8 64 00 30 */ lha r3, 0x30(r4)
/* 8006DDB8 00069BF8 80 0D 84 58 */ lwz r0, kp_ex_analog_max@sda21(r13)
/* 8006DDBC 00069BFC 7C 03 28 00 */ cmpw r3, r5
/* 8006DDC0 00069C00 41 81 00 10 */ bgt lbl_8006DDD0
/* 8006DDC4 00069C04 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DDC8 00069C08 D0 1E 00 14 */ stfs f0, 0x14(r30)
/* 8006DDCC 00069C0C 48 00 00 4C */ b lbl_8006DE18
.global lbl_8006DDD0
lbl_8006DDD0:
/* 8006DDD0 00069C10 7C 03 00 00 */ cmpw r3, r0
/* 8006DDD4 00069C14 41 80 00 10 */ blt lbl_8006DDE4
/* 8006DDD8 00069C18 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DDDC 00069C1C D0 1E 00 14 */ stfs f0, 0x14(r30)
/* 8006DDE0 00069C20 48 00 00 38 */ b lbl_8006DE18
.global lbl_8006DDE4
lbl_8006DDE4:
/* 8006DDE4 00069C24 7C 65 18 50 */ subf r3, r5, r3
/* 8006DDE8 00069C28 7C 05 00 50 */ subf r0, r5, r0
/* 8006DDEC 00069C2C 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DDF0 00069C30 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DDF4 00069C34 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DDF8 00069C38 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DDFC 00069C3C 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DE00 00069C40 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DE04 00069C44 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DE08 00069C48 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DE0C 00069C4C EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DE10 00069C50 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DE14 00069C54 D0 1E 00 14 */ stfs f0, 0x14(r30)
.global lbl_8006DE18
lbl_8006DE18:
/* 8006DE18 00069C58 80 AD EA 50 */ lwz r5, kp_ex_analog_min@sda21(r13)
/* 8006DE1C 00069C5C A8 64 00 32 */ lha r3, 0x32(r4)
/* 8006DE20 00069C60 80 0D 84 58 */ lwz r0, kp_ex_analog_max@sda21(r13)
/* 8006DE24 00069C64 7C 03 28 00 */ cmpw r3, r5
/* 8006DE28 00069C68 41 81 00 10 */ bgt lbl_8006DE38
/* 8006DE2C 00069C6C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DE30 00069C70 D0 1E 00 18 */ stfs f0, 0x18(r30)
/* 8006DE34 00069C74 48 00 00 4C */ b lbl_8006DE80
.global lbl_8006DE38
lbl_8006DE38:
/* 8006DE38 00069C78 7C 03 00 00 */ cmpw r3, r0
/* 8006DE3C 00069C7C 41 80 00 10 */ blt lbl_8006DE4C
/* 8006DE40 00069C80 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DE44 00069C84 D0 1E 00 18 */ stfs f0, 0x18(r30)
/* 8006DE48 00069C88 48 00 00 38 */ b lbl_8006DE80
.global lbl_8006DE4C
lbl_8006DE4C:
/* 8006DE4C 00069C8C 7C 65 18 50 */ subf r3, r5, r3
/* 8006DE50 00069C90 7C 05 00 50 */ subf r0, r5, r0
/* 8006DE54 00069C94 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DE58 00069C98 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DE5C 00069C9C 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DE60 00069CA0 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DE64 00069CA4 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DE68 00069CA8 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DE6C 00069CAC C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DE70 00069CB0 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DE74 00069CB4 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DE78 00069CB8 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DE7C 00069CBC D0 1E 00 18 */ stfs f0, 0x18(r30)
.global lbl_8006DE80
lbl_8006DE80:
/* 8006DE80 00069CC0 80 AD EA 4C */ lwz r5, kp_ex_trigger_min@sda21(r13)
/* 8006DE84 00069CC4 88 64 00 34 */ lbz r3, 0x34(r4)
/* 8006DE88 00069CC8 80 0D 84 54 */ lwz r0, kp_ex_trigger_max@sda21(r13)
/* 8006DE8C 00069CCC 7C 03 28 00 */ cmpw r3, r5
/* 8006DE90 00069CD0 41 81 00 10 */ bgt lbl_8006DEA0
/* 8006DE94 00069CD4 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DE98 00069CD8 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006DE9C 00069CDC 48 00 00 4C */ b lbl_8006DEE8
.global lbl_8006DEA0
lbl_8006DEA0:
/* 8006DEA0 00069CE0 7C 03 00 00 */ cmpw r3, r0
/* 8006DEA4 00069CE4 41 80 00 10 */ blt lbl_8006DEB4
/* 8006DEA8 00069CE8 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DEAC 00069CEC D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006DEB0 00069CF0 48 00 00 38 */ b lbl_8006DEE8
.global lbl_8006DEB4
lbl_8006DEB4:
/* 8006DEB4 00069CF4 7C 65 18 50 */ subf r3, r5, r3
/* 8006DEB8 00069CF8 7C 05 00 50 */ subf r0, r5, r0
/* 8006DEBC 00069CFC 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DEC0 00069D00 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DEC4 00069D04 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DEC8 00069D08 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DECC 00069D0C 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DED0 00069D10 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DED4 00069D14 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DED8 00069D18 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DEDC 00069D1C EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DEE0 00069D20 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DEE4 00069D24 D0 1E 00 1C */ stfs f0, 0x1c(r30)
.global lbl_8006DEE8
lbl_8006DEE8:
/* 8006DEE8 00069D28 80 AD EA 4C */ lwz r5, kp_ex_trigger_min@sda21(r13)
/* 8006DEEC 00069D2C 88 64 00 35 */ lbz r3, 0x35(r4)
/* 8006DEF0 00069D30 80 0D 84 54 */ lwz r0, kp_ex_trigger_max@sda21(r13)
/* 8006DEF4 00069D34 7C 03 28 00 */ cmpw r3, r5
/* 8006DEF8 00069D38 41 81 00 10 */ bgt lbl_8006DF08
/* 8006DEFC 00069D3C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006DF00 00069D40 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DF04 00069D44 48 00 07 9C */ b lbl_8006E6A0
.global lbl_8006DF08
lbl_8006DF08:
/* 8006DF08 00069D48 7C 03 00 00 */ cmpw r3, r0
/* 8006DF0C 00069D4C 41 80 00 10 */ blt lbl_8006DF1C
/* 8006DF10 00069D50 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006DF14 00069D54 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DF18 00069D58 48 00 07 88 */ b lbl_8006E6A0
.global lbl_8006DF1C
lbl_8006DF1C:
/* 8006DF1C 00069D5C 7C 65 18 50 */ subf r3, r5, r3
/* 8006DF20 00069D60 7C 05 00 50 */ subf r0, r5, r0
/* 8006DF24 00069D64 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006DF28 00069D68 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006DF2C 00069D6C 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006DF30 00069D70 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006DF34 00069D74 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006DF38 00069D78 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006DF3C 00069D7C C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006DF40 00069D80 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006DF44 00069D84 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006DF48 00069D88 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006DF4C 00069D8C D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006DF50 00069D90 48 00 07 50 */ b lbl_8006E6A0
.global lbl_8006DF54
lbl_8006DF54:
/* 8006DF54 00069D94 28 06 00 03 */ cmplwi r6, 0x3
/* 8006DF58 00069D98 40 82 05 04 */ bne lbl_8006E45C
/* 8006DF5C 00069D9C 88 04 00 40 */ lbz r0, 0x40(r4)
/* 8006DF60 00069DA0 28 00 00 0C */ cmplwi r0, 0xc
/* 8006DF64 00069DA4 40 82 04 F8 */ bne lbl_8006E45C
/* 8006DF68 00069DA8 7F A3 EB 78 */ mr r3, r29
/* 8006DF6C 00069DAC 38 9E 00 08 */ addi r4, r30, 0x8
/* 8006DF70 00069DB0 38 A0 00 04 */ li r5, 0x4
/* 8006DF74 00069DB4 4B FE 5F 1D */ bl WBCRead
/* 8006DF78 00069DB8 90 7E 00 48 */ stw r3, 0x48(r30)
/* 8006DF7C 00069DBC 88 7D 00 33 */ lbz r3, 0x33(r29)
/* 8006DF80 00069DC0 4B FE 5E 71 */ bl __wpadNoAlloc
/* 8006DF84 00069DC4 2C 03 00 00 */ cmpwi r3, 0x0
/* 8006DF88 00069DC8 40 82 00 10 */ bne lbl_8006DF98
/* 8006DF8C 00069DCC 38 00 FF FF */ li r0, -0x1
/* 8006DF90 00069DD0 90 1E 00 48 */ stw r0, 0x48(r30)
/* 8006DF94 00069DD4 48 00 04 B0 */ b lbl_8006E444
.global lbl_8006DF98
lbl_8006DF98:
/* 8006DF98 00069DD8 88 0D EA 89 */ lbz r0, kp_wbc_enabled@sda21(r13)
/* 8006DF9C 00069DDC 7C 00 07 75 */ extsb. r0, r0
/* 8006DFA0 00069DE0 40 80 00 10 */ bge lbl_8006DFB0
/* 8006DFA4 00069DE4 38 00 FF FA */ li r0, -0x6
/* 8006DFA8 00069DE8 90 1E 00 48 */ stw r0, 0x48(r30)
/* 8006DFAC 00069DEC 48 00 04 98 */ b lbl_8006E444
.global lbl_8006DFB0
lbl_8006DFB0:
/* 8006DFB0 00069DF0 88 0D EA 83 */ lbz r0, kp_wbc_zero_point_done@sda21(r13)
/* 8006DFB4 00069DF4 7C 00 07 75 */ extsb. r0, r0
/* 8006DFB8 00069DF8 40 82 00 10 */ bne lbl_8006DFC8
/* 8006DFBC 00069DFC 38 00 FF F9 */ li r0, -0x7
/* 8006DFC0 00069E00 90 1E 00 48 */ stw r0, 0x48(r30)
/* 8006DFC4 00069E04 48 00 04 80 */ b lbl_8006E444
.global lbl_8006DFC8
lbl_8006DFC8:
/* 8006DFC8 00069E08 2C 00 00 03 */ cmpwi r0, 0x3
/* 8006DFCC 00069E0C 41 81 00 44 */ bgt lbl_8006E010
/* 8006DFD0 00069E10 80 1E 00 48 */ lwz r0, 0x48(r30)
/* 8006DFD4 00069E14 2C 00 00 01 */ cmpwi r0, 0x1
/* 8006DFD8 00069E18 40 82 00 14 */ bne lbl_8006DFEC
/* 8006DFDC 00069E1C 38 60 FF FF */ li r3, -0x1
/* 8006DFE0 00069E20 38 00 00 00 */ li r0, 0x0
/* 8006DFE4 00069E24 98 6D EA 83 */ stb r3, kp_wbc_zero_point_done@sda21(r13)
/* 8006DFE8 00069E28 98 0D EA 85 */ stb r0, kp_wbc_tgc_weight_done@sda21(r13)
.global lbl_8006DFEC
lbl_8006DFEC:
/* 8006DFEC 00069E2C 88 0D EA 83 */ lbz r0, kp_wbc_zero_point_done@sda21(r13)
/* 8006DFF0 00069E30 7C 00 07 75 */ extsb. r0, r0
/* 8006DFF4 00069E34 40 80 00 10 */ bge lbl_8006E004
/* 8006DFF8 00069E38 38 00 FF FC */ li r0, -0x4
/* 8006DFFC 00069E3C 90 1E 00 48 */ stw r0, 0x48(r30)
/* 8006E000 00069E40 48 00 04 44 */ b lbl_8006E444
.global lbl_8006E004
lbl_8006E004:
/* 8006E004 00069E44 38 00 FF F8 */ li r0, -0x8
/* 8006E008 00069E48 90 1E 00 48 */ stw r0, 0x48(r30)
/* 8006E00C 00069E4C 48 00 04 38 */ b lbl_8006E444
.global lbl_8006E010
lbl_8006E010:
/* 8006E010 00069E50 80 1E 00 48 */ lwz r0, 0x48(r30)
/* 8006E014 00069E54 2C 00 FF FE */ cmpwi r0, -0x2
/* 8006E018 00069E58 40 82 00 10 */ bne lbl_8006E028
/* 8006E01C 00069E5C 38 00 FF FE */ li r0, -0x2
/* 8006E020 00069E60 90 1E 00 48 */ stw r0, 0x48(r30)
/* 8006E024 00069E64 48 00 04 20 */ b lbl_8006E444
.global lbl_8006E028
lbl_8006E028:
/* 8006E028 00069E68 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E02C 00069E6C 41 80 04 18 */ blt lbl_8006E444
/* 8006E030 00069E70 3C 80 80 4D */ lis r4, kp_wbc_weight_ave@ha
/* 8006E034 00069E74 C0 4D 84 5C */ lfs f2, kp_wbc_ave_count@sda21(r13)
/* 8006E038 00069E78 C8 04 96 58 */ lfd f0, kp_wbc_weight_ave@l(r4)
/* 8006E03C 00069E7C 38 64 96 58 */ addi r3, r4, -0x69a8
/* 8006E040 00069E80 C9 1E 00 08 */ lfd f8, 0x8(r30)
/* 8006E044 00069E84 FC 22 00 32 */ fmul f1, f2, f0
/* 8006E048 00069E88 C0 82 88 60 */ lfs f4, "@4581"@sda21(r2)
/* 8006E04C 00069E8C C8 FE 00 10 */ lfd f7, 0x10(r30)
/* 8006E050 00069E90 EC 04 10 2A */ fadds f0, f4, f2
/* 8006E054 00069E94 C8 DE 00 18 */ lfd f6, 0x18(r30)
/* 8006E058 00069E98 FC 68 38 2A */ fadd f3, f8, f7
/* 8006E05C 00069E9C FC 41 40 2A */ fadd f2, f1, f8
/* 8006E060 00069EA0 C8 BE 00 20 */ lfd f5, 0x20(r30)
/* 8006E064 00069EA4 FC 66 18 2A */ fadd f3, f6, f3
/* 8006E068 00069EA8 C8 22 88 88 */ lfd f1, "@5391"@sda21(r2)
/* 8006E06C 00069EAC FC 42 00 24 */ fdiv f2, f2, f0
/* 8006E070 00069EB0 D8 44 96 58 */ stfd f2, -0x69a8(r4)
/* 8006E074 00069EB4 FC 05 18 2A */ fadd f0, f5, f3
/* 8006E078 00069EB8 D8 5E 00 28 */ stfd f2, 0x28(r30)
/* 8006E07C 00069EBC C0 6D 84 5C */ lfs f3, kp_wbc_ave_count@sda21(r13)
/* 8006E080 00069EC0 FC 00 08 40 */ fcmpo cr0, f0, f1
/* 8006E084 00069EC4 C8 43 00 08 */ lfd f2, 0x8(r3)
/* 8006E088 00069EC8 EC 24 18 2A */ fadds f1, f4, f3
/* 8006E08C 00069ECC FC 43 00 B2 */ fmul f2, f3, f2
/* 8006E090 00069ED0 FC 42 38 2A */ fadd f2, f2, f7
/* 8006E094 00069ED4 FC 22 08 24 */ fdiv f1, f2, f1
/* 8006E098 00069ED8 D8 23 00 08 */ stfd f1, 0x8(r3)
/* 8006E09C 00069EDC D8 3E 00 30 */ stfd f1, 0x30(r30)
/* 8006E0A0 00069EE0 C0 6D 84 5C */ lfs f3, kp_wbc_ave_count@sda21(r13)
/* 8006E0A4 00069EE4 C8 43 00 10 */ lfd f2, 0x10(r3)
/* 8006E0A8 00069EE8 EC 24 18 2A */ fadds f1, f4, f3
/* 8006E0AC 00069EEC FC 43 00 B2 */ fmul f2, f3, f2
/* 8006E0B0 00069EF0 FC 42 30 2A */ fadd f2, f2, f6
/* 8006E0B4 00069EF4 FC 22 08 24 */ fdiv f1, f2, f1
/* 8006E0B8 00069EF8 D8 23 00 10 */ stfd f1, 0x10(r3)
/* 8006E0BC 00069EFC D8 3E 00 38 */ stfd f1, 0x38(r30)
/* 8006E0C0 00069F00 C0 6D 84 5C */ lfs f3, kp_wbc_ave_count@sda21(r13)
/* 8006E0C4 00069F04 C8 43 00 18 */ lfd f2, 0x18(r3)
/* 8006E0C8 00069F08 EC 24 18 2A */ fadds f1, f4, f3
/* 8006E0CC 00069F0C FC 43 00 B2 */ fmul f2, f3, f2
/* 8006E0D0 00069F10 FC 42 28 2A */ fadd f2, f2, f5
/* 8006E0D4 00069F14 FC 22 08 24 */ fdiv f1, f2, f1
/* 8006E0D8 00069F18 D8 23 00 18 */ stfd f1, 0x18(r3)
/* 8006E0DC 00069F1C D8 3E 00 40 */ stfd f1, 0x40(r30)
/* 8006E0E0 00069F20 40 81 00 10 */ ble lbl_8006E0F0
/* 8006E0E4 00069F24 38 00 FF FB */ li r0, -0x5
/* 8006E0E8 00069F28 90 1E 00 48 */ stw r0, 0x48(r30)
/* 8006E0EC 00069F2C 48 00 03 58 */ b lbl_8006E444
.global lbl_8006E0F0
lbl_8006E0F0:
/* 8006E0F0 00069F30 88 AD EA 85 */ lbz r5, kp_wbc_tgc_weight_done@sda21(r13)
/* 8006E0F4 00069F34 2C 05 00 00 */ cmpwi r5, 0x0
/* 8006E0F8 00069F38 41 82 03 4C */ beq lbl_8006E444
/* 8006E0FC 00069F3C C8 22 88 98 */ lfd f1, "@5393"@sda21(r2)
/* 8006E100 00069F40 38 8D 84 64 */ addi r4, r13, kp_wbc_stable_count@sda21
/* 8006E104 00069F44 A8 6D EA 86 */ lha r3, kp_wbc_tgc_weight_wait@sda21(r13)
/* 8006E108 00069F48 FC 40 08 24 */ fdiv f2, f0, f1
/* 8006E10C 00069F4C C8 62 88 C0 */ lfd f3, "@5403"@sda21(r2)
/* 8006E110 00069F50 38 63 00 01 */ addi r3, r3, 0x1
/* 8006E114 00069F54 C0 22 88 90 */ lfs f1, "@5392"@sda21(r2)
/* 8006E118 00069F58 7C 60 07 34 */ extsh r0, r3
/* 8006E11C 00069F5C B0 6D EA 86 */ sth r3, kp_wbc_tgc_weight_wait@sda21(r13)
/* 8006E120 00069F60 FC 40 10 1E */ fctiwz f2, f2
/* 8006E124 00069F64 2C 00 07 D0 */ cmpwi r0, 0x7d0
/* 8006E128 00069F68 D8 41 00 18 */ stfd f2, 0x18(r1)
/* 8006E12C 00069F6C 80 01 00 1C */ lwz r0, 0x1c(r1)
/* 8006E130 00069F70 54 00 06 3E */ clrlwi r0, r0, 24
/* 8006E134 00069F74 7C 04 00 AE */ lbzx r0, r4, r0
/* 8006E138 00069F78 90 01 00 0C */ stw r0, 0xc(r1)
/* 8006E13C 00069F7C C8 41 00 08 */ lfd f2, 0x8(r1)
/* 8006E140 00069F80 EC 42 18 28 */ fsubs f2, f2, f3
/* 8006E144 00069F84 EC 21 00 B2 */ fmuls f1, f1, f2
/* 8006E148 00069F88 D0 2D EA 60 */ stfs f1, kp_wbc_stable_width@sda21(r13)
/* 8006E14C 00069F8C 40 81 00 24 */ ble lbl_8006E170
/* 8006E150 00069F90 28 05 00 01 */ cmplwi r5, 0x1
/* 8006E154 00069F94 38 60 FF FF */ li r3, -0x1
/* 8006E158 00069F98 40 82 00 08 */ bne lbl_8006E160
/* 8006E15C 00069F9C 38 60 FF FD */ li r3, -0x3
.global lbl_8006E160
lbl_8006E160:
/* 8006E160 00069FA0 38 00 00 00 */ li r0, 0x0
/* 8006E164 00069FA4 98 6D EA 88 */ stb r3, kp_wbc_tgc_weight_err@sda21(r13)
/* 8006E168 00069FA8 98 0D EA 85 */ stb r0, kp_wbc_tgc_weight_done@sda21(r13)
/* 8006E16C 00069FAC 48 00 00 18 */ b lbl_8006E184
.global lbl_8006E170
lbl_8006E170:
/* 8006E170 00069FB0 C8 42 88 A0 */ lfd f2, "@5394"@sda21(r2)
/* 8006E174 00069FB4 FC 00 10 40 */ fcmpo cr0, f0, f2
/* 8006E178 00069FB8 40 80 00 0C */ bge lbl_8006E184
/* 8006E17C 00069FBC 38 00 00 01 */ li r0, 0x1
/* 8006E180 00069FC0 98 0D EA 85 */ stb r0, kp_wbc_tgc_weight_done@sda21(r13)
.global lbl_8006E184
lbl_8006E184:
/* 8006E184 00069FC4 88 0D EA 85 */ lbz r0, kp_wbc_tgc_weight_done@sda21(r13)
/* 8006E188 00069FC8 28 00 00 01 */ cmplwi r0, 0x1
/* 8006E18C 00069FCC 40 82 00 38 */ bne lbl_8006E1C4
/* 8006E190 00069FD0 C8 22 88 A0 */ lfd f1, "@5394"@sda21(r2)
/* 8006E194 00069FD4 38 00 00 01 */ li r0, 0x1
/* 8006E198 00069FD8 98 0D EA 88 */ stb r0, kp_wbc_tgc_weight_err@sda21(r13)
/* 8006E19C 00069FDC FC 00 08 40 */ fcmpo cr0, f0, f1
/* 8006E1A0 00069FE0 4C 41 13 82 */ cror eq, gt, eq
/* 8006E1A4 00069FE4 40 82 02 A0 */ bne lbl_8006E444
/* 8006E1A8 00069FE8 38 60 00 02 */ li r3, 0x2
/* 8006E1AC 00069FEC 38 00 00 00 */ li r0, 0x0
/* 8006E1B0 00069FF0 98 6D EA 85 */ stb r3, kp_wbc_tgc_weight_done@sda21(r13)
/* 8006E1B4 00069FF4 B0 0D EA 80 */ sth r0, kp_wbc_ave_sample_count@sda21(r13)
/* 8006E1B8 00069FF8 D8 0D EA 68 */ stfd f0, kp_wbc_max_weight@sda21(r13)
/* 8006E1BC 00069FFC D8 0D EA 70 */ stfd f0, kp_wbc_min_weight@sda21(r13)
/* 8006E1C0 0006A000 48 00 02 84 */ b lbl_8006E444
.global lbl_8006E1C4
lbl_8006E1C4:
/* 8006E1C4 0006A004 28 00 00 02 */ cmplwi r0, 0x2
/* 8006E1C8 0006A008 40 82 00 B8 */ bne lbl_8006E280
/* 8006E1CC 0006A00C C8 6D EA 70 */ lfd f3, kp_wbc_min_weight@sda21(r13)
/* 8006E1D0 0006A010 38 00 00 01 */ li r0, 0x1
/* 8006E1D4 0006A014 C8 42 88 A8 */ lfd f2, "@5395"@sda21(r2)
/* 8006E1D8 0006A018 FC 60 18 28 */ fsub f3, f0, f3
/* 8006E1DC 0006A01C 98 0D EA 88 */ stb r0, kp_wbc_tgc_weight_err@sda21(r13)
/* 8006E1E0 0006A020 D8 6D EA 68 */ stfd f3, kp_wbc_max_weight@sda21(r13)
/* 8006E1E4 0006A024 FC 03 10 40 */ fcmpo cr0, f3, f2
/* 8006E1E8 0006A028 40 80 00 10 */ bge lbl_8006E1F8
/* 8006E1EC 0006A02C C8 42 88 B0 */ lfd f2, "@5396"@sda21(r2)
/* 8006E1F0 0006A030 FC 63 00 B2 */ fmul f3, f3, f2
/* 8006E1F4 0006A034 D8 6D EA 68 */ stfd f3, kp_wbc_max_weight@sda21(r13)
.global lbl_8006E1F8
lbl_8006E1F8:
/* 8006E1F8 0006A038 FC 03 08 40 */ fcmpo cr0, f3, f1
/* 8006E1FC 0006A03C 40 80 00 14 */ bge lbl_8006E210
/* 8006E200 0006A040 A0 6D EA 80 */ lhz r3, kp_wbc_ave_sample_count@sda21(r13)
/* 8006E204 0006A044 38 03 00 01 */ addi r0, r3, 0x1
/* 8006E208 0006A048 B0 0D EA 80 */ sth r0, kp_wbc_ave_sample_count@sda21(r13)
/* 8006E20C 0006A04C 48 00 00 24 */ b lbl_8006E230
.global lbl_8006E210
lbl_8006E210:
/* 8006E210 0006A050 C8 6D EA 70 */ lfd f3, kp_wbc_min_weight@sda21(r13)
/* 8006E214 0006A054 38 00 00 00 */ li r0, 0x0
/* 8006E218 0006A058 C8 22 88 B8 */ lfd f1, "@5397"@sda21(r2)
/* 8006E21C 0006A05C FC 40 18 28 */ fsub f2, f0, f3
/* 8006E220 0006A060 B0 0D EA 80 */ sth r0, kp_wbc_ave_sample_count@sda21(r13)
/* 8006E224 0006A064 FC 21 00 B2 */ fmul f1, f1, f2
/* 8006E228 0006A068 FC 23 08 2A */ fadd f1, f3, f1
/* 8006E22C 0006A06C D8 2D EA 70 */ stfd f1, kp_wbc_min_weight@sda21(r13)
.global lbl_8006E230
lbl_8006E230:
/* 8006E230 0006A070 54 00 04 3E */ clrlwi r0, r0, 16
/* 8006E234 0006A074 28 00 00 64 */ cmplwi r0, 0x64
/* 8006E238 0006A078 40 81 02 0C */ ble lbl_8006E444
/* 8006E23C 0006A07C 38 60 00 03 */ li r3, 0x3
/* 8006E240 0006A080 38 00 00 01 */ li r0, 0x1
/* 8006E244 0006A084 98 6D EA 85 */ stb r3, kp_wbc_tgc_weight_done@sda21(r13)
/* 8006E248 0006A088 3C 80 80 4D */ lis r4, kp_wbc_ave_sample@ha
/* 8006E24C 0006A08C 38 64 96 78 */ addi r3, r4, kp_wbc_ave_sample@l
/* 8006E250 0006A090 B0 0D EA 80 */ sth r0, kp_wbc_ave_sample_count@sda21(r13)
/* 8006E254 0006A094 C8 3E 00 08 */ lfd f1, 0x8(r30)
/* 8006E258 0006A098 D8 24 96 78 */ stfd f1, -0x6988(r4)
/* 8006E25C 0006A09C C8 3E 00 10 */ lfd f1, 0x10(r30)
/* 8006E260 0006A0A0 D8 23 00 08 */ stfd f1, 0x8(r3)
/* 8006E264 0006A0A4 C8 3E 00 18 */ lfd f1, 0x18(r30)
/* 8006E268 0006A0A8 D8 23 00 10 */ stfd f1, 0x10(r3)
/* 8006E26C 0006A0AC C8 3E 00 20 */ lfd f1, 0x20(r30)
/* 8006E270 0006A0B0 D8 23 00 18 */ stfd f1, 0x18(r3)
/* 8006E274 0006A0B4 D8 0D EA 68 */ stfd f0, kp_wbc_max_weight@sda21(r13)
/* 8006E278 0006A0B8 D8 0D EA 70 */ stfd f0, kp_wbc_min_weight@sda21(r13)
/* 8006E27C 0006A0BC 48 00 01 C8 */ b lbl_8006E444
.global lbl_8006E280
lbl_8006E280:
/* 8006E280 0006A0C0 28 00 00 03 */ cmplwi r0, 0x3
/* 8006E284 0006A0C4 40 82 01 C0 */ bne lbl_8006E444
/* 8006E288 0006A0C8 3C 80 80 4D */ lis r4, kp_wbc_ave_sample@ha
/* 8006E28C 0006A0CC 38 00 FF FC */ li r0, -0x4
/* 8006E290 0006A0D0 38 64 96 78 */ addi r3, r4, kp_wbc_ave_sample@l
/* 8006E294 0006A0D4 C8 64 96 78 */ lfd f3, -0x6988(r4)
/* 8006E298 0006A0D8 C8 43 00 08 */ lfd f2, 0x8(r3)
/* 8006E29C 0006A0DC C8 83 00 10 */ lfd f4, 0x10(r3)
/* 8006E2A0 0006A0E0 FC A3 10 2A */ fadd f5, f3, f2
/* 8006E2A4 0006A0E4 C8 63 00 18 */ lfd f3, 0x18(r3)
/* 8006E2A8 0006A0E8 C8 42 88 A8 */ lfd f2, "@5395"@sda21(r2)
/* 8006E2AC 0006A0EC 98 0D EA 88 */ stb r0, kp_wbc_tgc_weight_err@sda21(r13)
/* 8006E2B0 0006A0F0 FC 84 28 2A */ fadd f4, f4, f5
/* 8006E2B4 0006A0F4 FC 63 20 2A */ fadd f3, f3, f4
/* 8006E2B8 0006A0F8 FC 60 18 28 */ fsub f3, f0, f3
/* 8006E2BC 0006A0FC FC 03 10 40 */ fcmpo cr0, f3, f2
/* 8006E2C0 0006A100 40 80 00 0C */ bge lbl_8006E2CC
/* 8006E2C4 0006A104 C8 02 88 B0 */ lfd f0, "@5396"@sda21(r2)
/* 8006E2C8 0006A108 FC 63 00 32 */ fmul f3, f3, f0
.global lbl_8006E2CC
lbl_8006E2CC:
/* 8006E2CC 0006A10C FC 03 08 40 */ fcmpo cr0, f3, f1
/* 8006E2D0 0006A110 4C 40 13 82 */ cror eq, lt, eq
/* 8006E2D4 0006A114 40 82 01 70 */ bne lbl_8006E444
/* 8006E2D8 0006A118 A0 AD EA 80 */ lhz r5, kp_wbc_ave_sample_count@sda21(r13)
/* 8006E2DC 0006A11C 3C 80 80 4D */ lis r4, kp_wbc_ave_sample@ha
/* 8006E2E0 0006A120 38 64 96 78 */ addi r3, r4, kp_wbc_ave_sample@l
/* 8006E2E4 0006A124 C9 82 88 70 */ lfd f12, "@4806"@sda21(r2)
/* 8006E2E8 0006A128 38 05 00 01 */ addi r0, r5, 0x1
/* 8006E2EC 0006A12C B0 0D EA 80 */ sth r0, kp_wbc_ave_sample_count@sda21(r13)
/* 8006E2F0 0006A130 54 05 04 3E */ clrlwi r5, r0, 16
/* 8006E2F4 0006A134 C8 64 96 78 */ lfd f3, -0x6988(r4)
/* 8006E2F8 0006A138 38 05 FF FF */ addi r0, r5, -0x1
/* 8006E2FC 0006A13C 90 A1 00 0C */ stw r5, 0xc(r1)
/* 8006E300 0006A140 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006E304 0006A144 C9 7E 00 08 */ lfd f11, 0x8(r30)
/* 8006E308 0006A148 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006E30C 0006A14C C8 01 00 08 */ lfd f0, 0x8(r1)
/* 8006E310 0006A150 C8 21 00 10 */ lfd f1, 0x10(r1)
/* 8006E314 0006A154 C9 42 88 C0 */ lfd f10, "@5403"@sda21(r2)
/* 8006E318 0006A158 FC 81 60 28 */ fsub f4, f1, f12
/* 8006E31C 0006A15C 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006E320 0006A160 FC 40 50 28 */ fsub f2, f0, f10
/* 8006E324 0006A164 C8 03 00 08 */ lfd f0, 0x8(r3)
/* 8006E328 0006A168 C8 21 00 10 */ lfd f1, 0x10(r1)
/* 8006E32C 0006A16C FC 64 00 F2 */ fmul f3, f4, f3
/* 8006E330 0006A170 90 A1 00 0C */ stw r5, 0xc(r1)
/* 8006E334 0006A174 FC 21 60 28 */ fsub f1, f1, f12
/* 8006E338 0006A178 C8 A3 00 10 */ lfd f5, 0x10(r3)
/* 8006E33C 0006A17C C8 81 00 08 */ lfd f4, 0x8(r1)
/* 8006E340 0006A180 FC 63 58 2A */ fadd f3, f3, f11
/* 8006E344 0006A184 FD 21 00 32 */ fmul f9, f1, f0
/* 8006E348 0006A188 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006E34C 0006A18C C8 23 00 18 */ lfd f1, 0x18(r3)
/* 8006E350 0006A190 FC C3 10 24 */ fdiv f6, f3, f2
/* 8006E354 0006A194 C8 41 00 10 */ lfd f2, 0x10(r1)
/* 8006E358 0006A198 90 A1 00 0C */ stw r5, 0xc(r1)
/* 8006E35C 0006A19C C8 61 00 08 */ lfd f3, 0x8(r1)
/* 8006E360 0006A1A0 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006E364 0006A1A4 C8 0D EA 70 */ lfd f0, kp_wbc_min_weight@sda21(r13)
/* 8006E368 0006A1A8 D8 C4 96 78 */ stfd f6, -0x6988(r4)
/* 8006E36C 0006A1AC FC C2 60 28 */ fsub f6, f2, f12
/* 8006E370 0006A1B0 FC E4 50 28 */ fsub f7, f4, f10
/* 8006E374 0006A1B4 C8 41 00 10 */ lfd f2, 0x10(r1)
/* 8006E378 0006A1B8 FC 83 50 28 */ fsub f4, f3, f10
/* 8006E37C 0006A1BC C9 1E 00 10 */ lfd f8, 0x10(r30)
/* 8006E380 0006A1C0 FC 62 60 28 */ fsub f3, f2, f12
/* 8006E384 0006A1C4 FC 49 40 2A */ fadd f2, f9, f8
/* 8006E388 0006A1C8 FC A6 01 72 */ fmul f5, f6, f5
/* 8006E38C 0006A1CC 90 A1 00 0C */ stw r5, 0xc(r1)
/* 8006E390 0006A1D0 FC C2 38 24 */ fdiv f6, f2, f7
/* 8006E394 0006A1D4 C8 41 00 08 */ lfd f2, 0x8(r1)
/* 8006E398 0006A1D8 D8 C3 00 08 */ stfd f6, 0x8(r3)
/* 8006E39C 0006A1DC FC 63 00 72 */ fmul f3, f3, f1
/* 8006E3A0 0006A1E0 C8 DE 00 18 */ lfd f6, 0x18(r30)
/* 8006E3A4 0006A1E4 FC 2B 40 2A */ fadd f1, f11, f8
/* 8006E3A8 0006A1E8 FC A5 30 2A */ fadd f5, f5, f6
/* 8006E3AC 0006A1EC FC 42 50 28 */ fsub f2, f2, f10
/* 8006E3B0 0006A1F0 FC 26 08 2A */ fadd f1, f6, f1
/* 8006E3B4 0006A1F4 FC 85 20 24 */ fdiv f4, f5, f4
/* 8006E3B8 0006A1F8 D8 83 00 10 */ stfd f4, 0x10(r3)
/* 8006E3BC 0006A1FC C8 9E 00 20 */ lfd f4, 0x20(r30)
/* 8006E3C0 0006A200 FC 63 20 2A */ fadd f3, f3, f4
/* 8006E3C4 0006A204 FC 84 08 2A */ fadd f4, f4, f1
/* 8006E3C8 0006A208 FC 23 10 24 */ fdiv f1, f3, f2
/* 8006E3CC 0006A20C D8 23 00 18 */ stfd f1, 0x18(r3)
/* 8006E3D0 0006A210 FC 00 20 40 */ fcmpo cr0, f0, f4
/* 8006E3D4 0006A214 40 81 00 08 */ ble lbl_8006E3DC
/* 8006E3D8 0006A218 D8 8D EA 70 */ stfd f4, kp_wbc_min_weight@sda21(r13)
.global lbl_8006E3DC
lbl_8006E3DC:
/* 8006E3DC 0006A21C C8 0D EA 68 */ lfd f0, kp_wbc_max_weight@sda21(r13)
/* 8006E3E0 0006A220 FC 00 20 40 */ fcmpo cr0, f0, f4
/* 8006E3E4 0006A224 40 80 00 08 */ bge lbl_8006E3EC
/* 8006E3E8 0006A228 D8 8D EA 68 */ stfd f4, kp_wbc_max_weight@sda21(r13)
.global lbl_8006E3EC
lbl_8006E3EC:
/* 8006E3EC 0006A22C 90 A1 00 14 */ stw r5, 0x14(r1)
/* 8006E3F0 0006A230 C8 42 88 C0 */ lfd f2, "@5403"@sda21(r2)
/* 8006E3F4 0006A234 C8 21 00 10 */ lfd f1, 0x10(r1)
/* 8006E3F8 0006A238 C0 0D 84 5C */ lfs f0, kp_wbc_ave_count@sda21(r13)
/* 8006E3FC 0006A23C EC 21 10 28 */ fsubs f1, f1, f2
/* 8006E400 0006A240 FC 01 00 00 */ fcmpu cr0, f1, f0
/* 8006E404 0006A244 40 82 00 40 */ bne lbl_8006E444
/* 8006E408 0006A248 3C 60 80 4D */ lis r3, kp_wbc_ave_sample@ha
/* 8006E40C 0006A24C 3B E0 00 00 */ li r31, 0x0
/* 8006E410 0006A250 38 A3 96 78 */ addi r5, r3, kp_wbc_ave_sample@l
/* 8006E414 0006A254 C8 43 96 78 */ lfd f2, -0x6988(r3)
/* 8006E418 0006A258 C8 05 00 08 */ lfd f0, 0x8(r5)
/* 8006E41C 0006A25C 7F A4 EB 78 */ mr r4, r29
/* 8006E420 0006A260 C8 25 00 10 */ lfd f1, 0x10(r5)
/* 8006E424 0006A264 38 6D EA 78 */ addi r3, r13, kp_wbc_tgc_weight@sda21
/* 8006E428 0006A268 FC 42 00 2A */ fadd f2, f2, f0
/* 8006E42C 0006A26C C8 05 00 18 */ lfd f0, 0x18(r5)
/* 8006E430 0006A270 9B ED EA 88 */ stb r31, kp_wbc_tgc_weight_err@sda21(r13)
/* 8006E434 0006A274 FC 21 10 2A */ fadd f1, f1, f2
/* 8006E438 0006A278 FC 20 08 2A */ fadd f1, f0, f1
/* 8006E43C 0006A27C 4B FE 5A 55 */ bl WBCRead
/* 8006E440 0006A280 9B ED EA 85 */ stb r31, kp_wbc_tgc_weight_done@sda21(r13)
.global lbl_8006E444
lbl_8006E444:
/* 8006E444 0006A284 C8 0D EA 78 */ lfd f0, kp_wbc_tgc_weight@sda21(r13)
/* 8006E448 0006A288 D8 1E 00 00 */ stfd f0, 0x0(r30)
/* 8006E44C 0006A28C 88 0D EA 88 */ lbz r0, kp_wbc_tgc_weight_err@sda21(r13)
/* 8006E450 0006A290 7C 00 07 74 */ extsb r0, r0
/* 8006E454 0006A294 90 1E 00 4C */ stw r0, 0x4c(r30)
/* 8006E458 0006A298 48 00 02 48 */ b lbl_8006E6A0
.global lbl_8006E45C
lbl_8006E45C:
/* 8006E45C 0006A29C 38 06 00 FB */ addi r0, r6, 0xfb
/* 8006E460 0006A2A0 54 00 06 3E */ clrlwi r0, r0, 24
/* 8006E464 0006A2A4 28 00 00 02 */ cmplwi r0, 0x2
/* 8006E468 0006A2A8 40 81 00 0C */ ble lbl_8006E474
/* 8006E46C 0006A2AC 28 06 00 FA */ cmplwi r6, 0xfa
/* 8006E470 0006A2B0 40 82 02 30 */ bne lbl_8006E6A0
.global lbl_8006E474
lbl_8006E474:
/* 8006E474 0006A2B4 88 04 00 40 */ lbz r0, 0x40(r4)
/* 8006E478 0006A2B8 28 00 00 10 */ cmplwi r0, 0x10
/* 8006E47C 0006A2BC 40 82 02 24 */ bne lbl_8006E6A0
/* 8006E480 0006A2C0 88 03 06 41 */ lbz r0, 0x641(r3)
/* 8006E484 0006A2C4 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E488 0006A2C8 41 82 00 B4 */ beq lbl_8006E53C
/* 8006E48C 0006A2CC 38 00 00 00 */ li r0, 0x0
/* 8006E490 0006A2D0 98 03 06 41 */ stb r0, 0x641(r3)
/* 8006E494 0006A2D4 88 04 00 28 */ lbz r0, 0x28(r4)
/* 8006E498 0006A2D8 28 00 00 06 */ cmplwi r0, 0x6
/* 8006E49C 0006A2DC 40 82 00 40 */ bne lbl_8006E4DC
/* 8006E4A0 0006A2E0 88 04 00 36 */ lbz r0, 0x36(r4)
/* 8006E4A4 0006A2E4 54 00 06 73 */ rlwinm. r0, r0, 0, 25, 25
/* 8006E4A8 0006A2E8 41 82 00 34 */ beq lbl_8006E4DC
/* 8006E4AC 0006A2EC 80 AD EA 58 */ lwz r5, Vec2_0@sda21(r13)
/* 8006E4B0 0006A2F0 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006E4B4 0006A2F4 C0 42 88 50 */ lfs f2, "@4535"@sda21(r2)
/* 8006E4B8 0006A2F8 C0 22 88 5C */ lfs f1, "@4580"@sda21(r2)
/* 8006E4BC 0006A2FC C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006E4C0 0006A300 90 BE 00 00 */ stw r5, 0x0(r30)
/* 8006E4C4 0006A304 90 1E 00 04 */ stw r0, 0x4(r30)
/* 8006E4C8 0006A308 D0 5E 00 10 */ stfs f2, 0x10(r30)
/* 8006E4CC 0006A30C D0 5E 00 08 */ stfs f2, 0x8(r30)
/* 8006E4D0 0006A310 D0 3E 00 0C */ stfs f1, 0xc(r30)
/* 8006E4D4 0006A314 D0 1E 00 14 */ stfs f0, 0x14(r30)
/* 8006E4D8 0006A318 D0 5E 00 18 */ stfs f2, 0x18(r30)
.global lbl_8006E4DC
lbl_8006E4DC:
/* 8006E4DC 0006A31C 88 04 00 28 */ lbz r0, 0x28(r4)
/* 8006E4E0 0006A320 28 00 00 07 */ cmplwi r0, 0x7
/* 8006E4E4 0006A324 40 82 00 58 */ bne lbl_8006E53C
/* 8006E4E8 0006A328 88 04 00 36 */ lbz r0, 0x36(r4)
/* 8006E4EC 0006A32C 54 00 06 73 */ rlwinm. r0, r0, 0, 25, 25
/* 8006E4F0 0006A330 41 82 00 4C */ beq lbl_8006E53C
/* 8006E4F4 0006A334 80 CD EA 58 */ lwz r6, Vec2_0@sda21(r13)
/* 8006E4F8 0006A338 38 A0 00 00 */ li r5, 0x0
/* 8006E4FC 0006A33C 80 0D EA 5C */ lwz r0, lbl_8055CE7C@sda21(r13)
/* 8006E500 0006A340 90 1E 00 10 */ stw r0, 0x10(r30)
/* 8006E504 0006A344 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006E508 0006A348 90 DE 00 0C */ stw r6, 0xc(r30)
/* 8006E50C 0006A34C A0 03 05 F0 */ lhz r0, 0x5f0(r3)
/* 8006E510 0006A350 80 ED EA 58 */ lwz r7, Vec2_0@sda21(r13)
/* 8006E514 0006A354 80 CD EA 5C */ lwz r6, lbl_8055CE7C@sda21(r13)
/* 8006E518 0006A358 90 DE 00 18 */ stw r6, 0x18(r30)
/* 8006E51C 0006A35C 90 FE 00 14 */ stw r7, 0x14(r30)
/* 8006E520 0006A360 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006E524 0006A364 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006E528 0006A368 90 BE 00 08 */ stw r5, 0x8(r30)
/* 8006E52C 0006A36C 90 BE 00 04 */ stw r5, 0x4(r30)
/* 8006E530 0006A370 90 BE 00 00 */ stw r5, 0x0(r30)
/* 8006E534 0006A374 B0 A3 05 F4 */ sth r5, 0x5f4(r3)
/* 8006E538 0006A378 B0 03 05 F6 */ sth r0, 0x5f6(r3)
.global lbl_8006E53C
lbl_8006E53C:
/* 8006E53C 0006A37C 88 64 00 36 */ lbz r3, 0x36(r4)
/* 8006E540 0006A380 54 60 07 FF */ clrlwi. r0, r3, 31
/* 8006E544 0006A384 41 82 01 5C */ beq lbl_8006E6A0
/* 8006E548 0006A388 54 60 06 73 */ rlwinm. r0, r3, 0, 25, 25
/* 8006E54C 0006A38C 41 82 01 54 */ beq lbl_8006E6A0
/* 8006E550 0006A390 88 04 00 28 */ lbz r0, 0x28(r4)
/* 8006E554 0006A394 28 00 00 06 */ cmplwi r0, 0x6
/* 8006E558 0006A398 40 82 00 30 */ bne lbl_8006E588
/* 8006E55C 0006A39C 88 84 00 30 */ lbz r4, 0x30(r4)
/* 8006E560 0006A3A0 7F EC FB 78 */ mr r12, r31
/* 8006E564 0006A3A4 88 BD 00 31 */ lbz r5, 0x31(r29)
/* 8006E568 0006A3A8 7F C3 F3 78 */ mr r3, r30
/* 8006E56C 0006A3AC 7C 84 07 74 */ extsb r4, r4
/* 8006E570 0006A3B0 80 CD 84 34 */ lwz r6, kp_fs_fstick_min@sda21(r13)
/* 8006E574 0006A3B4 7C A5 07 74 */ extsb r5, r5
/* 8006E578 0006A3B8 80 ED 84 38 */ lwz r7, kp_fs_fstick_max@sda21(r13)
/* 8006E57C 0006A3BC 7D 89 03 A6 */ mtctr r12
/* 8006E580 0006A3C0 4E 80 04 21 */ bctrl
/* 8006E584 0006A3C4 48 00 01 1C */ b lbl_8006E6A0
.global lbl_8006E588
lbl_8006E588:
/* 8006E588 0006A3C8 28 00 00 07 */ cmplwi r0, 0x7
/* 8006E58C 0006A3CC 40 82 01 14 */ bne lbl_8006E6A0
/* 8006E590 0006A3D0 7F EC FB 78 */ mr r12, r31
/* 8006E594 0006A3D4 38 7E 00 0C */ addi r3, r30, 0xc
/* 8006E598 0006A3D8 A8 84 00 2C */ lha r4, 0x2c(r4)
/* 8006E59C 0006A3DC A8 BD 00 2E */ lha r5, 0x2e(r29)
/* 8006E5A0 0006A3E0 80 CD 84 3C */ lwz r6, kp_cl_stick_min@sda21(r13)
/* 8006E5A4 0006A3E4 80 ED 84 40 */ lwz r7, kp_cl_stick_max@sda21(r13)
/* 8006E5A8 0006A3E8 7D 89 03 A6 */ mtctr r12
/* 8006E5AC 0006A3EC 4E 80 04 21 */ bctrl
/* 8006E5B0 0006A3F0 7F EC FB 78 */ mr r12, r31
/* 8006E5B4 0006A3F4 38 7E 00 14 */ addi r3, r30, 0x14
/* 8006E5B8 0006A3F8 A8 9D 00 30 */ lha r4, 0x30(r29)
/* 8006E5BC 0006A3FC A8 BD 00 32 */ lha r5, 0x32(r29)
/* 8006E5C0 0006A400 80 CD 84 3C */ lwz r6, kp_cl_stick_min@sda21(r13)
/* 8006E5C4 0006A404 80 ED 84 40 */ lwz r7, kp_cl_stick_max@sda21(r13)
/* 8006E5C8 0006A408 7D 89 03 A6 */ mtctr r12
/* 8006E5CC 0006A40C 4E 80 04 21 */ bctrl
/* 8006E5D0 0006A410 80 8D 84 44 */ lwz r4, kp_cl_trigger_min@sda21(r13)
/* 8006E5D4 0006A414 88 7D 00 34 */ lbz r3, 0x34(r29)
/* 8006E5D8 0006A418 80 0D 84 48 */ lwz r0, kp_cl_trigger_max@sda21(r13)
/* 8006E5DC 0006A41C 7C 03 20 00 */ cmpw r3, r4
/* 8006E5E0 0006A420 41 81 00 10 */ bgt lbl_8006E5F0
/* 8006E5E4 0006A424 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006E5E8 0006A428 D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006E5EC 0006A42C 48 00 00 4C */ b lbl_8006E638
.global lbl_8006E5F0
lbl_8006E5F0:
/* 8006E5F0 0006A430 7C 03 00 00 */ cmpw r3, r0
/* 8006E5F4 0006A434 41 80 00 10 */ blt lbl_8006E604
/* 8006E5F8 0006A438 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006E5FC 0006A43C D0 1E 00 1C */ stfs f0, 0x1c(r30)
/* 8006E600 0006A440 48 00 00 38 */ b lbl_8006E638
.global lbl_8006E604
lbl_8006E604:
/* 8006E604 0006A444 7C 64 18 50 */ subf r3, r4, r3
/* 8006E608 0006A448 7C 04 00 50 */ subf r0, r4, r0
/* 8006E60C 0006A44C 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006E610 0006A450 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006E614 0006A454 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006E618 0006A458 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006E61C 0006A45C 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006E620 0006A460 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006E624 0006A464 C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006E628 0006A468 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006E62C 0006A46C EC 00 10 28 */ fsubs f0, f0, f2
/* 8006E630 0006A470 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006E634 0006A474 D0 1E 00 1C */ stfs f0, 0x1c(r30)
.global lbl_8006E638
lbl_8006E638:
/* 8006E638 0006A478 80 8D 84 44 */ lwz r4, kp_cl_trigger_min@sda21(r13)
/* 8006E63C 0006A47C 88 7D 00 35 */ lbz r3, 0x35(r29)
/* 8006E640 0006A480 80 0D 84 48 */ lwz r0, kp_cl_trigger_max@sda21(r13)
/* 8006E644 0006A484 7C 03 20 00 */ cmpw r3, r4
/* 8006E648 0006A488 41 81 00 10 */ bgt lbl_8006E658
/* 8006E64C 0006A48C C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006E650 0006A490 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006E654 0006A494 48 00 00 4C */ b lbl_8006E6A0
.global lbl_8006E658
lbl_8006E658:
/* 8006E658 0006A498 7C 03 00 00 */ cmpw r3, r0
/* 8006E65C 0006A49C 41 80 00 10 */ blt lbl_8006E66C
/* 8006E660 0006A4A0 C0 02 88 60 */ lfs f0, "@4581"@sda21(r2)
/* 8006E664 0006A4A4 D0 1E 00 20 */ stfs f0, 0x20(r30)
/* 8006E668 0006A4A8 48 00 00 38 */ b lbl_8006E6A0
.global lbl_8006E66C
lbl_8006E66C:
/* 8006E66C 0006A4AC 7C 64 18 50 */ subf r3, r4, r3
/* 8006E670 0006A4B0 7C 04 00 50 */ subf r0, r4, r0
/* 8006E674 0006A4B4 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006E678 0006A4B8 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006E67C 0006A4BC 6C 00 80 00 */ xoris r0, r0, 0x8000
/* 8006E680 0006A4C0 C8 42 88 70 */ lfd f2, "@4806"@sda21(r2)
/* 8006E684 0006A4C4 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006E688 0006A4C8 C8 21 00 08 */ lfd f1, 0x8(r1)
/* 8006E68C 0006A4CC C8 01 00 10 */ lfd f0, 0x10(r1)
/* 8006E690 0006A4D0 EC 21 10 28 */ fsubs f1, f1, f2
/* 8006E694 0006A4D4 EC 00 10 28 */ fsubs f0, f0, f2
/* 8006E698 0006A4D8 EC 01 00 24 */ fdivs f0, f1, f0
/* 8006E69C 0006A4DC D0 1E 00 20 */ stfs f0, 0x20(r30)
.global lbl_8006E6A0
lbl_8006E6A0:
/* 8006E6A0 0006A4E0 80 01 00 34 */ lwz r0, 0x34(r1)
/* 8006E6A4 0006A4E4 83 E1 00 2C */ lwz r31, 0x2c(r1)
/* 8006E6A8 0006A4E8 83 C1 00 28 */ lwz r30, 0x28(r1)
/* 8006E6AC 0006A4EC 83 A1 00 24 */ lwz r29, 0x24(r1)
/* 8006E6B0 0006A4F0 7C 08 03 A6 */ mtlr r0
/* 8006E6B4 0006A4F4 38 21 00 30 */ addi r1, r1, 0x30
/* 8006E6B8 0006A4F8 4E 80 00 20 */ blr
/* 8006E6BC 0006A4FC 00 00 00 00 */ .4byte 0x00000000
.global KPADiMplsSamplingCallback
KPADiMplsSamplingCallback:
/* 8006E6C0 0006A500 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006E6C4 0006A504 3C 60 80 4C */ lis r3, inside_kpads@ha
/* 8006E6C8 0006A508 38 63 7C 08 */ addi r3, r3, inside_kpads@l
/* 8006E6CC 0006A50C 7C C3 02 14 */ add r6, r3, r0
/* 8006E6D0 0006A510 80 66 01 7C */ lwz r3, 0x17c(r6)
/* 8006E6D4 0006A514 2C 03 00 00 */ cmpwi r3, 0x0
/* 8006E6D8 0006A518 4D 82 00 20 */ beqlr
/* 8006E6DC 0006A51C 38 A3 FF 10 */ addi r5, r3, -0xf0
/* 8006E6E0 0006A520 90 A6 01 7C */ stw r5, 0x17c(r6)
/* 8006E6E4 0006A524 80 04 00 04 */ lwz r0, 0x4(r4)
/* 8006E6E8 0006A528 80 64 00 00 */ lwz r3, 0x0(r4)
/* 8006E6EC 0006A52C 90 65 00 B0 */ stw r3, 0xb0(r5)
/* 8006E6F0 0006A530 90 05 00 B4 */ stw r0, 0xb4(r5)
/* 8006E6F4 0006A534 80 04 00 0C */ lwz r0, 0xc(r4)
/* 8006E6F8 0006A538 80 64 00 08 */ lwz r3, 0x8(r4)
/* 8006E6FC 0006A53C 90 65 00 B8 */ stw r3, 0xb8(r5)
/* 8006E700 0006A540 90 05 00 BC */ stw r0, 0xbc(r5)
/* 8006E704 0006A544 80 04 00 14 */ lwz r0, 0x14(r4)
/* 8006E708 0006A548 80 64 00 10 */ lwz r3, 0x10(r4)
/* 8006E70C 0006A54C 90 65 00 C0 */ stw r3, 0xc0(r5)
/* 8006E710 0006A550 90 05 00 C4 */ stw r0, 0xc4(r5)
/* 8006E714 0006A554 80 04 00 1C */ lwz r0, 0x1c(r4)
/* 8006E718 0006A558 80 64 00 18 */ lwz r3, 0x18(r4)
/* 8006E71C 0006A55C 90 65 00 C8 */ stw r3, 0xc8(r5)
/* 8006E720 0006A560 90 05 00 CC */ stw r0, 0xcc(r5)
/* 8006E724 0006A564 80 04 00 24 */ lwz r0, 0x24(r4)
/* 8006E728 0006A568 80 64 00 20 */ lwz r3, 0x20(r4)
/* 8006E72C 0006A56C 90 65 00 D0 */ stw r3, 0xd0(r5)
/* 8006E730 0006A570 90 05 00 D4 */ stw r0, 0xd4(r5)
/* 8006E734 0006A574 80 04 00 2C */ lwz r0, 0x2c(r4)
/* 8006E738 0006A578 80 64 00 28 */ lwz r3, 0x28(r4)
/* 8006E73C 0006A57C 90 65 00 D8 */ stw r3, 0xd8(r5)
/* 8006E740 0006A580 90 05 00 DC */ stw r0, 0xdc(r5)
/* 8006E744 0006A584 80 04 00 34 */ lwz r0, 0x34(r4)
/* 8006E748 0006A588 80 64 00 30 */ lwz r3, 0x30(r4)
/* 8006E74C 0006A58C 90 65 00 E0 */ stw r3, 0xe0(r5)
/* 8006E750 0006A590 90 05 00 E4 */ stw r0, 0xe4(r5)
/* 8006E754 0006A594 80 04 00 38 */ lwz r0, 0x38(r4)
/* 8006E758 0006A598 90 05 00 E8 */ stw r0, 0xe8(r5)
/* 8006E75C 0006A59C 4E 80 00 20 */ blr
.global KPADRead
KPADRead:
/* 8006E760 0006A5A0 38 C0 00 00 */ li r6, 0x0
/* 8006E764 0006A5A4 38 E0 00 00 */ li r7, 0x0
/* 8006E768 0006A5A8 48 00 00 08 */ b KPADiRead
/* 8006E76C 0006A5AC 00 00 00 00 */ .4byte 0x00000000
.global KPADiRead
KPADiRead:
/* 8006E770 0006A5B0 94 21 FD C0 */ stwu r1, -0x240(r1)
/* 8006E774 0006A5B4 7C 08 02 A6 */ mflr r0
/* 8006E778 0006A5B8 90 01 02 44 */ stw r0, 0x244(r1)
/* 8006E77C 0006A5BC 39 61 02 38 */ addi r11, r1, 0x238
/* 8006E780 0006A5C0 DB E1 02 38 */ stfd f31, 0x238(r1)
/* 8006E784 0006A5C4 4B F9 8B 91 */ bl lbl_80007314
/* 8006E788 0006A5C8 88 0D EA 54 */ lbz r0, kp_initialized@sda21(r13)
/* 8006E78C 0006A5CC 3D 00 80 4C */ lis r8, inside_kpads@ha
/* 8006E790 0006A5D0 1D 23 06 88 */ mulli r9, r3, 0x688
/* 8006E794 0006A5D4 7C 79 1B 78 */ mr r25, r3
/* 8006E798 0006A5D8 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E79C 0006A5DC 39 08 7C 08 */ addi r8, r8, inside_kpads@l
/* 8006E7A0 0006A5E0 7C 9A 23 78 */ mr r26, r4
/* 8006E7A4 0006A5E4 7C B3 2B 78 */ mr r19, r5
/* 8006E7A8 0006A5E8 7C DB 33 78 */ mr r27, r6
/* 8006E7AC 0006A5EC 7C FC 3B 78 */ mr r28, r7
/* 8006E7B0 0006A5F0 7E A8 4A 14 */ add r21, r8, r9
/* 8006E7B4 0006A5F4 3B E0 00 00 */ li r31, 0x0
/* 8006E7B8 0006A5F8 3B A0 00 00 */ li r29, 0x0
/* 8006E7BC 0006A5FC 40 82 00 0C */ bne lbl_8006E7C8
/* 8006E7C0 0006A600 3B E0 FF FB */ li r31, -0x5
/* 8006E7C4 0006A604 48 00 07 18 */ b lbl_8006EEDC
.global lbl_8006E7C8
lbl_8006E7C8:
/* 8006E7C8 0006A608 4B FE 7C D9 */ bl WPADGetStatus
/* 8006E7CC 0006A60C 2C 03 00 03 */ cmpwi r3, 0x3
/* 8006E7D0 0006A610 41 82 00 0C */ beq lbl_8006E7DC
/* 8006E7D4 0006A614 3B E0 FF FD */ li r31, -0x3
/* 8006E7D8 0006A618 48 00 07 04 */ b lbl_8006EEDC
.global lbl_8006E7DC
lbl_8006E7DC:
/* 8006E7DC 0006A61C 4B FB 30 45 */ bl OSDisableInterrupts
/* 8006E7E0 0006A620 88 15 05 EB */ lbz r0, 0x5eb(r21)
/* 8006E7E4 0006A624 7C 72 1B 78 */ mr r18, r3
/* 8006E7E8 0006A628 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E7EC 0006A62C 41 82 00 10 */ beq lbl_8006E7FC
/* 8006E7F0 0006A630 4B FB 30 71 */ bl OSRestoreInterrupts
/* 8006E7F4 0006A634 3B E0 FF FC */ li r31, -0x4
/* 8006E7F8 0006A638 48 00 06 E4 */ b lbl_8006EEDC
.global lbl_8006E7FC
lbl_8006E7FC:
/* 8006E7FC 0006A63C 3A 20 00 01 */ li r17, 0x1
/* 8006E800 0006A640 9A 35 05 EB */ stb r17, 0x5eb(r21)
/* 8006E804 0006A644 7F 23 CB 78 */ mr r3, r25
/* 8006E808 0006A648 38 80 00 00 */ li r4, 0x0
/* 8006E80C 0006A64C 4B FE 93 A5 */ bl WPADProbe
/* 8006E810 0006A650 2C 03 FF FF */ cmpwi r3, -0x1
/* 8006E814 0006A654 40 82 00 B4 */ bne lbl_8006E8C8
/* 8006E818 0006A658 7F 23 CB 78 */ mr r3, r25
/* 8006E81C 0006A65C 4B FF CB 55 */ bl reset_kpad
/* 8006E820 0006A660 80 15 05 F8 */ lwz r0, 0x5f8(r21)
/* 8006E824 0006A664 2C 80 00 00 */ cmpwi cr1, r0, 0x0
/* 8006E828 0006A668 41 86 00 58 */ beq cr1, lbl_8006E880
/* 8006E82C 0006A66C 88 15 06 46 */ lbz r0, 0x646(r21)
/* 8006E830 0006A670 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E834 0006A674 41 82 00 4C */ beq lbl_8006E880
/* 8006E838 0006A678 88 15 06 47 */ lbz r0, 0x647(r21)
/* 8006E83C 0006A67C 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E840 0006A680 40 82 00 40 */ bne lbl_8006E880
/* 8006E844 0006A684 41 86 00 28 */ beq cr1, lbl_8006E86C
/* 8006E848 0006A688 40 82 00 24 */ bne lbl_8006E86C
/* 8006E84C 0006A68C 9A 35 06 47 */ stb r17, 0x647(r21)
/* 8006E850 0006A690 7F 23 CB 78 */ mr r3, r25
/* 8006E854 0006A694 38 80 00 01 */ li r4, 0x1
/* 8006E858 0006A698 81 95 05 F8 */ lwz r12, 0x5f8(r21)
/* 8006E85C 0006A69C 7D 89 03 A6 */ mtctr r12
/* 8006E860 0006A6A0 4E 80 04 21 */ bctrl
/* 8006E864 0006A6A4 38 00 00 00 */ li r0, 0x0
/* 8006E868 0006A6A8 98 15 06 46 */ stb r0, 0x646(r21)
.global lbl_8006E86C
lbl_8006E86C:
/* 8006E86C 0006A6AC 7F 23 CB 78 */ mr r3, r25
/* 8006E870 0006A6B0 4B FE BB F1 */ bl WPADIsDpdEnabled
/* 8006E874 0006A6B4 98 75 06 43 */ stb r3, 0x643(r21)
/* 8006E878 0006A6B8 38 00 00 00 */ li r0, 0x0
/* 8006E87C 0006A6BC 98 15 06 44 */ stb r0, 0x644(r21)
.global lbl_8006E880
lbl_8006E880:
/* 8006E880 0006A6C0 80 15 06 80 */ lwz r0, 0x680(r21)
/* 8006E884 0006A6C4 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E888 0006A6C8 41 82 00 28 */ beq lbl_8006E8B0
/* 8006E88C 0006A6CC 88 15 06 7B */ lbz r0, 0x67b(r21)
/* 8006E890 0006A6D0 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E894 0006A6D4 41 82 00 1C */ beq lbl_8006E8B0
/* 8006E898 0006A6D8 88 15 06 7C */ lbz r0, 0x67c(r21)
/* 8006E89C 0006A6DC 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E8A0 0006A6E0 40 82 00 10 */ bne lbl_8006E8B0
/* 8006E8A4 0006A6E4 7F 23 CB 78 */ mr r3, r25
/* 8006E8A8 0006A6E8 38 80 00 00 */ li r4, 0x0
/* 8006E8AC 0006A6EC 48 00 10 35 */ bl KPADiControlMplsCallback
.global lbl_8006E8B0
lbl_8006E8B0:
/* 8006E8B0 0006A6F0 38 00 00 00 */ li r0, 0x0
/* 8006E8B4 0006A6F4 98 15 05 EB */ stb r0, 0x5eb(r21)
/* 8006E8B8 0006A6F8 7E 43 93 78 */ mr r3, r18
/* 8006E8BC 0006A6FC 4B FB 2F A5 */ bl OSRestoreInterrupts
/* 8006E8C0 0006A700 3B E0 FF FE */ li r31, -0x2
/* 8006E8C4 0006A704 48 00 06 18 */ b lbl_8006EEDC
.global lbl_8006E8C8
lbl_8006E8C8:
/* 8006E8C8 0006A708 7E 43 93 78 */ mr r3, r18
/* 8006E8CC 0006A70C 4B FB 2F 95 */ bl OSRestoreInterrupts
/* 8006E8D0 0006A710 88 15 06 40 */ lbz r0, 0x640(r21)
/* 8006E8D4 0006A714 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E8D8 0006A718 41 82 00 14 */ beq lbl_8006E8EC
/* 8006E8DC 0006A71C 38 00 FF FC */ li r0, -0x4
/* 8006E8E0 0006A720 98 15 00 5D */ stb r0, 0x5d(r21)
/* 8006E8E4 0006A724 7F 23 CB 78 */ mr r3, r25
/* 8006E8E8 0006A728 4B FF CA 89 */ bl reset_kpad
.global lbl_8006E8EC
lbl_8006E8EC:
/* 8006E8EC 0006A72C 38 00 00 1E */ li r0, 0x1e
/* 8006E8F0 0006A730 38 A1 00 F4 */ addi r5, r1, 0xf4
/* 8006E8F4 0006A734 38 9A FF FC */ addi r4, r26, -0x4
/* 8006E8F8 0006A738 7C 09 03 A6 */ mtctr r0
/* 8006E8FC 0006A73C 60 00 00 00 */ nop
.global lbl_8006E900
lbl_8006E900:
/* 8006E900 0006A740 80 64 00 04 */ lwz r3, 0x4(r4)
/* 8006E904 0006A744 84 04 00 08 */ lwzu r0, 0x8(r4)
/* 8006E908 0006A748 90 65 00 04 */ stw r3, 0x4(r5)
/* 8006E90C 0006A74C 94 05 00 08 */ stwu r0, 0x8(r5)
/* 8006E910 0006A750 42 00 FF F0 */ bdnz lbl_8006E900
/* 8006E914 0006A754 88 15 01 7B */ lbz r0, 0x17b(r21)
/* 8006E918 0006A758 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006E91C 0006A75C 41 82 05 B8 */ beq lbl_8006EED4
/* 8006E920 0006A760 2C 1A 00 00 */ cmpwi r26, 0x0
/* 8006E924 0006A764 41 82 05 B0 */ beq lbl_8006EED4
/* 8006E928 0006A768 2C 13 00 00 */ cmpwi r19, 0x0
/* 8006E92C 0006A76C 41 82 05 A8 */ beq lbl_8006EED4
/* 8006E930 0006A770 4B FB 2E F1 */ bl OSDisableInterrupts
/* 8006E934 0006A774 8A 55 01 7B */ lbz r18, 0x17b(r21)
/* 8006E938 0006A778 7C 74 1B 78 */ mr r20, r3
/* 8006E93C 0006A77C 7C 12 98 40 */ cmplw r18, r19
/* 8006E940 0006A780 40 81 00 08 */ ble lbl_8006E948
/* 8006E944 0006A784 7E 72 9B 78 */ mr r18, r19
.global lbl_8006E948
lbl_8006E948:
/* 8006E948 0006A788 38 C0 00 00 */ li r6, 0x0
/* 8006E94C 0006A78C 98 D5 01 7B */ stb r6, 0x17b(r21)
/* 8006E950 0006A790 38 80 00 01 */ li r4, 0x1
/* 8006E954 0006A794 38 00 FF FF */ li r0, -0x1
/* 8006E958 0006A798 80 F5 06 60 */ lwz r7, 0x660(r21)
/* 8006E95C 0006A79C 38 60 00 00 */ li r3, 0x0
/* 8006E960 0006A7A0 80 B5 06 64 */ lwz r5, 0x664(r21)
/* 8006E964 0006A7A4 90 B5 06 60 */ stw r5, 0x660(r21)
/* 8006E968 0006A7A8 80 B5 06 68 */ lwz r5, 0x668(r21)
/* 8006E96C 0006A7AC 90 B5 06 64 */ stw r5, 0x664(r21)
/* 8006E970 0006A7B0 80 B5 06 6C */ lwz r5, 0x66c(r21)
/* 8006E974 0006A7B4 90 B5 06 68 */ stw r5, 0x668(r21)
/* 8006E978 0006A7B8 80 B5 06 6C */ lwz r5, 0x66c(r21)
/* 8006E97C 0006A7BC 7C A5 30 14 */ addc r5, r5, r6
/* 8006E980 0006A7C0 7C 86 21 14 */ adde r4, r6, r4
/* 8006E984 0006A7C4 7C 87 28 10 */ subfc r4, r7, r5
/* 8006E988 0006A7C8 7C 84 00 38 */ and r4, r4, r0
/* 8006E98C 0006A7CC 4B F9 8E 4D */ bl __cvt_sll_dbl
/* 8006E990 0006A7D0 3C 60 80 00 */ lis r3, 0x800000F8@ha
/* 8006E994 0006A7D4 3C 00 43 30 */ lis r0, 0x4330
/* 8006E998 0006A7D8 80 63 00 F8 */ lwz r3, 0x800000F8@l(r3)
/* 8006E99C 0006A7DC 90 01 01 E8 */ stw r0, 0x1e8(r1)
/* 8006E9A0 0006A7E0 54 60 F0 BE */ srwi r0, r3, 2
/* 8006E9A4 0006A7E4 C8 62 88 C0 */ lfd f3, "@5403"@sda21(r2)
/* 8006E9A8 0006A7E8 90 01 01 EC */ stw r0, 0x1ec(r1)
/* 8006E9AC 0006A7EC C8 02 88 C8 */ lfd f0, "@5550"@sda21(r2)
/* 8006E9B0 0006A7F0 C8 41 01 E8 */ lfd f2, 0x1e8(r1)
/* 8006E9B4 0006A7F4 FC 42 18 28 */ fsub f2, f2, f3
/* 8006E9B8 0006A7F8 FC 41 10 24 */ fdiv f2, f1, f2
/* 8006E9BC 0006A7FC FC 02 00 40 */ fcmpo cr0, f2, f0
/* 8006E9C0 0006A800 40 81 00 08 */ ble lbl_8006E9C8
/* 8006E9C4 0006A804 FC 40 00 90 */ fmr f2, f0
.global lbl_8006E9C8
lbl_8006E9C8:
/* 8006E9C8 0006A808 88 75 06 74 */ lbz r3, 0x674(r21)
/* 8006E9CC 0006A80C 3C 80 43 30 */ lis r4, 0x4330
/* 8006E9D0 0006A810 88 B5 06 75 */ lbz r5, 0x675(r21)
/* 8006E9D4 0006A814 1C 12 00 F0 */ mulli r0, r18, 0xf0
/* 8006E9D8 0006A818 7C 72 1A 14 */ add r3, r18, r3
/* 8006E9DC 0006A81C 98 B5 06 74 */ stb r5, 0x674(r21)
/* 8006E9E0 0006A820 C8 22 88 C0 */ lfd f1, "@5403"@sda21(r2)
/* 8006E9E4 0006A824 7E 5D 93 78 */ mr r29, r18
/* 8006E9E8 0006A828 7C 65 1A 14 */ add r3, r5, r3
/* 8006E9EC 0006A82C 90 61 01 F4 */ stw r3, 0x1f4(r1)
/* 8006E9F0 0006A830 7C 7A 02 14 */ add r3, r26, r0
/* 8006E9F4 0006A834 90 81 01 F0 */ stw r4, 0x1f0(r1)
/* 8006E9F8 0006A838 C8 01 01 F0 */ lfd f0, 0x1f0(r1)
/* 8006E9FC 0006A83C 9A 55 06 75 */ stb r18, 0x675(r21)
/* 8006EA00 0006A840 FC 00 08 28 */ fsub f0, f0, f1
/* 8006EA04 0006A844 88 15 01 7A */ lbz r0, 0x17a(r21)
/* 8006EA08 0006A848 FF E2 00 24 */ fdiv f31, f2, f0
/* 8006EA0C 0006A84C 7F D2 00 51 */ subf. r30, r18, r0
/* 8006EA10 0006A850 40 80 00 10 */ bge lbl_8006EA20
/* 8006EA14 0006A854 80 15 05 A4 */ lwz r0, 0x5a4(r21)
/* 8006EA18 0006A858 7C 9E 02 14 */ add r4, r30, r0
/* 8006EA1C 0006A85C 3B C4 00 10 */ addi r30, r4, 0x10
.global lbl_8006EA20
lbl_8006EA20:
/* 8006EA20 0006A860 38 A0 00 08 */ li r5, 0x8
/* 8006EA24 0006A864 60 00 00 00 */ nop
.global lbl_8006EA28
lbl_8006EA28:
/* 8006EA28 0006A868 2C 1E 00 10 */ cmpwi r30, 0x10
/* 8006EA2C 0006A86C 41 80 00 18 */ blt lbl_8006EA44
/* 8006EA30 0006A870 38 1E FF F0 */ addi r0, r30, -0x10
/* 8006EA34 0006A874 80 95 05 A0 */ lwz r4, 0x5a0(r21)
/* 8006EA38 0006A878 1C 00 00 42 */ mulli r0, r0, 0x42
/* 8006EA3C 0006A87C 7C 84 02 14 */ add r4, r4, r0
/* 8006EA40 0006A880 48 00 00 10 */ b lbl_8006EA50
.global lbl_8006EA44
lbl_8006EA44:
/* 8006EA44 0006A884 1C 1E 00 42 */ mulli r0, r30, 0x42
/* 8006EA48 0006A888 7C 95 02 14 */ add r4, r21, r0
/* 8006EA4C 0006A88C 38 84 01 80 */ addi r4, r4, 0x180
.global lbl_8006EA50
lbl_8006EA50:
/* 8006EA50 0006A890 38 E3 FF 0C */ addi r7, r3, -0xf4
/* 8006EA54 0006A894 38 C4 FF FC */ addi r6, r4, -0x4
/* 8006EA58 0006A898 7C A9 03 A6 */ mtctr r5
/* 8006EA5C 0006A89C 38 63 FF 10 */ addi r3, r3, -0xf0
.global lbl_8006EA60
lbl_8006EA60:
/* 8006EA60 0006A8A0 80 86 00 04 */ lwz r4, 0x4(r6)
/* 8006EA64 0006A8A4 84 06 00 08 */ lwzu r0, 0x8(r6)
/* 8006EA68 0006A8A8 90 87 00 04 */ stw r4, 0x4(r7)
/* 8006EA6C 0006A8AC 94 07 00 08 */ stwu r0, 0x8(r7)
/* 8006EA70 0006A8B0 42 00 FF F0 */ bdnz lbl_8006EA60
/* 8006EA74 0006A8B4 A0 06 00 04 */ lhz r0, 0x4(r6)
/* 8006EA78 0006A8B8 3B DE 00 01 */ addi r30, r30, 0x1
/* 8006EA7C 0006A8BC B0 07 00 04 */ sth r0, 0x4(r7)
/* 8006EA80 0006A8C0 80 95 05 A4 */ lwz r4, 0x5a4(r21)
/* 8006EA84 0006A8C4 38 04 00 10 */ addi r0, r4, 0x10
/* 8006EA88 0006A8C8 7C 1E 00 40 */ cmplw r30, r0
/* 8006EA8C 0006A8CC 41 80 00 08 */ blt lbl_8006EA94
/* 8006EA90 0006A8D0 3B C0 00 00 */ li r30, 0x0
.global lbl_8006EA94
lbl_8006EA94:
/* 8006EA94 0006A8D4 36 52 FF FF */ addic. r18, r18, -0x1
/* 8006EA98 0006A8D8 41 81 FF 90 */ bgt lbl_8006EA28
/* 8006EA9C 0006A8DC 7E 83 A3 78 */ mr r3, r20
/* 8006EAA0 0006A8E0 4B FB 2D C1 */ bl OSRestoreInterrupts
/* 8006EAA4 0006A8E4 1C 7D 00 F0 */ mulli r3, r29, 0xf0
/* 8006EAA8 0006A8E8 88 15 06 4B */ lbz r0, 0x64b(r21)
/* 8006EAAC 0006A8EC 7F B3 EB 78 */ mr r19, r29
/* 8006EAB0 0006A8F0 28 00 00 01 */ cmplwi r0, 0x1
/* 8006EAB4 0006A8F4 7E 9A 1A 14 */ add r20, r26, r3
/* 8006EAB8 0006A8F8 7E 92 A3 78 */ mr r18, r20
/* 8006EABC 0006A8FC 40 82 01 AC */ bne lbl_8006EC68
/* 8006EAC0 0006A900 3A C0 00 01 */ li r22, 0x1
/* 8006EAC4 0006A904 3E E0 00 01 */ lis r23, 0x1
/* 8006EAC8 0006A908 3B 00 00 00 */ li r24, 0x0
/* 8006EACC 0006A90C 3A 20 00 1E */ li r17, 0x1e
.global lbl_8006EAD0
lbl_8006EAD0:
/* 8006EAD0 0006A910 88 72 FF 38 */ lbz r3, -0xc8(r18)
/* 8006EAD4 0006A914 3A 52 FF 10 */ addi r18, r18, -0xf0
/* 8006EAD8 0006A918 88 15 00 5C */ lbz r0, 0x5c(r21)
/* 8006EADC 0006A91C 7C 00 18 40 */ cmplw r0, r3
/* 8006EAE0 0006A920 41 82 00 0C */ beq lbl_8006EAEC
/* 8006EAE4 0006A924 98 75 00 5C */ stb r3, 0x5c(r21)
/* 8006EAE8 0006A928 9A D5 06 41 */ stb r22, 0x641(r21)
.global lbl_8006EAEC
lbl_8006EAEC:
/* 8006EAEC 0006A92C 88 12 00 29 */ lbz r0, 0x29(r18)
/* 8006EAF0 0006A930 39 17 FF FF */ addi r8, r23, -0x1
/* 8006EAF4 0006A934 98 15 00 5D */ stb r0, 0x5d(r21)
/* 8006EAF8 0006A938 7D 07 43 78 */ mr r7, r8
/* 8006EAFC 0006A93C 7C 00 07 75 */ extsb. r0, r0
/* 8006EB00 0006A940 7D 06 43 78 */ mr r6, r8
/* 8006EB04 0006A944 88 72 00 40 */ lbz r3, 0x40(r18)
/* 8006EB08 0006A948 98 75 00 5F */ stb r3, 0x5f(r21)
/* 8006EB0C 0006A94C 88 95 00 5C */ lbz r4, 0x5c(r21)
/* 8006EB10 0006A950 41 82 00 18 */ beq lbl_8006EB28
/* 8006EB14 0006A954 2C 00 FF F9 */ cmpwi r0, -0x7
/* 8006EB18 0006A958 41 82 00 9C */ beq lbl_8006EBB4
/* 8006EB1C 0006A95C 2C 00 FF FE */ cmpwi r0, -0x2
/* 8006EB20 0006A960 41 82 00 94 */ beq lbl_8006EBB4
/* 8006EB24 0006A964 48 00 00 98 */ b lbl_8006EBBC
.global lbl_8006EB28
lbl_8006EB28:
/* 8006EB28 0006A968 28 04 00 01 */ cmplwi r4, 0x1
/* 8006EB2C 0006A96C 40 82 00 10 */ bne lbl_8006EB3C
/* 8006EB30 0006A970 A0 F2 00 00 */ lhz r7, 0x0(r18)
/* 8006EB34 0006A974 39 00 00 00 */ li r8, 0x0
/* 8006EB38 0006A978 48 00 00 7C */ b lbl_8006EBB4
.global lbl_8006EB3C
lbl_8006EB3C:
/* 8006EB3C 0006A97C 28 04 00 02 */ cmplwi r4, 0x2
/* 8006EB40 0006A980 41 82 00 10 */ beq lbl_8006EB50
/* 8006EB44 0006A984 38 04 FF F0 */ addi r0, r4, -0x10
/* 8006EB48 0006A988 28 00 00 03 */ cmplwi r0, 0x3
/* 8006EB4C 0006A98C 41 81 00 10 */ bgt lbl_8006EB5C
.global lbl_8006EB50
lbl_8006EB50:
/* 8006EB50 0006A990 A1 12 00 2A */ lhz r8, 0x2a(r18)
/* 8006EB54 0006A994 38 E0 00 00 */ li r7, 0x0
/* 8006EB58 0006A998 48 00 00 5C */ b lbl_8006EBB4
.global lbl_8006EB5C
lbl_8006EB5C:
/* 8006EB5C 0006A99C 28 04 00 06 */ cmplwi r4, 0x6
/* 8006EB60 0006A9A0 40 82 00 24 */ bne lbl_8006EB84
/* 8006EB64 0006A9A4 88 72 00 36 */ lbz r3, 0x36(r18)
/* 8006EB68 0006A9A8 54 60 06 73 */ rlwinm. r0, r3, 0, 25, 25
/* 8006EB6C 0006A9AC 41 82 00 18 */ beq lbl_8006EB84
/* 8006EB70 0006A9B0 54 60 07 FF */ clrlwi. r0, r3, 31
/* 8006EB74 0006A9B4 41 82 00 10 */ beq lbl_8006EB84
/* 8006EB78 0006A9B8 A0 F2 00 00 */ lhz r7, 0x0(r18)
/* 8006EB7C 0006A9BC 39 00 00 00 */ li r8, 0x0
/* 8006EB80 0006A9C0 48 00 00 34 */ b lbl_8006EBB4
.global lbl_8006EB84
lbl_8006EB84:
/* 8006EB84 0006A9C4 28 04 00 07 */ cmplwi r4, 0x7
/* 8006EB88 0006A9C8 40 82 00 24 */ bne lbl_8006EBAC
/* 8006EB8C 0006A9CC 88 72 00 36 */ lbz r3, 0x36(r18)
/* 8006EB90 0006A9D0 54 60 06 73 */ rlwinm. r0, r3, 0, 25, 25
/* 8006EB94 0006A9D4 41 82 00 18 */ beq lbl_8006EBAC
/* 8006EB98 0006A9D8 54 60 07 FF */ clrlwi. r0, r3, 31
/* 8006EB9C 0006A9DC 41 82 00 10 */ beq lbl_8006EBAC
/* 8006EBA0 0006A9E0 A1 12 00 2A */ lhz r8, 0x2a(r18)
/* 8006EBA4 0006A9E4 38 E0 00 00 */ li r7, 0x0
/* 8006EBA8 0006A9E8 48 00 00 0C */ b lbl_8006EBB4
.global lbl_8006EBAC
lbl_8006EBAC:
/* 8006EBAC 0006A9EC 39 00 00 00 */ li r8, 0x0
/* 8006EBB0 0006A9F0 38 E0 00 00 */ li r7, 0x0
.global lbl_8006EBB4
lbl_8006EBB4:
/* 8006EBB4 0006A9F4 A0 12 00 00 */ lhz r0, 0x0(r18)
/* 8006EBB8 0006A9F8 70 06 9F 1F */ andi. r6, r0, 0x9f1f
.global lbl_8006EBBC
lbl_8006EBBC:
/* 8006EBBC 0006A9FC 28 06 FF FF */ cmplwi r6, 0xffff
/* 8006EBC0 0006AA00 40 82 00 0C */ bne lbl_8006EBCC
/* 8006EBC4 0006AA04 80 15 00 00 */ lwz r0, 0x0(r21)
/* 8006EBC8 0006AA08 70 06 9F 1F */ andi. r6, r0, 0x9f1f
.global lbl_8006EBCC
lbl_8006EBCC:
/* 8006EBCC 0006AA0C 28 07 FF FF */ cmplwi r7, 0xffff
/* 8006EBD0 0006AA10 40 82 00 08 */ bne lbl_8006EBD8
/* 8006EBD4 0006AA14 80 F5 00 00 */ lwz r7, 0x0(r21)
.global lbl_8006EBD8
lbl_8006EBD8:
/* 8006EBD8 0006AA18 28 08 FF FF */ cmplwi r8, 0xffff
/* 8006EBDC 0006AA1C 40 82 00 08 */ bne lbl_8006EBE4
/* 8006EBE0 0006AA20 81 15 00 60 */ lwz r8, 0x60(r21)
.global lbl_8006EBE4
lbl_8006EBE4:
/* 8006EBE4 0006AA24 7E A3 AB 78 */ mr r3, r21
/* 8006EBE8 0006AA28 38 A0 00 01 */ li r5, 0x1
/* 8006EBEC 0006AA2C 4B FF CB 55 */ bl read_kpad_button
/* 8006EBF0 0006AA30 88 12 00 29 */ lbz r0, 0x29(r18)
/* 8006EBF4 0006AA34 7C 00 07 75 */ extsb. r0, r0
/* 8006EBF8 0006AA38 41 82 00 10 */ beq lbl_8006EC08
/* 8006EBFC 0006AA3C 2C 00 FF F9 */ cmpwi r0, -0x7
/* 8006EC00 0006AA40 41 82 00 14 */ beq lbl_8006EC14
/* 8006EC04 0006AA44 48 00 00 2C */ b lbl_8006EC30
.global lbl_8006EC08
lbl_8006EC08:
/* 8006EC08 0006AA48 7E A3 AB 78 */ mr r3, r21
/* 8006EC0C 0006AA4C 7E 44 93 78 */ mr r4, r18
/* 8006EC10 0006AA50 4B FF EA 71 */ bl read_kpad_ext
.global lbl_8006EC14
lbl_8006EC14:
/* 8006EC14 0006AA54 7E A3 AB 78 */ mr r3, r21
/* 8006EC18 0006AA58 7E 44 93 78 */ mr r4, r18
/* 8006EC1C 0006AA5C 4B FF CF 75 */ bl read_kpad_acc
/* 8006EC20 0006AA60 7E A3 AB 78 */ mr r3, r21
/* 8006EC24 0006AA64 7E 44 93 78 */ mr r4, r18
/* 8006EC28 0006AA68 4B FF E2 39 */ bl read_kpad_dpd
/* 8006EC2C 0006AA6C 48 00 00 10 */ b lbl_8006EC3C
.global lbl_8006EC30
lbl_8006EC30:
/* 8006EC30 0006AA70 2C 1C 00 00 */ cmpwi r28, 0x0
/* 8006EC34 0006AA74 40 82 00 08 */ bne lbl_8006EC3C
/* 8006EC38 0006AA78 9B 15 00 5E */ stb r24, 0x5e(r21)
.global lbl_8006EC3C
lbl_8006EC3C:
/* 8006EC3C 0006AA7C 38 B2 FF FC */ addi r5, r18, -0x4
/* 8006EC40 0006AA80 38 95 FF FC */ addi r4, r21, -0x4
/* 8006EC44 0006AA84 7E 29 03 A6 */ mtctr r17
.global lbl_8006EC48
lbl_8006EC48:
/* 8006EC48 0006AA88 80 64 00 04 */ lwz r3, 0x4(r4)
/* 8006EC4C 0006AA8C 84 04 00 08 */ lwzu r0, 0x8(r4)
/* 8006EC50 0006AA90 90 65 00 04 */ stw r3, 0x4(r5)
/* 8006EC54 0006AA94 94 05 00 08 */ stwu r0, 0x8(r5)
/* 8006EC58 0006AA98 42 00 FF F0 */ bdnz lbl_8006EC48
/* 8006EC5C 0006AA9C 36 73 FF FF */ addic. r19, r19, -0x1
/* 8006EC60 0006AAA0 41 81 FE 70 */ bgt lbl_8006EAD0
/* 8006EC64 0006AAA4 48 00 01 C0 */ b lbl_8006EE24
.global lbl_8006EC68
lbl_8006EC68:
/* 8006EC68 0006AAA8 3C 80 00 01 */ lis r4, 0x1
/* 8006EC6C 0006AAAC 38 60 00 01 */ li r3, 0x1
/* 8006EC70 0006AAB0 39 04 FF FF */ addi r8, r4, -0x1
/* 8006EC74 0006AAB4 7D 07 43 78 */ mr r7, r8
/* 8006EC78 0006AAB8 7D 06 43 78 */ mr r6, r8
/* 8006EC7C 0006AABC 60 00 00 00 */ nop
.global lbl_8006EC80
lbl_8006EC80:
/* 8006EC80 0006AAC0 88 92 FF 38 */ lbz r4, -0xc8(r18)
/* 8006EC84 0006AAC4 3A 52 FF 10 */ addi r18, r18, -0xf0
/* 8006EC88 0006AAC8 88 15 00 5C */ lbz r0, 0x5c(r21)
/* 8006EC8C 0006AACC 7C 00 20 40 */ cmplw r0, r4
/* 8006EC90 0006AAD0 41 82 00 0C */ beq lbl_8006EC9C
/* 8006EC94 0006AAD4 98 95 00 5C */ stb r4, 0x5c(r21)
/* 8006EC98 0006AAD8 98 75 06 41 */ stb r3, 0x641(r21)
.global lbl_8006EC9C
lbl_8006EC9C:
/* 8006EC9C 0006AADC 88 12 00 29 */ lbz r0, 0x29(r18)
/* 8006ECA0 0006AAE0 88 92 00 28 */ lbz r4, 0x28(r18)
/* 8006ECA4 0006AAE4 7C 00 07 75 */ extsb. r0, r0
/* 8006ECA8 0006AAE8 41 82 00 18 */ beq lbl_8006ECC0
/* 8006ECAC 0006AAEC 2C 00 FF F9 */ cmpwi r0, -0x7
/* 8006ECB0 0006AAF0 41 82 00 9C */ beq lbl_8006ED4C
/* 8006ECB4 0006AAF4 2C 00 FF FE */ cmpwi r0, -0x2
/* 8006ECB8 0006AAF8 41 82 00 94 */ beq lbl_8006ED4C
/* 8006ECBC 0006AAFC 48 00 00 98 */ b lbl_8006ED54
.global lbl_8006ECC0
lbl_8006ECC0:
/* 8006ECC0 0006AB00 28 04 00 01 */ cmplwi r4, 0x1
/* 8006ECC4 0006AB04 40 82 00 10 */ bne lbl_8006ECD4
/* 8006ECC8 0006AB08 A0 F2 00 00 */ lhz r7, 0x0(r18)
/* 8006ECCC 0006AB0C 39 00 00 00 */ li r8, 0x0
/* 8006ECD0 0006AB10 48 00 00 7C */ b lbl_8006ED4C
.global lbl_8006ECD4
lbl_8006ECD4:
/* 8006ECD4 0006AB14 28 04 00 02 */ cmplwi r4, 0x2
/* 8006ECD8 0006AB18 41 82 00 10 */ beq lbl_8006ECE8
/* 8006ECDC 0006AB1C 38 04 FF F0 */ addi r0, r4, -0x10
/* 8006ECE0 0006AB20 28 00 00 03 */ cmplwi r0, 0x3
/* 8006ECE4 0006AB24 41 81 00 10 */ bgt lbl_8006ECF4
.global lbl_8006ECE8
lbl_8006ECE8:
/* 8006ECE8 0006AB28 A1 12 00 2A */ lhz r8, 0x2a(r18)
/* 8006ECEC 0006AB2C 38 E0 00 00 */ li r7, 0x0
/* 8006ECF0 0006AB30 48 00 00 5C */ b lbl_8006ED4C
.global lbl_8006ECF4
lbl_8006ECF4:
/* 8006ECF4 0006AB34 28 04 00 06 */ cmplwi r4, 0x6
/* 8006ECF8 0006AB38 40 82 00 24 */ bne lbl_8006ED1C
/* 8006ECFC 0006AB3C 88 B2 00 36 */ lbz r5, 0x36(r18)
/* 8006ED00 0006AB40 54 A0 06 73 */ rlwinm. r0, r5, 0, 25, 25
/* 8006ED04 0006AB44 41 82 00 18 */ beq lbl_8006ED1C
/* 8006ED08 0006AB48 54 A0 07 FF */ clrlwi. r0, r5, 31
/* 8006ED0C 0006AB4C 41 82 00 10 */ beq lbl_8006ED1C
/* 8006ED10 0006AB50 A0 F2 00 00 */ lhz r7, 0x0(r18)
/* 8006ED14 0006AB54 39 00 00 00 */ li r8, 0x0
/* 8006ED18 0006AB58 48 00 00 34 */ b lbl_8006ED4C
.global lbl_8006ED1C
lbl_8006ED1C:
/* 8006ED1C 0006AB5C 28 04 00 07 */ cmplwi r4, 0x7
/* 8006ED20 0006AB60 40 82 00 24 */ bne lbl_8006ED44
/* 8006ED24 0006AB64 88 B2 00 36 */ lbz r5, 0x36(r18)
/* 8006ED28 0006AB68 54 A0 06 73 */ rlwinm. r0, r5, 0, 25, 25
/* 8006ED2C 0006AB6C 41 82 00 18 */ beq lbl_8006ED44
/* 8006ED30 0006AB70 54 A0 07 FF */ clrlwi. r0, r5, 31
/* 8006ED34 0006AB74 41 82 00 10 */ beq lbl_8006ED44
/* 8006ED38 0006AB78 A1 12 00 2A */ lhz r8, 0x2a(r18)
/* 8006ED3C 0006AB7C 38 E0 00 00 */ li r7, 0x0
/* 8006ED40 0006AB80 48 00 00 0C */ b lbl_8006ED4C
.global lbl_8006ED44
lbl_8006ED44:
/* 8006ED44 0006AB84 39 00 00 00 */ li r8, 0x0
/* 8006ED48 0006AB88 38 E0 00 00 */ li r7, 0x0
.global lbl_8006ED4C
lbl_8006ED4C:
/* 8006ED4C 0006AB8C A0 12 00 00 */ lhz r0, 0x0(r18)
/* 8006ED50 0006AB90 70 06 9F 1F */ andi. r6, r0, 0x9f1f
.global lbl_8006ED54
lbl_8006ED54:
/* 8006ED54 0006AB94 36 73 FF FF */ addic. r19, r19, -0x1
/* 8006ED58 0006AB98 41 81 FF 28 */ bgt lbl_8006EC80
/* 8006ED5C 0006AB9C 28 06 FF FF */ cmplwi r6, 0xffff
/* 8006ED60 0006ABA0 40 82 00 0C */ bne lbl_8006ED6C
/* 8006ED64 0006ABA4 80 15 00 00 */ lwz r0, 0x0(r21)
/* 8006ED68 0006ABA8 70 06 9F 1F */ andi. r6, r0, 0x9f1f
.global lbl_8006ED6C
lbl_8006ED6C:
/* 8006ED6C 0006ABAC 28 07 FF FF */ cmplwi r7, 0xffff
/* 8006ED70 0006ABB0 40 82 00 08 */ bne lbl_8006ED78
/* 8006ED74 0006ABB4 80 F5 00 00 */ lwz r7, 0x0(r21)
.global lbl_8006ED78
lbl_8006ED78:
/* 8006ED78 0006ABB8 28 08 FF FF */ cmplwi r8, 0xffff
/* 8006ED7C 0006ABBC 40 82 00 08 */ bne lbl_8006ED84
/* 8006ED80 0006ABC0 81 15 00 60 */ lwz r8, 0x60(r21)
.global lbl_8006ED84
lbl_8006ED84:
/* 8006ED84 0006ABC4 7E A3 AB 78 */ mr r3, r21
/* 8006ED88 0006ABC8 7F A5 EB 78 */ mr r5, r29
/* 8006ED8C 0006ABCC 4B FF C9 B5 */ bl read_kpad_button
/* 8006ED90 0006ABD0 7F B6 EB 78 */ mr r22, r29
/* 8006ED94 0006ABD4 7E 93 A3 78 */ mr r19, r20
/* 8006ED98 0006ABD8 3A E0 00 00 */ li r23, 0x0
/* 8006ED9C 0006ABDC 3A 40 00 1E */ li r18, 0x1e
.global lbl_8006EDA0
lbl_8006EDA0:
/* 8006EDA0 0006ABE0 88 13 FF 39 */ lbz r0, -0xc7(r19)
/* 8006EDA4 0006ABE4 3A 73 FF 10 */ addi r19, r19, -0xf0
/* 8006EDA8 0006ABE8 98 15 00 5D */ stb r0, 0x5d(r21)
/* 8006EDAC 0006ABEC 7C 00 07 75 */ extsb. r0, r0
/* 8006EDB0 0006ABF0 88 73 00 40 */ lbz r3, 0x40(r19)
/* 8006EDB4 0006ABF4 98 75 00 5F */ stb r3, 0x5f(r21)
/* 8006EDB8 0006ABF8 41 82 00 10 */ beq lbl_8006EDC8
/* 8006EDBC 0006ABFC 2C 00 FF F9 */ cmpwi r0, -0x7
/* 8006EDC0 0006AC00 41 82 00 14 */ beq lbl_8006EDD4
/* 8006EDC4 0006AC04 48 00 00 2C */ b lbl_8006EDF0
.global lbl_8006EDC8
lbl_8006EDC8:
/* 8006EDC8 0006AC08 7E A3 AB 78 */ mr r3, r21
/* 8006EDCC 0006AC0C 7E 64 9B 78 */ mr r4, r19
/* 8006EDD0 0006AC10 4B FF E8 B1 */ bl read_kpad_ext
.global lbl_8006EDD4
lbl_8006EDD4:
/* 8006EDD4 0006AC14 7E A3 AB 78 */ mr r3, r21
/* 8006EDD8 0006AC18 7E 64 9B 78 */ mr r4, r19
/* 8006EDDC 0006AC1C 4B FF CD B5 */ bl read_kpad_acc
/* 8006EDE0 0006AC20 7E A3 AB 78 */ mr r3, r21
/* 8006EDE4 0006AC24 7E 64 9B 78 */ mr r4, r19
/* 8006EDE8 0006AC28 4B FF E0 79 */ bl read_kpad_dpd
/* 8006EDEC 0006AC2C 48 00 00 10 */ b lbl_8006EDFC
.global lbl_8006EDF0
lbl_8006EDF0:
/* 8006EDF0 0006AC30 2C 1C 00 00 */ cmpwi r28, 0x0
/* 8006EDF4 0006AC34 40 82 00 08 */ bne lbl_8006EDFC
/* 8006EDF8 0006AC38 9A F5 00 5E */ stb r23, 0x5e(r21)
.global lbl_8006EDFC
lbl_8006EDFC:
/* 8006EDFC 0006AC3C 38 B3 FF FC */ addi r5, r19, -0x4
/* 8006EE00 0006AC40 38 95 FF FC */ addi r4, r21, -0x4
/* 8006EE04 0006AC44 7E 49 03 A6 */ mtctr r18
.global lbl_8006EE08
lbl_8006EE08:
/* 8006EE08 0006AC48 80 64 00 04 */ lwz r3, 0x4(r4)
/* 8006EE0C 0006AC4C 84 04 00 08 */ lwzu r0, 0x8(r4)
/* 8006EE10 0006AC50 90 65 00 04 */ stw r3, 0x4(r5)
/* 8006EE14 0006AC54 94 05 00 08 */ stwu r0, 0x8(r5)
/* 8006EE18 0006AC58 42 00 FF F0 */ bdnz lbl_8006EE08
/* 8006EE1C 0006AC5C 36 D6 FF FF */ addic. r22, r22, -0x1
/* 8006EE20 0006AC60 41 81 FF 80 */ bgt lbl_8006EDA0
.global lbl_8006EE24
lbl_8006EE24:
/* 8006EE24 0006AC64 48 00 16 ED */ bl KMPLSIsInit
/* 8006EE28 0006AC68 2C 03 00 00 */ cmpwi r3, 0x0
/* 8006EE2C 0006AC6C 41 82 00 A8 */ beq lbl_8006EED4
/* 8006EE30 0006AC70 92 95 01 7C */ stw r20, 0x17c(r21)
/* 8006EE34 0006AC74 7F 23 CB 78 */ mr r3, r25
/* 8006EE38 0006AC78 38 95 01 80 */ addi r4, r21, 0x180
/* 8006EE3C 0006AC7C 80 B5 05 BC */ lwz r5, 0x5bc(r21)
/* 8006EE40 0006AC80 80 D5 05 C0 */ lwz r6, 0x5c0(r21)
/* 8006EE44 0006AC84 81 75 05 C4 */ lwz r11, 0x5c4(r21)
/* 8006EE48 0006AC88 81 55 05 D8 */ lwz r10, 0x5d8(r21)
/* 8006EE4C 0006AC8C 81 35 05 DC */ lwz r9, 0x5dc(r21)
/* 8006EE50 0006AC90 81 15 05 C8 */ lwz r8, 0x5c8(r21)
/* 8006EE54 0006AC94 80 F5 05 CC */ lwz r7, 0x5cc(r21)
/* 8006EE58 0006AC98 88 15 00 5E */ lbz r0, 0x5e(r21)
/* 8006EE5C 0006AC9C 90 A1 00 14 */ stw r5, 0x14(r1)
/* 8006EE60 0006ACA0 80 B5 05 A0 */ lwz r5, 0x5a0(r21)
/* 8006EE64 0006ACA4 90 C1 00 18 */ stw r6, 0x18(r1)
/* 8006EE68 0006ACA8 80 D5 05 A4 */ lwz r6, 0x5a4(r21)
/* 8006EE6C 0006ACAC 91 61 00 1C */ stw r11, 0x1c(r1)
/* 8006EE70 0006ACB0 91 41 00 28 */ stw r10, 0x28(r1)
/* 8006EE74 0006ACB4 91 21 00 2C */ stw r9, 0x2c(r1)
/* 8006EE78 0006ACB8 91 01 00 3C */ stw r8, 0x3c(r1)
/* 8006EE7C 0006ACBC 90 E1 00 40 */ stw r7, 0x40(r1)
/* 8006EE80 0006ACC0 98 01 00 66 */ stb r0, 0x66(r1)
/* 8006EE84 0006ACC4 48 00 31 BD */ bl KMPLSSetKpadRingBuffer
/* 8006EE88 0006ACC8 3C 60 80 07 */ lis r3, KPADiMplsSamplingCallback@ha
/* 8006EE8C 0006ACCC 38 63 E6 C0 */ addi r3, r3, KPADiMplsSamplingCallback@l
/* 8006EE90 0006ACD0 48 00 36 11 */ bl KMPLSSetSamplingCallback
/* 8006EE94 0006ACD4 FC 20 F8 90 */ fmr f1, f31
/* 8006EE98 0006ACD8 7F 23 CB 78 */ mr r3, r25
/* 8006EE9C 0006ACDC 7F C5 F3 78 */ mr r5, r30
/* 8006EEA0 0006ACE0 7F A6 EB 78 */ mr r6, r29
/* 8006EEA4 0006ACE4 38 95 00 B0 */ addi r4, r21, 0xb0
/* 8006EEA8 0006ACE8 38 E1 00 08 */ addi r7, r1, 0x8
/* 8006EEAC 0006ACEC 48 00 31 C5 */ bl KMPLSRead
/* 8006EEB0 0006ACF0 38 00 00 1E */ li r0, 0x1e
/* 8006EEB4 0006ACF4 38 BA FF FC */ addi r5, r26, -0x4
/* 8006EEB8 0006ACF8 38 95 FF FC */ addi r4, r21, -0x4
/* 8006EEBC 0006ACFC 7C 09 03 A6 */ mtctr r0
.global lbl_8006EEC0
lbl_8006EEC0:
/* 8006EEC0 0006AD00 80 64 00 04 */ lwz r3, 0x4(r4)
/* 8006EEC4 0006AD04 84 04 00 08 */ lwzu r0, 0x8(r4)
/* 8006EEC8 0006AD08 90 65 00 04 */ stw r3, 0x4(r5)
/* 8006EECC 0006AD0C 94 05 00 08 */ stwu r0, 0x8(r5)
/* 8006EED0 0006AD10 42 00 FF F0 */ bdnz lbl_8006EEC0
.global lbl_8006EED4
lbl_8006EED4:
/* 8006EED4 0006AD14 38 00 00 00 */ li r0, 0x0
/* 8006EED8 0006AD18 98 15 05 EB */ stb r0, 0x5eb(r21)
.global lbl_8006EEDC
lbl_8006EEDC:
/* 8006EEDC 0006AD1C 2C 1D 00 00 */ cmpwi r29, 0x0
/* 8006EEE0 0006AD20 40 82 00 6C */ bne lbl_8006EF4C
/* 8006EEE4 0006AD24 2C 1F 00 00 */ cmpwi r31, 0x0
/* 8006EEE8 0006AD28 40 82 00 3C */ bne lbl_8006EF24
/* 8006EEEC 0006AD2C 2C 1C 00 00 */ cmpwi r28, 0x0
/* 8006EEF0 0006AD30 41 82 00 2C */ beq lbl_8006EF1C
/* 8006EEF4 0006AD34 38 00 00 1E */ li r0, 0x1e
/* 8006EEF8 0006AD38 38 BA FF FC */ addi r5, r26, -0x4
/* 8006EEFC 0006AD3C 38 81 00 F4 */ addi r4, r1, 0xf4
/* 8006EF00 0006AD40 7C 09 03 A6 */ mtctr r0
/* 8006EF04 0006AD44 60 00 00 00 */ nop
.global lbl_8006EF08
lbl_8006EF08:
/* 8006EF08 0006AD48 80 64 00 04 */ lwz r3, 0x4(r4)
/* 8006EF0C 0006AD4C 84 04 00 08 */ lwzu r0, 0x8(r4)
/* 8006EF10 0006AD50 90 65 00 04 */ stw r3, 0x4(r5)
/* 8006EF14 0006AD54 94 05 00 08 */ stwu r0, 0x8(r5)
/* 8006EF18 0006AD58 42 00 FF F0 */ bdnz lbl_8006EF08
.global lbl_8006EF1C
lbl_8006EF1C:
/* 8006EF1C 0006AD5C 3B E0 FF FF */ li r31, -0x1
/* 8006EF20 0006AD60 48 00 00 2C */ b lbl_8006EF4C
.global lbl_8006EF24
lbl_8006EF24:
/* 8006EF24 0006AD64 2C 1F FF FE */ cmpwi r31, -0x2
/* 8006EF28 0006AD68 40 82 00 24 */ bne lbl_8006EF4C
/* 8006EF2C 0006AD6C 2C 1C 00 00 */ cmpwi r28, 0x0
/* 8006EF30 0006AD70 41 82 00 1C */ beq lbl_8006EF4C
/* 8006EF34 0006AD74 38 80 00 FD */ li r4, 0xfd
/* 8006EF38 0006AD78 38 60 00 00 */ li r3, 0x0
/* 8006EF3C 0006AD7C 38 00 FF FF */ li r0, -0x1
/* 8006EF40 0006AD80 98 9A 00 5C */ stb r4, 0x5c(r26)
/* 8006EF44 0006AD84 98 7A 00 5F */ stb r3, 0x5f(r26)
/* 8006EF48 0006AD88 98 1A 00 5D */ stb r0, 0x5d(r26)
.global lbl_8006EF4C
lbl_8006EF4C:
/* 8006EF4C 0006AD8C 2C 1B 00 00 */ cmpwi r27, 0x0
/* 8006EF50 0006AD90 41 82 00 08 */ beq lbl_8006EF58
/* 8006EF54 0006AD94 93 FB 00 00 */ stw r31, 0x0(r27)
.global lbl_8006EF58
lbl_8006EF58:
/* 8006EF58 0006AD98 CB E1 02 38 */ lfd f31, 0x238(r1)
/* 8006EF5C 0006AD9C 39 61 02 38 */ addi r11, r1, 0x238
/* 8006EF60 0006ADA0 7F A3 EB 78 */ mr r3, r29
/* 8006EF64 0006ADA4 4B F9 83 FD */ bl lbl_80007360
/* 8006EF68 0006ADA8 80 01 02 44 */ lwz r0, 0x244(r1)
/* 8006EF6C 0006ADAC 7C 08 03 A6 */ mtlr r0
/* 8006EF70 0006ADB0 38 21 02 40 */ addi r1, r1, 0x240
/* 8006EF74 0006ADB4 4E 80 00 20 */ blr
/* 8006EF78 0006ADB8 00 00 00 00 */ .4byte 0x00000000
/* 8006EF7C 0006ADBC 00 00 00 00 */ .4byte 0x00000000
.global KPADInit
KPADInit:
/* 8006EF80 0006ADC0 38 60 00 00 */ li r3, 0x0
/* 8006EF84 0006ADC4 38 80 00 00 */ li r4, 0x0
/* 8006EF88 0006ADC8 48 00 00 08 */ b KPADInitEx
/* 8006EF8C 0006ADCC 00 00 00 00 */ .4byte 0x00000000
.global KPADInitEx
KPADInitEx:
/* 8006EF90 0006ADD0 94 21 FF 60 */ stwu r1, -0xa0(r1)
/* 8006EF94 0006ADD4 7C 08 02 A6 */ mflr r0
/* 8006EF98 0006ADD8 90 01 00 A4 */ stw r0, 0xa4(r1)
/* 8006EF9C 0006ADDC 39 61 00 60 */ addi r11, r1, 0x60
/* 8006EFA0 0006ADE0 DB E1 00 90 */ stfd f31, 0x90(r1)
/* 8006EFA4 0006ADE4 F3 E1 00 98 */ psq_st f31, 0x98(r1), 0, qr0
/* 8006EFA8 0006ADE8 DB C1 00 80 */ stfd f30, 0x80(r1)
/* 8006EFAC 0006ADEC F3 C1 00 88 */ psq_st f30, 0x88(r1), 0, qr0
/* 8006EFB0 0006ADF0 DB A1 00 70 */ stfd f29, 0x70(r1)
/* 8006EFB4 0006ADF4 F3 A1 00 78 */ psq_st f29, 0x78(r1), 0, qr0
/* 8006EFB8 0006ADF8 DB 81 00 60 */ stfd f28, 0x60(r1)
/* 8006EFBC 0006ADFC F3 81 00 68 */ psq_st f28, 0x68(r1), 0, qr0
/* 8006EFC0 0006AE00 4B F9 83 49 */ bl __save_gpr
/* 8006EFC4 0006AE04 88 0D EA 54 */ lbz r0, kp_initialized@sda21(r13)
/* 8006EFC8 0006AE08 3E 80 80 4C */ lis r20, inside_kpads@ha
/* 8006EFCC 0006AE0C 7C 6F 1B 78 */ mr r15, r3
/* 8006EFD0 0006AE10 7C 90 23 78 */ mr r16, r4
/* 8006EFD4 0006AE14 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006EFD8 0006AE18 3A 94 7C 08 */ addi r20, r20, inside_kpads@l
/* 8006EFDC 0006AE1C 40 82 03 E4 */ bne lbl_8006F3C0
/* 8006EFE0 0006AE20 4B FE 74 01 */ bl WPADInit
/* 8006EFE4 0006AE24 4B FB 28 3D */ bl OSDisableInterrupts
/* 8006EFE8 0006AE28 90 61 00 10 */ stw r3, 0x10(r1)
/* 8006EFEC 0006AE2C 38 74 00 00 */ addi r3, r20, 0x0
/* 8006EFF0 0006AE30 38 80 00 00 */ li r4, 0x0
/* 8006EFF4 0006AE34 38 A0 1A 20 */ li r5, 0x1a20
/* 8006EFF8 0006AE38 4B F9 53 59 */ bl memset
/* 8006EFFC 0006AE3C 4B FE B4 25 */ bl WPADGetDpdSensitivity
/* 8006F000 0006AE40 54 63 06 3E */ clrlwi r3, r3, 24
/* 8006F004 0006AE44 3C 00 43 30 */ lis r0, 0x4330
/* 8006F008 0006AE48 90 61 00 0C */ stw r3, 0xc(r1)
/* 8006F00C 0006AE4C 3A 20 00 00 */ li r17, 0x0
/* 8006F010 0006AE50 C8 22 88 C0 */ lfd f1, "@5403"@sda21(r2)
/* 8006F014 0006AE54 3C 60 00 01 */ lis r3, 0x1
/* 8006F018 0006AE58 90 01 00 08 */ stw r0, 0x8(r1)
/* 8006F01C 0006AE5C 7E 37 8B 78 */ mr r23, r17
/* 8006F020 0006AE60 C3 C2 88 60 */ lfs f30, "@4581"@sda21(r2)
/* 8006F024 0006AE64 7E 3A 8B 78 */ mr r26, r17
/* 8006F028 0006AE68 C8 01 00 08 */ lfd f0, 0x8(r1)
/* 8006F02C 0006AE6C 7E 3B 8B 78 */ mr r27, r17
/* 8006F030 0006AE70 C3 E2 88 50 */ lfs f31, "@4535"@sda21(r2)
/* 8006F034 0006AE74 7E 3D 8B 78 */ mr r29, r17
/* 8006F038 0006AE78 EC 00 08 28 */ fsubs f0, f0, f1
/* 8006F03C 0006AE7C 3A 74 00 00 */ addi r19, r20, 0x0
/* 8006F040 0006AE80 56 12 F0 BE */ srwi r18, r16, 2
/* 8006F044 0006AE84 3B 83 9C 40 */ addi r28, r3, -0x63c0
/* 8006F048 0006AE88 3B E0 00 00 */ li r31, 0x0
/* 8006F04C 0006AE8C 3B C0 FF FF */ li r30, -0x1
/* 8006F050 0006AE90 EC 1E 00 2A */ fadds f0, f30, f0
/* 8006F054 0006AE94 3E C0 80 07 */ lis r22, KPADiSamplingCallback@ha
/* 8006F058 0006AE98 3B 00 00 01 */ li r24, 0x1
/* 8006F05C 0006AE9C 3B 20 00 03 */ li r25, 0x3
/* 8006F060 0006AEA0 D0 0D 84 18 */ stfs f0, kp_err_dist_max@sda21(r13)
/* 8006F064 0006AEA4 39 C0 00 FD */ li r14, 0xfd
/* 8006F068 0006AEA8 3E A0 80 07 */ lis r21, KPADiConnectCallback@ha
.global lbl_8006F06C
lbl_8006F06C:
/* 8006F06C 0006AEAC 7E 23 8B 78 */ mr r3, r17
/* 8006F070 0006AEB0 38 95 F5 50 */ addi r4, r21, KPADiConnectCallback@l
/* 8006F074 0006AEB4 4B FE 8C 5D */ bl WPADSetConnectCallback
/* 8006F078 0006AEB8 90 73 06 3C */ stw r3, 0x63c(r19)
/* 8006F07C 0006AEBC 7E 23 8B 78 */ mr r3, r17
/* 8006F080 0006AEC0 38 96 F9 C0 */ addi r4, r22, KPADiSamplingCallback@l
/* 8006F084 0006AEC4 4B FE 8B BD */ bl WPADSetSamplingCallback
/* 8006F088 0006AEC8 90 73 06 38 */ stw r3, 0x638(r19)
/* 8006F08C 0006AECC 7E 23 8B 78 */ mr r3, r17
/* 8006F090 0006AED0 9A F3 06 43 */ stb r23, 0x643(r19)
/* 8006F094 0006AED4 9B 13 06 42 */ stb r24, 0x642(r19)
/* 8006F098 0006AED8 9A F3 06 45 */ stb r23, 0x645(r19)
/* 8006F09C 0006AEDC 9A F3 06 46 */ stb r23, 0x646(r19)
/* 8006F0A0 0006AEE0 9B 13 06 47 */ stb r24, 0x647(r19)
/* 8006F0A4 0006AEE4 9A F3 06 79 */ stb r23, 0x679(r19)
/* 8006F0A8 0006AEE8 9A F3 06 76 */ stb r23, 0x676(r19)
/* 8006F0AC 0006AEEC 9A F3 06 7A */ stb r23, 0x67a(r19)
/* 8006F0B0 0006AEF0 9B 33 06 7D */ stb r25, 0x67d(r19)
/* 8006F0B4 0006AEF4 4B FE C6 ED */ bl WPADiGetMplsStatus
/* 8006F0B8 0006AEF8 98 73 06 78 */ stb r3, 0x678(r19)
/* 8006F0BC 0006AEFC C3 82 88 60 */ lfs f28, "@4581"@sda21(r2)
/* 8006F0C0 0006AF00 98 73 06 77 */ stb r3, 0x677(r19)
/* 8006F0C4 0006AF04 C3 A2 88 68 */ lfs f29, "@4583"@sda21(r2)
/* 8006F0C8 0006AF08 EC 3C 07 32 */ fmuls f1, f28, f28
/* 8006F0CC 0006AF0C 9B 53 06 7B */ stb r26, 0x67b(r19)
/* 8006F0D0 0006AF10 EC 1D 07 72 */ fmuls f0, f29, f29
/* 8006F0D4 0006AF14 C0 4D 83 EC */ lfs f2, idist_org@sda21(r13)
/* 8006F0D8 0006AF18 9B 13 06 7C */ stb r24, 0x67c(r19)
/* 8006F0DC 0006AF1C 80 6D 83 F0 */ lwz r3, iaccXY_nrm_hori@sda21(r13)
/* 8006F0E0 0006AF20 99 D3 00 5C */ stb r14, 0x5c(r19)
/* 8006F0E4 0006AF24 EC 21 00 2A */ fadds f1, f1, f0
/* 8006F0E8 0006AF28 80 0D 83 F4 */ lwz r0, lbl_80556814@sda21(r13)
/* 8006F0EC 0006AF2C 9B 53 00 5F */ stb r26, 0x5f(r19)
/* 8006F0F0 0006AF30 80 AD 83 F8 */ lwz r5, isec_nrm_hori@sda21(r13)
/* 8006F0F4 0006AF34 D0 53 01 10 */ stfs f2, 0x110(r19)
/* 8006F0F8 0006AF38 80 8D 83 FC */ lwz r4, lbl_8055681C@sda21(r13)
/* 8006F0FC 0006AF3C 90 73 01 14 */ stw r3, 0x114(r19)
/* 8006F100 0006AF40 80 6D EA 40 */ lwz r3, icenter_org@sda21(r13)
/* 8006F104 0006AF44 90 13 01 18 */ stw r0, 0x118(r19)
/* 8006F108 0006AF48 80 0D EA 44 */ lwz r0, lbl_8055CE64@sda21(r13)
/* 8006F10C 0006AF4C 90 B3 01 1C */ stw r5, 0x11c(r19)
/* 8006F110 0006AF50 90 93 01 20 */ stw r4, 0x120(r19)
/* 8006F114 0006AF54 90 73 01 24 */ stw r3, 0x124(r19)
/* 8006F118 0006AF58 90 13 01 28 */ stw r0, 0x128(r19)
/* 8006F11C 0006AF5C 4B FA 56 CD */ bl sqrt
/* 8006F120 0006AF60 C0 13 01 24 */ lfs f0, 0x124(r19)
/* 8006F124 0006AF64 FC 20 08 18 */ frsp f1, f1
/* 8006F128 0006AF68 FC 00 F8 40 */ fcmpo cr0, f0, f31
/* 8006F12C 0006AF6C 40 80 00 0C */ bge lbl_8006F138
/* 8006F130 0006AF70 EF 9C 00 2A */ fadds f28, f28, f0
/* 8006F134 0006AF74 48 00 00 08 */ b lbl_8006F13C
.global lbl_8006F138
lbl_8006F138:
/* 8006F138 0006AF78 EF 9C 00 28 */ fsubs f28, f28, f0
.global lbl_8006F13C
lbl_8006F13C:
/* 8006F13C 0006AF7C C0 13 01 28 */ lfs f0, 0x128(r19)
/* 8006F140 0006AF80 FC 00 F8 40 */ fcmpo cr0, f0, f31
/* 8006F144 0006AF84 40 80 00 0C */ bge lbl_8006F150
/* 8006F148 0006AF88 EF BD 00 2A */ fadds f29, f29, f0
/* 8006F14C 0006AF8C 48 00 00 08 */ b lbl_8006F154
.global lbl_8006F150
lbl_8006F150:
/* 8006F150 0006AF90 EF BD 00 28 */ fsubs f29, f29, f0
.global lbl_8006F154
lbl_8006F154:
/* 8006F154 0006AF94 FC 1C E8 40 */ fcmpo cr0, f28, f29
/* 8006F158 0006AF98 40 80 00 08 */ bge lbl_8006F160
/* 8006F15C 0006AF9C 48 00 00 08 */ b lbl_8006F164
.global lbl_8006F160
lbl_8006F160:
/* 8006F160 0006AFA0 FF 80 E8 90 */ fmr f28, f29
.global lbl_8006F164
lbl_8006F164:
/* 8006F164 0006AFA4 EC 01 E0 24 */ fdivs f0, f1, f28
/* 8006F168 0006AFA8 2C 10 00 00 */ cmpwi r16, 0x0
/* 8006F16C 0006AFAC D0 13 01 2C */ stfs f0, 0x12c(r19)
/* 8006F170 0006AFB0 D3 F3 01 08 */ stfs f31, 0x108(r19)
/* 8006F174 0006AFB4 D3 F3 01 00 */ stfs f31, 0x100(r19)
/* 8006F178 0006AFB8 D3 F3 00 F8 */ stfs f31, 0xf8(r19)
/* 8006F17C 0006AFBC D3 F3 00 F0 */ stfs f31, 0xf0(r19)
/* 8006F180 0006AFC0 D3 D3 01 0C */ stfs f30, 0x10c(r19)
/* 8006F184 0006AFC4 D3 D3 01 04 */ stfs f30, 0x104(r19)
/* 8006F188 0006AFC8 D3 D3 00 FC */ stfs f30, 0xfc(r19)
/* 8006F18C 0006AFCC D3 D3 00 F4 */ stfs f30, 0xf4(r19)
/* 8006F190 0006AFD0 93 73 06 58 */ stw r27, 0x658(r19)
/* 8006F194 0006AFD4 93 73 06 54 */ stw r27, 0x654(r19)
/* 8006F198 0006AFD8 93 73 06 50 */ stw r27, 0x650(r19)
/* 8006F19C 0006AFDC 93 73 06 4C */ stw r27, 0x64c(r19)
/* 8006F1A0 0006AFE0 B3 93 05 F0 */ sth r28, 0x5f0(r19)
/* 8006F1A4 0006AFE4 B3 73 05 F2 */ sth r27, 0x5f2(r19)
/* 8006F1A8 0006AFE8 B3 73 05 EC */ sth r27, 0x5ec(r19)
/* 8006F1AC 0006AFEC B3 93 05 EE */ sth r28, 0x5ee(r19)
/* 8006F1B0 0006AFF0 B3 73 05 F4 */ sth r27, 0x5f4(r19)
/* 8006F1B4 0006AFF4 B3 93 05 F6 */ sth r28, 0x5f6(r19)
/* 8006F1B8 0006AFF8 9B 73 06 4B */ stb r27, 0x64b(r19)
/* 8006F1BC 0006AFFC 9B 13 06 48 */ stb r24, 0x648(r19)
/* 8006F1C0 0006B000 9B 13 06 49 */ stb r24, 0x649(r19)
/* 8006F1C4 0006B004 9B 13 06 7E */ stb r24, 0x67e(r19)
/* 8006F1C8 0006B008 9B 73 06 4A */ stb r27, 0x64a(r19)
/* 8006F1CC 0006B00C 41 82 00 20 */ beq lbl_8006F1EC
/* 8006F1D0 0006B010 2C 0F 00 00 */ cmpwi r15, 0x0
/* 8006F1D4 0006B014 41 82 00 18 */ beq lbl_8006F1EC
/* 8006F1D8 0006B018 7C 12 F9 D6 */ mullw r0, r18, r31
/* 8006F1DC 0006B01C 92 53 05 A4 */ stw r18, 0x5a4(r19)
/* 8006F1E0 0006B020 7C 0F 02 14 */ add r0, r15, r0
/* 8006F1E4 0006B024 90 13 05 A0 */ stw r0, 0x5a0(r19)
/* 8006F1E8 0006B028 48 00 00 0C */ b lbl_8006F1F4
.global lbl_8006F1EC
lbl_8006F1EC:
/* 8006F1EC 0006B02C 93 B3 05 A4 */ stw r29, 0x5a4(r19)
/* 8006F1F0 0006B030 93 B3 05 A0 */ stw r29, 0x5a0(r19)
.global lbl_8006F1F4
lbl_8006F1F4:
/* 8006F1F4 0006B034 9B D3 01 A9 */ stb r30, 0x1a9(r19)
/* 8006F1F8 0006B038 38 A0 00 00 */ li r5, 0x0
/* 8006F1FC 0006B03C 38 80 00 00 */ li r4, 0x0
/* 8006F200 0006B040 9B D3 01 EB */ stb r30, 0x1eb(r19)
/* 8006F204 0006B044 9B D3 02 2D */ stb r30, 0x22d(r19)
/* 8006F208 0006B048 9B D3 02 6F */ stb r30, 0x26f(r19)
/* 8006F20C 0006B04C 9B D3 02 B1 */ stb r30, 0x2b1(r19)
/* 8006F210 0006B050 9B D3 02 F3 */ stb r30, 0x2f3(r19)
/* 8006F214 0006B054 9B D3 03 35 */ stb r30, 0x335(r19)
/* 8006F218 0006B058 9B D3 03 77 */ stb r30, 0x377(r19)
/* 8006F21C 0006B05C 9B D3 03 B9 */ stb r30, 0x3b9(r19)
/* 8006F220 0006B060 9B D3 03 FB */ stb r30, 0x3fb(r19)
/* 8006F224 0006B064 9B D3 04 3D */ stb r30, 0x43d(r19)
/* 8006F228 0006B068 9B D3 04 7F */ stb r30, 0x47f(r19)
/* 8006F22C 0006B06C 9B D3 04 C1 */ stb r30, 0x4c1(r19)
/* 8006F230 0006B070 9B D3 05 03 */ stb r30, 0x503(r19)
/* 8006F234 0006B074 9B D3 05 45 */ stb r30, 0x545(r19)
/* 8006F238 0006B078 9B D3 05 87 */ stb r30, 0x587(r19)
/* 8006F23C 0006B07C 48 00 00 18 */ b lbl_8006F254
.global lbl_8006F240
lbl_8006F240:
/* 8006F240 0006B080 80 13 05 A0 */ lwz r0, 0x5a0(r19)
/* 8006F244 0006B084 38 A5 00 01 */ addi r5, r5, 0x1
/* 8006F248 0006B088 7C 60 22 14 */ add r3, r0, r4
/* 8006F24C 0006B08C 38 84 00 42 */ addi r4, r4, 0x42
/* 8006F250 0006B090 9B C3 00 29 */ stb r30, 0x29(r3)
.global lbl_8006F254
lbl_8006F254:
/* 8006F254 0006B094 80 13 05 A4 */ lwz r0, 0x5a4(r19)
/* 8006F258 0006B098 7C 05 00 40 */ cmplw r5, r0
/* 8006F25C 0006B09C 41 80 FF E4 */ blt lbl_8006F240
/* 8006F260 0006B0A0 3A 31 00 01 */ addi r17, r17, 0x1
/* 8006F264 0006B0A4 3B FF 00 42 */ addi r31, r31, 0x42
/* 8006F268 0006B0A8 2C 11 00 04 */ cmpwi r17, 0x4
/* 8006F26C 0006B0AC 3A 73 06 88 */ addi r19, r19, 0x688
/* 8006F270 0006B0B0 41 80 FD FC */ blt lbl_8006F06C
/* 8006F274 0006B0B4 C8 02 88 A8 */ lfd f0, "@5395"@sda21(r2)
/* 8006F278 0006B0B8 38 94 1A 70 */ addi r4, r20, 0x1a70
/* 8006F27C 0006B0BC 38 A0 00 00 */ li r5, 0x0
/* 8006F280 0006B0C0 38 00 FF FE */ li r0, -0x2
/* 8006F284 0006B0C4 39 C0 00 01 */ li r14, 0x1
/* 8006F288 0006B0C8 98 AD EA 8A */ stb r5, kp_wbc_issued@sda21(r13)
/* 8006F28C 0006B0CC 38 60 00 01 */ li r3, 0x1
/* 8006F290 0006B0D0 98 AD EA 89 */ stb r5, kp_wbc_enabled@sda21(r13)
/* 8006F294 0006B0D4 B0 AD EA 80 */ sth r5, kp_wbc_ave_sample_count@sda21(r13)
/* 8006F298 0006B0D8 D8 14 1A 70 */ stfd f0, 0x1a70(r20)
/* 8006F29C 0006B0DC D8 04 00 08 */ stfd f0, 0x8(r4)
/* 8006F2A0 0006B0E0 D8 04 00 10 */ stfd f0, 0x10(r4)
/* 8006F2A4 0006B0E4 D8 04 00 18 */ stfd f0, 0x18(r4)
/* 8006F2A8 0006B0E8 98 0D EA 88 */ stb r0, kp_wbc_tgc_weight_err@sda21(r13)
/* 8006F2AC 0006B0EC B0 AD EA 86 */ sth r5, kp_wbc_tgc_weight_wait@sda21(r13)
/* 8006F2B0 0006B0F0 99 CD EA 85 */ stb r14, kp_wbc_tgc_weight_done@sda21(r13)
/* 8006F2B4 0006B0F4 98 AD EA 83 */ stb r5, kp_wbc_zero_point_done@sda21(r13)
/* 8006F2B8 0006B0F8 4B FE E3 E9 */ bl WPADSetCallbackByKPAD
/* 8006F2BC 0006B0FC C3 AD 84 00 */ lfs f29, kp_obj_interval@sda21(r13)
/* 8006F2C0 0006B100 4B FB 25 61 */ bl OSDisableInterrupts
/* 8006F2C4 0006B104 C0 02 88 D0 */ lfs f0, "@5613"@sda21(r2)
/* 8006F2C8 0006B108 D3 AD 84 00 */ stfs f29, kp_obj_interval@sda21(r13)
/* 8006F2CC 0006B10C EC 1D 00 24 */ fdivs f0, f29, f0
/* 8006F2D0 0006B110 D0 0D EA 90 */ stfs f0, kp_err_dist_min@sda21(r13)
/* 8006F2D4 0006B114 D0 0D EA 8C */ stfs f0, kp_dist_vv1@sda21(r13)
/* 8006F2D8 0006B118 4B FB 25 89 */ bl OSRestoreInterrupts
/* 8006F2DC 0006B11C 38 74 00 00 */ addi r3, r20, 0x0
/* 8006F2E0 0006B120 39 E0 00 03 */ li r15, 0x3
/* 8006F2E4 0006B124 3A 03 13 98 */ addi r16, r3, 0x1398
.global lbl_8006F2E8
lbl_8006F2E8:
/* 8006F2E8 0006B128 4B FE 71 B9 */ bl WPADGetStatus
/* 8006F2EC 0006B12C 2C 03 00 03 */ cmpwi r3, 0x3
/* 8006F2F0 0006B130 40 82 00 10 */ bne lbl_8006F300
/* 8006F2F4 0006B134 7D E3 7B 78 */ mr r3, r15
/* 8006F2F8 0006B138 38 80 00 00 */ li r4, 0x0
/* 8006F2FC 0006B13C 4B FE 8E 55 */ bl WPADControlMotor
.global lbl_8006F300
lbl_8006F300:
/* 8006F300 0006B140 35 EF FF FF */ addic. r15, r15, -0x1
/* 8006F304 0006B144 99 D0 06 40 */ stb r14, 0x640(r16)
/* 8006F308 0006B148 3A 10 F9 78 */ addi r16, r16, -0x688
/* 8006F30C 0006B14C 40 80 FF DC */ bge lbl_8006F2E8
/* 8006F310 0006B150 C0 22 88 D4 */ lfs f1, "@5614"@sda21(r2)
/* 8006F314 0006B154 39 D4 1A 20 */ addi r14, r20, 0x1a20
/* 8006F318 0006B158 C0 0D 84 6C */ lfs f0, kp_fs_revise_deg@sda21(r13)
/* 8006F31C 0006B15C C0 42 88 50 */ lfs f2, "@4535"@sda21(r2)
/* 8006F320 0006B160 C0 62 88 60 */ lfs f3, "@4581"@sda21(r2)
/* 8006F324 0006B164 EC 21 00 32 */ fmuls f1, f1, f0
/* 8006F328 0006B168 D0 74 1A 20 */ stfs f3, 0x1a20(r20)
/* 8006F32C 0006B16C D0 4E 00 04 */ stfs f2, 0x4(r14)
/* 8006F330 0006B170 D0 4E 00 08 */ stfs f2, 0x8(r14)
/* 8006F334 0006B174 D0 4E 00 0C */ stfs f2, 0xc(r14)
/* 8006F338 0006B178 D0 4E 00 10 */ stfs f2, 0x10(r14)
/* 8006F33C 0006B17C 4B FA 4C 01 */ bl cos
/* 8006F340 0006B180 FC 20 08 18 */ frsp f1, f1
/* 8006F344 0006B184 C0 42 88 D4 */ lfs f2, "@5614"@sda21(r2)
/* 8006F348 0006B188 C0 0D 84 6C */ lfs f0, kp_fs_revise_deg@sda21(r13)
/* 8006F34C 0006B18C D0 2E 00 14 */ stfs f1, 0x14(r14)
/* 8006F350 0006B190 EC 22 00 32 */ fmuls f1, f2, f0
/* 8006F354 0006B194 4B FA 50 F1 */ bl sin
/* 8006F358 0006B198 FC 60 08 50 */ fneg f3, f1
/* 8006F35C 0006B19C C0 42 88 50 */ lfs f2, "@4535"@sda21(r2)
/* 8006F360 0006B1A0 C0 22 88 D4 */ lfs f1, "@5614"@sda21(r2)
/* 8006F364 0006B1A4 C0 0D 84 6C */ lfs f0, kp_fs_revise_deg@sda21(r13)
/* 8006F368 0006B1A8 FC 60 18 18 */ frsp f3, f3
/* 8006F36C 0006B1AC D0 4E 00 1C */ stfs f2, 0x1c(r14)
/* 8006F370 0006B1B0 EC 21 00 32 */ fmuls f1, f1, f0
/* 8006F374 0006B1B4 D0 6E 00 18 */ stfs f3, 0x18(r14)
/* 8006F378 0006B1B8 D0 4E 00 20 */ stfs f2, 0x20(r14)
/* 8006F37C 0006B1BC 4B FA 50 C9 */ bl sin
/* 8006F380 0006B1C0 FC 20 08 18 */ frsp f1, f1
/* 8006F384 0006B1C4 C0 42 88 D4 */ lfs f2, "@5614"@sda21(r2)
/* 8006F388 0006B1C8 C0 0D 84 6C */ lfs f0, kp_fs_revise_deg@sda21(r13)
/* 8006F38C 0006B1CC D0 2E 00 24 */ stfs f1, 0x24(r14)
/* 8006F390 0006B1D0 EC 22 00 32 */ fmuls f1, f2, f0
/* 8006F394 0006B1D4 4B FA 4B A9 */ bl cos
/* 8006F398 0006B1D8 FC 20 08 18 */ frsp f1, f1
/* 8006F39C 0006B1DC C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006F3A0 0006B1E0 38 00 00 01 */ li r0, 0x1
/* 8006F3A4 0006B1E4 D0 0E 00 2C */ stfs f0, 0x2c(r14)
/* 8006F3A8 0006B1E8 80 61 00 10 */ lwz r3, 0x10(r1)
/* 8006F3AC 0006B1EC D0 2E 00 28 */ stfs f1, 0x28(r14)
/* 8006F3B0 0006B1F0 98 0D EA 54 */ stb r0, kp_initialized@sda21(r13)
/* 8006F3B4 0006B1F4 4B FB 24 AD */ bl OSRestoreInterrupts
/* 8006F3B8 0006B1F8 80 6D 83 E8 */ lwz r3, __KPADVersion@sda21(r13)
/* 8006F3BC 0006B1FC 4B FA C3 25 */ bl OSRegisterVersion
.global lbl_8006F3C0
lbl_8006F3C0:
/* 8006F3C0 0006B200 39 61 00 60 */ addi r11, r1, 0x60
/* 8006F3C4 0006B204 E3 E1 00 98 */ psq_l f31, 0x98(r1), 0, qr0
/* 8006F3C8 0006B208 CB E1 00 90 */ lfd f31, 0x90(r1)
/* 8006F3CC 0006B20C E3 C1 00 88 */ psq_l f30, 0x88(r1), 0, qr0
/* 8006F3D0 0006B210 CB C1 00 80 */ lfd f30, 0x80(r1)
/* 8006F3D4 0006B214 E3 A1 00 78 */ psq_l f29, 0x78(r1), 0, qr0
/* 8006F3D8 0006B218 CB A1 00 70 */ lfd f29, 0x70(r1)
/* 8006F3DC 0006B21C E3 81 00 68 */ psq_l f28, 0x68(r1), 0, qr0
/* 8006F3E0 0006B220 CB 81 00 60 */ lfd f28, 0x60(r1)
/* 8006F3E4 0006B224 4B F9 7F 71 */ bl __restore_gpr
/* 8006F3E8 0006B228 80 01 00 A4 */ lwz r0, 0xa4(r1)
/* 8006F3EC 0006B22C 7C 08 03 A6 */ mtlr r0
/* 8006F3F0 0006B230 38 21 00 A0 */ addi r1, r1, 0xa0
/* 8006F3F4 0006B234 4E 80 00 20 */ blr
/* 8006F3F8 0006B238 00 00 00 00 */ .4byte 0x00000000
/* 8006F3FC 0006B23C 00 00 00 00 */ .4byte 0x00000000
.global KPADShutdown
KPADShutdown:
/* 8006F400 0006B240 94 21 FF F0 */ stwu r1, -0x10(r1)
/* 8006F404 0006B244 7C 08 02 A6 */ mflr r0
/* 8006F408 0006B248 38 60 00 00 */ li r3, 0x0
/* 8006F40C 0006B24C 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006F410 0006B250 93 E1 00 0C */ stw r31, 0xc(r1)
/* 8006F414 0006B254 93 C1 00 08 */ stw r30, 0x8(r1)
/* 8006F418 0006B258 4B FE E2 89 */ bl WPADSetCallbackByKPAD
/* 8006F41C 0006B25C 3F E0 80 4C */ lis r31, inside_kpads@ha
/* 8006F420 0006B260 3B C0 00 00 */ li r30, 0x0
/* 8006F424 0006B264 3B FF 7C 08 */ addi r31, r31, inside_kpads@l
.global lbl_8006F428
lbl_8006F428:
/* 8006F428 0006B268 80 9F 06 38 */ lwz r4, 0x638(r31)
/* 8006F42C 0006B26C 2C 04 00 00 */ cmpwi r4, 0x0
/* 8006F430 0006B270 41 82 00 10 */ beq lbl_8006F440
/* 8006F434 0006B274 7F C3 F3 78 */ mr r3, r30
/* 8006F438 0006B278 4B FE 88 09 */ bl WPADSetSamplingCallback
/* 8006F43C 0006B27C 48 00 00 10 */ b lbl_8006F44C
.global lbl_8006F440
lbl_8006F440:
/* 8006F440 0006B280 7F C3 F3 78 */ mr r3, r30
/* 8006F444 0006B284 38 80 00 00 */ li r4, 0x0
/* 8006F448 0006B288 4B FE 87 F9 */ bl WPADSetSamplingCallback
.global lbl_8006F44C
lbl_8006F44C:
/* 8006F44C 0006B28C 80 9F 06 3C */ lwz r4, 0x63c(r31)
/* 8006F450 0006B290 2C 04 00 00 */ cmpwi r4, 0x0
/* 8006F454 0006B294 41 82 00 10 */ beq lbl_8006F464
/* 8006F458 0006B298 7F C3 F3 78 */ mr r3, r30
/* 8006F45C 0006B29C 4B FE 88 75 */ bl WPADSetConnectCallback
/* 8006F460 0006B2A0 48 00 00 10 */ b lbl_8006F470
.global lbl_8006F464
lbl_8006F464:
/* 8006F464 0006B2A4 7F C3 F3 78 */ mr r3, r30
/* 8006F468 0006B2A8 38 80 00 00 */ li r4, 0x0
/* 8006F46C 0006B2AC 4B FE 88 65 */ bl WPADSetConnectCallback
.global lbl_8006F470
lbl_8006F470:
/* 8006F470 0006B2B0 3B DE 00 01 */ addi r30, r30, 0x1
/* 8006F474 0006B2B4 3B FF 06 88 */ addi r31, r31, 0x688
/* 8006F478 0006B2B8 2C 1E 00 04 */ cmpwi r30, 0x4
/* 8006F47C 0006B2BC 41 80 FF AC */ blt lbl_8006F428
/* 8006F480 0006B2C0 48 00 10 B1 */ bl KMPLSShutdown
/* 8006F484 0006B2C4 38 00 00 00 */ li r0, 0x0
/* 8006F488 0006B2C8 98 0D EA 54 */ stb r0, kp_initialized@sda21(r13)
/* 8006F48C 0006B2CC 83 E1 00 0C */ lwz r31, 0xc(r1)
/* 8006F490 0006B2D0 83 C1 00 08 */ lwz r30, 0x8(r1)
/* 8006F494 0006B2D4 80 01 00 14 */ lwz r0, 0x14(r1)
/* 8006F498 0006B2D8 7C 08 03 A6 */ mtlr r0
/* 8006F49C 0006B2DC 38 21 00 10 */ addi r1, r1, 0x10
/* 8006F4A0 0006B2E0 4E 80 00 20 */ blr
/* 8006F4A4 0006B2E4 00 00 00 00 */ .4byte 0x00000000
/* 8006F4A8 0006B2E8 00 00 00 00 */ .4byte 0x00000000
/* 8006F4AC 0006B2EC 00 00 00 00 */ .4byte 0x00000000
.global KPADReset
KPADReset:
/* 8006F4B0 0006B2F0 94 21 FF D0 */ stwu r1, -0x30(r1)
/* 8006F4B4 0006B2F4 7C 08 02 A6 */ mflr r0
/* 8006F4B8 0006B2F8 90 01 00 34 */ stw r0, 0x34(r1)
/* 8006F4BC 0006B2FC DB E1 00 20 */ stfd f31, 0x20(r1)
/* 8006F4C0 0006B300 F3 E1 00 28 */ psq_st f31, 0x28(r1), 0, qr0
/* 8006F4C4 0006B304 93 E1 00 1C */ stw r31, 0x1c(r1)
/* 8006F4C8 0006B308 93 C1 00 18 */ stw r30, 0x18(r1)
/* 8006F4CC 0006B30C 93 A1 00 14 */ stw r29, 0x14(r1)
/* 8006F4D0 0006B310 C3 ED 84 00 */ lfs f31, kp_obj_interval@sda21(r13)
/* 8006F4D4 0006B314 4B FB 23 4D */ bl OSDisableInterrupts
/* 8006F4D8 0006B318 C0 02 88 D0 */ lfs f0, "@5613"@sda21(r2)
/* 8006F4DC 0006B31C D3 ED 84 00 */ stfs f31, kp_obj_interval@sda21(r13)
/* 8006F4E0 0006B320 EC 1F 00 24 */ fdivs f0, f31, f0
/* 8006F4E4 0006B324 D0 0D EA 90 */ stfs f0, kp_err_dist_min@sda21(r13)
/* 8006F4E8 0006B328 D0 0D EA 8C */ stfs f0, kp_dist_vv1@sda21(r13)
/* 8006F4EC 0006B32C 4B FB 23 75 */ bl OSRestoreInterrupts
/* 8006F4F0 0006B330 3C 60 80 4C */ lis r3, inside_kpads@ha
/* 8006F4F4 0006B334 3B A0 00 03 */ li r29, 0x3
/* 8006F4F8 0006B338 38 63 7C 08 */ addi r3, r3, inside_kpads@l
/* 8006F4FC 0006B33C 3B E0 00 01 */ li r31, 0x1
/* 8006F500 0006B340 3B C3 13 98 */ addi r30, r3, 0x1398
.global lbl_8006F504
lbl_8006F504:
/* 8006F504 0006B344 4B FE 6F 9D */ bl WPADGetStatus
/* 8006F508 0006B348 2C 03 00 03 */ cmpwi r3, 0x3
/* 8006F50C 0006B34C 40 82 00 10 */ bne lbl_8006F51C
/* 8006F510 0006B350 7F A3 EB 78 */ mr r3, r29
/* 8006F514 0006B354 38 80 00 00 */ li r4, 0x0
/* 8006F518 0006B358 4B FE 8C 39 */ bl WPADControlMotor
.global lbl_8006F51C
lbl_8006F51C:
/* 8006F51C 0006B35C 37 BD FF FF */ addic. r29, r29, -0x1
/* 8006F520 0006B360 9B FE 06 40 */ stb r31, 0x640(r30)
/* 8006F524 0006B364 3B DE F9 78 */ addi r30, r30, -0x688
/* 8006F528 0006B368 40 80 FF DC */ bge lbl_8006F504
/* 8006F52C 0006B36C 80 01 00 34 */ lwz r0, 0x34(r1)
/* 8006F530 0006B370 E3 E1 00 28 */ psq_l f31, 0x28(r1), 0, qr0
/* 8006F534 0006B374 CB E1 00 20 */ lfd f31, 0x20(r1)
/* 8006F538 0006B378 83 E1 00 1C */ lwz r31, 0x1c(r1)
/* 8006F53C 0006B37C 83 C1 00 18 */ lwz r30, 0x18(r1)
/* 8006F540 0006B380 83 A1 00 14 */ lwz r29, 0x14(r1)
/* 8006F544 0006B384 7C 08 03 A6 */ mtlr r0
/* 8006F548 0006B388 38 21 00 30 */ addi r1, r1, 0x30
/* 8006F54C 0006B38C 4E 80 00 20 */ blr
.global KPADiConnectCallback
KPADiConnectCallback:
/* 8006F550 0006B390 94 21 FF E0 */ stwu r1, -0x20(r1)
/* 8006F554 0006B394 7C 08 02 A6 */ mflr r0
/* 8006F558 0006B398 3C A0 80 4C */ lis r5, inside_kpads@ha
/* 8006F55C 0006B39C 2C 04 00 00 */ cmpwi r4, 0x0
/* 8006F560 0006B3A0 90 01 00 24 */ stw r0, 0x24(r1)
/* 8006F564 0006B3A4 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006F568 0006B3A8 38 A5 7C 08 */ addi r5, r5, inside_kpads@l
/* 8006F56C 0006B3AC 93 E1 00 1C */ stw r31, 0x1c(r1)
/* 8006F570 0006B3B0 7F E5 02 14 */ add r31, r5, r0
/* 8006F574 0006B3B4 93 C1 00 18 */ stw r30, 0x18(r1)
/* 8006F578 0006B3B8 7C 9E 23 78 */ mr r30, r4
/* 8006F57C 0006B3BC 93 A1 00 14 */ stw r29, 0x14(r1)
/* 8006F580 0006B3C0 7C 7D 1B 78 */ mr r29, r3
/* 8006F584 0006B3C4 93 81 00 10 */ stw r28, 0x10(r1)
/* 8006F588 0006B3C8 40 82 00 9C */ bne lbl_8006F624
/* 8006F58C 0006B3CC 3B 80 00 00 */ li r28, 0x0
/* 8006F590 0006B3D0 93 9F 06 5C */ stw r28, 0x65c(r31)
/* 8006F594 0006B3D4 38 00 00 01 */ li r0, 0x1
/* 8006F598 0006B3D8 38 60 00 00 */ li r3, 0x0
/* 8006F59C 0006B3DC 98 1F 06 7E */ stb r0, 0x67e(r31)
/* 8006F5A0 0006B3E0 4B FE E1 01 */ bl WPADSetCallbackByKPAD
/* 8006F5A4 0006B3E4 3C 80 80 07 */ lis r4, KPADiSamplingCallback@ha
/* 8006F5A8 0006B3E8 7F A3 EB 78 */ mr r3, r29
/* 8006F5AC 0006B3EC 38 84 F9 C0 */ addi r4, r4, KPADiSamplingCallback@l
/* 8006F5B0 0006B3F0 4B FE 86 91 */ bl WPADSetSamplingCallback
/* 8006F5B4 0006B3F4 38 60 00 01 */ li r3, 0x1
/* 8006F5B8 0006B3F8 4B FE E0 E9 */ bl WPADSetCallbackByKPAD
/* 8006F5BC 0006B3FC 9B 9F 06 43 */ stb r28, 0x643(r31)
/* 8006F5C0 0006B400 2C 1D 00 03 */ cmpwi r29, 0x3
/* 8006F5C4 0006B404 9B 9F 06 45 */ stb r28, 0x645(r31)
/* 8006F5C8 0006B408 9B 9F 06 44 */ stb r28, 0x644(r31)
/* 8006F5CC 0006B40C 40 82 00 30 */ bne lbl_8006F5FC
/* 8006F5D0 0006B410 88 0D EA 83 */ lbz r0, kp_wbc_zero_point_done@sda21(r13)
/* 8006F5D4 0006B414 9B 8D EA 8A */ stb r28, kp_wbc_issued@sda21(r13)
/* 8006F5D8 0006B418 2C 00 00 04 */ cmpwi r0, 0x4
/* 8006F5DC 0006B41C 9B 8D EA 89 */ stb r28, kp_wbc_enabled@sda21(r13)
/* 8006F5E0 0006B420 41 82 00 08 */ beq lbl_8006F5E8
/* 8006F5E4 0006B424 9B 8D EA 83 */ stb r28, kp_wbc_zero_point_done@sda21(r13)
.global lbl_8006F5E8
lbl_8006F5E8:
/* 8006F5E8 0006B428 38 00 FF FE */ li r0, -0x2
/* 8006F5EC 0006B42C 38 60 00 00 */ li r3, 0x0
/* 8006F5F0 0006B430 98 6D EA 85 */ stb r3, kp_wbc_tgc_weight_done@sda21(r13)
/* 8006F5F4 0006B434 98 0D EA 88 */ stb r0, kp_wbc_tgc_weight_err@sda21(r13)
/* 8006F5F8 0006B438 90 1F 00 A8 */ stw r0, 0xa8(r31)
.global lbl_8006F5FC
lbl_8006F5FC:
/* 8006F5FC 0006B43C 38 80 00 00 */ li r4, 0x0
/* 8006F600 0006B440 98 9F 06 7A */ stb r4, 0x67a(r31)
/* 8006F604 0006B444 38 60 00 01 */ li r3, 0x1
/* 8006F608 0006B448 98 7F 06 7D */ stb r3, 0x67d(r31)
/* 8006F60C 0006B44C 88 1F 06 79 */ lbz r0, 0x679(r31)
/* 8006F610 0006B450 98 1F 06 78 */ stb r0, 0x678(r31)
/* 8006F614 0006B454 98 9F 06 77 */ stb r4, 0x677(r31)
/* 8006F618 0006B458 98 9F 06 7B */ stb r4, 0x67b(r31)
/* 8006F61C 0006B45C 98 7F 06 7C */ stb r3, 0x67c(r31)
/* 8006F620 0006B460 48 00 00 F0 */ b lbl_8006F710
.global lbl_8006F624
lbl_8006F624:
/* 8006F624 0006B464 38 80 FF FF */ li r4, -0x1
/* 8006F628 0006B468 98 9F 01 A9 */ stb r4, 0x1a9(r31)
/* 8006F62C 0006B46C 38 C0 00 00 */ li r6, 0x0
/* 8006F630 0006B470 38 A0 00 00 */ li r5, 0x0
/* 8006F634 0006B474 98 9F 01 EB */ stb r4, 0x1eb(r31)
/* 8006F638 0006B478 98 9F 02 2D */ stb r4, 0x22d(r31)
/* 8006F63C 0006B47C 98 9F 02 6F */ stb r4, 0x26f(r31)
/* 8006F640 0006B480 98 9F 02 B1 */ stb r4, 0x2b1(r31)
/* 8006F644 0006B484 98 9F 02 F3 */ stb r4, 0x2f3(r31)
/* 8006F648 0006B488 98 9F 03 35 */ stb r4, 0x335(r31)
/* 8006F64C 0006B48C 98 9F 03 77 */ stb r4, 0x377(r31)
/* 8006F650 0006B490 98 9F 03 B9 */ stb r4, 0x3b9(r31)
/* 8006F654 0006B494 98 9F 03 FB */ stb r4, 0x3fb(r31)
/* 8006F658 0006B498 98 9F 04 3D */ stb r4, 0x43d(r31)
/* 8006F65C 0006B49C 98 9F 04 7F */ stb r4, 0x47f(r31)
/* 8006F660 0006B4A0 98 9F 04 C1 */ stb r4, 0x4c1(r31)
/* 8006F664 0006B4A4 98 9F 05 03 */ stb r4, 0x503(r31)
/* 8006F668 0006B4A8 98 9F 05 45 */ stb r4, 0x545(r31)
/* 8006F66C 0006B4AC 98 9F 05 87 */ stb r4, 0x587(r31)
/* 8006F670 0006B4B0 48 00 00 1C */ b lbl_8006F68C
/* 8006F674 0006B4B4 60 00 00 00 */ nop
.global lbl_8006F678
lbl_8006F678:
/* 8006F678 0006B4B8 80 1F 05 A0 */ lwz r0, 0x5a0(r31)
/* 8006F67C 0006B4BC 38 C6 00 01 */ addi r6, r6, 0x1
/* 8006F680 0006B4C0 7C 60 2A 14 */ add r3, r0, r5
/* 8006F684 0006B4C4 38 A5 00 42 */ addi r5, r5, 0x42
/* 8006F688 0006B4C8 98 83 00 29 */ stb r4, 0x29(r3)
.global lbl_8006F68C
lbl_8006F68C:
/* 8006F68C 0006B4CC 80 1F 05 A4 */ lwz r0, 0x5a4(r31)
/* 8006F690 0006B4D0 7C 06 00 40 */ cmplw r6, r0
/* 8006F694 0006B4D4 41 80 FF E4 */ blt lbl_8006F678
/* 8006F698 0006B4D8 80 1F 05 F8 */ lwz r0, 0x5f8(r31)
/* 8006F69C 0006B4DC 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006F6A0 0006B4E0 41 82 00 34 */ beq lbl_8006F6D4
/* 8006F6A4 0006B4E4 88 1F 06 47 */ lbz r0, 0x647(r31)
/* 8006F6A8 0006B4E8 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006F6AC 0006B4EC 40 82 00 28 */ bne lbl_8006F6D4
/* 8006F6B0 0006B4F0 38 00 00 01 */ li r0, 0x1
/* 8006F6B4 0006B4F4 98 1F 06 47 */ stb r0, 0x647(r31)
/* 8006F6B8 0006B4F8 7F A3 EB 78 */ mr r3, r29
/* 8006F6BC 0006B4FC 38 80 00 01 */ li r4, 0x1
/* 8006F6C0 0006B500 81 9F 05 F8 */ lwz r12, 0x5f8(r31)
/* 8006F6C4 0006B504 7D 89 03 A6 */ mtctr r12
/* 8006F6C8 0006B508 4E 80 04 21 */ bctrl
/* 8006F6CC 0006B50C 38 00 00 00 */ li r0, 0x0
/* 8006F6D0 0006B510 98 1F 06 46 */ stb r0, 0x646(r31)
.global lbl_8006F6D4
lbl_8006F6D4:
/* 8006F6D4 0006B514 7F A3 EB 78 */ mr r3, r29
/* 8006F6D8 0006B518 4B FE AD 89 */ bl WPADIsDpdEnabled
/* 8006F6DC 0006B51C 98 7F 06 43 */ stb r3, 0x643(r31)
/* 8006F6E0 0006B520 38 00 00 00 */ li r0, 0x0
/* 8006F6E4 0006B524 98 1F 06 44 */ stb r0, 0x644(r31)
/* 8006F6E8 0006B528 88 1F 06 7C */ lbz r0, 0x67c(r31)
/* 8006F6EC 0006B52C 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006F6F0 0006B530 40 82 00 20 */ bne lbl_8006F710
/* 8006F6F4 0006B534 81 9F 06 80 */ lwz r12, 0x680(r31)
/* 8006F6F8 0006B538 2C 0C 00 00 */ cmpwi r12, 0x0
/* 8006F6FC 0006B53C 41 82 00 14 */ beq lbl_8006F710
/* 8006F700 0006B540 7F A3 EB 78 */ mr r3, r29
/* 8006F704 0006B544 38 80 00 01 */ li r4, 0x1
/* 8006F708 0006B548 7D 89 03 A6 */ mtctr r12
/* 8006F70C 0006B54C 4E 80 04 21 */ bctrl
.global lbl_8006F710
lbl_8006F710:
/* 8006F710 0006B550 81 9F 06 3C */ lwz r12, 0x63c(r31)
/* 8006F714 0006B554 2C 0C 00 00 */ cmpwi r12, 0x0
/* 8006F718 0006B558 41 82 00 14 */ beq lbl_8006F72C
/* 8006F71C 0006B55C 7F A3 EB 78 */ mr r3, r29
/* 8006F720 0006B560 7F C4 F3 78 */ mr r4, r30
/* 8006F724 0006B564 7D 89 03 A6 */ mtctr r12
/* 8006F728 0006B568 4E 80 04 21 */ bctrl
.global lbl_8006F72C
lbl_8006F72C:
/* 8006F72C 0006B56C 80 01 00 24 */ lwz r0, 0x24(r1)
/* 8006F730 0006B570 83 E1 00 1C */ lwz r31, 0x1c(r1)
/* 8006F734 0006B574 83 C1 00 18 */ lwz r30, 0x18(r1)
/* 8006F738 0006B578 83 A1 00 14 */ lwz r29, 0x14(r1)
/* 8006F73C 0006B57C 83 81 00 10 */ lwz r28, 0x10(r1)
/* 8006F740 0006B580 7C 08 03 A6 */ mtlr r0
/* 8006F744 0006B584 38 21 00 20 */ addi r1, r1, 0x20
/* 8006F748 0006B588 4E 80 00 20 */ blr
/* 8006F74C 0006B58C 00 00 00 00 */ .4byte 0x00000000
.global KPADSetConnectCallback
KPADSetConnectCallback:
/* 8006F750 0006B590 94 21 FF F0 */ stwu r1, -0x10(r1)
/* 8006F754 0006B594 7C 08 02 A6 */ mflr r0
/* 8006F758 0006B598 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006F75C 0006B59C 93 E1 00 0C */ stw r31, 0xc(r1)
/* 8006F760 0006B5A0 7C 7F 1B 78 */ mr r31, r3
/* 8006F764 0006B5A4 93 C1 00 08 */ stw r30, 0x8(r1)
/* 8006F768 0006B5A8 7C 9E 23 78 */ mr r30, r4
/* 8006F76C 0006B5AC 4B FB 20 B5 */ bl OSDisableInterrupts
/* 8006F770 0006B5B0 1C 1F 06 88 */ mulli r0, r31, 0x688
/* 8006F774 0006B5B4 3C 80 80 4C */ lis r4, inside_kpads@ha
/* 8006F778 0006B5B8 38 84 7C 08 */ addi r4, r4, inside_kpads@l
/* 8006F77C 0006B5BC 7C 84 02 14 */ add r4, r4, r0
/* 8006F780 0006B5C0 83 E4 06 3C */ lwz r31, 0x63c(r4)
/* 8006F784 0006B5C4 93 C4 06 3C */ stw r30, 0x63c(r4)
/* 8006F788 0006B5C8 4B FB 20 D9 */ bl OSRestoreInterrupts
/* 8006F78C 0006B5CC 7F E3 FB 78 */ mr r3, r31
/* 8006F790 0006B5D0 83 E1 00 0C */ lwz r31, 0xc(r1)
/* 8006F794 0006B5D4 83 C1 00 08 */ lwz r30, 0x8(r1)
/* 8006F798 0006B5D8 80 01 00 14 */ lwz r0, 0x14(r1)
/* 8006F79C 0006B5DC 7C 08 03 A6 */ mtlr r0
/* 8006F7A0 0006B5E0 38 21 00 10 */ addi r1, r1, 0x10
/* 8006F7A4 0006B5E4 4E 80 00 20 */ blr
/* 8006F7A8 0006B5E8 00 00 00 00 */ .4byte 0x00000000
/* 8006F7AC 0006B5EC 00 00 00 00 */ .4byte 0x00000000
.global KPADiControlWbcCallback
KPADiControlWbcCallback:
/* 8006F7B0 0006B5F0 7C 83 00 34 */ cntlzw r3, r4
/* 8006F7B4 0006B5F4 38 00 00 00 */ li r0, 0x0
/* 8006F7B8 0006B5F8 54 63 D9 7E */ srwi r3, r3, 5
/* 8006F7BC 0006B5FC 98 6D EA 89 */ stb r3, kp_wbc_enabled@sda21(r13)
/* 8006F7C0 0006B600 98 0D EA 82 */ stb r0, kp_wbc_failure_count@sda21(r13)
/* 8006F7C4 0006B604 98 0D EA 8A */ stb r0, kp_wbc_issued@sda21(r13)
/* 8006F7C8 0006B608 4E 80 00 20 */ blr
/* 8006F7CC 0006B60C 00 00 00 00 */ .4byte 0x00000000
.global KPADiUpdateTempWbcCallback
KPADiUpdateTempWbcCallback:
/* 8006F7D0 0006B610 2C 04 00 00 */ cmpwi r4, 0x0
/* 8006F7D4 0006B614 40 82 00 1C */ bne lbl_8006F7F0
/* 8006F7D8 0006B618 38 80 00 02 */ li r4, 0x2
/* 8006F7DC 0006B61C 38 60 00 64 */ li r3, 0x64
/* 8006F7E0 0006B620 38 00 00 00 */ li r0, 0x0
/* 8006F7E4 0006B624 98 8D EA 83 */ stb r4, kp_wbc_zero_point_done@sda21(r13)
/* 8006F7E8 0006B628 98 6D EA 84 */ stb r3, kp_wbc_zero_point_wait@sda21(r13)
/* 8006F7EC 0006B62C B0 0D EA 80 */ sth r0, kp_wbc_ave_sample_count@sda21(r13)
.global lbl_8006F7F0
lbl_8006F7F0:
/* 8006F7F0 0006B630 38 00 00 00 */ li r0, 0x0
/* 8006F7F4 0006B634 98 0D EA 8A */ stb r0, kp_wbc_issued@sda21(r13)
/* 8006F7F8 0006B638 4E 80 00 20 */ blr
/* 8006F7FC 0006B63C 00 00 00 00 */ .4byte 0x00000000
.global KPADDisableDPD
KPADDisableDPD:
/* 8006F800 0006B640 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006F804 0006B644 3C 60 80 4C */ lis r3, inside_kpads@ha
/* 8006F808 0006B648 38 80 00 00 */ li r4, 0x0
/* 8006F80C 0006B64C 38 63 7C 08 */ addi r3, r3, inside_kpads@l
/* 8006F810 0006B650 7C 63 02 14 */ add r3, r3, r0
/* 8006F814 0006B654 98 83 06 42 */ stb r4, 0x642(r3)
/* 8006F818 0006B658 4E 80 00 20 */ blr
/* 8006F81C 0006B65C 00 00 00 00 */ .4byte 0x00000000
.global KPADEnableDPD
KPADEnableDPD:
/* 8006F820 0006B660 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006F824 0006B664 3C 60 80 4C */ lis r3, inside_kpads@ha
/* 8006F828 0006B668 38 80 00 01 */ li r4, 0x1
/* 8006F82C 0006B66C 38 63 7C 08 */ addi r3, r3, inside_kpads@l
/* 8006F830 0006B670 7C 63 02 14 */ add r3, r3, r0
/* 8006F834 0006B674 98 83 06 42 */ stb r4, 0x642(r3)
/* 8006F838 0006B678 4E 80 00 20 */ blr
/* 8006F83C 0006B67C 00 00 00 00 */ .4byte 0x00000000
.global KPADiControlDpdCallback
KPADiControlDpdCallback:
/* 8006F840 0006B680 94 21 FF F0 */ stwu r1, -0x10(r1)
/* 8006F844 0006B684 7C 08 02 A6 */ mflr r0
/* 8006F848 0006B688 3C A0 80 4C */ lis r5, inside_kpads@ha
/* 8006F84C 0006B68C 2C 04 00 00 */ cmpwi r4, 0x0
/* 8006F850 0006B690 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006F854 0006B694 1C 03 06 88 */ mulli r0, r3, 0x688
/* 8006F858 0006B698 38 A5 7C 08 */ addi r5, r5, inside_kpads@l
/* 8006F85C 0006B69C 93 E1 00 0C */ stw r31, 0xc(r1)
/* 8006F860 0006B6A0 7F E5 02 14 */ add r31, r5, r0
/* 8006F864 0006B6A4 93 C1 00 08 */ stw r30, 0x8(r1)
/* 8006F868 0006B6A8 7C 7E 1B 78 */ mr r30, r3
/* 8006F86C 0006B6AC 40 82 00 3C */ bne lbl_8006F8A8
/* 8006F870 0006B6B0 80 1F 05 F8 */ lwz r0, 0x5f8(r31)
/* 8006F874 0006B6B4 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006F878 0006B6B8 41 82 00 30 */ beq lbl_8006F8A8
/* 8006F87C 0006B6BC 88 1F 06 47 */ lbz r0, 0x647(r31)
/* 8006F880 0006B6C0 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006F884 0006B6C4 40 82 00 24 */ bne lbl_8006F8A8
/* 8006F888 0006B6C8 38 00 00 01 */ li r0, 0x1
/* 8006F88C 0006B6CC 98 1F 06 47 */ stb r0, 0x647(r31)
/* 8006F890 0006B6D0 38 80 00 01 */ li r4, 0x1
/* 8006F894 0006B6D4 81 9F 05 F8 */ lwz r12, 0x5f8(r31)
/* 8006F898 0006B6D8 7D 89 03 A6 */ mtctr r12
/* 8006F89C 0006B6DC 4E 80 04 21 */ bctrl
/* 8006F8A0 0006B6E0 38 00 00 00 */ li r0, 0x0
/* 8006F8A4 0006B6E4 98 1F 06 46 */ stb r0, 0x646(r31)
.global lbl_8006F8A8
lbl_8006F8A8:
/* 8006F8A8 0006B6E8 7F C3 F3 78 */ mr r3, r30
/* 8006F8AC 0006B6EC 4B FE AB B5 */ bl WPADIsDpdEnabled
/* 8006F8B0 0006B6F0 98 7F 06 43 */ stb r3, 0x643(r31)
/* 8006F8B4 0006B6F4 38 00 00 00 */ li r0, 0x0
/* 8006F8B8 0006B6F8 98 1F 06 44 */ stb r0, 0x644(r31)
/* 8006F8BC 0006B6FC 83 E1 00 0C */ lwz r31, 0xc(r1)
/* 8006F8C0 0006B700 83 C1 00 08 */ lwz r30, 0x8(r1)
/* 8006F8C4 0006B704 80 01 00 14 */ lwz r0, 0x14(r1)
/* 8006F8C8 0006B708 7C 08 03 A6 */ mtlr r0
/* 8006F8CC 0006B70C 38 21 00 10 */ addi r1, r1, 0x10
/* 8006F8D0 0006B710 4E 80 00 20 */ blr
/* 8006F8D4 0006B714 00 00 00 00 */ .4byte 0x00000000
/* 8006F8D8 0006B718 00 00 00 00 */ .4byte 0x00000000
/* 8006F8DC 0006B71C 00 00 00 00 */ .4byte 0x00000000
.global KPADiControlMplsCallback
KPADiControlMplsCallback:
/* 8006F8E0 0006B720 94 21 FF F0 */ stwu r1, -0x10(r1)
/* 8006F8E4 0006B724 7C 08 02 A6 */ mflr r0
/* 8006F8E8 0006B728 3C A0 80 4C */ lis r5, inside_kpads@ha
/* 8006F8EC 0006B72C 2C 04 00 00 */ cmpwi r4, 0x0
/* 8006F8F0 0006B730 90 01 00 14 */ stw r0, 0x14(r1)
/* 8006F8F4 0006B734 1C C3 06 88 */ mulli r6, r3, 0x688
/* 8006F8F8 0006B738 38 A5 7C 08 */ addi r5, r5, inside_kpads@l
/* 8006F8FC 0006B73C 93 E1 00 0C */ stw r31, 0xc(r1)
/* 8006F900 0006B740 38 00 00 00 */ li r0, 0x0
/* 8006F904 0006B744 7F E5 32 14 */ add r31, r5, r6
/* 8006F908 0006B748 98 1F 06 7A */ stb r0, 0x67a(r31)
/* 8006F90C 0006B74C 38 00 00 01 */ li r0, 0x1
/* 8006F910 0006B750 98 1F 06 7D */ stb r0, 0x67d(r31)
/* 8006F914 0006B754 40 82 00 10 */ bne lbl_8006F924
/* 8006F918 0006B758 88 1F 06 76 */ lbz r0, 0x676(r31)
/* 8006F91C 0006B75C 98 1F 06 77 */ stb r0, 0x677(r31)
/* 8006F920 0006B760 48 00 00 88 */ b lbl_8006F9A8
.global lbl_8006F924
lbl_8006F924:
/* 8006F924 0006B764 38 04 00 04 */ addi r0, r4, 0x4
/* 8006F928 0006B768 28 00 00 01 */ cmplwi r0, 0x1
/* 8006F92C 0006B76C 41 81 00 74 */ bgt lbl_8006F9A0
/* 8006F930 0006B770 88 1F 06 7C */ lbz r0, 0x67c(r31)
/* 8006F934 0006B774 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006F938 0006B778 40 82 00 68 */ bne lbl_8006F9A0
/* 8006F93C 0006B77C 88 9F 06 76 */ lbz r4, 0x676(r31)
/* 8006F940 0006B780 2C 04 00 00 */ cmpwi r4, 0x0
/* 8006F944 0006B784 41 82 00 5C */ beq lbl_8006F9A0
/* 8006F948 0006B788 88 1F 06 78 */ lbz r0, 0x678(r31)
/* 8006F94C 0006B78C 7C 04 00 40 */ cmplw r4, r0
/* 8006F950 0006B790 40 82 00 50 */ bne lbl_8006F9A0
/* 8006F954 0006B794 2C 04 00 05 */ cmpwi r4, 0x5
/* 8006F958 0006B798 41 82 00 10 */ beq lbl_8006F968
/* 8006F95C 0006B79C 2C 04 00 07 */ cmpwi r4, 0x7
/* 8006F960 0006B7A0 41 82 00 10 */ beq lbl_8006F970
/* 8006F964 0006B7A4 48 00 00 14 */ b lbl_8006F978
.global lbl_8006F968
lbl_8006F968:
/* 8006F968 0006B7A8 38 80 FF FE */ li r4, -0x2
/* 8006F96C 0006B7AC 48 00 00 10 */ b lbl_8006F97C
.global lbl_8006F970
lbl_8006F970:
/* 8006F970 0006B7B0 38 80 FF FD */ li r4, -0x3
/* 8006F974 0006B7B4 48 00 00 08 */ b lbl_8006F97C
.global lbl_8006F978
lbl_8006F978:
/* 8006F978 0006B7B8 38 80 FF FF */ li r4, -0x1
.global lbl_8006F97C
lbl_8006F97C:
/* 8006F97C 0006B7BC 38 00 00 00 */ li r0, 0x0
/* 8006F980 0006B7C0 98 1F 06 7C */ stb r0, 0x67c(r31)
/* 8006F984 0006B7C4 81 9F 06 80 */ lwz r12, 0x680(r31)
/* 8006F988 0006B7C8 2C 0C 00 00 */ cmpwi r12, 0x0
/* 8006F98C 0006B7CC 41 82 00 0C */ beq lbl_8006F998
/* 8006F990 0006B7D0 7D 89 03 A6 */ mtctr r12
/* 8006F994 0006B7D4 4E 80 04 21 */ bctrl
.global lbl_8006F998
lbl_8006F998:
/* 8006F998 0006B7D8 38 00 00 01 */ li r0, 0x1
/* 8006F99C 0006B7DC 98 1F 06 7B */ stb r0, 0x67b(r31)
.global lbl_8006F9A0
lbl_8006F9A0:
/* 8006F9A0 0006B7E0 38 00 00 00 */ li r0, 0x0
/* 8006F9A4 0006B7E4 98 1F 06 77 */ stb r0, 0x677(r31)
.global lbl_8006F9A8
lbl_8006F9A8:
/* 8006F9A8 0006B7E8 80 01 00 14 */ lwz r0, 0x14(r1)
/* 8006F9AC 0006B7EC 83 E1 00 0C */ lwz r31, 0xc(r1)
/* 8006F9B0 0006B7F0 7C 08 03 A6 */ mtlr r0
/* 8006F9B4 0006B7F4 38 21 00 10 */ addi r1, r1, 0x10
/* 8006F9B8 0006B7F8 4E 80 00 20 */ blr
/* 8006F9BC 0006B7FC 00 00 00 00 */ .4byte 0x00000000
.global KPADiSamplingCallback
KPADiSamplingCallback:
/* 8006F9C0 0006B800 94 21 FF A0 */ stwu r1, -0x60(r1)
/* 8006F9C4 0006B804 7C 08 02 A6 */ mflr r0
/* 8006F9C8 0006B808 90 01 00 64 */ stw r0, 0x64(r1)
/* 8006F9CC 0006B80C 39 61 00 40 */ addi r11, r1, 0x40
/* 8006F9D0 0006B810 DB E1 00 50 */ stfd f31, 0x50(r1)
/* 8006F9D4 0006B814 F3 E1 00 58 */ psq_st f31, 0x58(r1), 0, qr0
/* 8006F9D8 0006B818 DB C1 00 40 */ stfd f30, 0x40(r1)
/* 8006F9DC 0006B81C F3 C1 00 48 */ psq_st f30, 0x48(r1), 0, qr0
/* 8006F9E0 0006B820 4B F9 79 5D */ bl lbl_8000733C
/* 8006F9E4 0006B824 3F E0 80 4C */ lis r31, inside_kpads@ha
/* 8006F9E8 0006B828 3C E0 43 30 */ lis r7, 0x4330
/* 8006F9EC 0006B82C 3B FF 7C 08 */ addi r31, r31, inside_kpads@l
/* 8006F9F0 0006B830 80 A2 88 E0 */ lwz r5, "@3159"@sda21(r2)
/* 8006F9F4 0006B834 A0 02 88 E4 */ lhz r0, lbl_8055E864@sda21(r2)
/* 8006F9F8 0006B838 1C C3 06 88 */ mulli r6, r3, 0x688
/* 8006F9FC 0006B83C 38 9F 00 00 */ addi r4, r31, 0x0
/* 8006FA00 0006B840 90 E1 00 18 */ stw r7, 0x18(r1)
/* 8006FA04 0006B844 7C 7C 1B 78 */ mr r28, r3
/* 8006FA08 0006B848 7F C4 32 14 */ add r30, r4, r6
/* 8006FA0C 0006B84C 90 E1 00 20 */ stw r7, 0x20(r1)
/* 8006FA10 0006B850 38 81 00 08 */ addi r4, r1, 0x8
/* 8006FA14 0006B854 90 A1 00 0C */ stw r5, 0xc(r1)
/* 8006FA18 0006B858 B0 01 00 10 */ sth r0, 0x10(r1)
/* 8006FA1C 0006B85C 4B FE 81 95 */ bl WPADProbe
/* 8006FA20 0006B860 2C 03 FF FF */ cmpwi r3, -0x1
/* 8006FA24 0006B864 41 82 09 24 */ beq lbl_80070348
/* 8006FA28 0006B868 80 7E 05 A4 */ lwz r3, 0x5a4(r30)
/* 8006FA2C 0006B86C 8B 7E 01 7A */ lbz r27, 0x17a(r30)
/* 8006FA30 0006B870 38 03 00 10 */ addi r0, r3, 0x10
/* 8006FA34 0006B874 7C 1B 00 40 */ cmplw r27, r0
/* 8006FA38 0006B878 41 80 00 08 */ blt lbl_8006FA40
/* 8006FA3C 0006B87C 3B 60 00 00 */ li r27, 0x0
.global lbl_8006FA40
lbl_8006FA40:
/* 8006FA40 0006B880 28 1B 00 10 */ cmplwi r27, 0x10
/* 8006FA44 0006B884 41 80 00 18 */ blt lbl_8006FA5C
/* 8006FA48 0006B888 38 1B FF F0 */ addi r0, r27, -0x10
/* 8006FA4C 0006B88C 80 7E 05 A0 */ lwz r3, 0x5a0(r30)
/* 8006FA50 0006B890 1C 00 00 42 */ mulli r0, r0, 0x42
/* 8006FA54 0006B894 7F A3 02 14 */ add r29, r3, r0
/* 8006FA58 0006B898 48 00 00 10 */ b lbl_8006FA68
.global lbl_8006FA5C
lbl_8006FA5C:
/* 8006FA5C 0006B89C 1C 1B 00 42 */ mulli r0, r27, 0x42
/* 8006FA60 0006B8A0 7C 7E 02 14 */ add r3, r30, r0
/* 8006FA64 0006B8A4 3B A3 01 80 */ addi r29, r3, 0x180
.global lbl_8006FA68
lbl_8006FA68:
/* 8006FA68 0006B8A8 7F 83 E3 78 */ mr r3, r28
/* 8006FA6C 0006B8AC 7F A4 EB 78 */ mr r4, r29
/* 8006FA70 0006B8B0 4B FE 8A D1 */ bl WPADRead
/* 8006FA74 0006B8B4 7F 83 E3 78 */ mr r3, r28
/* 8006FA78 0006B8B8 4B FE 83 49 */ bl WPADGetDataFormat
/* 8006FA7C 0006B8BC 98 7D 00 40 */ stb r3, 0x40(r29)
/* 8006FA80 0006B8C0 38 1B 00 01 */ addi r0, r27, 0x1
/* 8006FA84 0006B8C4 98 1E 01 7A */ stb r0, 0x17a(r30)
/* 8006FA88 0006B8C8 80 7E 05 A4 */ lwz r3, 0x5a4(r30)
/* 8006FA8C 0006B8CC 88 9E 01 7B */ lbz r4, 0x17b(r30)
/* 8006FA90 0006B8D0 38 03 00 10 */ addi r0, r3, 0x10
/* 8006FA94 0006B8D4 7C 04 00 40 */ cmplw r4, r0
/* 8006FA98 0006B8D8 40 80 00 0C */ bge lbl_8006FAA4
/* 8006FA9C 0006B8DC 38 04 00 01 */ addi r0, r4, 0x1
/* 8006FAA0 0006B8E0 98 1E 01 7B */ stb r0, 0x17b(r30)
.global lbl_8006FAA4
lbl_8006FAA4:
/* 8006FAA4 0006B8E4 80 1E 06 70 */ lwz r0, 0x670(r30)
/* 8006FAA8 0006B8E8 90 1E 06 6C */ stw r0, 0x66c(r30)
/* 8006FAAC 0006B8EC 4B FB 60 B5 */ bl OSGetTick
/* 8006FAB0 0006B8F0 90 7E 06 70 */ stw r3, 0x670(r30)
/* 8006FAB4 0006B8F4 80 61 00 08 */ lwz r3, 0x8(r1)
/* 8006FAB8 0006B8F8 80 1E 06 5C */ lwz r0, 0x65c(r30)
/* 8006FABC 0006B8FC 7C 03 00 40 */ cmplw r3, r0
/* 8006FAC0 0006B900 41 82 00 14 */ beq lbl_8006FAD4
/* 8006FAC4 0006B904 28 03 00 01 */ cmplwi r3, 0x1
/* 8006FAC8 0006B908 40 82 00 0C */ bne lbl_8006FAD4
/* 8006FACC 0006B90C 38 00 00 01 */ li r0, 0x1
/* 8006FAD0 0006B910 98 1E 06 7E */ stb r0, 0x67e(r30)
.global lbl_8006FAD4
lbl_8006FAD4:
/* 8006FAD4 0006B914 88 1E 06 7E */ lbz r0, 0x67e(r30)
/* 8006FAD8 0006B918 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006FADC 0006B91C 41 82 01 24 */ beq lbl_8006FC00
/* 8006FAE0 0006B920 7F 83 E3 78 */ mr r3, r28
/* 8006FAE4 0006B924 38 A1 00 0C */ addi r5, r1, 0xc
/* 8006FAE8 0006B928 38 80 00 00 */ li r4, 0x0
/* 8006FAEC 0006B92C 4B FE 7E F5 */ bl WPADGetAccGravityUnit
/* 8006FAF0 0006B930 A8 A1 00 0C */ lha r5, 0xc(r1)
/* 8006FAF4 0006B934 A8 81 00 10 */ lha r4, 0x10(r1)
/* 8006FAF8 0006B938 A8 61 00 0E */ lha r3, 0xe(r1)
/* 8006FAFC 0006B93C 7C 04 29 D6 */ mullw r0, r4, r5
/* 8006FB00 0006B940 7C 00 19 D7 */ mullw. r0, r0, r3
/* 8006FB04 0006B944 41 82 00 60 */ beq lbl_8006FB64
/* 8006FB08 0006B948 6C A0 80 00 */ xoris r0, r5, 0x8000
/* 8006FB0C 0006B94C 90 01 00 1C */ stw r0, 0x1c(r1)
/* 8006FB10 0006B950 6C 60 80 00 */ xoris r0, r3, 0x8000
/* 8006FB14 0006B954 C8 82 88 70 */ lfd f4, "@4806"@sda21(r2)
/* 8006FB18 0006B958 90 01 00 24 */ stw r0, 0x24(r1)
/* 8006FB1C 0006B95C 6C 83 80 00 */ xoris r3, r4, 0x8000
/* 8006FB20 0006B960 C8 21 00 18 */ lfd f1, 0x18(r1)
/* 8006FB24 0006B964 38 00 00 00 */ li r0, 0x0
/* 8006FB28 0006B968 C8 01 00 20 */ lfd f0, 0x20(r1)
/* 8006FB2C 0006B96C EC 41 20 28 */ fsubs f2, f1, f4
/* 8006FB30 0006B970 C0 62 88 60 */ lfs f3, "@4581"@sda21(r2)
/* 8006FB34 0006B974 EC 20 20 28 */ fsubs f1, f0, f4
/* 8006FB38 0006B978 90 61 00 1C */ stw r3, 0x1c(r1)
/* 8006FB3C 0006B97C C8 01 00 18 */ lfd f0, 0x18(r1)
/* 8006FB40 0006B980 EC 43 10 24 */ fdivs f2, f3, f2
/* 8006FB44 0006B984 D0 5E 05 FC */ stfs f2, 0x5fc(r30)
/* 8006FB48 0006B988 EC 00 20 28 */ fsubs f0, f0, f4
/* 8006FB4C 0006B98C EC 23 08 24 */ fdivs f1, f3, f1
/* 8006FB50 0006B990 D0 3E 06 00 */ stfs f1, 0x600(r30)
/* 8006FB54 0006B994 EC 03 00 24 */ fdivs f0, f3, f0
/* 8006FB58 0006B998 D0 1E 06 04 */ stfs f0, 0x604(r30)
/* 8006FB5C 0006B99C 98 1E 06 7E */ stb r0, 0x67e(r30)
/* 8006FB60 0006B9A0 48 00 00 14 */ b lbl_8006FB74
.global lbl_8006FB64
lbl_8006FB64:
/* 8006FB64 0006B9A4 C0 02 88 DC */ lfs f0, "@5800"@sda21(r2)
/* 8006FB68 0006B9A8 D0 1E 05 FC */ stfs f0, 0x5fc(r30)
/* 8006FB6C 0006B9AC D0 1E 06 00 */ stfs f0, 0x600(r30)
/* 8006FB70 0006B9B0 D0 1E 06 04 */ stfs f0, 0x604(r30)
.global lbl_8006FB74
lbl_8006FB74:
/* 8006FB74 0006B9B4 7F 83 E3 78 */ mr r3, r28
/* 8006FB78 0006B9B8 38 A1 00 0C */ addi r5, r1, 0xc
/* 8006FB7C 0006B9BC 38 80 00 01 */ li r4, 0x1
/* 8006FB80 0006B9C0 4B FE 7E 61 */ bl WPADGetAccGravityUnit
/* 8006FB84 0006B9C4 A8 A1 00 0C */ lha r5, 0xc(r1)
/* 8006FB88 0006B9C8 A8 81 00 10 */ lha r4, 0x10(r1)
/* 8006FB8C 0006B9CC A8 61 00 0E */ lha r3, 0xe(r1)
/* 8006FB90 0006B9D0 7C 04 29 D6 */ mullw r0, r4, r5
/* 8006FB94 0006B9D4 7C 00 19 D7 */ mullw. r0, r0, r3
/* 8006FB98 0006B9D8 41 82 00 58 */ beq lbl_8006FBF0
/* 8006FB9C 0006B9DC 6C A0 80 00 */ xoris r0, r5, 0x8000
/* 8006FBA0 0006B9E0 90 01 00 24 */ stw r0, 0x24(r1)
/* 8006FBA4 0006B9E4 6C 60 80 00 */ xoris r0, r3, 0x8000
/* 8006FBA8 0006B9E8 C8 82 88 70 */ lfd f4, "@4806"@sda21(r2)
/* 8006FBAC 0006B9EC 90 01 00 1C */ stw r0, 0x1c(r1)
/* 8006FBB0 0006B9F0 6C 80 80 00 */ xoris r0, r4, 0x8000
/* 8006FBB4 0006B9F4 C8 21 00 20 */ lfd f1, 0x20(r1)
/* 8006FBB8 0006B9F8 C8 01 00 18 */ lfd f0, 0x18(r1)
/* 8006FBBC 0006B9FC EC 41 20 28 */ fsubs f2, f1, f4
/* 8006FBC0 0006BA00 C0 62 88 60 */ lfs f3, "@4581"@sda21(r2)
/* 8006FBC4 0006BA04 EC 20 20 28 */ fsubs f1, f0, f4
/* 8006FBC8 0006BA08 90 01 00 24 */ stw r0, 0x24(r1)
/* 8006FBCC 0006BA0C C8 01 00 20 */ lfd f0, 0x20(r1)
/* 8006FBD0 0006BA10 EC 43 10 24 */ fdivs f2, f3, f2
/* 8006FBD4 0006BA14 D0 5E 06 08 */ stfs f2, 0x608(r30)
/* 8006FBD8 0006BA18 EC 00 20 28 */ fsubs f0, f0, f4
/* 8006FBDC 0006BA1C EC 23 08 24 */ fdivs f1, f3, f1
/* 8006FBE0 0006BA20 D0 3E 06 0C */ stfs f1, 0x60c(r30)
/* 8006FBE4 0006BA24 EC 03 00 24 */ fdivs f0, f3, f0
/* 8006FBE8 0006BA28 D0 1E 06 10 */ stfs f0, 0x610(r30)
/* 8006FBEC 0006BA2C 48 00 00 14 */ b lbl_8006FC00
.global lbl_8006FBF0
lbl_8006FBF0:
/* 8006FBF0 0006BA30 C0 02 88 D8 */ lfs f0, "@5799"@sda21(r2)
/* 8006FBF4 0006BA34 D0 1E 06 08 */ stfs f0, 0x608(r30)
/* 8006FBF8 0006BA38 D0 1E 06 0C */ stfs f0, 0x60c(r30)
/* 8006FBFC 0006BA3C D0 1E 06 10 */ stfs f0, 0x610(r30)
.global lbl_8006FC00
lbl_8006FC00:
/* 8006FC00 0006BA40 88 1E 06 48 */ lbz r0, 0x648(r30)
/* 8006FC04 0006BA44 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006FC08 0006BA48 41 82 00 B8 */ beq lbl_8006FCC0
/* 8006FC0C 0006BA4C 88 1E 06 49 */ lbz r0, 0x649(r30)
/* 8006FC10 0006BA50 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006FC14 0006BA54 41 82 00 24 */ beq lbl_8006FC38
/* 8006FC18 0006BA58 4B FE 68 E9 */ bl WPADGetSensorBarPosition
/* 8006FC1C 0006BA5C 54 60 06 3E */ clrlwi r0, r3, 24
/* 8006FC20 0006BA60 28 00 00 01 */ cmplwi r0, 0x1
/* 8006FC24 0006BA64 40 82 00 0C */ bne lbl_8006FC30
/* 8006FC28 0006BA68 C0 02 88 90 */ lfs f0, "@5392"@sda21(r2)
/* 8006FC2C 0006BA6C 48 00 00 10 */ b lbl_8006FC3C
.global lbl_8006FC30
lbl_8006FC30:
/* 8006FC30 0006BA70 C0 02 88 E8 */ lfs f0, "@6007"@sda21(r2)
/* 8006FC34 0006BA74 48 00 00 08 */ b lbl_8006FC3C
.global lbl_8006FC38
lbl_8006FC38:
/* 8006FC38 0006BA78 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
.global lbl_8006FC3C
lbl_8006FC3C:
/* 8006FC3C 0006BA7C C3 C2 88 60 */ lfs f30, "@4581"@sda21(r2)
/* 8006FC40 0006BA80 FC 40 00 50 */ fneg f2, f0
/* 8006FC44 0006BA84 C3 E2 88 68 */ lfs f31, "@4583"@sda21(r2)
/* 8006FC48 0006BA88 EC 3E 07 B2 */ fmuls f1, f30, f30
/* 8006FC4C 0006BA8C C0 62 88 50 */ lfs f3, "@4535"@sda21(r2)
/* 8006FC50 0006BA90 EC 1F 07 F2 */ fmuls f0, f31, f31
/* 8006FC54 0006BA94 D0 7E 01 24 */ stfs f3, 0x124(r30)
/* 8006FC58 0006BA98 D0 5E 01 28 */ stfs f2, 0x128(r30)
/* 8006FC5C 0006BA9C EC 21 00 2A */ fadds f1, f1, f0
/* 8006FC60 0006BAA0 4B FA 4B 89 */ bl sqrt
/* 8006FC64 0006BAA4 C0 5E 01 24 */ lfs f2, 0x124(r30)
/* 8006FC68 0006BAA8 FC 60 08 18 */ frsp f3, f1
/* 8006FC6C 0006BAAC C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006FC70 0006BAB0 FC 02 00 40 */ fcmpo cr0, f2, f0
/* 8006FC74 0006BAB4 40 80 00 0C */ bge lbl_8006FC80
/* 8006FC78 0006BAB8 EF DE 10 2A */ fadds f30, f30, f2
/* 8006FC7C 0006BABC 48 00 00 08 */ b lbl_8006FC84
.global lbl_8006FC80
lbl_8006FC80:
/* 8006FC80 0006BAC0 EF DE 10 28 */ fsubs f30, f30, f2
.global lbl_8006FC84
lbl_8006FC84:
/* 8006FC84 0006BAC4 C0 3E 01 28 */ lfs f1, 0x128(r30)
/* 8006FC88 0006BAC8 C0 02 88 50 */ lfs f0, "@4535"@sda21(r2)
/* 8006FC8C 0006BACC FC 01 00 40 */ fcmpo cr0, f1, f0
/* 8006FC90 0006BAD0 40 80 00 0C */ bge lbl_8006FC9C
/* 8006FC94 0006BAD4 EF FF 08 2A */ fadds f31, f31, f1
/* 8006FC98 0006BAD8 48 00 00 08 */ b lbl_8006FCA0
.global lbl_8006FC9C
lbl_8006FC9C:
/* 8006FC9C 0006BADC EF FF 08 28 */ fsubs f31, f31, f1
.global lbl_8006FCA0
lbl_8006FCA0:
/* 8006FCA0 0006BAE0 FC 1E F8 40 */ fcmpo cr0, f30, f31
/* 8006FCA4 0006BAE4 40 80 00 08 */ bge lbl_8006FCAC
/* 8006FCA8 0006BAE8 48 00 00 08 */ b lbl_8006FCB0
.global lbl_8006FCAC
lbl_8006FCAC:
/* 8006FCAC 0006BAEC FF C0 F8 90 */ fmr f30, f31
.global lbl_8006FCB0
lbl_8006FCB0:
/* 8006FCB0 0006BAF0 EC 03 F0 24 */ fdivs f0, f3, f30
/* 8006FCB4 0006BAF4 38 00 00 00 */ li r0, 0x0
/* 8006FCB8 0006BAF8 D0 1E 01 2C */ stfs f0, 0x12c(r30)
/* 8006FCBC 0006BAFC 98 1E 06 48 */ stb r0, 0x648(r30)
.global lbl_8006FCC0
lbl_8006FCC0:
/* 8006FCC0 0006BB00 80 01 00 08 */ lwz r0, 0x8(r1)
/* 8006FCC4 0006BB04 2C 00 00 12 */ cmpwi r0, 0x12
/* 8006FCC8 0006BB08 41 82 00 AC */ beq lbl_8006FD74
/* 8006FCCC 0006BB0C 40 80 00 4C */ bge lbl_8006FD18
/* 8006FCD0 0006BB10 2C 00 00 04 */ cmpwi r0, 0x4
/* 8006FCD4 0006BB14 41 82 06 74 */ beq lbl_80070348
/* 8006FCD8 0006BB18 40 80 00 28 */ bge lbl_8006FD00
/* 8006FCDC 0006BB1C 2C 00 00 01 */ cmpwi r0, 0x1
/* 8006FCE0 0006BB20 41 82 00 7C */ beq lbl_8006FD5C
/* 8006FCE4 0006BB24 40 80 00 10 */ bge lbl_8006FCF4
/* 8006FCE8 0006BB28 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006FCEC 0006BB2C 40 80 00 68 */ bge lbl_8006FD54
/* 8006FCF0 0006BB30 48 00 06 58 */ b lbl_80070348
.global lbl_8006FCF4
lbl_8006FCF4:
/* 8006FCF4 0006BB34 2C 00 00 03 */ cmpwi r0, 0x3
/* 8006FCF8 0006BB38 40 80 00 84 */ bge lbl_8006FD7C
/* 8006FCFC 0006BB3C 48 00 00 68 */ b lbl_8006FD64
.global lbl_8006FD00
lbl_8006FD00:
/* 8006FD00 0006BB40 2C 00 00 10 */ cmpwi r0, 0x10
/* 8006FD04 0006BB44 41 82 00 80 */ beq lbl_8006FD84
/* 8006FD08 0006BB48 40 80 00 64 */ bge lbl_8006FD6C
/* 8006FD0C 0006BB4C 2C 00 00 08 */ cmpwi r0, 0x8
/* 8006FD10 0006BB50 40 80 06 38 */ bge lbl_80070348
/* 8006FD14 0006BB54 48 00 00 80 */ b lbl_8006FD94
.global lbl_8006FD18
lbl_8006FD18:
/* 8006FD18 0006BB58 2C 00 00 FA */ cmpwi r0, 0xfa
/* 8006FD1C 0006BB5C 41 82 00 78 */ beq lbl_8006FD94
/* 8006FD20 0006BB60 40 80 00 20 */ bge lbl_8006FD40
/* 8006FD24 0006BB64 2C 00 00 1D */ cmpwi r0, 0x1d
/* 8006FD28 0006BB68 41 82 00 7C */ beq lbl_8006FDA4
/* 8006FD2C 0006BB6C 40 80 06 1C */ bge lbl_80070348
/* 8006FD30 0006BB70 2C 00 00 14 */ cmpwi r0, 0x14
/* 8006FD34 0006BB74 41 82 06 14 */ beq lbl_80070348
/* 8006FD38 0006BB78 40 80 00 64 */ bge lbl_8006FD9C
/* 8006FD3C 0006BB7C 48 00 00 50 */ b lbl_8006FD8C
.global lbl_8006FD40
lbl_8006FD40:
/* 8006FD40 0006BB80 2C 00 00 FF */ cmpwi r0, 0xff
/* 8006FD44 0006BB84 41 82 00 10 */ beq lbl_8006FD54
/* 8006FD48 0006BB88 40 80 06 00 */ bge lbl_80070348
/* 8006FD4C 0006BB8C 2C 00 00 FD */ cmpwi r0, 0xfd
/* 8006FD50 0006BB90 40 80 05 F8 */ bge lbl_80070348
.global lbl_8006FD54
lbl_8006FD54:
/* 8006FD54 0006BB94 3B 60 00 00 */ li r27, 0x0
/* 8006FD58 0006BB98 48 00 00 50 */ b lbl_8006FDA8
.global lbl_8006FD5C
lbl_8006FD5C:
/* 8006FD5C 0006BB9C 3B 60 00 02 */ li r27, 0x2
/* 8006FD60 0006BBA0 48 00 00 48 */ b lbl_8006FDA8
.global lbl_8006FD64
lbl_8006FD64:
/* 8006FD64 0006BBA4 3B 60 00 04 */ li r27, 0x4
/* 8006FD68 0006BBA8 48 00 00 40 */ b lbl_8006FDA8
.global lbl_8006FD6C
lbl_8006FD6C:
/* 8006FD6C 0006BBAC 3B 60 00 06 */ li r27, 0x6
/* 8006FD70 0006BBB0 48 00 00 38 */ b lbl_8006FDA8
.global lbl_8006FD74
lbl_8006FD74:
/* 8006FD74 0006BBB4 3B 60 00 08 */ li r27, 0x8
/* 8006FD78 0006BBB8 48 00 00 30 */ b lbl_8006FDA8
.global lbl_8006FD7C
lbl_8006FD7C:
/* 8006FD7C 0006BBBC 3B 60 00 0A */ li r27, 0xa
/* 8006FD80 0006BBC0 48 00 00 28 */ b lbl_8006FDA8
.global lbl_8006FD84
lbl_8006FD84:
/* 8006FD84 0006BBC4 3B 60 00 0C */ li r27, 0xc
/* 8006FD88 0006BBC8 48 00 00 20 */ b lbl_8006FDA8
.global lbl_8006FD8C
lbl_8006FD8C:
/* 8006FD8C 0006BBCC 3B 60 00 0E */ li r27, 0xe
/* 8006FD90 0006BBD0 48 00 00 18 */ b lbl_8006FDA8
.global lbl_8006FD94
lbl_8006FD94:
/* 8006FD94 0006BBD4 3B 60 00 10 */ li r27, 0x10
/* 8006FD98 0006BBD8 48 00 00 10 */ b lbl_8006FDA8
.global lbl_8006FD9C
lbl_8006FD9C:
/* 8006FD9C 0006BBDC 3B 60 00 12 */ li r27, 0x12
/* 8006FDA0 0006BBE0 48 00 00 08 */ b lbl_8006FDA8
.global lbl_8006FDA4
lbl_8006FDA4:
/* 8006FDA4 0006BBE4 3B 60 00 14 */ li r27, 0x14
.global lbl_8006FDA8
lbl_8006FDA8:
/* 8006FDA8 0006BBE8 88 1E 06 42 */ lbz r0, 0x642(r30)
/* 8006FDAC 0006BBEC 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006FDB0 0006BBF0 41 82 00 08 */ beq lbl_8006FDB8
/* 8006FDB4 0006BBF4 3B 7B 00 01 */ addi r27, r27, 0x1
.global lbl_8006FDB8
lbl_8006FDB8:
/* 8006FDB8 0006BBF8 7F 83 E3 78 */ mr r3, r28
/* 8006FDBC 0006BBFC 4B FE A6 A5 */ bl WPADIsDpdEnabled
/* 8006FDC0 0006BC00 2C 03 00 00 */ cmpwi r3, 0x0
/* 8006FDC4 0006BC04 41 82 00 0C */ beq lbl_8006FDD0
/* 8006FDC8 0006BC08 88 9E 06 45 */ lbz r4, 0x645(r30)
/* 8006FDCC 0006BC0C 48 00 00 08 */ b lbl_8006FDD4
.global lbl_8006FDD0
lbl_8006FDD0:
/* 8006FDD0 0006BC10 38 80 00 00 */ li r4, 0x0
.global lbl_8006FDD4
lbl_8006FDD4:
/* 8006FDD4 0006BC14 3C 60 80 44 */ lis r3, "@LOCAL@KPADiSamplingCallback__Fl@table"@ha
/* 8006FDD8 0006BC18 57 60 08 3C */ slwi r0, r27, 1
/* 8006FDDC 0006BC1C 38 63 9F 9C */ addi r3, r3, "@LOCAL@KPADiSamplingCallback__Fl@table"@l
/* 8006FDE0 0006BC20 7F 63 02 14 */ add r27, r3, r0
/* 8006FDE4 0006BC24 7C 03 00 AE */ lbzx r0, r3, r0
/* 8006FDE8 0006BC28 7C 04 00 40 */ cmplw r4, r0
/* 8006FDEC 0006BC2C 41 82 00 7C */ beq lbl_8006FE68
/* 8006FDF0 0006BC30 80 1E 05 F8 */ lwz r0, 0x5f8(r30)
/* 8006FDF4 0006BC34 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006FDF8 0006BC38 41 82 00 34 */ beq lbl_8006FE2C
/* 8006FDFC 0006BC3C 88 1E 06 46 */ lbz r0, 0x646(r30)
/* 8006FE00 0006BC40 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006FE04 0006BC44 40 82 00 28 */ bne lbl_8006FE2C
/* 8006FE08 0006BC48 38 00 00 01 */ li r0, 0x1
/* 8006FE0C 0006BC4C 98 1E 06 46 */ stb r0, 0x646(r30)
/* 8006FE10 0006BC50 7F 83 E3 78 */ mr r3, r28
/* 8006FE14 0006BC54 38 80 00 00 */ li r4, 0x0
/* 8006FE18 0006BC58 81 9E 05 F8 */ lwz r12, 0x5f8(r30)
/* 8006FE1C 0006BC5C 7D 89 03 A6 */ mtctr r12
/* 8006FE20 0006BC60 4E 80 04 21 */ bctrl
/* 8006FE24 0006BC64 38 00 00 00 */ li r0, 0x0
/* 8006FE28 0006BC68 98 1E 06 47 */ stb r0, 0x647(r30)
.global lbl_8006FE2C
lbl_8006FE2C:
/* 8006FE2C 0006BC6C 88 1E 06 44 */ lbz r0, 0x644(r30)
/* 8006FE30 0006BC70 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006FE34 0006BC74 40 82 00 4C */ bne lbl_8006FE80
/* 8006FE38 0006BC78 38 00 00 01 */ li r0, 0x1
/* 8006FE3C 0006BC7C 3C A0 80 07 */ lis r5, KPADiControlDpdCallback@ha
/* 8006FE40 0006BC80 98 1E 06 44 */ stb r0, 0x644(r30)
/* 8006FE44 0006BC84 7F 83 E3 78 */ mr r3, r28
/* 8006FE48 0006BC88 88 9B 00 00 */ lbz r4, 0x0(r27)
/* 8006FE4C 0006BC8C 38 A5 F8 40 */ addi r5, r5, KPADiControlDpdCallback@l
/* 8006FE50 0006BC90 4B FE A6 A1 */ bl WPADControlDpd
/* 8006FE54 0006BC94 2C 03 00 00 */ cmpwi r3, 0x0
/* 8006FE58 0006BC98 40 82 00 28 */ bne lbl_8006FE80
/* 8006FE5C 0006BC9C 88 1B 00 00 */ lbz r0, 0x0(r27)
/* 8006FE60 0006BCA0 98 1E 06 45 */ stb r0, 0x645(r30)
/* 8006FE64 0006BCA4 48 00 00 1C */ b lbl_8006FE80
.global lbl_8006FE68
lbl_8006FE68:
/* 8006FE68 0006BCA8 88 9B 00 01 */ lbz r4, 0x1(r27)
/* 8006FE6C 0006BCAC 88 1D 00 40 */ lbz r0, 0x40(r29)
/* 8006FE70 0006BCB0 7C 00 20 40 */ cmplw r0, r4
/* 8006FE74 0006BCB4 41 82 00 0C */ beq lbl_8006FE80
/* 8006FE78 0006BCB8 7F 83 E3 78 */ mr r3, r28
/* 8006FE7C 0006BCBC 4B FE 7F 95 */ bl WPADSetDataFormat
.global lbl_8006FE80
lbl_8006FE80:
/* 8006FE80 0006BCC0 80 01 00 08 */ lwz r0, 0x8(r1)
/* 8006FE84 0006BCC4 28 00 00 03 */ cmplwi r0, 0x3
/* 8006FE88 0006BCC8 40 82 02 F4 */ bne lbl_8007017C
/* 8006FE8C 0006BCCC 88 0D EA 8A */ lbz r0, kp_wbc_issued@sda21(r13)
/* 8006FE90 0006BCD0 2C 00 00 00 */ cmpwi r0, 0x0
/* 8006FE94 0006BCD4 40 82 02 E8 */ bne lbl_8007017C
/* 8006FE98 0006BCD8 88 0D EA 89 */ lbz r0, kp_wbc_enabled@sda21(r13)
/* 8006FE9C 0006BCDC 7C 00 07 74 */ extsb r0, r0
/* 8006FEA0 0006BCE0 2C 80 00 02 */ cmpwi cr1, r0, 0x2
/* 8006FEA4 0006BCE4 40 85 02 04 */ ble cr1, lbl_800700A8
/* 8006FEA8 0006BCE8 88 0D EA 83 */ lbz r0, kp_wbc_zero_point_done@sda21(r13)
/* 8006FEAC 0006BCEC 7C 00 07 74 */ extsb r0, r0
/* 8006FEB0 0006BCF0 2C 00 00 01 */ cmpwi r0, 0x1
/* 8006FEB4 0006BCF4 40 82 00 2C */ bne lbl_8006FEE0
/* 8006FEB8 0006BCF8 3C A0 80 07 */ lis r5, KPADiUpdateTempWbcCallback@ha
/* 8006FEBC 0006BCFC 7F 83 E3 78 */ mr r3, r28
/* 8006FEC0 0006BD00 38 A5 F7 D0 */ addi r5, r5, KPADiUpdateTempWbcCallback@l
/* 8006FEC4 0006BD04 38 80 00 00 */ li r4, 0x0
/* 8006FEC8 0006BD08 4B FE B6 A9 */ bl WPADControlBLC
/* 8006FECC 0006BD0C 2C 03 00 00 */ cmpwi r3, 0x0
/* 8006FED0 0006BD10 40 82 02 AC */ bne lbl_8007017C
/* 8006FED4 0006BD14 38 00 00 01 */ li r0, 0x1
/* 8006FED8 0006BD18 98 0D EA 8A */ stb r0, kp_wbc_issued@sda21(r13)
/* 8006FEDC 0006BD1C 48 00 02 A0 */ b lbl_8007017C
.global lbl_8006FEE0
lbl_8006FEE0:
/* 8006FEE0 0006BD20 2C 00 00 02 */ cmpwi r0, 0x2
/* 8006FEE4 0006BD24 40 82 00 54 */ bne lbl_8006FF38
/* 8006FEE8 0006BD28 88 6D EA 84 */ lbz r3, kp_wbc_zero_point_wait@sda21(r13)
/* 8006FEEC 0006BD2C 2C 03 00 00 */ cmpwi r3, 0x0
/* 8006FEF0 0006BD30 40 82 00 3C */ bne lbl_8006FF2C
/* 8006FEF4 0006BD34 88 1D 00 32 */ lbz r0, 0x32(r29)
/* 8006FEF8 0006BD38 7C 00 07 74 */ extsb r0, r0
/* 8006FEFC 0006BD3C 2C 00 00 7F */ cmpwi r0, 0x7f
/* 8006FF00 0006BD40 41 82 00 0C */ beq lbl_8006FF0C
/* 8006FF04 0006BD44 2C 00 FF 80 */ cmpwi r0, -0x80
/* 8006FF08 0006BD48 40 82 00 10 */ bne lbl_8006FF18
.global lbl_8006FF0C
lbl_8006FF0C:
/* 8006FF0C 0006BD4C 38 00 00 01 */ li r0, 0x1
/* 8006FF10 0006BD50 98 0D EA 83 */ stb r0, kp_wbc_zero_point_done@sda21(r13)
/* 8006FF14 0006BD54 48 00 02 68 */ b lbl_8007017C
.global lbl_8006FF18
lbl_8006FF18:
/* 8006FF18 0006BD58 38 60 00 03 */ li r3, 0x3
/* 8006FF1C 0006BD5C 38 00 00 00 */ li r0, 0x0
/* 8006FF20 0006BD60 98 6D EA 83 */ stb r3, kp_wbc_zero_point_done@sda21(r13)
/* 8006FF24 0006BD64 B0 0D EA 80 */ sth r0, kp_wbc_ave_sample_count@sda21(r13)
/* 8006FF28 0006BD68 48 00 02 54 */ b lbl_8007017C
.global lbl_8006FF2C
lbl_8006FF2C:
/* 8006FF2C 0006BD6C 38 03 FF FF */ addi r0, r3, -0x1
/* 8006FF30 0006BD70 98 0D EA 84 */ stb r0, kp_wbc_zero_point_wait@sda21(r13)
/* 8006FF34 0006BD74 48 00 02 48 */ b lbl_8007017C
.global lbl_8006FF38
lbl_8006FF38:
/* 8006FF38 0006BD78 2C 00 00 03 */ cmpwi r0, 0x3
/* 8006FF3C 0006BD7C 40 82 02 40 */ bne lbl_8007017C
/* 8006FF40 0006BD80 88 1D 00 29 */ lbz r0, 0x29(r29)
/* 8006FF44 0006BD84 7C 00 07 75 */ extsb. r0, r0
/* 8006FF48 0006BD88 40 82 02 34 */ bne lbl_8007017C
/* 8006FF4C 0006BD8C A0 6D EA 80 */ lhz r3, kp_wbc_ave_sample_count@sda21(r13)
/* 8006FF50 0006BD90 3B 7F 1A 70 */ addi r27, r31, 0x1a70
/* 8006FF54 0006BD94 C8 22 88 70 */ lfd f1, "@4806"@sda21(r2)
/* 8006FF58 0006BD98 38 03 00 01 */ addi r0, r3, 0x1
/* 8006FF5C 0006BD9C B0 0D EA 80 */ sth r0, kp_wbc_ave_sample_count@sda21(r13)
/* 8006FF60 0006BDA0 54 04 04 3E */ clrlwi r4, r0, 16
/* 8006FF64 0006BDA4 C8 5F 1A 70 */ lfd f2, 0x1a70(r31)
/* 8006FF68 0006BDA8 38 64 FF FF */ addi r3, r4, -0x1
/* 8006FF6C 0006BDAC A0 1D 00 2A */ lhz r0, 0x2a(r29)
/* 8006FF70 0006BDB0 6C 63 80 00 */ xoris r3, r3, 0x8000
/* 8006FF74 0006BDB4 90 61 00 1C */ stw r3, 0x1c(r1)
/* 8006FF78 0006BDB8 C8 02 88 C0 */ lfd f0, "@5403"@sda21(r2)
/* 8006FF7C 0006BDBC C8 61 00 18 */ lfd f3, 0x18(r1)
/* 8006FF80 0006BDC0 90 01 00 24 */ stw r0, 0x24(r1)
/* 8006FF84 0006BDC4 FC 83 08 28 */ fsub f4, f3, f1
/* 8006FF88 0006BDC8 C8 DB 00 08 */ lfd f6, 0x8(r27)
/* 8006FF8C 0006BDCC C8 61 00 20 */ lfd f3, 0x20(r1)
/* 8006FF90 0006BDD0 90 81 00 1C */ stw r4, 0x1c(r1)
/* 8006FF94 0006BDD4 FC E4 00 B2 */ fmul f7, f4, f2
/* 8006FF98 0006BDD8 C8 BB 00 10 */ lfd f5, 0x10(r27)
/* 8006FF9C 0006BDDC C8 41 00 18 */ lfd f2, 0x18(r1)
/* 8006FFA0 0006BDE0 FC 63 00 28 */ fsub f3, f3, f0
/* 8006FFA4 0006BDE4 90 61 00 24 */ stw r3, 0x24(r1)
/* 8006FFA8 0006BDE8 FC 82 00 28 */ fsub f4, f2, f0
/* 8006FFAC 0006BDEC FD 07 18 2A */ fadd f8, f7, f3
/* 8006FFB0 0006BDF0 C8 41 00 20 */ lfd f2, 0x20(r1)
/* 8006FFB4 0006BDF4 C8 7B 00 18 */ lfd f3, 0x18(r27)
/* 8006FFB8 0006BDF8 FC E2 08 28 */ fsub f7, f2, f1
/* 8006FFBC 0006BDFC 90 81 00 24 */ stw r4, 0x24(r1)
/* 8006FFC0 0006BE00 FD 08 20 24 */ fdiv f8, f8, f4
/* 8006FFC4 0006BE04 C8 81 00 20 */ lfd f4, 0x20(r1)
/* 8006FFC8 0006BE08 C0 4D 84 5C */ lfs f2, kp_wbc_ave_count@sda21(r13)
/* 8006FFCC 0006BE0C D9 1F 1A 70 */ stfd f8, 0x1a70(r31)
/* 8006FFD0 0006BE10 FD 07 01 B2 */ fmul f8, f7, f6
/* 8006FFD4 0006BE14 A0 1D 00 2C */ lhz r0, 0x2c(r29)
/* 8006FFD8 0006BE18 90 01 00 1C */ stw r0, 0x1c(r1)
/* 8006FFDC 0006BE1C FC E4 00 28 */ fsub f7, f4, f0
/* 8006FFE0 0006BE20 C8 81 00 18 */ lfd f4, 0x18(r1)
/* 8006FFE4 0006BE24 FC C4 00 28 */ fsub f6, f4, f0
/* 8006FFE8 0006BE28 90 61 00 1C */ stw r3, 0x1c(r1)
/* 8006FFEC 0006BE2C C8 81 00 18 */ lfd f4, 0x18(r1)
/* 8006FFF0 0006BE30 FD 08 30 2A */ fadd f8, f8, f6
/* 8006FFF4 0006BE34 90 81 00 1C */ stw r4, 0x1c(r1)
/* 8006FFF8 0006BE38 FC C4 08 28 */ fsub f6, f4, f1
/* 8006FFFC 0006BE3C FC E8 38 24 */ fdiv f7, f8, f7
/* 80070000 0006BE40 C8 81 00 18 */ lfd f4, 0x18(r1)
/* 80070004 0006BE44 D8 FB 00 08 */ stfd f7, 0x8(r27)
/* 80070008 0006BE48 FC E6 01 72 */ fmul f7, f6, f5
/* 8007000C 0006BE4C A0 1D 00 2E */ lhz r0, 0x2e(r29)
/* 80070010 0006BE50 90 01 00 24 */ stw r0, 0x24(r1)
/* 80070014 0006BE54 FC A4 00 28 */ fsub f5, f4, f0
/* 80070018 0006BE58 C8 81 00 20 */ lfd f4, 0x20(r1)
/* 8007001C 0006BE5C FC C4 00 28 */ fsub f6, f4, f0
/* 80070020 0006BE60 90 61 00 24 */ stw r3, 0x24(r1)
/* 80070024 0006BE64 C8 81 00 20 */ lfd f4, 0x20(r1)
/* 80070028 0006BE68 FC C7 30 2A */ fadd f6, f7, f6
/* 8007002C 0006BE6C 90 81 00 24 */ stw r4, 0x24(r1)
/* 80070030 0006BE70 FC 84 08 28 */ fsub f4, f4, f1
/* 80070034 0006BE74 FC A6 28 24 */ fdiv f5, f6, f5
/* 80070038 0006BE78 C8 21 00 20 */ lfd f1, 0x20(r1)
/* 8007003C 0006BE7C D8 BB 00 10 */ stfd f5, 0x10(r27)
/* 80070040 0006BE80 FC A4 00 F2 */ fmul f5, f4, f3
/* 80070044 0006BE84 A0 1D 00 30 */ lhz r0, 0x30(r29)
/* 80070048 0006BE88 90 01 00 1C */ stw r0, 0x1c(r1)
/* 8007004C 0006BE8C FC 61 00 28 */ fsub f3, f1, f0
/* 80070050 0006BE90 C8 21 00 18 */ lfd f1, 0x18(r1)
/* 80070054 0006BE94 FC 81 00 28 */ fsub f4, f1, f0
/* 80070058 0006BE98 90 81 00 1C */ stw r4, 0x1c(r1)
/* 8007005C 0006BE9C C8 21 00 18 */ lfd f1, 0x18(r1)
/* 80070060 0006BEA0 FC 85 20 2A */ fadd f4, f5, f4
/* 80070064 0006BEA4 EC 01 00 28 */ fsubs f0, f1, f0
/* 80070068 0006BEA8 FC 24 18 24 */ fdiv f1, f4, f3
/* 8007006C 0006BEAC D8 3B 00 18 */ stfd f1, 0x18(r27)
/* 80070070 0006BEB0 FC 00 10 00 */ fcmpu cr0, f0, f2
/* 80070074 0006BEB4 40 82 01 08 */ bne lbl_8007017C
/* 80070078 0006BEB8 38 60 00 04 */ li r3, 0x4
/* 8007007C 0006BEBC 38 00 00 00 */ li r0, 0x0
/* 80070080 0006BEC0 98 6D EA 83 */ stb r3, kp_wbc_zero_point_done@sda21(r13)
/* 80070084 0006BEC4 7F A3 EB 78 */ mr r3, r29
/* 80070088 0006BEC8 38 9F 1A 50 */ addi r4, r31, 0x1a50
/* 8007008C 0006BECC 38 A0 00 04 */ li r5, 0x4
/* 80070090 0006BED0 B0 0D EA 80 */ sth r0, kp_wbc_ave_sample_count@sda21(r13)
/* 80070094 0006BED4 4B FE 3D FD */ bl WBCRead
/* 80070098 0006BED8 7F 63 DB 78 */ mr r3, r27
/* 8007009C 0006BEDC 38 80 00 04 */ li r4, 0x4
/* 800700A0 0006BEE0 4B FE 3D F1 */ bl WBCRead
/* 800700A4 0006BEE4 48 00 00 D8 */ b lbl_8007017C
.global lbl_800700A8
lbl_800700A8:
/* 800700A8 0006BEE8 2C 00 00 00 */ cmpwi r0, 0x0
/* 800700AC 0006BEEC 40 82 00 2C */ bne lbl_800700D8
/* 800700B0 0006BEF0 3C A0 80 07 */ lis r5, KPADiControlWbcCallback@ha
/* 800700B4 0006BEF4 7F 83 E3 78 */ mr r3, r28
/* 800700B8 0006BEF8 38 A5 F7 B0 */ addi r5, r5, KPADiControlWbcCallback@l
/* 800700BC 0006BEFC 38 80 00 AA */ li r4, 0xaa
/* 800700C0 0006BF00 4B FE B4 B1 */ bl WPADControlBLC
/* 800700C4 0006BF04 2C 03 00 00 */ cmpwi r3, 0x0
/* 800700C8 0006BF08 40 82 00 B4 */ bne lbl_8007017C
/* 800700CC 0006BF0C 38 00 00 01 */ li r0, 0x1
/* 800700D0 0006BF10 98 0D EA 8A */ stb r0, kp_wbc_issued@sda21(r13)
/* 800700D4 0006BF14 48 00 00 A8 */ b lbl_8007017C
.global lbl_800700D8
lbl_800700D8:
/* 800700D8 0006BF18 2C 00 00 01 */ cmpwi r0, 0x1
/* 800700DC 0006BF1C 40 82 00 4C */ bne lbl_80070128
/* 800700E0 0006BF20 88 0D EA 82 */ lbz r0, kp_wbc_failure_count@sda21(r13)
/* 800700E4 0006BF24 28 00 00 03 */ cmplwi r0, 0x3
/* 800700E8 0006BF28 40 80 00 34 */ bge lbl_8007011C
/* 800700EC 0006BF2C 4B FE 3D 05 */ bl __wpadNoAlloc
/* 800700F0 0006BF30 2C 03 00 01 */ cmpwi r3, 0x1
/* 800700F4 0006BF34 40 82 00 18 */ bne lbl_8007010C
/* 800700F8 0006BF38 38 60 00 02 */ li r3, 0x2
/* 800700FC 0006BF3C 38 00 00 00 */ li r0, 0x0
/* 80070100 0006BF40 98 6D EA 89 */ stb r3, kp_wbc_enabled@sda21(r13)
/* 80070104 0006BF44 98 0D EA 84 */ stb r0, kp_wbc_zero_point_wait@sda21(r13)
/* 80070108 0006BF48 48 00 00 74 */ b lbl_8007017C
.global lbl_8007010C
lbl_8007010C:
/* 8007010C 0006BF4C 88 6D EA 82 */ lbz r3, kp_wbc_failure_count@sda21(r13)
/* 80070110 0006BF50 38 03 00 01 */ addi r0, r3, 0x1
/* 80070114 0006BF54 98 0D EA 82 */ stb r0, kp_wbc_failure_count@sda21(r13)
/* 80070118 0006BF58 48 00 00 64 */ b lbl_8007017C
.global lbl_8007011C
lbl_8007011C:
/* 8007011C 0006BF5C 38 00 FF FF */ li r0, -0x1
/* 80070120 0006BF60 98 0D EA 89 */ stb r0, kp_wbc_enabled@sda21(r13)
/* 80070124 0006BF64 48 00 00 58 */ b lbl_8007017C
.global lbl_80070128
lbl_80070128:
/* 80070128 0006BF68 40 86 00 54 */ bne cr1, lbl_8007017C
/* 8007012C 0006BF6C 4B FE 3C C5 */ bl __wpadNoAlloc
/* 80070130 0006BF70 2C 03 00 00 */ cmpwi r3, 0x0
/* 80070134 0006BF74 41 82 00 18 */ beq lbl_8007014C
/* 80070138 0006BF78 38 60 00 03 */ li r3, 0x3
/* 8007013C 0006BF7C 38 00 00 00 */ li r0, 0x0
/* 80070140 0006BF80 98 6D EA 89 */ stb r3, kp_wbc_enabled@sda21(r13)
/* 80070144 0006BF84 98 0D EA 82 */ stb r0, kp_wbc_failure_count@sda21(r13)
/* 80070148 0006BF88 48 00 00 34 */ b lbl_8007017C
.global lbl_8007014C
lbl_8007014C:
/* 8007014C 0006BF8C 88 6D EA 84 */ lbz r3, kp_wbc_zero_point_wait@sda21(r13)
/* 80070150 0006BF90 88 0D 84 60 */ lbz r0, kp_wbc_calib_count@sda21(r13)
/* 80070154 0006BF94 38 63 00 01 */ addi r3, r3, 0x1
/* 80070158 0006BF98 98 6D EA 84 */ stb r3, kp_wbc_zero_point_wait@sda21(r13)
/* 8007015C 0006BF9C 54 63 06 3E */ clrlwi r3, r3, 24
/* 80070160 0006BFA0 7C 03 00 40 */ cmplw r3, r0
/* 80070164 0006BFA4 40 81 00 18 */ ble lbl_8007017C
/* 80070168 0006BFA8 88 6D EA 82 */ lbz r3, kp_wbc_failure_count@sda21(r13)
/* 8007016C 0006BFAC 38 00 00 01 */ li r0, 0x1
/* 80070170 0006BFB0 98 0D EA 89 */ stb r0, kp_wbc_enabled@sda21(r13)
/* 80070174 0006BFB4 38 03 00 01 */ addi r0, r3, 0x1
/* 80070178 0006BFB8 98 0D EA 82 */ stb r0, kp_wbc_failure_count@sda21(r13)
.global lbl_8007017C
lbl_8007017C:
/* 8007017C 0006BFBC 7F 83 E3 78 */ mr r3, r28
/* 80070180 0006BFC0 4B FE B6 21 */ bl WPADiGetMplsStatus
/* 80070184 0006BFC4 88 1E 06 7A */ lbz r0, 0x67a(r30)
/* 80070188 0006BFC8 7C 7F 1B 78 */ mr r31, r3
/* 8007018C 0006BFCC 2C 00 00 00 */ cmpwi r0, 0x0
/* 80070190 0006BFD0 40 82 01 B8 */ bne lbl_80070348
/* 80070194 0006BFD4 88 1E 06 7B */ lbz r0, 0x67b(r30)
/* 80070198 0006BFD8 2C 00 00 00 */ cmpwi r0, 0x0
/* 8007019C 0006BFDC 41 82 00 64 */ beq lbl_80070200
/* 800701A0 0006BFE0 88 1E 06 77 */ lbz r0, 0x677(r30)
/* 800701A4 0006BFE4 54 64 06 3E */ clrlwi r4, r3, 24
/* 800701A8 0006BFE8 7C 04 00 40 */ cmplw r4, r0
/* 800701AC 0006BFEC 40 82 00 54 */ bne lbl_80070200
/* 800701B0 0006BFF0 88 1E 06 78 */ lbz r0, 0x678(r30)
/* 800701B4 0006BFF4 7C 04 00 40 */ cmplw r4, r0
/* 800701B8 0006BFF8 40 82 00 48 */ bne lbl_80070200
/* 800701BC 0006BFFC 88 7E 06 79 */ lbz r3, 0x679(r30)
/* 800701C0 0006C000 7C 00 18 40 */ cmplw r0, r3
/* 800701C4 0006C004 40 82 00 34 */ bne lbl_800701F8
/* 800701C8 0006C008 38 00 00 00 */ li r0, 0x0
/* 800701CC 0006C00C 98 1E 06 7B */ stb r0, 0x67b(r30)
/* 800701D0 0006C010 81 9E 06 80 */ lwz r12, 0x680(r30)
/* 800701D4 0006C014 2C 0C 00 00 */ cmpwi r12, 0x0
/* 800701D8 0006C018 41 82 00 14 */ beq lbl_800701EC
/* 800701DC 0006C01C 7F 83 E3 78 */ mr r3, r28
/* 800701E0 0006C020 38 80 00 01 */ li r4, 0x1
/* 800701E4 0006C024 7D 89 03 A6 */ mtctr r12
/* 800701E8 0006C028 4E 80 04 21 */ bctrl
.global lbl_800701EC
lbl_800701EC:
/* 800701EC 0006C02C 38 00 00 01 */ li r0, 0x1
/* 800701F0 0006C030 98 1E 06 7C */ stb r0, 0x67c(r30)
/* 800701F4 0006C034 48 00 01 3C */ b lbl_80070330
.global lbl_800701F8
lbl_800701F8:
/* 800701F8 0006C038 98 7E 06 78 */ stb r3, 0x678(r30)
/* 800701FC 0006C03C 48 00 01 34 */ b lbl_80070330
.global lbl_80070200
lbl_80070200:
/* 80070200 0006C040 88 9E 06 7D */ lbz r4, 0x67d(r30)
/* 80070204 0006C044 2C 04 00 00 */ cmpwi r4, 0x0
/* 80070208 0006C048 41 82 00 10 */ beq lbl_80070218
/* 8007020C 0006C04C 38 04 FF FF */ addi r0, r4, -0x1
/* 80070210 0006C050 98 1E 06 7D */ stb r0, 0x67d(r30)
/* 80070214 0006C054 48 00 01 34 */ b lbl_80070348
.global lbl_80070218
lbl_80070218:
/* 80070218 0006C058 88 1E 06 78 */ lbz r0, 0x678(r30)
/* 8007021C 0006C05C 54 64 06 3F */ clrlwi. r4, r3, 24
/* 80070220 0006C060 98 1E 06 76 */ stb r0, 0x676(r30)
/* 80070224 0006C064 41 82 00 18 */ beq lbl_8007023C
/* 80070228 0006C068 88 1E 06 76 */ lbz r0, 0x676(r30)
/* 8007022C 0006C06C 7C 04 00 40 */ cmplw r4, r0
/* 80070230 0006C070 41 82 00 0C */ beq lbl_8007023C
/* 80070234 0006C074 38 00 00 00 */ li r0, 0x0
/* 80070238 0006C078 98 1E 06 76 */ stb r0, 0x676(r30)
.global lbl_8007023C
lbl_8007023C:
/* 8007023C 0006C07C 88 1E 06 76 */ lbz r0, 0x676(r30)
/* 80070240 0006C080 54 64 06 3E */ clrlwi r4, r3, 24
/* 80070244 0006C084 7C 04 00 40 */ cmplw r4, r0
/* 80070248 0006C088 41 82 00 E0 */ beq lbl_80070328
/* 8007024C 0006C08C 88 1E 06 7B */ lbz r0, 0x67b(r30)
/* 80070250 0006C090 2C 00 00 00 */ cmpwi r0, 0x0
/* 80070254 0006C094 40 82 00 0C */ bne lbl_80070260
/* 80070258 0006C098 38 00 00 00 */ li r0, 0x0
/* 8007025C 0006C09C 98 1E 06 77 */ stb r0, 0x677(r30)
.global lbl_80070260
lbl_80070260:
/* 80070260 0006C0A0 38 80 00 01 */ li r4, 0x1
/* 80070264 0006C0A4 98 9E 06 7A */ stb r4, 0x67a(r30)
/* 80070268 0006C0A8 88 1E 06 7B */ lbz r0, 0x67b(r30)
/* 8007026C 0006C0AC 2C 00 00 00 */ cmpwi r0, 0x0
/* 80070270 0006C0B0 40 82 00 A0 */ bne lbl_80070310
/* 80070274 0006C0B4 98 9E 06 7B */ stb r4, 0x67b(r30)
/* 80070278 0006C0B8 81 9E 06 80 */ lwz r12, 0x680(r30)
/* 8007027C 0006C0BC 2C 0C 00 00 */ cmpwi r12, 0x0
/* 80070280 0006C0C0 41 82 00 88 */ beq lbl_80070308
/* 80070284 0006C0C4 54 60 06 3F */ clrlwi. r0, r3, 24
/* 80070288 0006C0C8 40 82 00 28 */ bne lbl_800702B0
/* 8007028C 0006C0CC 88 7E 06 78 */ lbz r3, 0x678(r30)
/* 80070290 0006C0D0 2C 03 00 00 */ cmpwi r3, 0x0
/* 80070294 0006C0D4 41 82 00 1C */ beq lbl_800702B0
/* 80070298 0006C0D8 80 9E 06 5C */ lwz r4, 0x65c(r30)
/* 8007029C 0006C0DC 38 04 FF FB */ addi r0, r4, -0x5
/* 800702A0 0006C0E0 28 00 00 02 */ cmplwi r0, 0x2
/* 800702A4 0006C0E4 40 81 00 14 */ ble lbl_800702B8
/* 800702A8 0006C0E8 28 04 00 FA */ cmplwi r4, 0xfa
/* 800702AC 0006C0EC 41 82 00 0C */ beq lbl_800702B8
.global lbl_800702B0
lbl_800702B0:
/* 800702B0 0006C0F0 3B 60 00 00 */ li r27, 0x0
/* 800702B4 0006C0F4 48 00 00 24 */ b lbl_800702D8
.global lbl_800702B8
lbl_800702B8:
/* 800702B8 0006C0F8 28 03 00 05 */ cmplwi r3, 0x5
/* 800702BC 0006C0FC 40 82 00 0C */ bne lbl_800702C8
/* 800702C0 0006C100 3B 60 FF FE */ li r27, -0x2
/* 800702C4 0006C104 48 00 00 14 */ b lbl_800702D8
.global lbl_800702C8
lbl_800702C8:
/* 800702C8 0006C108 28 03 00 07 */ cmplwi r3, 0x7
/* 800702CC 0006C10C 3B 60 FF FF */ li r27, -0x1
/* 800702D0 0006C110 40 82 00 08 */ bne lbl_800702D8
/* 800702D4 0006C114 3B 60 FF FD */ li r27, -0x3
.global lbl_800702D8
lbl_800702D8:
/* 800702D8 0006C118 7F 83 E3 78 */ mr r3, r28
/* 800702DC 0006C11C 7F 64 DB 78 */ mr r4, r27
/* 800702E0 0006C120 7D 89 03 A6 */ mtctr r12
/* 800702E4 0006C124 4E 80 04 21 */ bctrl
/* 800702E8 0006C128 2C 1B 00 00 */ cmpwi r27, 0x0
/* 800702EC 0006C12C 40 80 00 1C */ bge lbl_80070308
/* 800702F0 0006C130 88 1E 06 79 */ lbz r0, 0x679(r30)
/* 800702F4 0006C134 2C 00 00 00 */ cmpwi r0, 0x0
/* 800702F8 0006C138 40 82 00 10 */ bne lbl_80070308
/* 800702FC 0006C13C 98 1E 06 78 */ stb r0, 0x678(r30)
/* 80070300 0006C140 88 1E 06 79 */ lbz r0, 0x679(r30)
/* 80070304 0006C144 98 1E 06 76 */ stb r0, 0x676(r30)
.global lbl_80070308
lbl_80070308:
/* 80070308 0006C148 38 00 00 00 */ li r0, 0x0
/* 8007030C 0006C14C 98 1E 06 7C */ stb r0, 0x67c(r30)
.global lbl_80070310
lbl_80070310:
/* 80070310 0006C150 3C A0 80 07 */ lis r5, KPADiControlMplsCallback@ha
/* 80070314 0006C154 88 9E 06 76 */ lbz r4, 0x676(r30)
/* 80070318 0006C158 7F 83 E3 78 */ mr r3, r28
/* 8007031C 0006C15C 38 A5 F8 E0 */ addi r5, r5, KPADiControlMplsCallback@l
/* 80070320 0006C160 4B FE C6 61 */ bl WPADiControlMpls
/* 80070324 0006C164 48 00 00 0C */ b lbl_80070330
.global lbl_80070328
lbl_80070328:
/* 80070328 0006C168 88 1E 06 79 */ lbz r0, 0x679(r30)
/* 8007032C 0006C16C 98 1E 06 78 */ stb r0, 0x678(r30)
.global lbl_80070330
lbl_80070330:
/* 80070330 0006C170 57 E0 06 3F */ clrlwi. r0, r31, 24
/* 80070334 0006C174 40 82 00 14 */ bne lbl_80070348
/* 80070338 0006C178 88 1E 06 79 */ lbz r0, 0x679(r30)
/* 8007033C 0006C17C 2C 00 00 00 */ cmpwi r0, 0x0
/* 80070340 0006C180 40 82 00 08 */ bne lbl_80070348
/* 80070344 0006C184 98 1E 06 78 */ stb r0, 0x678(r30)
.global lbl_80070348
lbl_80070348:
/* 80070348 0006C188 80 01 00 08 */ lwz r0, 0x8(r1)
/* 8007034C 0006C18C 90 1E 06 5C */ stw r0, 0x65c(r30)
/* 80070350 0006C190 81 9E 06 38 */ lwz r12, 0x638(r30)
/* 80070354 0006C194 2C 0C 00 00 */ cmpwi r12, 0x0
/* 80070358 0006C198 41 82 00 10 */ beq lbl_80070368
/* 8007035C 0006C19C 7F 83 E3 78 */ mr r3, r28
/* 80070360 0006C1A0 7D 89 03 A6 */ mtctr r12
/* 80070364 0006C1A4 4E 80 04 21 */ bctrl
.global lbl_80070368
lbl_80070368:
/* 80070368 0006C1A8 39 61 00 40 */ addi r11, r1, 0x40
/* 8007036C 0006C1AC E3 E1 00 58 */ psq_l f31, 0x58(r1), 0, qr0
/* 80070370 0006C1B0 CB E1 00 50 */ lfd f31, 0x50(r1)
/* 80070374 0006C1B4 E3 C1 00 48 */ psq_l f30, 0x48(r1), 0, qr0
/* 80070378 0006C1B8 CB C1 00 40 */ lfd f30, 0x40(r1)
/* 8007037C 0006C1BC 4B F9 70 0D */ bl lbl_80007388
/* 80070380 0006C1C0 80 01 00 64 */ lwz r0, 0x64(r1)
/* 80070384 0006C1C4 7C 08 03 A6 */ mtlr r0
/* 80070388 0006C1C8 38 21 00 60 */ addi r1, r1, 0x60
/* 8007038C 0006C1CC 4E 80 00 20 */ blr
.include "macros.inc"
.section .data, "wa" # 0x80421040 - 0x80496700 ; 0x000756C0
.global "@1614"
"@1614":
.4byte 0x3C3C2052
.4byte 0x564C5F53
.4byte 0x444B202D
.4byte 0x204B5041
.4byte 0x44200972
.4byte 0x656C6561
.4byte 0x73652062
.4byte 0x75696C64
.4byte 0x3A204175
.4byte 0x67203233
.4byte 0x20323031
.4byte 0x30203139
.4byte 0x3A34383A
.4byte 0x32332028
.4byte 0x30783433
.4byte 0x30325F31
.4byte 0x34352920
.4byte 0x3E3E0000
.global "@4805"
"@4805":
.4byte lbl_8006BBDC
.4byte lbl_8006BBE0
.4byte lbl_8006BBE0
.4byte lbl_8006BBDC
.4byte lbl_8006BBE0
.4byte lbl_8006BBE0
.4byte lbl_8006BBDC
.4byte lbl_8006BBE0
.4byte lbl_8006BBE0
.4byte lbl_8006BBDC
.4byte lbl_8006BBDC
.4byte lbl_8006BBE0
.4byte lbl_8006BBDC
.4byte lbl_8006BBDC
.4byte lbl_8006BBDC
.4byte lbl_8006BBE0
.4byte lbl_8006BBE0
.4byte lbl_8006BBE0
.4byte lbl_8006BBDC
.4byte lbl_8006BBE0
.4byte lbl_8006BBE0
.global "@LOCAL@KPADiSamplingCallback__Fl@table"
"@LOCAL@KPADiSamplingCallback__Fl@table":
.4byte 0x00010302
.4byte 0x00040105
.4byte 0x00070108
.4byte 0x000B010B
.4byte 0x000F010F
.4byte 0x000C000C
.4byte 0x000A000A
.4byte 0x00110111
.4byte 0x00100110
.4byte 0x00130013
.4byte 0x00140014
.include "macros.inc"
.section .bss, "", @nobits # 0x80496700 - 0x80556420 ; 0x000BFD20
.global inside_kpads
inside_kpads:
.skip 0x1A20
.global kp_fs_rot
kp_fs_rot:
.skip 0x30
.global kp_wbc_weight_ave
kp_wbc_weight_ave:
.skip 0x20
.global kp_wbc_ave_sample
kp_wbc_ave_sample:
.skip 0x30
.include "macros.inc"
.section .sdata, "wa" # 0x80556420 - 0x8055C6E0 ; 0x000062C0
.global __KPADVersion
__KPADVersion:
.4byte "@1614"
.global idist_org
idist_org:
.4byte 0x3F800000
.global iaccXY_nrm_hori
iaccXY_nrm_hori:
.4byte 0
.global lbl_80556814
lbl_80556814:
.4byte 0xBF800000
.global isec_nrm_hori
isec_nrm_hori:
.4byte 0x3F800000
.global lbl_8055681C
lbl_8055681C:
.4byte 0
.global kp_obj_interval
kp_obj_interval:
.4byte 0x3E4CCCCD
.global kp_acc_horizon_pw
kp_acc_horizon_pw:
.4byte 0x3D4CCCCD
.global kp_ah_circle_radius
kp_ah_circle_radius:
.4byte 0x3D8F5C29
.global kp_ah_circle_pw
kp_ah_circle_pw:
.4byte 0x3D75C28F
.global kp_ah_circle_ct
kp_ah_circle_ct:
.4byte 0x00640000
.global kp_err_outside_frame
kp_err_outside_frame:
.4byte 0x3D4CCCCD
.global kp_err_dist_max
kp_err_dist_max:
.4byte 0x40400000
.global kp_err_dist_speed
kp_err_dist_speed:
.4byte 0x3D23D70A
.global kp_err_first_inpr
kp_err_first_inpr:
.4byte 0x3F666666
.global kp_err_next_inpr
kp_err_next_inpr:
.4byte 0x3F666666
.global kp_err_acc_inpr
kp_err_acc_inpr:
.4byte 0x3F666666
.global kp_err_up_inpr
kp_err_up_inpr:
.4byte 0x3F333333
.global kp_err_near_pos
kp_err_near_pos:
.4byte 0x3DCCCCCD
.global kp_fs_fstick_min
kp_fs_fstick_min:
.4byte 0x0000000F
.global kp_fs_fstick_max
kp_fs_fstick_max:
.4byte 0x00000047
.global kp_cl_stick_min
kp_cl_stick_min:
.4byte 0x0000003C
.global kp_cl_stick_max
kp_cl_stick_max:
.4byte 0x00000134
.global kp_cl_trigger_min
kp_cl_trigger_min:
.4byte 0x0000001E
.global kp_cl_trigger_max
kp_cl_trigger_max:
.4byte 0x000000B4
.global kp_rm_acc_max
kp_rm_acc_max:
.4byte 0x4059999A
.global kp_fs_acc_max
kp_fs_acc_max:
.4byte 0x40066666
.global kp_ex_trigger_max
kp_ex_trigger_max:
.4byte 0x00000100
.global kp_ex_analog_max
kp_ex_analog_max:
.4byte 0x00000400
.global kp_wbc_ave_count
kp_wbc_ave_count:
.4byte 0x43C80000
.global kp_wbc_calib_count
kp_wbc_calib_count:
.4byte 0xC8000000
.global kp_wbc_stable_count
kp_wbc_stable_count:
.4byte 0x02020305
.4byte 0x05050000
.global kp_fs_revise_deg
kp_fs_revise_deg:
.4byte 0x41C00000
.include "macros.inc"
.section .sbss, "", @nobits # 0x8055C6E0 - 0x8055DF80 ; 0x000018A0
.global icenter_org
icenter_org:
.skip 0x4
.global lbl_8055CE64
lbl_8055CE64:
.skip 0x4
.global kp_stick_clamp_cross
kp_stick_clamp_cross:
.skip 0x4
.global kp_ex_trigger_min
kp_ex_trigger_min:
.skip 0x4
.global kp_ex_analog_min
kp_ex_analog_min:
.skip 0x4
.global kp_initialized
kp_initialized:
.skip 0x4
.global Vec2_0
Vec2_0:
.skip 0x4
.global lbl_8055CE7C
lbl_8055CE7C:
.skip 0x4
.global kp_wbc_stable_width
kp_wbc_stable_width:
.skip 0x8
.global kp_wbc_max_weight
kp_wbc_max_weight:
.skip 0x8
.global kp_wbc_min_weight
kp_wbc_min_weight:
.skip 0x8
.global kp_wbc_tgc_weight
kp_wbc_tgc_weight:
.skip 0x8
.global kp_wbc_ave_sample_count
kp_wbc_ave_sample_count:
.skip 0x2
.global kp_wbc_failure_count
kp_wbc_failure_count:
.skip 0x1
.global kp_wbc_zero_point_done
kp_wbc_zero_point_done:
.skip 0x1
.global kp_wbc_zero_point_wait
kp_wbc_zero_point_wait:
.skip 0x1
.global kp_wbc_tgc_weight_done
kp_wbc_tgc_weight_done:
.skip 0x1
.global kp_wbc_tgc_weight_wait
kp_wbc_tgc_weight_wait:
.skip 0x2
.global kp_wbc_tgc_weight_err
kp_wbc_tgc_weight_err:
.skip 0x1
.global kp_wbc_enabled
kp_wbc_enabled:
.skip 0x1
.global kp_wbc_issued
kp_wbc_issued:
.skip 0x2
.global kp_dist_vv1
kp_dist_vv1:
.skip 0x4
.global kp_err_dist_min
kp_err_dist_min:
.skip 0x8
.include "macros.inc"
.section .sdata2, "wa" # 0x8055DF80 - 0x805643C0 ; 0x00006440
.global "@4535"
"@4535":
.4byte 0
.global "@4536"
"@4536":
.4byte 0x3F000000
.global "@4537"
"@4537":
.4byte 0x43480000
.global "@4580"
"@4580":
.4byte 0xBF800000
.global "@4581"
"@4581":
.4byte 0x3F800000
.global "@4582"
"@4582":
.4byte 0xBF400000
.global "@4583"
"@4583":
.4byte 0x3F400000
.global "@4712"
"@4712":
.4byte 0x40000000
.global "@4806"
"@4806":
.4byte 0x43300000
.4byte 0x80000000
.global "@5024"
"@5024":
.4byte 0x3B000000
.global "@5025_8055E7FC"
"@5025_8055E7FC":
.4byte 0x3F7FC000
.global "@5026_8055E800"
"@5026_8055E800":
.4byte 0x3F3FC000
.4byte 0
.global "@5391"
"@5391":
.4byte 0x4062C000
.4byte 0
.global "@5392"
"@5392":
.4byte 0x3E4CCCCD
.4byte 0
.global "@5393"
"@5393":
.4byte 0x40410000
.4byte 0
.global "@5394"
"@5394":
.4byte 0x40000000
.4byte 0
.global "@5395"
"@5395":
.4byte 0
.4byte 0
.global "@5396"
"@5396":
.4byte 0xBFF00000
.4byte 0
.global "@5397"
"@5397":
.4byte 0x3FE00000
.4byte 0
.global "@5403"
"@5403":
.4byte 0x43300000
.4byte 0
.global "@5550"
"@5550":
.4byte 0x3FD33333
.4byte 0x33333333
.global "@5613"
"@5613":
.4byte 0x3EC489D2
.global "@5614"
"@5614":
.4byte 0x3C8EFA35
.global "@5799"
"@5799":
.4byte 0x3BA3D70A
.global "@5800"
"@5800":
.4byte 0x3C23D70A
.global "@3159"
"@3159":
.4byte 0x00010001
.global lbl_8055E864
lbl_8055E864:
.4byte 0x00010000
.global "@6007"
"@6007":
.4byte 0xBE4CCCCD
.4byte 0