.include "macros.inc" .section .text, "ax" # 0x80006A00 - 0x80406260 ; 0x003FF860 .global wpad_callback_func wpad_callback_func: /* 80070390 0006C1D0 80 AD EA 98 */ lwz r5, kmpls@sda21(r13) /* 80070394 0006C1D4 1C 03 0D B0 */ mulli r0, r3, 0xdb0 /* 80070398 0006C1D8 2C 05 00 00 */ cmpwi r5, 0x0 /* 8007039C 0006C1DC 7C 65 02 14 */ add r3, r5, r0 /* 800703A0 0006C1E0 4D 82 00 20 */ beqlr /* 800703A4 0006C1E4 2C 04 00 00 */ cmpwi r4, 0x0 /* 800703A8 0006C1E8 40 82 00 10 */ bne lbl_800703B8 /* 800703AC 0006C1EC 38 00 00 01 */ li r0, 0x1 /* 800703B0 0006C1F0 98 03 00 CA */ stb r0, 0xca(r3) /* 800703B4 0006C1F4 4E 80 00 20 */ blr .global lbl_800703B8 lbl_800703B8: /* 800703B8 0006C1F8 38 00 FF FF */ li r0, -0x1 /* 800703BC 0006C1FC 98 03 00 CA */ stb r0, 0xca(r3) /* 800703C0 0006C200 4E 80 00 20 */ blr /* 800703C4 0006C204 00 00 00 00 */ .4byte 0x00000000 /* 800703C8 0006C208 00 00 00 00 */ .4byte 0x00000000 /* 800703CC 0006C20C 00 00 00 00 */ .4byte 0x00000000 .global work_calibration work_calibration: /* 800703D0 0006C210 94 21 FF F0 */ stwu r1, -0x10(r1) /* 800703D4 0006C214 7C 08 02 A6 */ mflr r0 /* 800703D8 0006C218 90 01 00 14 */ stw r0, 0x14(r1) /* 800703DC 0006C21C 93 E1 00 0C */ stw r31, 0xc(r1) /* 800703E0 0006C220 1F E3 0D B0 */ mulli r31, r3, 0xdb0 /* 800703E4 0006C224 93 C1 00 08 */ stw r30, 0x8(r1) /* 800703E8 0006C228 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 800703EC 0006C22C 2C 80 00 00 */ cmpwi cr1, r0, 0x0 /* 800703F0 0006C230 7C 80 FA 14 */ add r4, r0, r31 /* 800703F4 0006C234 3B C4 00 08 */ addi r30, r4, 0x8 /* 800703F8 0006C238 41 86 00 F4 */ beq cr1, lbl_800704EC /* 800703FC 0006C23C 88 1E 00 C2 */ lbz r0, 0xc2(r30) /* 80070400 0006C240 7C 00 07 75 */ extsb. r0, r0 /* 80070404 0006C244 40 82 00 34 */ bne lbl_80070438 /* 80070408 0006C248 41 86 00 E4 */ beq cr1, lbl_800704EC /* 8007040C 0006C24C 80 7E 01 7C */ lwz r3, 0x17c(r30) /* 80070410 0006C250 3C 00 80 00 */ lis r0, 0x8000 /* 80070414 0006C254 C0 02 88 F0 */ lfs f0, "@2647_8055E870"@sda21(r2) /* 80070418 0006C258 38 63 00 FF */ addi r3, r3, 0xff /* 8007041C 0006C25C 54 63 15 BA */ rlwinm r3, r3, 2, 22, 29 /* 80070420 0006C260 7C 7E 1A 14 */ add r3, r30, r3 /* 80070424 0006C264 90 03 09 80 */ stw r0, 0x980(r3) /* 80070428 0006C268 90 03 05 80 */ stw r0, 0x580(r3) /* 8007042C 0006C26C 90 03 01 80 */ stw r0, 0x180(r3) /* 80070430 0006C270 D0 1E 00 EC */ stfs f0, 0xec(r30) /* 80070434 0006C274 48 00 00 B8 */ b lbl_800704EC .global lbl_80070438 lbl_80070438: /* 80070438 0006C278 40 80 00 20 */ bge lbl_80070458 /* 8007043C 0006C27C 38 00 00 00 */ li r0, 0x0 /* 80070440 0006C280 3C A0 80 07 */ lis r5, wpad_callback_func@ha /* 80070444 0006C284 98 1E 00 C2 */ stb r0, 0xc2(r30) /* 80070448 0006C288 38 A5 03 90 */ addi r5, r5, wpad_callback_func@l /* 8007044C 0006C28C 38 80 00 80 */ li r4, 0x80 /* 80070450 0006C290 4B FE C5 31 */ bl WPADiControlMpls /* 80070454 0006C294 48 00 00 98 */ b lbl_800704EC .global lbl_80070458 lbl_80070458: /* 80070458 0006C298 C0 22 88 F4 */ lfs f1, "@2648_8055E874"@sda21(r2) /* 8007045C 0006C29C C0 1E 00 EC */ lfs f0, 0xec(r30) /* 80070460 0006C2A0 FC 01 00 00 */ fcmpu cr0, f1, f0 /* 80070464 0006C2A4 40 82 00 88 */ bne lbl_800704EC /* 80070468 0006C2A8 C0 3E 00 C4 */ lfs f1, 0xc4(r30) /* 8007046C 0006C2AC C0 02 88 F8 */ lfs f0, "@2649_8055E878"@sda21(r2) /* 80070470 0006C2B0 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80070474 0006C2B4 4C 40 13 82 */ cror eq, lt, eq /* 80070478 0006C2B8 40 82 00 10 */ bne lbl_80070488 /* 8007047C 0006C2BC 38 00 00 00 */ li r0, 0x0 /* 80070480 0006C2C0 98 1E 00 B8 */ stb r0, 0xb8(r30) /* 80070484 0006C2C4 48 00 00 68 */ b lbl_800704EC .global lbl_80070488 lbl_80070488: /* 80070488 0006C2C8 38 00 00 00 */ li r0, 0x0 /* 8007048C 0006C2CC 3C A0 80 07 */ lis r5, wpad_callback_func@ha /* 80070490 0006C2D0 98 1E 00 C2 */ stb r0, 0xc2(r30) /* 80070494 0006C2D4 38 A5 03 90 */ addi r5, r5, wpad_callback_func@l /* 80070498 0006C2D8 38 80 00 80 */ li r4, 0x80 /* 8007049C 0006C2DC 4B FE C4 E5 */ bl WPADiControlMpls /* 800704A0 0006C2E0 C0 3E 00 C4 */ lfs f1, 0xc4(r30) /* 800704A4 0006C2E4 C0 02 88 F8 */ lfs f0, "@2649_8055E878"@sda21(r2) /* 800704A8 0006C2E8 EC 01 00 28 */ fsubs f0, f1, f0 /* 800704AC 0006C2EC D0 1E 00 C4 */ stfs f0, 0xc4(r30) /* 800704B0 0006C2F0 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 800704B4 0006C2F4 7C 60 FA 14 */ add r3, r0, r31 /* 800704B8 0006C2F8 2C 00 00 00 */ cmpwi r0, 0x0 /* 800704BC 0006C2FC 38 83 00 08 */ addi r4, r3, 0x8 /* 800704C0 0006C300 41 82 00 2C */ beq lbl_800704EC /* 800704C4 0006C304 80 64 01 7C */ lwz r3, 0x17c(r4) /* 800704C8 0006C308 3C 00 80 00 */ lis r0, 0x8000 /* 800704CC 0006C30C C0 02 88 F0 */ lfs f0, "@2647_8055E870"@sda21(r2) /* 800704D0 0006C310 38 63 00 FF */ addi r3, r3, 0xff /* 800704D4 0006C314 54 63 15 BA */ rlwinm r3, r3, 2, 22, 29 /* 800704D8 0006C318 7C 64 1A 14 */ add r3, r4, r3 /* 800704DC 0006C31C 90 03 09 80 */ stw r0, 0x980(r3) /* 800704E0 0006C320 90 03 05 80 */ stw r0, 0x580(r3) /* 800704E4 0006C324 90 03 01 80 */ stw r0, 0x180(r3) /* 800704E8 0006C328 D0 04 00 EC */ stfs f0, 0xec(r4) .global lbl_800704EC lbl_800704EC: /* 800704EC 0006C32C 80 01 00 14 */ lwz r0, 0x14(r1) /* 800704F0 0006C330 83 E1 00 0C */ lwz r31, 0xc(r1) /* 800704F4 0006C334 83 C1 00 08 */ lwz r30, 0x8(r1) /* 800704F8 0006C338 7C 08 03 A6 */ mtlr r0 /* 800704FC 0006C33C 38 21 00 10 */ addi r1, r1, 0x10 /* 80070500 0006C340 4E 80 00 20 */ blr /* 80070504 0006C344 00 00 00 00 */ .4byte 0x00000000 /* 80070508 0006C348 00 00 00 00 */ .4byte 0x00000000 /* 8007050C 0006C34C 00 00 00 00 */ .4byte 0x00000000 .global KMPLSIsInit KMPLSIsInit: /* 80070510 0006C350 80 6D EA 98 */ lwz r3, kmpls@sda21(r13) /* 80070514 0006C354 7C 03 00 D0 */ neg r0, r3 /* 80070518 0006C358 7C 00 1B 78 */ or r0, r0, r3 /* 8007051C 0006C35C 54 03 0F FE */ srwi r3, r0, 31 /* 80070520 0006C360 4E 80 00 20 */ blr /* 80070524 0006C364 00 00 00 00 */ .4byte 0x00000000 /* 80070528 0006C368 00 00 00 00 */ .4byte 0x00000000 /* 8007052C 0006C36C 00 00 00 00 */ .4byte 0x00000000 .global KMPLSShutdown KMPLSShutdown: /* 80070530 0006C370 38 00 00 00 */ li r0, 0x0 /* 80070534 0006C374 90 0D EA 98 */ stw r0, kmpls@sda21(r13) /* 80070538 0006C378 4E 80 00 20 */ blr /* 8007053C 0006C37C 00 00 00 00 */ .4byte 0x00000000 .global dpd_revise_scale dpd_revise_scale: /* 80070540 0006C380 94 21 FF B0 */ stwu r1, -0x50(r1) /* 80070544 0006C384 7C 08 02 A6 */ mflr r0 /* 80070548 0006C388 90 01 00 54 */ stw r0, 0x54(r1) /* 8007054C 0006C38C DB E1 00 40 */ stfd f31, 0x40(r1) /* 80070550 0006C390 F3 E1 00 48 */ psq_st f31, 0x48(r1), 0, qr0 /* 80070554 0006C394 C3 E2 88 F0 */ lfs f31, "@2647_8055E870"@sda21(r2) /* 80070558 0006C398 DB C1 00 30 */ stfd f30, 0x30(r1) /* 8007055C 0006C39C F3 C1 00 38 */ psq_st f30, 0x38(r1), 0, qr0 /* 80070560 0006C3A0 DB A1 00 20 */ stfd f29, 0x20(r1) /* 80070564 0006C3A4 F3 A1 00 28 */ psq_st f29, 0x28(r1), 0, qr0 /* 80070568 0006C3A8 DB 81 00 10 */ stfd f28, 0x10(r1) /* 8007056C 0006C3AC F3 81 00 18 */ psq_st f28, 0x18(r1), 0, qr0 /* 80070570 0006C3B0 93 E1 00 0C */ stw r31, 0xc(r1) /* 80070574 0006C3B4 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80070578 0006C3B8 2C 00 00 00 */ cmpwi r0, 0x0 /* 8007057C 0006C3BC 41 82 00 AC */ beq lbl_80070628 /* 80070580 0006C3C0 1F E3 0D B0 */ mulli r31, r3, 0xdb0 /* 80070584 0006C3C4 7C 60 FA 14 */ add r3, r0, r31 /* 80070588 0006C3C8 80 03 01 08 */ lwz r0, 0x108(r3) /* 8007058C 0006C3CC 2C 00 00 00 */ cmpwi r0, 0x0 /* 80070590 0006C3D0 41 82 00 24 */ beq lbl_800705B4 /* 80070594 0006C3D4 4B FE 5F 6D */ bl WPADGetSensorBarPosition /* 80070598 0006C3D8 54 60 06 3E */ clrlwi r0, r3, 24 /* 8007059C 0006C3DC 28 00 00 01 */ cmplwi r0, 0x1 /* 800705A0 0006C3E0 40 82 00 0C */ bne lbl_800705AC /* 800705A4 0006C3E4 C3 C2 89 2C */ lfs f30, "@3075"@sda21(r2) /* 800705A8 0006C3E8 48 00 00 14 */ b lbl_800705BC .global lbl_800705AC lbl_800705AC: /* 800705AC 0006C3EC C3 C2 89 30 */ lfs f30, "@3076"@sda21(r2) /* 800705B0 0006C3F0 48 00 00 0C */ b lbl_800705BC .global lbl_800705B4 lbl_800705B4: /* 800705B4 0006C3F4 C0 03 01 0C */ lfs f0, 0x10c(r3) /* 800705B8 0006C3F8 FF C0 00 50 */ fneg f30, f0 .global lbl_800705BC lbl_800705BC: /* 800705BC 0006C3FC C3 A2 88 F4 */ lfs f29, "@2648_8055E874"@sda21(r2) /* 800705C0 0006C400 C3 82 89 34 */ lfs f28, "@3077"@sda21(r2) /* 800705C4 0006C404 EC 3D 07 72 */ fmuls f1, f29, f29 /* 800705C8 0006C408 EC 1C 07 32 */ fmuls f0, f28, f28 /* 800705CC 0006C40C EC 21 00 2A */ fadds f1, f1, f0 /* 800705D0 0006C410 4B FA 42 19 */ bl sqrt /* 800705D4 0006C414 C0 02 88 F0 */ lfs f0, "@2647_8055E870"@sda21(r2) /* 800705D8 0006C418 FC 20 08 18 */ frsp f1, f1 /* 800705DC 0006C41C FC 1F 00 40 */ fcmpo cr0, f31, f0 /* 800705E0 0006C420 40 80 00 0C */ bge lbl_800705EC /* 800705E4 0006C424 EF BD F8 2A */ fadds f29, f29, f31 /* 800705E8 0006C428 48 00 00 08 */ b lbl_800705F0 .global lbl_800705EC lbl_800705EC: /* 800705EC 0006C42C EF BD F8 28 */ fsubs f29, f29, f31 .global lbl_800705F0 lbl_800705F0: /* 800705F0 0006C430 C0 02 88 F0 */ lfs f0, "@2647_8055E870"@sda21(r2) /* 800705F4 0006C434 FC 1E 00 40 */ fcmpo cr0, f30, f0 /* 800705F8 0006C438 40 80 00 0C */ bge lbl_80070604 /* 800705FC 0006C43C EF 9C F0 2A */ fadds f28, f28, f30 /* 80070600 0006C440 48 00 00 08 */ b lbl_80070608 .global lbl_80070604 lbl_80070604: /* 80070604 0006C444 EF 9C F0 28 */ fsubs f28, f28, f30 .global lbl_80070608 lbl_80070608: /* 80070608 0006C448 FC 1D E0 40 */ fcmpo cr0, f29, f28 /* 8007060C 0006C44C 40 80 00 08 */ bge lbl_80070614 /* 80070610 0006C450 48 00 00 08 */ b lbl_80070618 .global lbl_80070614 lbl_80070614: /* 80070614 0006C454 FF A0 E0 90 */ fmr f29, f28 .global lbl_80070618 lbl_80070618: /* 80070618 0006C458 EC 01 E8 24 */ fdivs f0, f1, f29 /* 8007061C 0006C45C 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80070620 0006C460 7C 60 FA 14 */ add r3, r0, r31 /* 80070624 0006C464 D0 03 01 04 */ stfs f0, 0x104(r3) .global lbl_80070628 lbl_80070628: /* 80070628 0006C468 80 01 00 54 */ lwz r0, 0x54(r1) /* 8007062C 0006C46C E3 E1 00 48 */ psq_l f31, 0x48(r1), 0, qr0 /* 80070630 0006C470 CB E1 00 40 */ lfd f31, 0x40(r1) /* 80070634 0006C474 E3 C1 00 38 */ psq_l f30, 0x38(r1), 0, qr0 /* 80070638 0006C478 CB C1 00 30 */ lfd f30, 0x30(r1) /* 8007063C 0006C47C E3 A1 00 28 */ psq_l f29, 0x28(r1), 0, qr0 /* 80070640 0006C480 CB A1 00 20 */ lfd f29, 0x20(r1) /* 80070644 0006C484 E3 81 00 18 */ psq_l f28, 0x18(r1), 0, qr0 /* 80070648 0006C488 CB 81 00 10 */ lfd f28, 0x10(r1) /* 8007064C 0006C48C 83 E1 00 0C */ lwz r31, 0xc(r1) /* 80070650 0006C490 7C 08 03 A6 */ mtlr r0 /* 80070654 0006C494 38 21 00 50 */ addi r1, r1, 0x50 /* 80070658 0006C498 4E 80 00 20 */ blr /* 8007065C 0006C49C 00 00 00 00 */ .4byte 0x00000000 .global move_mpls_orient move_mpls_orient: /* 80070660 0006C4A0 94 21 FF C0 */ stwu r1, -0x40(r1) /* 80070664 0006C4A4 7C 08 02 A6 */ mflr r0 /* 80070668 0006C4A8 90 01 00 44 */ stw r0, 0x44(r1) /* 8007066C 0006C4AC DB E1 00 30 */ stfd f31, 0x30(r1) /* 80070670 0006C4B0 F3 E1 00 38 */ psq_st f31, 0x38(r1), 0, qr0 /* 80070674 0006C4B4 93 E1 00 2C */ stw r31, 0x2c(r1) /* 80070678 0006C4B8 7C DF 33 78 */ mr r31, r6 /* 8007067C 0006C4BC 93 C1 00 28 */ stw r30, 0x28(r1) /* 80070680 0006C4C0 7C 9E 23 78 */ mr r30, r4 /* 80070684 0006C4C4 93 A1 00 24 */ stw r29, 0x24(r1) /* 80070688 0006C4C8 7C 7D 1B 78 */ mr r29, r3 /* 8007068C 0006C4CC C0 44 00 00 */ lfs f2, 0x0(r4) /* 80070690 0006C4D0 C0 05 00 00 */ lfs f0, 0x0(r5) /* 80070694 0006C4D4 C0 24 00 04 */ lfs f1, 0x4(r4) /* 80070698 0006C4D8 EC A2 00 28 */ fsubs f5, f2, f0 /* 8007069C 0006C4DC C0 05 00 04 */ lfs f0, 0x4(r5) /* 800706A0 0006C4E0 C0 44 00 08 */ lfs f2, 0x8(r4) /* 800706A4 0006C4E4 EC 81 00 28 */ fsubs f4, f1, f0 /* 800706A8 0006C4E8 C0 05 00 08 */ lfs f0, 0x8(r5) /* 800706AC 0006C4EC EC 25 01 72 */ fmuls f1, f5, f5 /* 800706B0 0006C4F0 EC 62 00 28 */ fsubs f3, f2, f0 /* 800706B4 0006C4F4 D0 A1 00 14 */ stfs f5, 0x14(r1) /* 800706B8 0006C4F8 EC 04 01 32 */ fmuls f0, f4, f4 /* 800706BC 0006C4FC D0 81 00 18 */ stfs f4, 0x18(r1) /* 800706C0 0006C500 EC 43 00 F2 */ fmuls f2, f3, f3 /* 800706C4 0006C504 EC 01 00 2A */ fadds f0, f1, f0 /* 800706C8 0006C508 D0 61 00 1C */ stfs f3, 0x1c(r1) /* 800706CC 0006C50C EC 22 00 2A */ fadds f1, f2, f0 /* 800706D0 0006C510 4B FA 41 19 */ bl sqrt /* 800706D4 0006C514 FF E0 08 18 */ frsp f31, f1 /* 800706D8 0006C518 C1 3E 00 00 */ lfs f9, 0x0(r30) /* 800706DC 0006C51C C0 3F 00 00 */ lfs f1, 0x0(r31) /* 800706E0 0006C520 C0 FE 00 04 */ lfs f7, 0x4(r30) /* 800706E4 0006C524 ED 09 08 28 */ fsubs f8, f9, f1 /* 800706E8 0006C528 C0 1F 00 04 */ lfs f0, 0x4(r31) /* 800706EC 0006C52C C0 21 00 14 */ lfs f1, 0x14(r1) /* 800706F0 0006C530 EC C7 00 28 */ fsubs f6, f7, f0 /* 800706F4 0006C534 C0 01 00 18 */ lfs f0, 0x18(r1) /* 800706F8 0006C538 EC 48 00 72 */ fmuls f2, f8, f1 /* 800706FC 0006C53C C0 9E 00 08 */ lfs f4, 0x8(r30) /* 80070700 0006C540 C0 3F 00 08 */ lfs f1, 0x8(r31) /* 80070704 0006C544 EC 06 00 32 */ fmuls f0, f6, f0 /* 80070708 0006C548 C0 61 00 1C */ lfs f3, 0x1c(r1) /* 8007070C 0006C54C EC A4 08 28 */ fsubs f5, f4, f1 /* 80070710 0006C550 C0 22 88 F0 */ lfs f1, "@2647_8055E870"@sda21(r2) /* 80070714 0006C554 EC 02 00 2A */ fadds f0, f2, f0 /* 80070718 0006C558 D1 01 00 08 */ stfs f8, 0x8(r1) /* 8007071C 0006C55C EC 45 00 F2 */ fmuls f2, f5, f3 /* 80070720 0006C560 D0 C1 00 0C */ stfs f6, 0xc(r1) /* 80070724 0006C564 D0 A1 00 10 */ stfs f5, 0x10(r1) /* 80070728 0006C568 EC 02 00 2A */ fadds f0, f2, f0 /* 8007072C 0006C56C FC 00 08 40 */ fcmpo cr0, f0, f1 /* 80070730 0006C570 4C 41 13 82 */ cror eq, gt, eq /* 80070734 0006C574 40 82 00 08 */ bne lbl_8007073C /* 80070738 0006C578 48 00 00 B4 */ b lbl_800707EC .global lbl_8007073C lbl_8007073C: /* 8007073C 0006C57C EC 29 02 32 */ fmuls f1, f9, f8 /* 80070740 0006C580 EC 07 01 B2 */ fmuls f0, f7, f6 /* 80070744 0006C584 EC 44 01 72 */ fmuls f2, f4, f5 /* 80070748 0006C588 EC 01 00 2A */ fadds f0, f1, f0 /* 8007074C 0006C58C EC 02 00 2A */ fadds f0, f2, f0 /* 80070750 0006C590 EC 40 02 72 */ fmuls f2, f0, f9 /* 80070754 0006C594 EC 20 01 F2 */ fmuls f1, f0, f7 /* 80070758 0006C598 EC 00 01 32 */ fmuls f0, f0, f4 /* 8007075C 0006C59C EC 88 10 28 */ fsubs f4, f8, f2 /* 80070760 0006C5A0 EC 46 08 28 */ fsubs f2, f6, f1 /* 80070764 0006C5A4 EC 65 00 28 */ fsubs f3, f5, f0 /* 80070768 0006C5A8 D0 81 00 08 */ stfs f4, 0x8(r1) /* 8007076C 0006C5AC EC 24 01 32 */ fmuls f1, f4, f4 /* 80070770 0006C5B0 EC 02 00 B2 */ fmuls f0, f2, f2 /* 80070774 0006C5B4 D0 41 00 0C */ stfs f2, 0xc(r1) /* 80070778 0006C5B8 EC 43 00 F2 */ fmuls f2, f3, f3 /* 8007077C 0006C5BC D0 61 00 10 */ stfs f3, 0x10(r1) /* 80070780 0006C5C0 EC 01 00 2A */ fadds f0, f1, f0 /* 80070784 0006C5C4 EC 22 00 2A */ fadds f1, f2, f0 /* 80070788 0006C5C8 4B FA 40 61 */ bl sqrt /* 8007078C 0006C5CC FC 20 08 18 */ frsp f1, f1 /* 80070790 0006C5D0 C0 02 89 38 */ lfs f0, "@3168"@sda21(r2) /* 80070794 0006C5D4 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80070798 0006C5D8 40 80 00 0C */ bge lbl_800707A4 /* 8007079C 0006C5DC C0 22 88 F0 */ lfs f1, "@2647_8055E870"@sda21(r2) /* 800707A0 0006C5E0 48 00 00 4C */ b lbl_800707EC .global lbl_800707A4 lbl_800707A4: /* 800707A4 0006C5E4 C0 1D 00 D8 */ lfs f0, 0xd8(r29) /* 800707A8 0006C5E8 C0 C1 00 08 */ lfs f6, 0x8(r1) /* 800707AC 0006C5EC EC 1F 00 32 */ fmuls f0, f31, f0 /* 800707B0 0006C5F0 C0 81 00 0C */ lfs f4, 0xc(r1) /* 800707B4 0006C5F4 C0 41 00 10 */ lfs f2, 0x10(r1) /* 800707B8 0006C5F8 C0 BE 00 00 */ lfs f5, 0x0(r30) /* 800707BC 0006C5FC EC 20 08 24 */ fdivs f1, f0, f1 /* 800707C0 0006C600 C0 7E 00 04 */ lfs f3, 0x4(r30) /* 800707C4 0006C604 C0 1E 00 08 */ lfs f0, 0x8(r30) /* 800707C8 0006C608 EC C1 01 B2 */ fmuls f6, f1, f6 /* 800707CC 0006C60C EC 81 01 32 */ fmuls f4, f1, f4 /* 800707D0 0006C610 EC 41 00 B2 */ fmuls f2, f1, f2 /* 800707D4 0006C614 EC A5 30 28 */ fsubs f5, f5, f6 /* 800707D8 0006C618 EC 63 20 28 */ fsubs f3, f3, f4 /* 800707DC 0006C61C EC 00 10 28 */ fsubs f0, f0, f2 /* 800707E0 0006C620 D0 BE 00 00 */ stfs f5, 0x0(r30) /* 800707E4 0006C624 D0 7E 00 04 */ stfs f3, 0x4(r30) /* 800707E8 0006C628 D0 1E 00 08 */ stfs f0, 0x8(r30) .global lbl_800707EC lbl_800707EC: /* 800707EC 0006C62C 80 01 00 44 */ lwz r0, 0x44(r1) /* 800707F0 0006C630 E3 E1 00 38 */ psq_l f31, 0x38(r1), 0, qr0 /* 800707F4 0006C634 CB E1 00 30 */ lfd f31, 0x30(r1) /* 800707F8 0006C638 83 E1 00 2C */ lwz r31, 0x2c(r1) /* 800707FC 0006C63C 83 C1 00 28 */ lwz r30, 0x28(r1) /* 80070800 0006C640 83 A1 00 24 */ lwz r29, 0x24(r1) /* 80070804 0006C644 7C 08 03 A6 */ mtlr r0 /* 80070808 0006C648 38 21 00 40 */ addi r1, r1, 0x40 /* 8007080C 0006C64C 4E 80 00 20 */ blr .global revise_dir_acc revise_dir_acc: /* 80070810 0006C650 94 21 FF 70 */ stwu r1, -0x90(r1) /* 80070814 0006C654 7C 08 02 A6 */ mflr r0 /* 80070818 0006C658 90 01 00 94 */ stw r0, 0x94(r1) /* 8007081C 0006C65C 1C 03 0D B0 */ mulli r0, r3, 0xdb0 /* 80070820 0006C660 93 E1 00 8C */ stw r31, 0x8c(r1) /* 80070824 0006C664 93 C1 00 88 */ stw r30, 0x88(r1) /* 80070828 0006C668 7C BE 2B 78 */ mr r30, r5 /* 8007082C 0006C66C 93 A1 00 84 */ stw r29, 0x84(r1) /* 80070830 0006C670 7C 9D 23 78 */ mr r29, r4 /* 80070834 0006C674 80 CD EA 98 */ lwz r6, kmpls@sda21(r13) /* 80070838 0006C678 2C 06 00 00 */ cmpwi r6, 0x0 /* 8007083C 0006C67C 7F E6 02 14 */ add r31, r6, r0 /* 80070840 0006C680 40 82 00 0C */ bne lbl_8007084C /* 80070844 0006C684 C0 22 88 F0 */ lfs f1, "@2647_8055E870"@sda21(r2) /* 80070848 0006C688 48 00 02 58 */ b lbl_80070AA0 .global lbl_8007084C lbl_8007084C: /* 8007084C 0006C68C C0 25 00 00 */ lfs f1, 0x0(r5) /* 80070850 0006C690 C0 05 00 04 */ lfs f0, 0x4(r5) /* 80070854 0006C694 EC 41 00 72 */ fmuls f2, f1, f1 /* 80070858 0006C698 C0 65 00 08 */ lfs f3, 0x8(r5) /* 8007085C 0006C69C EC 00 00 32 */ fmuls f0, f0, f0 /* 80070860 0006C6A0 C0 22 88 F0 */ lfs f1, "@2647_8055E870"@sda21(r2) /* 80070864 0006C6A4 EC 63 00 F2 */ fmuls f3, f3, f3 /* 80070868 0006C6A8 EC 02 00 2A */ fadds f0, f2, f0 /* 8007086C 0006C6AC EC 03 00 2A */ fadds f0, f3, f0 /* 80070870 0006C6B0 FC 01 00 00 */ fcmpu cr0, f1, f0 /* 80070874 0006C6B4 40 82 00 08 */ bne lbl_8007087C /* 80070878 0006C6B8 48 00 02 28 */ b lbl_80070AA0 .global lbl_8007087C lbl_8007087C: /* 8007087C 0006C6BC FC 20 00 90 */ fmr f1, f0 /* 80070880 0006C6C0 4B FA 3F 69 */ bl sqrt /* 80070884 0006C6C4 FC 80 08 18 */ frsp f4, f1 /* 80070888 0006C6C8 C0 62 88 F4 */ lfs f3, "@2648_8055E874"@sda21(r2) /* 8007088C 0006C6CC FC 04 18 40 */ fcmpo cr0, f4, f3 /* 80070890 0006C6D0 40 80 00 30 */ bge lbl_800708C0 /* 80070894 0006C6D4 C0 3F 00 E8 */ lfs f1, 0xe8(r31) /* 80070898 0006C6D8 EC 03 08 28 */ fsubs f0, f3, f1 /* 8007089C 0006C6DC FC 04 00 40 */ fcmpo cr0, f4, f0 /* 800708A0 0006C6E0 4C 40 13 82 */ cror eq, lt, eq /* 800708A4 0006C6E4 40 82 00 0C */ bne lbl_800708B0 /* 800708A8 0006C6E8 C0 22 88 F0 */ lfs f1, "@2647_8055E870"@sda21(r2) /* 800708AC 0006C6EC 48 00 01 F4 */ b lbl_80070AA0 .global lbl_800708B0 lbl_800708B0: /* 800708B0 0006C6F0 EC 23 08 24 */ fdivs f1, f3, f1 /* 800708B4 0006C6F4 EC 04 00 28 */ fsubs f0, f4, f0 /* 800708B8 0006C6F8 EC 01 00 32 */ fmuls f0, f1, f0 /* 800708BC 0006C6FC 48 00 00 30 */ b lbl_800708EC .global lbl_800708C0 lbl_800708C0: /* 800708C0 0006C700 C0 5F 00 E8 */ lfs f2, 0xe8(r31) /* 800708C4 0006C704 EC 03 10 2A */ fadds f0, f3, f2 /* 800708C8 0006C708 FC 04 00 40 */ fcmpo cr0, f4, f0 /* 800708CC 0006C70C 4C 41 13 82 */ cror eq, gt, eq /* 800708D0 0006C710 40 82 00 0C */ bne lbl_800708DC /* 800708D4 0006C714 C0 22 88 F0 */ lfs f1, "@2647_8055E870"@sda21(r2) /* 800708D8 0006C718 48 00 01 C8 */ b lbl_80070AA0 .global lbl_800708DC lbl_800708DC: /* 800708DC 0006C71C C0 22 89 28 */ lfs f1, "@2817_8055E8A8"@sda21(r2) /* 800708E0 0006C720 EC 04 00 28 */ fsubs f0, f4, f0 /* 800708E4 0006C724 EC 21 10 24 */ fdivs f1, f1, f2 /* 800708E8 0006C728 EC 01 00 32 */ fmuls f0, f1, f0 .global lbl_800708EC lbl_800708EC: /* 800708EC 0006C72C C0 22 88 F4 */ lfs f1, "@2648_8055E874"@sda21(r2) /* 800708F0 0006C730 EC 00 00 32 */ fmuls f0, f0, f0 /* 800708F4 0006C734 C0 DF 00 E4 */ lfs f6, 0xe4(r31) /* 800708F8 0006C738 38 61 00 14 */ addi r3, r1, 0x14 /* 800708FC 0006C73C EC E1 20 24 */ fdivs f7, f1, f4 /* 80070900 0006C740 C0 9E 00 00 */ lfs f4, 0x0(r30) /* 80070904 0006C744 C0 3E 00 04 */ lfs f1, 0x4(r30) /* 80070908 0006C748 C0 BE 00 08 */ lfs f5, 0x8(r30) /* 8007090C 0006C74C C0 7D 00 00 */ lfs f3, 0x0(r29) /* 80070910 0006C750 C0 5D 00 0C */ lfs f2, 0xc(r29) /* 80070914 0006C754 ED 27 01 32 */ fmuls f9, f7, f4 /* 80070918 0006C758 C0 9D 00 18 */ lfs f4, 0x18(r29) /* 8007091C 0006C75C ED 07 00 72 */ fmuls f8, f7, f1 /* 80070920 0006C760 C0 22 89 28 */ lfs f1, "@2817_8055E8A8"@sda21(r2) /* 80070924 0006C764 EC E7 01 72 */ fmuls f7, f7, f5 /* 80070928 0006C768 D1 21 00 08 */ stfs f9, 0x8(r1) /* 8007092C 0006C76C EC 69 00 F2 */ fmuls f3, f9, f3 /* 80070930 0006C770 D1 01 00 0C */ stfs f8, 0xc(r1) /* 80070934 0006C774 EC 48 00 B2 */ fmuls f2, f8, f2 /* 80070938 0006C778 EC 87 01 32 */ fmuls f4, f7, f4 /* 8007093C 0006C77C D0 E1 00 10 */ stfs f7, 0x10(r1) /* 80070940 0006C780 EC 00 01 B2 */ fmuls f0, f0, f6 /* 80070944 0006C784 EC 43 10 2A */ fadds f2, f3, f2 /* 80070948 0006C788 EC C4 10 2A */ fadds f6, f4, f2 /* 8007094C 0006C78C D0 C1 00 20 */ stfs f6, 0x20(r1) /* 80070950 0006C790 FC 40 30 50 */ fneg f2, f6 /* 80070954 0006C794 C0 9D 00 04 */ lfs f4, 0x4(r29) /* 80070958 0006C798 C0 7D 00 10 */ lfs f3, 0x10(r29) /* 8007095C 0006C79C C0 BD 00 1C */ lfs f5, 0x1c(r29) /* 80070960 0006C7A0 EC 42 00 32 */ fmuls f2, f2, f0 /* 80070964 0006C7A4 EC 89 01 32 */ fmuls f4, f9, f4 /* 80070968 0006C7A8 EC 68 00 F2 */ fmuls f3, f8, f3 /* 8007096C 0006C7AC EC A7 01 72 */ fmuls f5, f7, f5 /* 80070970 0006C7B0 EC 46 10 2A */ fadds f2, f6, f2 /* 80070974 0006C7B4 EC 64 18 2A */ fadds f3, f4, f3 /* 80070978 0006C7B8 EC C5 18 2A */ fadds f6, f5, f3 /* 8007097C 0006C7BC D0 C1 00 24 */ stfs f6, 0x24(r1) /* 80070980 0006C7C0 EC 21 30 28 */ fsubs f1, f1, f6 /* 80070984 0006C7C4 C0 9D 00 08 */ lfs f4, 0x8(r29) /* 80070988 0006C7C8 C0 7D 00 14 */ lfs f3, 0x14(r29) /* 8007098C 0006C7CC C0 BD 00 20 */ lfs f5, 0x20(r29) /* 80070990 0006C7D0 EC 21 00 32 */ fmuls f1, f1, f0 /* 80070994 0006C7D4 EC 89 01 32 */ fmuls f4, f9, f4 /* 80070998 0006C7D8 EC 68 00 F2 */ fmuls f3, f8, f3 /* 8007099C 0006C7DC D0 41 00 14 */ stfs f2, 0x14(r1) /* 800709A0 0006C7E0 EC 26 08 2A */ fadds f1, f6, f1 /* 800709A4 0006C7E4 EC A7 01 72 */ fmuls f5, f7, f5 /* 800709A8 0006C7E8 EC 44 18 2A */ fadds f2, f4, f3 /* 800709AC 0006C7EC D0 21 00 18 */ stfs f1, 0x18(r1) /* 800709B0 0006C7F0 EC 45 10 2A */ fadds f2, f5, f2 /* 800709B4 0006C7F4 D0 41 00 28 */ stfs f2, 0x28(r1) /* 800709B8 0006C7F8 FC 20 10 50 */ fneg f1, f2 /* 800709BC 0006C7FC EC 01 00 32 */ fmuls f0, f1, f0 /* 800709C0 0006C800 EC 02 00 2A */ fadds f0, f2, f0 /* 800709C4 0006C804 D0 01 00 1C */ stfs f0, 0x1c(r1) /* 800709C8 0006C808 48 00 1B 49 */ bl __KMPLS_normalize_Fxyz /* 800709CC 0006C80C C0 02 88 F0 */ lfs f0, "@2647_8055E870"@sda21(r2) /* 800709D0 0006C810 FC 00 08 00 */ fcmpu cr0, f0, f1 /* 800709D4 0006C814 40 82 00 0C */ bne lbl_800709E0 /* 800709D8 0006C818 FC 20 00 90 */ fmr f1, f0 /* 800709DC 0006C81C 48 00 00 C4 */ b lbl_80070AA0 .global lbl_800709E0 lbl_800709E0: /* 800709E0 0006C820 38 61 00 50 */ addi r3, r1, 0x50 /* 800709E4 0006C824 38 81 00 20 */ addi r4, r1, 0x20 /* 800709E8 0006C828 38 A1 00 14 */ addi r5, r1, 0x14 /* 800709EC 0006C82C 48 00 1F 25 */ bl __KMPLS_make_vec_dir /* 800709F0 0006C830 7F A4 EB 78 */ mr r4, r29 /* 800709F4 0006C834 38 61 00 50 */ addi r3, r1, 0x50 /* 800709F8 0006C838 38 A1 00 2C */ addi r5, r1, 0x2c /* 800709FC 0006C83C 48 00 22 25 */ bl __KMPLS_mult_dir /* 80070A00 0006C840 80 81 00 2C */ lwz r4, 0x2c(r1) /* 80070A04 0006C844 7F A3 EB 78 */ mr r3, r29 /* 80070A08 0006C848 80 01 00 30 */ lwz r0, 0x30(r1) /* 80070A0C 0006C84C 90 1D 00 04 */ stw r0, 0x4(r29) /* 80070A10 0006C850 C0 22 89 3C */ lfs f1, "@3197_8055E8BC"@sda21(r2) /* 80070A14 0006C854 90 9D 00 00 */ stw r4, 0x0(r29) /* 80070A18 0006C858 80 81 00 34 */ lwz r4, 0x34(r1) /* 80070A1C 0006C85C 80 01 00 38 */ lwz r0, 0x38(r1) /* 80070A20 0006C860 90 1D 00 0C */ stw r0, 0xc(r29) /* 80070A24 0006C864 90 9D 00 08 */ stw r4, 0x8(r29) /* 80070A28 0006C868 80 81 00 3C */ lwz r4, 0x3c(r1) /* 80070A2C 0006C86C 80 01 00 40 */ lwz r0, 0x40(r1) /* 80070A30 0006C870 90 1D 00 14 */ stw r0, 0x14(r29) /* 80070A34 0006C874 90 9D 00 10 */ stw r4, 0x10(r29) /* 80070A38 0006C878 80 81 00 44 */ lwz r4, 0x44(r1) /* 80070A3C 0006C87C 80 01 00 48 */ lwz r0, 0x48(r1) /* 80070A40 0006C880 90 1D 00 1C */ stw r0, 0x1c(r29) /* 80070A44 0006C884 90 9D 00 18 */ stw r4, 0x18(r29) /* 80070A48 0006C888 80 01 00 4C */ lwz r0, 0x4c(r1) /* 80070A4C 0006C88C 90 1D 00 20 */ stw r0, 0x20(r29) /* 80070A50 0006C890 48 00 1B 51 */ bl __KMPLS_normalize_directionXYZ /* 80070A54 0006C894 C0 41 00 20 */ lfs f2, 0x20(r1) /* 80070A58 0006C898 C0 01 00 14 */ lfs f0, 0x14(r1) /* 80070A5C 0006C89C C0 21 00 24 */ lfs f1, 0x24(r1) /* 80070A60 0006C8A0 EC A2 00 28 */ fsubs f5, f2, f0 /* 80070A64 0006C8A4 C0 01 00 18 */ lfs f0, 0x18(r1) /* 80070A68 0006C8A8 C0 41 00 28 */ lfs f2, 0x28(r1) /* 80070A6C 0006C8AC EC 81 00 28 */ fsubs f4, f1, f0 /* 80070A70 0006C8B0 C0 01 00 1C */ lfs f0, 0x1c(r1) /* 80070A74 0006C8B4 EC 25 01 72 */ fmuls f1, f5, f5 /* 80070A78 0006C8B8 EC 62 00 28 */ fsubs f3, f2, f0 /* 80070A7C 0006C8BC D0 A1 00 20 */ stfs f5, 0x20(r1) /* 80070A80 0006C8C0 EC 04 01 32 */ fmuls f0, f4, f4 /* 80070A84 0006C8C4 D0 81 00 24 */ stfs f4, 0x24(r1) /* 80070A88 0006C8C8 EC 43 00 F2 */ fmuls f2, f3, f3 /* 80070A8C 0006C8CC EC 01 00 2A */ fadds f0, f1, f0 /* 80070A90 0006C8D0 D0 61 00 28 */ stfs f3, 0x28(r1) /* 80070A94 0006C8D4 EC 22 00 2A */ fadds f1, f2, f0 /* 80070A98 0006C8D8 4B FA 3D 51 */ bl sqrt /* 80070A9C 0006C8DC FC 20 08 18 */ frsp f1, f1 .global lbl_80070AA0 lbl_80070AA0: /* 80070AA0 0006C8E0 80 01 00 94 */ lwz r0, 0x94(r1) /* 80070AA4 0006C8E4 83 E1 00 8C */ lwz r31, 0x8c(r1) /* 80070AA8 0006C8E8 83 C1 00 88 */ lwz r30, 0x88(r1) /* 80070AAC 0006C8EC 83 A1 00 84 */ lwz r29, 0x84(r1) /* 80070AB0 0006C8F0 7C 08 03 A6 */ mtlr r0 /* 80070AB4 0006C8F4 38 21 00 90 */ addi r1, r1, 0x90 /* 80070AB8 0006C8F8 4E 80 00 20 */ blr /* 80070ABC 0006C8FC 00 00 00 00 */ .4byte 0x00000000 .global revise_dir_dpd revise_dir_dpd: /* 80070AC0 0006C900 94 21 FF 40 */ stwu r1, -0xc0(r1) /* 80070AC4 0006C904 7C 08 02 A6 */ mflr r0 /* 80070AC8 0006C908 90 01 00 C4 */ stw r0, 0xc4(r1) /* 80070ACC 0006C90C 39 61 00 B0 */ addi r11, r1, 0xb0 /* 80070AD0 0006C910 DB E1 00 B0 */ stfd f31, 0xb0(r1) /* 80070AD4 0006C914 F3 E1 00 B8 */ psq_st f31, 0xb8(r1), 0, qr0 /* 80070AD8 0006C918 4B F9 68 65 */ bl lbl_8000733C /* 80070ADC 0006C91C 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80070AE0 0006C920 1F 83 0D B0 */ mulli r28, r3, 0xdb0 /* 80070AE4 0006C924 C3 E2 89 40 */ lfs f31, "@3230"@sda21(r2) /* 80070AE8 0006C928 7C 7B 1B 78 */ mr r27, r3 /* 80070AEC 0006C92C 2C 00 00 00 */ cmpwi r0, 0x0 /* 80070AF0 0006C930 7C 9D 23 78 */ mr r29, r4 /* 80070AF4 0006C934 7C BE 2B 78 */ mr r30, r5 /* 80070AF8 0006C938 7F E0 E2 14 */ add r31, r0, r28 /* 80070AFC 0006C93C 40 82 00 0C */ bne lbl_80070B08 /* 80070B00 0006C940 C0 22 88 F0 */ lfs f1, "@2647_8055E870"@sda21(r2) /* 80070B04 0006C944 48 00 03 28 */ b lbl_80070E2C .global lbl_80070B08 lbl_80070B08: /* 80070B08 0006C948 4B FF AA 49 */ bl KPADIsEnableAimingMode /* 80070B0C 0006C94C 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80070B10 0006C950 54 64 06 3E */ clrlwi r4, r3, 24 /* 80070B14 0006C954 7C 60 E2 14 */ add r3, r0, r28 /* 80070B18 0006C958 80 03 01 08 */ lwz r0, 0x108(r3) /* 80070B1C 0006C95C 7C 00 20 00 */ cmpw r0, r4 /* 80070B20 0006C960 40 82 00 20 */ bne lbl_80070B40 /* 80070B24 0006C964 7F 63 DB 78 */ mr r3, r27 /* 80070B28 0006C968 4B FF AA 49 */ bl KPADGetSensorHeight /* 80070B2C 0006C96C 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80070B30 0006C970 7C 60 E2 14 */ add r3, r0, r28 /* 80070B34 0006C974 C0 03 01 0C */ lfs f0, 0x10c(r3) /* 80070B38 0006C978 FC 00 08 00 */ fcmpu cr0, f0, f1 /* 80070B3C 0006C97C 41 82 00 38 */ beq lbl_80070B74 .global lbl_80070B40 lbl_80070B40: /* 80070B40 0006C980 7F 63 DB 78 */ mr r3, r27 /* 80070B44 0006C984 4B FF AA 0D */ bl KPADIsEnableAimingMode /* 80070B48 0006C988 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80070B4C 0006C98C 54 65 06 3E */ clrlwi r5, r3, 24 /* 80070B50 0006C990 7F 63 DB 78 */ mr r3, r27 /* 80070B54 0006C994 7C 80 E2 14 */ add r4, r0, r28 /* 80070B58 0006C998 90 A4 01 08 */ stw r5, 0x108(r4) /* 80070B5C 0006C99C 4B FF AA 15 */ bl KPADGetSensorHeight /* 80070B60 0006C9A0 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80070B64 0006C9A4 7F 63 DB 78 */ mr r3, r27 /* 80070B68 0006C9A8 7C 80 E2 14 */ add r4, r0, r28 /* 80070B6C 0006C9AC D0 24 01 0C */ stfs f1, 0x10c(r4) /* 80070B70 0006C9B0 4B FF F9 D1 */ bl dpd_revise_scale .global lbl_80070B74 lbl_80070B74: /* 80070B74 0006C9B4 C0 1F 01 04 */ lfs f0, 0x104(r31) /* 80070B78 0006C9B8 88 1E 00 5E */ lbz r0, 0x5e(r30) /* 80070B7C 0006C9BC EF FF 00 24 */ fdivs f31, f31, f0 /* 80070B80 0006C9C0 2C 00 00 02 */ cmpwi r0, 0x2 /* 80070B84 0006C9C4 40 82 02 A4 */ bne lbl_80070E28 /* 80070B88 0006C9C8 C0 9E 00 34 */ lfs f4, 0x34(r30) /* 80070B8C 0006C9CC 3C C0 80 44 */ lis r6, e_dir@ha /* 80070B90 0006C9D0 D0 81 00 68 */ stfs f4, 0x68(r1) /* 80070B94 0006C9D4 38 C6 A0 10 */ addi r6, r6, e_dir@l /* 80070B98 0006C9D8 C0 42 88 F0 */ lfs f2, "@2647_8055E870"@sda21(r2) /* 80070B9C 0006C9DC FC 20 F8 50 */ fneg f1, f31 /* 80070BA0 0006C9E0 C0 7E 00 38 */ lfs f3, 0x38(r30) /* 80070BA4 0006C9E4 38 61 00 08 */ addi r3, r1, 0x8 /* 80070BA8 0006C9E8 80 A6 00 18 */ lwz r5, 0x18(r6) /* 80070BAC 0006C9EC FC 00 18 50 */ fneg f0, f3 /* 80070BB0 0006C9F0 80 86 00 1C */ lwz r4, 0x1c(r6) /* 80070BB4 0006C9F4 80 06 00 20 */ lwz r0, 0x20(r6) /* 80070BB8 0006C9F8 D0 61 00 6C */ stfs f3, 0x6c(r1) /* 80070BBC 0006C9FC D0 41 00 70 */ stfs f2, 0x70(r1) /* 80070BC0 0006CA00 D0 01 00 74 */ stfs f0, 0x74(r1) /* 80070BC4 0006CA04 D0 81 00 78 */ stfs f4, 0x78(r1) /* 80070BC8 0006CA08 D0 41 00 7C */ stfs f2, 0x7c(r1) /* 80070BCC 0006CA0C 90 A1 00 80 */ stw r5, 0x80(r1) /* 80070BD0 0006CA10 90 81 00 84 */ stw r4, 0x84(r1) /* 80070BD4 0006CA14 90 01 00 88 */ stw r0, 0x88(r1) /* 80070BD8 0006CA18 90 A1 00 08 */ stw r5, 0x8(r1) /* 80070BDC 0006CA1C 90 81 00 0C */ stw r4, 0xc(r1) /* 80070BE0 0006CA20 90 01 00 10 */ stw r0, 0x10(r1) /* 80070BE4 0006CA24 90 A1 00 14 */ stw r5, 0x14(r1) /* 80070BE8 0006CA28 90 81 00 18 */ stw r4, 0x18(r1) /* 80070BEC 0006CA2C 90 01 00 1C */ stw r0, 0x1c(r1) /* 80070BF0 0006CA30 C0 1E 00 20 */ lfs f0, 0x20(r30) /* 80070BF4 0006CA34 EC 01 00 32 */ fmuls f0, f1, f0 /* 80070BF8 0006CA38 D0 01 00 08 */ stfs f0, 0x8(r1) /* 80070BFC 0006CA3C 48 00 19 15 */ bl __KMPLS_normalize_Fxyz /* 80070C00 0006CA40 38 61 00 20 */ addi r3, r1, 0x20 /* 80070C04 0006CA44 38 81 00 14 */ addi r4, r1, 0x14 /* 80070C08 0006CA48 38 A1 00 08 */ addi r5, r1, 0x8 /* 80070C0C 0006CA4C 48 00 1D 05 */ bl __KMPLS_make_vec_dir /* 80070C10 0006CA50 38 61 00 20 */ addi r3, r1, 0x20 /* 80070C14 0006CA54 38 81 00 68 */ addi r4, r1, 0x68 /* 80070C18 0006CA58 38 A1 00 44 */ addi r5, r1, 0x44 /* 80070C1C 0006CA5C 48 00 20 05 */ bl __KMPLS_mult_dir /* 80070C20 0006CA60 80 81 00 5C */ lwz r4, 0x5c(r1) /* 80070C24 0006CA64 80 61 00 60 */ lwz r3, 0x60(r1) /* 80070C28 0006CA68 80 01 00 64 */ lwz r0, 0x64(r1) /* 80070C2C 0006CA6C 90 81 00 08 */ stw r4, 0x8(r1) /* 80070C30 0006CA70 90 61 00 0C */ stw r3, 0xc(r1) /* 80070C34 0006CA74 90 01 00 10 */ stw r0, 0x10(r1) /* 80070C38 0006CA78 90 81 00 14 */ stw r4, 0x14(r1) /* 80070C3C 0006CA7C 90 61 00 18 */ stw r3, 0x18(r1) /* 80070C40 0006CA80 90 01 00 1C */ stw r0, 0x1c(r1) /* 80070C44 0006CA84 C0 3D 00 18 */ lfs f1, 0x18(r29) /* 80070C48 0006CA88 C0 1D 00 20 */ lfs f0, 0x20(r29) /* 80070C4C 0006CA8C EC 21 00 72 */ fmuls f1, f1, f1 /* 80070C50 0006CA90 EC 00 00 32 */ fmuls f0, f0, f0 /* 80070C54 0006CA94 EC 21 00 2A */ fadds f1, f1, f0 /* 80070C58 0006CA98 4B FA 3B 91 */ bl sqrt /* 80070C5C 0006CA9C FC 40 08 18 */ frsp f2, f1 /* 80070C60 0006CAA0 C0 21 00 08 */ lfs f1, 0x8(r1) /* 80070C64 0006CAA4 C0 01 00 10 */ lfs f0, 0x10(r1) /* 80070C68 0006CAA8 38 61 00 20 */ addi r3, r1, 0x20 /* 80070C6C 0006CAAC 38 81 00 14 */ addi r4, r1, 0x14 /* 80070C70 0006CAB0 38 A1 00 08 */ addi r5, r1, 0x8 /* 80070C74 0006CAB4 EC 21 00 B2 */ fmuls f1, f1, f2 /* 80070C78 0006CAB8 EC 00 00 B2 */ fmuls f0, f0, f2 /* 80070C7C 0006CABC D0 21 00 08 */ stfs f1, 0x8(r1) /* 80070C80 0006CAC0 D0 01 00 10 */ stfs f0, 0x10(r1) /* 80070C84 0006CAC4 C0 1D 00 1C */ lfs f0, 0x1c(r29) /* 80070C88 0006CAC8 D0 01 00 0C */ stfs f0, 0xc(r1) /* 80070C8C 0006CACC 48 00 1C 85 */ bl __KMPLS_make_vec_dir /* 80070C90 0006CAD0 38 61 00 20 */ addi r3, r1, 0x20 /* 80070C94 0006CAD4 38 81 00 44 */ addi r4, r1, 0x44 /* 80070C98 0006CAD8 38 A1 00 68 */ addi r5, r1, 0x68 /* 80070C9C 0006CADC 48 00 1F 85 */ bl __KMPLS_mult_dir /* 80070CA0 0006CAE0 80 DD 00 00 */ lwz r6, 0x0(r29) /* 80070CA4 0006CAE4 7F A3 EB 78 */ mr r3, r29 /* 80070CA8 0006CAE8 80 1D 00 04 */ lwz r0, 0x4(r29) /* 80070CAC 0006CAEC 7F A5 EB 78 */ mr r5, r29 /* 80070CB0 0006CAF0 90 01 00 48 */ stw r0, 0x48(r1) /* 80070CB4 0006CAF4 38 81 00 68 */ addi r4, r1, 0x68 /* 80070CB8 0006CAF8 90 C1 00 44 */ stw r6, 0x44(r1) /* 80070CBC 0006CAFC 80 DD 00 08 */ lwz r6, 0x8(r29) /* 80070CC0 0006CB00 80 1D 00 0C */ lwz r0, 0xc(r29) /* 80070CC4 0006CB04 90 01 00 50 */ stw r0, 0x50(r1) /* 80070CC8 0006CB08 90 C1 00 4C */ stw r6, 0x4c(r1) /* 80070CCC 0006CB0C 80 DD 00 10 */ lwz r6, 0x10(r29) /* 80070CD0 0006CB10 80 1D 00 14 */ lwz r0, 0x14(r29) /* 80070CD4 0006CB14 90 01 00 58 */ stw r0, 0x58(r1) /* 80070CD8 0006CB18 90 C1 00 54 */ stw r6, 0x54(r1) /* 80070CDC 0006CB1C 80 DD 00 18 */ lwz r6, 0x18(r29) /* 80070CE0 0006CB20 80 1D 00 1C */ lwz r0, 0x1c(r29) /* 80070CE4 0006CB24 90 01 00 60 */ stw r0, 0x60(r1) /* 80070CE8 0006CB28 90 C1 00 5C */ stw r6, 0x5c(r1) /* 80070CEC 0006CB2C 80 1D 00 20 */ lwz r0, 0x20(r29) /* 80070CF0 0006CB30 90 01 00 64 */ stw r0, 0x64(r1) /* 80070CF4 0006CB34 C0 3F 00 EC */ lfs f1, 0xec(r31) /* 80070CF8 0006CB38 48 00 20 E9 */ bl __KMPLS_linear_Direction /* 80070CFC 0006CB3C C0 21 00 44 */ lfs f1, 0x44(r1) /* 80070D00 0006CB40 C0 1D 00 00 */ lfs f0, 0x0(r29) /* 80070D04 0006CB44 C0 41 00 48 */ lfs f2, 0x48(r1) /* 80070D08 0006CB48 EC 01 00 28 */ fsubs f0, f1, f0 /* 80070D0C 0006CB4C C1 21 00 4C */ lfs f9, 0x4c(r1) /* 80070D10 0006CB50 C0 A1 00 50 */ lfs f5, 0x50(r1) /* 80070D14 0006CB54 D0 01 00 44 */ stfs f0, 0x44(r1) /* 80070D18 0006CB58 EC 20 00 32 */ fmuls f1, f0, f0 /* 80070D1C 0006CB5C C0 C1 00 54 */ lfs f6, 0x54(r1) /* 80070D20 0006CB60 C0 1D 00 04 */ lfs f0, 0x4(r29) /* 80070D24 0006CB64 C0 E1 00 58 */ lfs f7, 0x58(r1) /* 80070D28 0006CB68 EC 02 00 28 */ fsubs f0, f2, f0 /* 80070D2C 0006CB6C C0 41 00 5C */ lfs f2, 0x5c(r1) /* 80070D30 0006CB70 C0 61 00 60 */ lfs f3, 0x60(r1) /* 80070D34 0006CB74 D0 01 00 48 */ stfs f0, 0x48(r1) /* 80070D38 0006CB78 EC 00 00 32 */ fmuls f0, f0, f0 /* 80070D3C 0006CB7C C0 81 00 64 */ lfs f4, 0x64(r1) /* 80070D40 0006CB80 C1 1D 00 08 */ lfs f8, 0x8(r29) /* 80070D44 0006CB84 ED 09 40 28 */ fsubs f8, f9, f8 /* 80070D48 0006CB88 EC 01 00 2A */ fadds f0, f1, f0 /* 80070D4C 0006CB8C D1 01 00 4C */ stfs f8, 0x4c(r1) /* 80070D50 0006CB90 EC 28 02 32 */ fmuls f1, f8, f8 /* 80070D54 0006CB94 EC 21 00 2A */ fadds f1, f1, f0 /* 80070D58 0006CB98 D0 21 00 44 */ stfs f1, 0x44(r1) /* 80070D5C 0006CB9C C0 1D 00 0C */ lfs f0, 0xc(r29) /* 80070D60 0006CBA0 EC 05 00 28 */ fsubs f0, f5, f0 /* 80070D64 0006CBA4 D0 01 00 50 */ stfs f0, 0x50(r1) /* 80070D68 0006CBA8 EC A0 00 32 */ fmuls f5, f0, f0 /* 80070D6C 0006CBAC C0 1D 00 10 */ lfs f0, 0x10(r29) /* 80070D70 0006CBB0 EC 06 00 28 */ fsubs f0, f6, f0 /* 80070D74 0006CBB4 D0 01 00 54 */ stfs f0, 0x54(r1) /* 80070D78 0006CBB8 EC 00 00 32 */ fmuls f0, f0, f0 /* 80070D7C 0006CBBC C0 DD 00 14 */ lfs f6, 0x14(r29) /* 80070D80 0006CBC0 EC C7 30 28 */ fsubs f6, f7, f6 /* 80070D84 0006CBC4 EC 05 00 2A */ fadds f0, f5, f0 /* 80070D88 0006CBC8 D0 C1 00 58 */ stfs f6, 0x58(r1) /* 80070D8C 0006CBCC EC A6 01 B2 */ fmuls f5, f6, f6 /* 80070D90 0006CBD0 EC A5 00 2A */ fadds f5, f5, f0 /* 80070D94 0006CBD4 D0 A1 00 50 */ stfs f5, 0x50(r1) /* 80070D98 0006CBD8 FC 01 28 40 */ fcmpo cr0, f1, f5 /* 80070D9C 0006CBDC C0 1D 00 18 */ lfs f0, 0x18(r29) /* 80070DA0 0006CBE0 EC 02 00 28 */ fsubs f0, f2, f0 /* 80070DA4 0006CBE4 D0 01 00 5C */ stfs f0, 0x5c(r1) /* 80070DA8 0006CBE8 EC 40 00 32 */ fmuls f2, f0, f0 /* 80070DAC 0006CBEC C0 1D 00 1C */ lfs f0, 0x1c(r29) /* 80070DB0 0006CBF0 EC 03 00 28 */ fsubs f0, f3, f0 /* 80070DB4 0006CBF4 D0 01 00 60 */ stfs f0, 0x60(r1) /* 80070DB8 0006CBF8 EC 00 00 32 */ fmuls f0, f0, f0 /* 80070DBC 0006CBFC C0 7D 00 20 */ lfs f3, 0x20(r29) /* 80070DC0 0006CC00 EC 64 18 28 */ fsubs f3, f4, f3 /* 80070DC4 0006CC04 EC 02 00 2A */ fadds f0, f2, f0 /* 80070DC8 0006CC08 D0 61 00 64 */ stfs f3, 0x64(r1) /* 80070DCC 0006CC0C EC 43 00 F2 */ fmuls f2, f3, f3 /* 80070DD0 0006CC10 EC 02 00 2A */ fadds f0, f2, f0 /* 80070DD4 0006CC14 D0 01 00 5C */ stfs f0, 0x5c(r1) /* 80070DD8 0006CC18 40 81 00 28 */ ble lbl_80070E00 /* 80070DDC 0006CC1C FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80070DE0 0006CC20 40 81 00 10 */ ble lbl_80070DF0 /* 80070DE4 0006CC24 4B FA 3A 05 */ bl sqrt /* 80070DE8 0006CC28 FC 20 08 18 */ frsp f1, f1 /* 80070DEC 0006CC2C 48 00 00 40 */ b lbl_80070E2C .global lbl_80070DF0 lbl_80070DF0: /* 80070DF0 0006CC30 FC 20 00 90 */ fmr f1, f0 /* 80070DF4 0006CC34 4B FA 39 F5 */ bl sqrt /* 80070DF8 0006CC38 FC 20 08 18 */ frsp f1, f1 /* 80070DFC 0006CC3C 48 00 00 30 */ b lbl_80070E2C .global lbl_80070E00 lbl_80070E00: /* 80070E00 0006CC40 FC 05 00 40 */ fcmpo cr0, f5, f0 /* 80070E04 0006CC44 40 81 00 14 */ ble lbl_80070E18 /* 80070E08 0006CC48 FC 20 28 90 */ fmr f1, f5 /* 80070E0C 0006CC4C 4B FA 39 DD */ bl sqrt /* 80070E10 0006CC50 FC 20 08 18 */ frsp f1, f1 /* 80070E14 0006CC54 48 00 00 18 */ b lbl_80070E2C .global lbl_80070E18 lbl_80070E18: /* 80070E18 0006CC58 FC 20 00 90 */ fmr f1, f0 /* 80070E1C 0006CC5C 4B FA 39 CD */ bl sqrt /* 80070E20 0006CC60 FC 20 08 18 */ frsp f1, f1 /* 80070E24 0006CC64 48 00 00 08 */ b lbl_80070E2C .global lbl_80070E28 lbl_80070E28: /* 80070E28 0006CC68 C0 22 88 F0 */ lfs f1, "@2647_8055E870"@sda21(r2) .global lbl_80070E2C lbl_80070E2C: /* 80070E2C 0006CC6C 39 61 00 B0 */ addi r11, r1, 0xb0 /* 80070E30 0006CC70 E3 E1 00 B8 */ psq_l f31, 0xb8(r1), 0, qr0 /* 80070E34 0006CC74 CB E1 00 B0 */ lfd f31, 0xb0(r1) /* 80070E38 0006CC78 4B F9 65 51 */ bl lbl_80007388 /* 80070E3C 0006CC7C 80 01 00 C4 */ lwz r0, 0xc4(r1) /* 80070E40 0006CC80 7C 08 03 A6 */ mtlr r0 /* 80070E44 0006CC84 38 21 00 C0 */ addi r1, r1, 0xc0 /* 80070E48 0006CC88 4E 80 00 20 */ blr /* 80070E4C 0006CC8C 00 00 00 00 */ .4byte 0x00000000 .global calc_mpls_dir calc_mpls_dir: /* 80070E50 0006CC90 94 21 FE F0 */ stwu r1, -0x110(r1) /* 80070E54 0006CC94 7C 08 02 A6 */ mflr r0 /* 80070E58 0006CC98 90 01 01 14 */ stw r0, 0x114(r1) /* 80070E5C 0006CC9C DB E1 01 00 */ stfd f31, 0x100(r1) /* 80070E60 0006CCA0 F3 E1 01 08 */ psq_st f31, 0x108(r1), 0, qr0 /* 80070E64 0006CCA4 DB C1 00 F0 */ stfd f30, 0xf0(r1) /* 80070E68 0006CCA8 F3 C1 00 F8 */ psq_st f30, 0xf8(r1), 0, qr0 /* 80070E6C 0006CCAC DB A1 00 E0 */ stfd f29, 0xe0(r1) /* 80070E70 0006CCB0 F3 A1 00 E8 */ psq_st f29, 0xe8(r1), 0, qr0 /* 80070E74 0006CCB4 DB 81 00 D0 */ stfd f28, 0xd0(r1) /* 80070E78 0006CCB8 F3 81 00 D8 */ psq_st f28, 0xd8(r1), 0, qr0 /* 80070E7C 0006CCBC DB 61 00 C0 */ stfd f27, 0xc0(r1) /* 80070E80 0006CCC0 F3 61 00 C8 */ psq_st f27, 0xc8(r1), 0, qr0 /* 80070E84 0006CCC4 DB 41 00 B0 */ stfd f26, 0xb0(r1) /* 80070E88 0006CCC8 F3 41 00 B8 */ psq_st f26, 0xb8(r1), 0, qr0 /* 80070E8C 0006CCCC DB 21 00 A0 */ stfd f25, 0xa0(r1) /* 80070E90 0006CCD0 F3 21 00 A8 */ psq_st f25, 0xa8(r1), 0, qr0 /* 80070E94 0006CCD4 DB 01 00 90 */ stfd f24, 0x90(r1) /* 80070E98 0006CCD8 F3 01 00 98 */ psq_st f24, 0x98(r1), 0, qr0 /* 80070E9C 0006CCDC DA E1 00 80 */ stfd f23, 0x80(r1) /* 80070EA0 0006CCE0 F2 E1 00 88 */ psq_st f23, 0x88(r1), 0, qr0 /* 80070EA4 0006CCE4 DA C1 00 70 */ stfd f22, 0x70(r1) /* 80070EA8 0006CCE8 F2 C1 00 78 */ psq_st f22, 0x78(r1), 0, qr0 /* 80070EAC 0006CCEC DA A1 00 60 */ stfd f21, 0x60(r1) /* 80070EB0 0006CCF0 F2 A1 00 68 */ psq_st f21, 0x68(r1), 0, qr0 /* 80070EB4 0006CCF4 DA 81 00 50 */ stfd f20, 0x50(r1) /* 80070EB8 0006CCF8 F2 81 00 58 */ psq_st f20, 0x58(r1), 0, qr0 /* 80070EBC 0006CCFC DA 61 00 40 */ stfd f19, 0x40(r1) /* 80070EC0 0006CD00 F2 61 00 48 */ psq_st f19, 0x48(r1), 0, qr0 /* 80070EC4 0006CD04 DA 41 00 30 */ stfd f18, 0x30(r1) /* 80070EC8 0006CD08 F2 41 00 38 */ psq_st f18, 0x38(r1), 0, qr0 /* 80070ECC 0006CD0C C2 E3 00 A8 */ lfs f23, 0xa8(r3) /* 80070ED0 0006CD10 C0 23 00 00 */ lfs f1, 0x0(r3) /* 80070ED4 0006CD14 C0 03 00 04 */ lfs f0, 0x4(r3) /* 80070ED8 0006CD18 EC 57 00 72 */ fmuls f2, f23, f1 /* 80070EDC 0006CD1C C3 03 00 B0 */ lfs f24, 0xb0(r3) /* 80070EE0 0006CD20 EC 97 00 32 */ fmuls f4, f23, f0 /* 80070EE4 0006CD24 80 A3 00 24 */ lwz r5, 0x24(r3) /* 80070EE8 0006CD28 90 A1 00 14 */ stw r5, 0x14(r1) /* 80070EEC 0006CD2C EC 18 00 B2 */ fmuls f0, f24, f2 /* 80070EF0 0006CD30 EC 38 01 32 */ fmuls f1, f24, f4 /* 80070EF4 0006CD34 C3 63 00 B4 */ lfs f27, 0xb4(r3) /* 80070EF8 0006CD38 80 03 00 2C */ lwz r0, 0x2c(r3) /* 80070EFC 0006CD3C EC 00 00 32 */ fmuls f0, f0, f0 /* 80070F00 0006CD40 C3 22 89 44 */ lfs f25, "@3248_8055E8C4"@sda21(r2) /* 80070F04 0006CD44 90 01 00 1C */ stw r0, 0x1c(r1) /* 80070F08 0006CD48 EC 21 00 72 */ fmuls f1, f1, f1 /* 80070F0C 0006CD4C 80 83 00 28 */ lwz r4, 0x28(r3) /* 80070F10 0006CD50 EC 79 00 32 */ fmuls f3, f25, f0 /* 80070F14 0006CD54 C3 42 88 F4 */ lfs f26, "@2648_8055E874"@sda21(r2) /* 80070F18 0006CD58 EC 1B 01 32 */ fmuls f0, f27, f4 /* 80070F1C 0006CD5C EC 5B 00 B2 */ fmuls f2, f27, f2 /* 80070F20 0006CD60 ED 9A 18 2A */ fadds f12, f26, f3 /* 80070F24 0006CD64 90 81 00 18 */ stw r4, 0x18(r1) /* 80070F28 0006CD68 EC 39 00 72 */ fmuls f1, f25, f1 /* 80070F2C 0006CD6C 80 A3 00 18 */ lwz r5, 0x18(r3) /* 80070F30 0006CD70 90 A1 00 08 */ stw r5, 0x8(r1) /* 80070F34 0006CD74 ED 8C 00 B2 */ fmuls f12, f12, f2 /* 80070F38 0006CD78 EE DA 08 2A */ fadds f22, f26, f1 /* 80070F3C 0006CD7C C1 41 00 14 */ lfs f10, 0x14(r1) /* 80070F40 0006CD80 C1 01 00 1C */ lfs f8, 0x1c(r1) /* 80070F44 0006CD84 C1 21 00 18 */ lfs f9, 0x18(r1) /* 80070F48 0006CD88 EC 2C 02 B2 */ fmuls f1, f12, f10 /* 80070F4C 0006CD8C EE D6 00 32 */ fmuls f22, f22, f0 /* 80070F50 0006CD90 C0 03 00 30 */ lfs f0, 0x30(r3) /* 80070F54 0006CD94 EC 6C 02 32 */ fmuls f3, f12, f8 /* 80070F58 0006CD98 80 03 00 20 */ lwz r0, 0x20(r3) /* 80070F5C 0006CD9C EC AC 02 72 */ fmuls f5, f12, f9 /* 80070F60 0006CDA0 80 A3 00 30 */ lwz r5, 0x30(r3) /* 80070F64 0006CDA4 80 83 00 1C */ lwz r4, 0x1c(r3) /* 80070F68 0006CDA8 EE 60 08 28 */ fsubs f19, f0, f1 /* 80070F6C 0006CDAC 90 01 00 10 */ stw r0, 0x10(r1) /* 80070F70 0006CDB0 C0 03 00 38 */ lfs f0, 0x38(r3) /* 80070F74 0006CDB4 90 A1 00 20 */ stw r5, 0x20(r1) /* 80070F78 0006CDB8 EE 40 18 28 */ fsubs f18, f0, f3 /* 80070F7C 0006CDBC C0 83 00 34 */ lfs f4, 0x34(r3) /* 80070F80 0006CDC0 C0 C1 00 20 */ lfs f6, 0x20(r1) /* 80070F84 0006CDC4 90 81 00 0C */ stw r4, 0xc(r1) /* 80070F88 0006CDC8 ED 64 28 28 */ fsubs f11, f4, f5 /* 80070F8C 0006CDCC 80 83 00 34 */ lwz r4, 0x34(r3) /* 80070F90 0006CDD0 80 03 00 38 */ lwz r0, 0x38(r3) /* 80070F94 0006CDD4 EF 8C 01 B2 */ fmuls f28, f12, f6 /* 80070F98 0006CDD8 C0 61 00 10 */ lfs f3, 0x10(r1) /* 80070F9C 0006CDDC EC 36 01 B2 */ fmuls f1, f22, f6 /* 80070FA0 0006CDE0 C0 E1 00 08 */ lfs f7, 0x8(r1) /* 80070FA4 0006CDE4 90 81 00 24 */ stw r4, 0x24(r1) /* 80070FA8 0006CDE8 EE B6 00 F2 */ fmuls f21, f22, f3 /* 80070FAC 0006CDEC C0 A1 00 0C */ lfs f5, 0xc(r1) /* 80070FB0 0006CDF0 EC D6 01 F2 */ fmuls f6, f22, f7 /* 80070FB4 0006CDF4 90 01 00 28 */ stw r0, 0x28(r1) /* 80070FB8 0006CDF8 C0 41 00 24 */ lfs f2, 0x24(r1) /* 80070FBC 0006CDFC EC 96 01 72 */ fmuls f4, f22, f5 /* 80070FC0 0006CE00 EC D3 30 2A */ fadds f6, f19, f6 /* 80070FC4 0006CE04 C3 A3 00 24 */ lfs f29, 0x24(r3) /* 80070FC8 0006CE08 C0 03 00 18 */ lfs f0, 0x18(r3) /* 80070FCC 0006CE0C EF CC 00 B2 */ fmuls f30, f12, f2 /* 80070FD0 0006CE10 EC 8B 20 2A */ fadds f4, f11, f4 /* 80070FD4 0006CE14 C1 A1 00 28 */ lfs f13, 0x28(r1) /* 80070FD8 0006CE18 EE 76 00 B2 */ fmuls f19, f22, f2 /* 80070FDC 0006CE1C C3 E3 00 28 */ lfs f31, 0x28(r3) /* 80070FE0 0006CE20 EC 52 A8 2A */ fadds f2, f18, f21 /* 80070FE4 0006CE24 C1 63 00 2C */ lfs f11, 0x2c(r3) /* 80070FE8 0006CE28 EE B6 03 72 */ fmuls f21, f22, f13 /* 80070FEC 0006CE2C C2 83 00 1C */ lfs f20, 0x1c(r3) /* 80070FF0 0006CE30 ED 8C 03 72 */ fmuls f12, f12, f13 /* 80070FF4 0006CE34 D0 C3 00 30 */ stfs f6, 0x30(r3) /* 80070FF8 0006CE38 C2 C3 00 20 */ lfs f22, 0x20(r3) /* 80070FFC 0006CE3C EF BD E0 2A */ fadds f29, f29, f28 /* 80071000 0006CE40 ED BF F0 2A */ fadds f13, f31, f30 /* 80071004 0006CE44 D0 83 00 34 */ stfs f4, 0x34(r3) /* 80071008 0006CE48 EC CB 60 2A */ fadds f6, f11, f12 /* 8007100C 0006CE4C D0 43 00 38 */ stfs f2, 0x38(r3) /* 80071010 0006CE50 EC 00 08 28 */ fsubs f0, f0, f1 /* 80071014 0006CE54 ED 94 98 28 */ fsubs f12, f20, f19 /* 80071018 0006CE58 ED 76 A8 28 */ fsubs f11, f22, f21 /* 8007101C 0006CE5C C0 43 00 08 */ lfs f2, 0x8(r3) /* 80071020 0006CE60 C0 22 89 3C */ lfs f1, "@3197_8055E8BC"@sda21(r2) /* 80071024 0006CE64 EC 57 00 B2 */ fmuls f2, f23, f2 /* 80071028 0006CE68 EC 98 00 B2 */ fmuls f4, f24, f2 /* 8007102C 0006CE6C EC 5B 00 B2 */ fmuls f2, f27, f2 /* 80071030 0006CE70 EC 84 01 32 */ fmuls f4, f4, f4 /* 80071034 0006CE74 EC 99 01 32 */ fmuls f4, f25, f4 /* 80071038 0006CE78 EE 5A 20 2A */ fadds f18, f26, f4 /* 8007103C 0006CE7C EE 52 00 B2 */ fmuls f18, f18, f2 /* 80071040 0006CE80 ED 52 02 B2 */ fmuls f10, f18, f10 /* 80071044 0006CE84 ED 32 02 72 */ fmuls f9, f18, f9 /* 80071048 0006CE88 ED 12 02 32 */ fmuls f8, f18, f8 /* 8007104C 0006CE8C EC 52 00 F2 */ fmuls f2, f18, f3 /* 80071050 0006CE90 EC 60 50 2A */ fadds f3, f0, f10 /* 80071054 0006CE94 EC 0C 48 2A */ fadds f0, f12, f9 /* 80071058 0006CE98 ED 0B 40 2A */ fadds f8, f11, f8 /* 8007105C 0006CE9C D0 63 00 18 */ stfs f3, 0x18(r3) /* 80071060 0006CEA0 EC 92 01 72 */ fmuls f4, f18, f5 /* 80071064 0006CEA4 EC F2 01 F2 */ fmuls f7, f18, f7 /* 80071068 0006CEA8 D0 03 00 1C */ stfs f0, 0x1c(r3) /* 8007106C 0006CEAC EC 06 10 28 */ fsubs f0, f6, f2 /* 80071070 0006CEB0 EC 6D 20 28 */ fsubs f3, f13, f4 /* 80071074 0006CEB4 D1 03 00 20 */ stfs f8, 0x20(r3) /* 80071078 0006CEB8 EC BD 38 28 */ fsubs f5, f29, f7 /* 8007107C 0006CEBC D0 63 00 28 */ stfs f3, 0x28(r3) /* 80071080 0006CEC0 D0 A3 00 24 */ stfs f5, 0x24(r3) /* 80071084 0006CEC4 D0 03 00 2C */ stfs f0, 0x2c(r3) /* 80071088 0006CEC8 38 63 00 18 */ addi r3, r3, 0x18 /* 8007108C 0006CECC 48 00 15 15 */ bl __KMPLS_normalize_directionXYZ /* 80071090 0006CED0 80 01 01 14 */ lwz r0, 0x114(r1) /* 80071094 0006CED4 E3 E1 01 08 */ psq_l f31, 0x108(r1), 0, qr0 /* 80071098 0006CED8 CB E1 01 00 */ lfd f31, 0x100(r1) /* 8007109C 0006CEDC E3 C1 00 F8 */ psq_l f30, 0xf8(r1), 0, qr0 /* 800710A0 0006CEE0 CB C1 00 F0 */ lfd f30, 0xf0(r1) /* 800710A4 0006CEE4 E3 A1 00 E8 */ psq_l f29, 0xe8(r1), 0, qr0 /* 800710A8 0006CEE8 CB A1 00 E0 */ lfd f29, 0xe0(r1) /* 800710AC 0006CEEC E3 81 00 D8 */ psq_l f28, 0xd8(r1), 0, qr0 /* 800710B0 0006CEF0 CB 81 00 D0 */ lfd f28, 0xd0(r1) /* 800710B4 0006CEF4 E3 61 00 C8 */ psq_l f27, 0xc8(r1), 0, qr0 /* 800710B8 0006CEF8 CB 61 00 C0 */ lfd f27, 0xc0(r1) /* 800710BC 0006CEFC E3 41 00 B8 */ psq_l f26, 0xb8(r1), 0, qr0 /* 800710C0 0006CF00 CB 41 00 B0 */ lfd f26, 0xb0(r1) /* 800710C4 0006CF04 E3 21 00 A8 */ psq_l f25, 0xa8(r1), 0, qr0 /* 800710C8 0006CF08 CB 21 00 A0 */ lfd f25, 0xa0(r1) /* 800710CC 0006CF0C E3 01 00 98 */ psq_l f24, 0x98(r1), 0, qr0 /* 800710D0 0006CF10 CB 01 00 90 */ lfd f24, 0x90(r1) /* 800710D4 0006CF14 E2 E1 00 88 */ psq_l f23, 0x88(r1), 0, qr0 /* 800710D8 0006CF18 CA E1 00 80 */ lfd f23, 0x80(r1) /* 800710DC 0006CF1C E2 C1 00 78 */ psq_l f22, 0x78(r1), 0, qr0 /* 800710E0 0006CF20 CA C1 00 70 */ lfd f22, 0x70(r1) /* 800710E4 0006CF24 E2 A1 00 68 */ psq_l f21, 0x68(r1), 0, qr0 /* 800710E8 0006CF28 CA A1 00 60 */ lfd f21, 0x60(r1) /* 800710EC 0006CF2C E2 81 00 58 */ psq_l f20, 0x58(r1), 0, qr0 /* 800710F0 0006CF30 CA 81 00 50 */ lfd f20, 0x50(r1) /* 800710F4 0006CF34 E2 61 00 48 */ psq_l f19, 0x48(r1), 0, qr0 /* 800710F8 0006CF38 CA 61 00 40 */ lfd f19, 0x40(r1) /* 800710FC 0006CF3C E2 41 00 38 */ psq_l f18, 0x38(r1), 0, qr0 /* 80071100 0006CF40 CA 41 00 30 */ lfd f18, 0x30(r1) /* 80071104 0006CF44 7C 08 03 A6 */ mtlr r0 /* 80071108 0006CF48 38 21 01 10 */ addi r1, r1, 0x110 /* 8007110C 0006CF4C 4E 80 00 20 */ blr .global get_mpls_data_x get_mpls_data_x: /* 80071110 0006CF50 94 21 FF E0 */ stwu r1, -0x20(r1) /* 80071114 0006CF54 88 04 00 36 */ lbz r0, 0x36(r4) /* 80071118 0006CF58 54 00 07 7B */ rlwinm. r0, r0, 0, 29, 29 /* 8007111C 0006CF5C 41 82 00 10 */ beq lbl_8007112C /* 80071120 0006CF60 C0 83 01 54 */ lfs f4, 0x154(r3) /* 80071124 0006CF64 C8 A3 01 20 */ lfd f5, 0x120(r3) /* 80071128 0006CF68 48 00 00 0C */ b lbl_80071134 .global lbl_8007112C lbl_8007112C: /* 8007112C 0006CF6C C0 83 01 38 */ lfs f4, 0x138(r3) /* 80071130 0006CF70 C8 A3 01 08 */ lfd f5, 0x108(r3) .global lbl_80071134 lbl_80071134: /* 80071134 0006CF74 A8 84 00 38 */ lha r4, 0x38(r4) /* 80071138 0006CF78 3C 00 43 30 */ lis r0, 0x4330 /* 8007113C 0006CF7C 90 01 00 08 */ stw r0, 0x8(r1) /* 80071140 0006CF80 6C 80 80 00 */ xoris r0, r4, 0x8000 /* 80071144 0006CF84 C8 62 89 18 */ lfd f3, "@2685_8055E898"@sda21(r2) /* 80071148 0006CF88 90 01 00 0C */ stw r0, 0xc(r1) /* 8007114C 0006CF8C C8 43 0D 80 */ lfd f2, 0xd80(r3) /* 80071150 0006CF90 C8 01 00 08 */ lfd f0, 0x8(r1) /* 80071154 0006CF94 C8 22 89 48 */ lfd f1, "@3259"@sda21(r2) /* 80071158 0006CF98 FC 60 18 28 */ fsub f3, f0, f3 /* 8007115C 0006CF9C C8 02 89 00 */ lfd f0, "@2679"@sda21(r2) /* 80071160 0006CFA0 FC 63 20 28 */ fsub f3, f3, f4 /* 80071164 0006CFA4 FC 65 00 F2 */ fmul f3, f5, f3 /* 80071168 0006CFA8 FC 63 10 28 */ fsub f3, f3, f2 /* 8007116C 0006CFAC FC 21 00 F2 */ fmul f1, f1, f3 /* 80071170 0006CFB0 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071174 0006CFB4 40 80 00 08 */ bge lbl_8007117C /* 80071178 0006CFB8 FC 20 08 50 */ fneg f1, f1 .global lbl_8007117C lbl_8007117C: /* 8007117C 0006CFBC C8 02 89 50 */ lfd f0, "@3260"@sda21(r2) /* 80071180 0006CFC0 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071184 0006CFC4 40 80 00 0C */ bge lbl_80071190 /* 80071188 0006CFC8 FC 20 00 90 */ fmr f1, f0 /* 8007118C 0006CFCC 48 00 00 14 */ b lbl_800711A0 .global lbl_80071190 lbl_80071190: /* 80071190 0006CFD0 C8 02 89 08 */ lfd f0, "@2680"@sda21(r2) /* 80071194 0006CFD4 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071198 0006CFD8 40 81 00 08 */ ble lbl_800711A0 /* 8007119C 0006CFDC FC 20 00 90 */ fmr f1, f0 .global lbl_800711A0 lbl_800711A0: /* 800711A0 0006CFE0 FC 63 00 72 */ fmul f3, f3, f1 /* 800711A4 0006CFE4 C8 43 0D 80 */ lfd f2, 0xd80(r3) /* 800711A8 0006CFE8 C0 23 0D A4 */ lfs f1, 0xda4(r3) /* 800711AC 0006CFEC C8 02 89 00 */ lfd f0, "@2679"@sda21(r2) /* 800711B0 0006CFF0 FC 42 18 2A */ fadd f2, f2, f3 /* 800711B4 0006CFF4 D8 43 0D 80 */ stfd f2, 0xd80(r3) /* 800711B8 0006CFF8 FC 22 00 72 */ fmul f1, f2, f1 /* 800711BC 0006CFFC FC 01 00 40 */ fcmpo cr0, f1, f0 /* 800711C0 0006D000 40 80 00 1C */ bge lbl_800711DC /* 800711C4 0006D004 C8 02 89 58 */ lfd f0, "@3261"@sda21(r2) /* 800711C8 0006D008 FC 01 00 28 */ fsub f0, f1, f0 /* 800711CC 0006D00C FC 00 00 1E */ fctiwz f0, f0 /* 800711D0 0006D010 D8 01 00 08 */ stfd f0, 0x8(r1) /* 800711D4 0006D014 80 61 00 0C */ lwz r3, 0xc(r1) /* 800711D8 0006D018 48 00 00 18 */ b lbl_800711F0 .global lbl_800711DC lbl_800711DC: /* 800711DC 0006D01C C8 02 89 58 */ lfd f0, "@3261"@sda21(r2) /* 800711E0 0006D020 FC 00 08 2A */ fadd f0, f0, f1 /* 800711E4 0006D024 FC 00 00 1E */ fctiwz f0, f0 /* 800711E8 0006D028 D8 01 00 10 */ stfd f0, 0x10(r1) /* 800711EC 0006D02C 80 61 00 14 */ lwz r3, 0x14(r1) .global lbl_800711F0 lbl_800711F0: /* 800711F0 0006D030 38 21 00 20 */ addi r1, r1, 0x20 /* 800711F4 0006D034 4E 80 00 20 */ blr /* 800711F8 0006D038 00 00 00 00 */ .4byte 0x00000000 /* 800711FC 0006D03C 00 00 00 00 */ .4byte 0x00000000 .global get_mpls_data_y get_mpls_data_y: /* 80071200 0006D040 94 21 FF E0 */ stwu r1, -0x20(r1) /* 80071204 0006D044 88 04 00 36 */ lbz r0, 0x36(r4) /* 80071208 0006D048 54 00 07 39 */ rlwinm. r0, r0, 0, 28, 28 /* 8007120C 0006D04C 41 82 00 10 */ beq lbl_8007121C /* 80071210 0006D050 C0 83 01 5C */ lfs f4, 0x15c(r3) /* 80071214 0006D054 C8 A3 01 28 */ lfd f5, 0x128(r3) /* 80071218 0006D058 48 00 00 0C */ b lbl_80071224 .global lbl_8007121C lbl_8007121C: /* 8007121C 0006D05C C0 83 01 40 */ lfs f4, 0x140(r3) /* 80071220 0006D060 C8 A3 01 10 */ lfd f5, 0x110(r3) .global lbl_80071224 lbl_80071224: /* 80071224 0006D064 A8 84 00 3A */ lha r4, 0x3a(r4) /* 80071228 0006D068 3C 00 43 30 */ lis r0, 0x4330 /* 8007122C 0006D06C 90 01 00 08 */ stw r0, 0x8(r1) /* 80071230 0006D070 6C 80 80 00 */ xoris r0, r4, 0x8000 /* 80071234 0006D074 C8 62 89 18 */ lfd f3, "@2685_8055E898"@sda21(r2) /* 80071238 0006D078 90 01 00 0C */ stw r0, 0xc(r1) /* 8007123C 0006D07C C8 43 0D 88 */ lfd f2, 0xd88(r3) /* 80071240 0006D080 C8 01 00 08 */ lfd f0, 0x8(r1) /* 80071244 0006D084 C8 22 89 48 */ lfd f1, "@3259"@sda21(r2) /* 80071248 0006D088 FC 60 18 28 */ fsub f3, f0, f3 /* 8007124C 0006D08C C8 02 89 00 */ lfd f0, "@2679"@sda21(r2) /* 80071250 0006D090 FC 63 20 28 */ fsub f3, f3, f4 /* 80071254 0006D094 FC 65 00 F2 */ fmul f3, f5, f3 /* 80071258 0006D098 FC 63 10 28 */ fsub f3, f3, f2 /* 8007125C 0006D09C FC 21 00 F2 */ fmul f1, f1, f3 /* 80071260 0006D0A0 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071264 0006D0A4 40 80 00 08 */ bge lbl_8007126C /* 80071268 0006D0A8 FC 20 08 50 */ fneg f1, f1 .global lbl_8007126C lbl_8007126C: /* 8007126C 0006D0AC C8 02 89 50 */ lfd f0, "@3260"@sda21(r2) /* 80071270 0006D0B0 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071274 0006D0B4 40 80 00 0C */ bge lbl_80071280 /* 80071278 0006D0B8 FC 20 00 90 */ fmr f1, f0 /* 8007127C 0006D0BC 48 00 00 14 */ b lbl_80071290 .global lbl_80071280 lbl_80071280: /* 80071280 0006D0C0 C8 02 89 08 */ lfd f0, "@2680"@sda21(r2) /* 80071284 0006D0C4 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071288 0006D0C8 40 81 00 08 */ ble lbl_80071290 /* 8007128C 0006D0CC FC 20 00 90 */ fmr f1, f0 .global lbl_80071290 lbl_80071290: /* 80071290 0006D0D0 FC 63 00 72 */ fmul f3, f3, f1 /* 80071294 0006D0D4 C8 43 0D 88 */ lfd f2, 0xd88(r3) /* 80071298 0006D0D8 C0 23 0D A8 */ lfs f1, 0xda8(r3) /* 8007129C 0006D0DC C8 02 89 00 */ lfd f0, "@2679"@sda21(r2) /* 800712A0 0006D0E0 FC 42 18 2A */ fadd f2, f2, f3 /* 800712A4 0006D0E4 D8 43 0D 88 */ stfd f2, 0xd88(r3) /* 800712A8 0006D0E8 FC 22 00 72 */ fmul f1, f2, f1 /* 800712AC 0006D0EC FC 01 00 40 */ fcmpo cr0, f1, f0 /* 800712B0 0006D0F0 40 80 00 1C */ bge lbl_800712CC /* 800712B4 0006D0F4 C8 02 89 58 */ lfd f0, "@3261"@sda21(r2) /* 800712B8 0006D0F8 FC 01 00 28 */ fsub f0, f1, f0 /* 800712BC 0006D0FC FC 00 00 1E */ fctiwz f0, f0 /* 800712C0 0006D100 D8 01 00 08 */ stfd f0, 0x8(r1) /* 800712C4 0006D104 80 61 00 0C */ lwz r3, 0xc(r1) /* 800712C8 0006D108 48 00 00 18 */ b lbl_800712E0 .global lbl_800712CC lbl_800712CC: /* 800712CC 0006D10C C8 02 89 58 */ lfd f0, "@3261"@sda21(r2) /* 800712D0 0006D110 FC 00 08 2A */ fadd f0, f0, f1 /* 800712D4 0006D114 FC 00 00 1E */ fctiwz f0, f0 /* 800712D8 0006D118 D8 01 00 10 */ stfd f0, 0x10(r1) /* 800712DC 0006D11C 80 61 00 14 */ lwz r3, 0x14(r1) .global lbl_800712E0 lbl_800712E0: /* 800712E0 0006D120 38 21 00 20 */ addi r1, r1, 0x20 /* 800712E4 0006D124 4E 80 00 20 */ blr /* 800712E8 0006D128 00 00 00 00 */ .4byte 0x00000000 /* 800712EC 0006D12C 00 00 00 00 */ .4byte 0x00000000 .global get_mpls_data_z get_mpls_data_z: /* 800712F0 0006D130 94 21 FF E0 */ stwu r1, -0x20(r1) /* 800712F4 0006D134 88 04 00 36 */ lbz r0, 0x36(r4) /* 800712F8 0006D138 54 00 07 BD */ rlwinm. r0, r0, 0, 30, 30 /* 800712FC 0006D13C 41 82 00 10 */ beq lbl_8007130C /* 80071300 0006D140 C0 83 01 64 */ lfs f4, 0x164(r3) /* 80071304 0006D144 C8 A3 01 30 */ lfd f5, 0x130(r3) /* 80071308 0006D148 48 00 00 0C */ b lbl_80071314 .global lbl_8007130C lbl_8007130C: /* 8007130C 0006D14C C0 83 01 48 */ lfs f4, 0x148(r3) /* 80071310 0006D150 C8 A3 01 18 */ lfd f5, 0x118(r3) .global lbl_80071314 lbl_80071314: /* 80071314 0006D154 A8 84 00 3C */ lha r4, 0x3c(r4) /* 80071318 0006D158 3C 00 43 30 */ lis r0, 0x4330 /* 8007131C 0006D15C 90 01 00 08 */ stw r0, 0x8(r1) /* 80071320 0006D160 6C 80 80 00 */ xoris r0, r4, 0x8000 /* 80071324 0006D164 C8 62 89 18 */ lfd f3, "@2685_8055E898"@sda21(r2) /* 80071328 0006D168 90 01 00 0C */ stw r0, 0xc(r1) /* 8007132C 0006D16C C8 43 0D 90 */ lfd f2, 0xd90(r3) /* 80071330 0006D170 C8 01 00 08 */ lfd f0, 0x8(r1) /* 80071334 0006D174 C8 22 89 48 */ lfd f1, "@3259"@sda21(r2) /* 80071338 0006D178 FC 60 18 28 */ fsub f3, f0, f3 /* 8007133C 0006D17C C8 02 89 00 */ lfd f0, "@2679"@sda21(r2) /* 80071340 0006D180 FC 63 20 28 */ fsub f3, f3, f4 /* 80071344 0006D184 FC 65 00 F2 */ fmul f3, f5, f3 /* 80071348 0006D188 FC 63 10 28 */ fsub f3, f3, f2 /* 8007134C 0006D18C FC 21 00 F2 */ fmul f1, f1, f3 /* 80071350 0006D190 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071354 0006D194 40 80 00 08 */ bge lbl_8007135C /* 80071358 0006D198 FC 20 08 50 */ fneg f1, f1 .global lbl_8007135C lbl_8007135C: /* 8007135C 0006D19C C8 02 89 50 */ lfd f0, "@3260"@sda21(r2) /* 80071360 0006D1A0 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071364 0006D1A4 40 80 00 0C */ bge lbl_80071370 /* 80071368 0006D1A8 FC 20 00 90 */ fmr f1, f0 /* 8007136C 0006D1AC 48 00 00 14 */ b lbl_80071380 .global lbl_80071370 lbl_80071370: /* 80071370 0006D1B0 C8 02 89 08 */ lfd f0, "@2680"@sda21(r2) /* 80071374 0006D1B4 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071378 0006D1B8 40 81 00 08 */ ble lbl_80071380 /* 8007137C 0006D1BC FC 20 00 90 */ fmr f1, f0 .global lbl_80071380 lbl_80071380: /* 80071380 0006D1C0 FC 63 00 72 */ fmul f3, f3, f1 /* 80071384 0006D1C4 C8 43 0D 90 */ lfd f2, 0xd90(r3) /* 80071388 0006D1C8 C0 23 0D AC */ lfs f1, 0xdac(r3) /* 8007138C 0006D1CC C8 02 89 00 */ lfd f0, "@2679"@sda21(r2) /* 80071390 0006D1D0 FC 42 18 2A */ fadd f2, f2, f3 /* 80071394 0006D1D4 D8 43 0D 90 */ stfd f2, 0xd90(r3) /* 80071398 0006D1D8 FC 22 00 72 */ fmul f1, f2, f1 /* 8007139C 0006D1DC FC 01 00 40 */ fcmpo cr0, f1, f0 /* 800713A0 0006D1E0 40 80 00 1C */ bge lbl_800713BC /* 800713A4 0006D1E4 C8 02 89 58 */ lfd f0, "@3261"@sda21(r2) /* 800713A8 0006D1E8 FC 01 00 28 */ fsub f0, f1, f0 /* 800713AC 0006D1EC FC 00 00 1E */ fctiwz f0, f0 /* 800713B0 0006D1F0 D8 01 00 08 */ stfd f0, 0x8(r1) /* 800713B4 0006D1F4 80 61 00 0C */ lwz r3, 0xc(r1) /* 800713B8 0006D1F8 48 00 00 18 */ b lbl_800713D0 .global lbl_800713BC lbl_800713BC: /* 800713BC 0006D1FC C8 02 89 58 */ lfd f0, "@3261"@sda21(r2) /* 800713C0 0006D200 FC 00 08 2A */ fadd f0, f0, f1 /* 800713C4 0006D204 FC 00 00 1E */ fctiwz f0, f0 /* 800713C8 0006D208 D8 01 00 10 */ stfd f0, 0x10(r1) /* 800713CC 0006D20C 80 61 00 14 */ lwz r3, 0x14(r1) .global lbl_800713D0 lbl_800713D0: /* 800713D0 0006D210 38 21 00 20 */ addi r1, r1, 0x20 /* 800713D4 0006D214 4E 80 00 20 */ blr /* 800713D8 0006D218 00 00 00 00 */ .4byte 0x00000000 /* 800713DC 0006D21C 00 00 00 00 */ .4byte 0x00000000 .global read_mpls read_mpls: /* 800713E0 0006D220 94 21 FE E0 */ stwu r1, -0x120(r1) /* 800713E4 0006D224 7C 08 02 A6 */ mflr r0 /* 800713E8 0006D228 90 01 01 24 */ stw r0, 0x124(r1) /* 800713EC 0006D22C 39 61 00 C0 */ addi r11, r1, 0xc0 /* 800713F0 0006D230 DB E1 01 10 */ stfd f31, 0x110(r1) /* 800713F4 0006D234 F3 E1 01 18 */ psq_st f31, 0x118(r1), 0, qr0 /* 800713F8 0006D238 DB C1 01 00 */ stfd f30, 0x100(r1) /* 800713FC 0006D23C F3 C1 01 08 */ psq_st f30, 0x108(r1), 0, qr0 /* 80071400 0006D240 DB A1 00 F0 */ stfd f29, 0xf0(r1) /* 80071404 0006D244 F3 A1 00 F8 */ psq_st f29, 0xf8(r1), 0, qr0 /* 80071408 0006D248 DB 81 00 E0 */ stfd f28, 0xe0(r1) /* 8007140C 0006D24C F3 81 00 E8 */ psq_st f28, 0xe8(r1), 0, qr0 /* 80071410 0006D250 DB 61 00 D0 */ stfd f27, 0xd0(r1) /* 80071414 0006D254 F3 61 00 D8 */ psq_st f27, 0xd8(r1), 0, qr0 /* 80071418 0006D258 DB 41 00 C0 */ stfd f26, 0xc0(r1) /* 8007141C 0006D25C F3 41 00 C8 */ psq_st f26, 0xc8(r1), 0, qr0 /* 80071420 0006D260 4B F9 5E E9 */ bl __save_gpr /* 80071424 0006D264 1C E3 0D B0 */ mulli r7, r3, 0xdb0 /* 80071428 0006D268 3C 00 43 30 */ lis r0, 0x4330 /* 8007142C 0006D26C 80 CD EA 98 */ lwz r6, kmpls@sda21(r13) /* 80071430 0006D270 7C 72 1B 78 */ mr r18, r3 /* 80071434 0006D274 2C 05 00 00 */ cmpwi r5, 0x0 /* 80071438 0006D278 90 01 00 50 */ stw r0, 0x50(r1) /* 8007143C 0006D27C 7C 66 3A 14 */ add r3, r6, r7 /* 80071440 0006D280 90 01 00 58 */ stw r0, 0x58(r1) /* 80071444 0006D284 7C 93 23 78 */ mr r19, r4 /* 80071448 0006D288 7C B4 2B 78 */ mr r20, r5 /* 8007144C 0006D28C 3A 03 00 08 */ addi r16, r3, 0x8 /* 80071450 0006D290 40 81 0A 08 */ ble lbl_80071E58 /* 80071454 0006D294 2C 06 00 00 */ cmpwi r6, 0x0 /* 80071458 0006D298 41 82 0A 00 */ beq lbl_80071E58 /* 8007145C 0006D29C 88 10 00 B8 */ lbz r0, 0xb8(r16) /* 80071460 0006D2A0 2C 00 00 00 */ cmpwi r0, 0x0 /* 80071464 0006D2A4 41 82 00 28 */ beq lbl_8007148C /* 80071468 0006D2A8 C3 70 00 C4 */ lfs f27, 0xc4(r16) /* 8007146C 0006D2AC 3A A0 00 01 */ li r21, 0x1 /* 80071470 0006D2B0 C0 02 89 60 */ lfs f0, "@3463"@sda21(r2) /* 80071474 0006D2B4 C3 42 89 64 */ lfs f26, "@3464"@sda21(r2) /* 80071478 0006D2B8 EC 00 06 F2 */ fmuls f0, f0, f27 /* 8007147C 0006D2BC FC 00 00 1E */ fctiwz f0, f0 /* 80071480 0006D2C0 D8 01 00 60 */ stfd f0, 0x60(r1) /* 80071484 0006D2C4 82 C1 00 64 */ lwz r22, 0x64(r1) /* 80071488 0006D2C8 48 00 00 14 */ b lbl_8007149C .global lbl_8007148C lbl_8007148C: /* 8007148C 0006D2CC 8A A3 00 C6 */ lbz r21, 0xc6(r3) /* 80071490 0006D2D0 C3 63 00 D4 */ lfs f27, 0xd4(r3) /* 80071494 0006D2D4 82 C3 00 D8 */ lwz r22, 0xd8(r3) /* 80071498 0006D2D8 C3 43 00 DC */ lfs f26, 0xdc(r3) .global lbl_8007149C lbl_8007149C: /* 8007149C 0006D2DC C0 10 00 54 */ lfs f0, 0x54(r16) /* 800714A0 0006D2E0 3C 80 80 44 */ lis r4, mpls_assign_ct@ha /* 800714A4 0006D2E4 88 10 00 BC */ lbz r0, 0xbc(r16) /* 800714A8 0006D2E8 38 84 9F EC */ addi r4, r4, mpls_assign_ct@l /* 800714AC 0006D2EC EC 3B 00 24 */ fdivs f1, f27, f0 /* 800714B0 0006D2F0 1C 00 00 0C */ mulli r0, r0, 0xc /* 800714B4 0006D2F4 7C 64 02 14 */ add r3, r4, r0 /* 800714B8 0006D2F8 7F A4 00 2E */ lwzx r29, r4, r0 /* 800714BC 0006D2FC 83 83 00 04 */ lwz r28, 0x4(r3) /* 800714C0 0006D300 83 43 00 08 */ lwz r26, 0x8(r3) /* 800714C4 0006D304 7C 1D 00 D0 */ neg r0, r29 /* 800714C8 0006D308 90 01 00 68 */ stw r0, 0x68(r1) /* 800714CC 0006D30C 7D DC 00 D0 */ neg r14, r28 /* 800714D0 0006D310 7F 7A 00 D0 */ neg r27, r26 /* 800714D4 0006D314 48 00 0F ED */ bl __KMPLS_f2i /* 800714D8 0006D318 C0 10 00 58 */ lfs f0, 0x58(r16) /* 800714DC 0006D31C 7C 79 1B 78 */ mr r25, r3 /* 800714E0 0006D320 EC 3B 00 24 */ fdivs f1, f27, f0 /* 800714E4 0006D324 48 00 0F DD */ bl __KMPLS_f2i /* 800714E8 0006D328 C0 10 00 5C */ lfs f0, 0x5c(r16) /* 800714EC 0006D32C 7C 78 1B 78 */ mr r24, r3 /* 800714F0 0006D330 EC 3B 00 24 */ fdivs f1, f27, f0 /* 800714F4 0006D334 48 00 0F CD */ bl __KMPLS_f2i /* 800714F8 0006D338 2C 19 00 00 */ cmpwi r25, 0x0 /* 800714FC 0006D33C 7C 77 1B 78 */ mr r23, r3 /* 80071500 0006D340 40 82 00 08 */ bne lbl_80071508 /* 80071504 0006D344 3B 39 00 01 */ addi r25, r25, 0x1 .global lbl_80071508 lbl_80071508: /* 80071508 0006D348 2C 18 00 00 */ cmpwi r24, 0x0 /* 8007150C 0006D34C 40 82 00 08 */ bne lbl_80071514 /* 80071510 0006D350 3B 18 00 01 */ addi r24, r24, 0x1 .global lbl_80071514 lbl_80071514: /* 80071514 0006D354 2C 03 00 00 */ cmpwi r3, 0x0 /* 80071518 0006D358 40 82 00 08 */ bne lbl_80071520 /* 8007151C 0006D35C 3A E3 00 01 */ addi r23, r3, 0x1 .global lbl_80071520 lbl_80071520: /* 80071520 0006D360 38 00 00 00 */ li r0, 0x0 /* 80071524 0006D364 98 10 00 BB */ stb r0, 0xbb(r16) /* 80071528 0006D368 C3 62 88 F4 */ lfs f27, "@2648_8055E874"@sda21(r2) /* 8007152C 0006D36C 98 10 00 BA */ stb r0, 0xba(r16) /* 80071530 0006D370 CB 82 89 18 */ lfd f28, "@2685_8055E898"@sda21(r2) /* 80071534 0006D374 98 10 00 B9 */ stb r0, 0xb9(r16) /* 80071538 0006D378 CB A2 89 00 */ lfd f29, "@2679"@sda21(r2) /* 8007153C 0006D37C D3 70 00 E8 */ stfs f27, 0xe8(r16) /* 80071540 0006D380 C3 C2 88 F0 */ lfs f30, "@2647_8055E870"@sda21(r2) /* 80071544 0006D384 D3 70 00 EC */ stfs f27, 0xec(r16) /* 80071548 0006D388 C3 E2 89 20 */ lfs f31, "@2757_8055E8A0"@sda21(r2) .global lbl_8007154C lbl_8007154C: /* 8007154C 0006D38C 7C 74 98 50 */ subf r3, r20, r19 /* 80071550 0006D390 34 63 FF FF */ addic. r3, r3, -0x1 /* 80071554 0006D394 40 80 00 10 */ bge lbl_80071564 /* 80071558 0006D398 80 10 0D A0 */ lwz r0, 0xda0(r16) /* 8007155C 0006D39C 7C 63 02 14 */ add r3, r3, r0 /* 80071560 0006D3A0 38 63 00 10 */ addi r3, r3, 0x10 .global lbl_80071564 lbl_80071564: /* 80071564 0006D3A4 2C 03 00 10 */ cmpwi r3, 0x10 /* 80071568 0006D3A8 41 80 00 18 */ blt lbl_80071580 /* 8007156C 0006D3AC 38 03 FF F0 */ addi r0, r3, -0x10 /* 80071570 0006D3B0 80 70 0D 9C */ lwz r3, 0xd9c(r16) /* 80071574 0006D3B4 1C 00 00 42 */ mulli r0, r0, 0x42 /* 80071578 0006D3B8 7D E3 02 14 */ add r15, r3, r0 /* 8007157C 0006D3BC 48 00 00 10 */ b lbl_8007158C .global lbl_80071580 lbl_80071580: /* 80071580 0006D3C0 1C 03 00 42 */ mulli r0, r3, 0x42 /* 80071584 0006D3C4 80 70 0D 98 */ lwz r3, 0xd98(r16) /* 80071588 0006D3C8 7D E3 02 14 */ add r15, r3, r0 .global lbl_8007158C lbl_8007158C: /* 8007158C 0006D3CC 80 D0 00 3C */ lwz r6, 0x3c(r16) /* 80071590 0006D3D0 80 B0 00 40 */ lwz r5, 0x40(r16) /* 80071594 0006D3D4 80 90 00 44 */ lwz r4, 0x44(r16) /* 80071598 0006D3D8 80 10 00 04 */ lwz r0, 0x4(r16) /* 8007159C 0006D3DC 80 70 00 00 */ lwz r3, 0x0(r16) /* 800715A0 0006D3E0 90 70 00 3C */ stw r3, 0x3c(r16) /* 800715A4 0006D3E4 90 10 00 40 */ stw r0, 0x40(r16) /* 800715A8 0006D3E8 80 10 00 08 */ lwz r0, 0x8(r16) /* 800715AC 0006D3EC 90 10 00 44 */ stw r0, 0x44(r16) /* 800715B0 0006D3F0 88 0F 00 29 */ lbz r0, 0x29(r15) /* 800715B4 0006D3F4 90 C1 00 08 */ stw r6, 0x8(r1) /* 800715B8 0006D3F8 7C 00 07 75 */ extsb. r0, r0 /* 800715BC 0006D3FC 90 A1 00 0C */ stw r5, 0xc(r1) /* 800715C0 0006D400 90 81 00 10 */ stw r4, 0x10(r1) /* 800715C4 0006D404 41 82 00 70 */ beq lbl_80071634 /* 800715C8 0006D408 80 6D EA 98 */ lwz r3, kmpls@sda21(r13) /* 800715CC 0006D40C C0 30 00 48 */ lfs f1, 0x48(r16) /* 800715D0 0006D410 C0 03 00 00 */ lfs f0, 0x0(r3) /* 800715D4 0006D414 EC 21 00 32 */ fmuls f1, f1, f0 /* 800715D8 0006D418 D0 30 00 48 */ stfs f1, 0x48(r16) /* 800715DC 0006D41C C0 10 00 00 */ lfs f0, 0x0(r16) /* 800715E0 0006D420 EC 00 08 2A */ fadds f0, f0, f1 /* 800715E4 0006D424 D0 10 00 00 */ stfs f0, 0x0(r16) /* 800715E8 0006D428 80 6D EA 98 */ lwz r3, kmpls@sda21(r13) /* 800715EC 0006D42C C0 30 00 4C */ lfs f1, 0x4c(r16) /* 800715F0 0006D430 C0 03 00 00 */ lfs f0, 0x0(r3) /* 800715F4 0006D434 EC 21 00 32 */ fmuls f1, f1, f0 /* 800715F8 0006D438 D0 30 00 4C */ stfs f1, 0x4c(r16) /* 800715FC 0006D43C C0 10 00 04 */ lfs f0, 0x4(r16) /* 80071600 0006D440 EC 00 08 2A */ fadds f0, f0, f1 /* 80071604 0006D444 D0 10 00 04 */ stfs f0, 0x4(r16) /* 80071608 0006D448 80 6D EA 98 */ lwz r3, kmpls@sda21(r13) /* 8007160C 0006D44C C0 30 00 50 */ lfs f1, 0x50(r16) /* 80071610 0006D450 C0 03 00 00 */ lfs f0, 0x0(r3) /* 80071614 0006D454 EC 21 00 32 */ fmuls f1, f1, f0 /* 80071618 0006D458 D0 30 00 50 */ stfs f1, 0x50(r16) /* 8007161C 0006D45C C0 10 00 08 */ lfs f0, 0x8(r16) /* 80071620 0006D460 EC 00 08 2A */ fadds f0, f0, f1 /* 80071624 0006D464 D0 10 00 08 */ stfs f0, 0x8(r16) /* 80071628 0006D468 D3 D0 00 E8 */ stfs f30, 0xe8(r16) /* 8007162C 0006D46C D3 D0 00 EC */ stfs f30, 0xec(r16) /* 80071630 0006D470 48 00 07 28 */ b lbl_80071D58 .global lbl_80071634 lbl_80071634: /* 80071634 0006D474 80 70 01 7C */ lwz r3, 0x17c(r16) /* 80071638 0006D478 38 03 00 01 */ addi r0, r3, 0x1 /* 8007163C 0006D47C 54 00 06 3E */ clrlwi r0, r0, 24 /* 80071640 0006D480 90 10 01 7C */ stw r0, 0x17c(r16) /* 80071644 0006D484 88 10 00 BC */ lbz r0, 0xbc(r16) /* 80071648 0006D488 28 00 00 02 */ cmplwi r0, 0x2 /* 8007164C 0006D48C 40 80 00 18 */ bge lbl_80071664 /* 80071650 0006D490 7E 03 83 78 */ mr r3, r16 /* 80071654 0006D494 7D E4 7B 78 */ mr r4, r15 /* 80071658 0006D498 4B FF FA B9 */ bl get_mpls_data_x /* 8007165C 0006D49C 7C 71 1B 78 */ mr r17, r3 /* 80071660 0006D4A0 48 00 00 08 */ b lbl_80071668 .global lbl_80071664 lbl_80071664: /* 80071664 0006D4A4 AA 2F 00 2E */ lha r17, 0x2e(r15) .global lbl_80071668 lbl_80071668: /* 80071668 0006D4A8 80 10 01 7C */ lwz r0, 0x17c(r16) /* 8007166C 0006D4AC 3B E0 00 01 */ li r31, 0x1 /* 80071670 0006D4B0 54 00 10 3A */ slwi r0, r0, 2 /* 80071674 0006D4B4 7C 70 02 14 */ add r3, r16, r0 /* 80071678 0006D4B8 92 23 01 80 */ stw r17, 0x180(r3) /* 8007167C 0006D4BC C0 30 01 70 */ lfs f1, 0x170(r16) /* 80071680 0006D4C0 48 00 0E 41 */ bl __KMPLS_f2i /* 80071684 0006D4C4 80 01 00 68 */ lwz r0, 0x68(r1) /* 80071688 0006D4C8 7C 63 88 50 */ subf r3, r3, r17 /* 8007168C 0006D4CC 7C 03 00 00 */ cmpw r3, r0 /* 80071690 0006D4D0 40 81 00 0C */ ble lbl_8007169C /* 80071694 0006D4D4 7C 03 E8 00 */ cmpw r3, r29 /* 80071698 0006D4D8 41 80 00 38 */ blt lbl_800716D0 .global lbl_8007169C lbl_8007169C: /* 8007169C 0006D4DC 80 6D EA 98 */ lwz r3, kmpls@sda21(r13) /* 800716A0 0006D4E0 C0 30 00 48 */ lfs f1, 0x48(r16) /* 800716A4 0006D4E4 C0 03 00 00 */ lfs f0, 0x0(r3) /* 800716A8 0006D4E8 EC 21 00 32 */ fmuls f1, f1, f0 /* 800716AC 0006D4EC D0 30 00 48 */ stfs f1, 0x48(r16) /* 800716B0 0006D4F0 C0 10 00 00 */ lfs f0, 0x0(r16) /* 800716B4 0006D4F4 EC 00 08 2A */ fadds f0, f0, f1 /* 800716B8 0006D4F8 D0 10 00 00 */ stfs f0, 0x0(r16) /* 800716BC 0006D4FC 88 70 00 B9 */ lbz r3, 0xb9(r16) /* 800716C0 0006D500 38 03 00 01 */ addi r0, r3, 0x1 /* 800716C4 0006D504 98 10 00 B9 */ stb r0, 0xb9(r16) /* 800716C8 0006D508 D3 D0 00 E8 */ stfs f30, 0xe8(r16) /* 800716CC 0006D50C 48 00 01 B4 */ b lbl_80071880 .global lbl_800716D0 lbl_800716D0: /* 800716D0 0006D510 6E 20 80 00 */ xoris r0, r17, 0x8000 /* 800716D4 0006D514 90 01 00 54 */ stw r0, 0x54(r1) /* 800716D8 0006D518 7C B9 88 50 */ subf r5, r25, r17 /* 800716DC 0006D51C 7C D1 CA 14 */ add r6, r17, r25 /* 800716E0 0006D520 C8 01 00 50 */ lfd f0, 0x50(r1) /* 800716E4 0006D524 EC 00 E0 28 */ fsubs f0, f0, f28 /* 800716E8 0006D528 D0 10 00 00 */ stfs f0, 0x0(r16) /* 800716EC 0006D52C 80 90 01 7C */ lwz r4, 0x17c(r16) /* 800716F0 0006D530 7C 16 20 50 */ subf r0, r22, r4 /* 800716F4 0006D534 38 64 FF FF */ addi r3, r4, -0x1 /* 800716F8 0006D538 54 64 06 3E */ clrlwi r4, r3, 24 /* 800716FC 0006D53C 54 07 06 3E */ clrlwi r7, r0, 24 .global lbl_80071700 lbl_80071700: /* 80071700 0006D540 54 80 10 3A */ slwi r0, r4, 2 /* 80071704 0006D544 7C 70 02 14 */ add r3, r16, r0 /* 80071708 0006D548 80 63 01 80 */ lwz r3, 0x180(r3) /* 8007170C 0006D54C 7C 03 28 00 */ cmpw r3, r5 /* 80071710 0006D550 41 80 00 24 */ blt lbl_80071734 /* 80071714 0006D554 7C 03 30 00 */ cmpw r3, r6 /* 80071718 0006D558 41 81 00 1C */ bgt lbl_80071734 /* 8007171C 0006D55C 38 04 FF FF */ addi r0, r4, -0x1 /* 80071720 0006D560 7E 31 1A 14 */ add r17, r17, r3 /* 80071724 0006D564 54 04 06 3E */ clrlwi r4, r0, 24 /* 80071728 0006D568 3B FF 00 01 */ addi r31, r31, 0x1 /* 8007172C 0006D56C 7C 04 38 00 */ cmpw r4, r7 /* 80071730 0006D570 40 82 FF D0 */ bne lbl_80071700 .global lbl_80071734 lbl_80071734: /* 80071734 0006D574 38 7F FF FF */ addi r3, r31, -0x1 /* 80071738 0006D578 38 16 FF FF */ addi r0, r22, -0x1 /* 8007173C 0006D57C 6C 63 80 00 */ xoris r3, r3, 0x8000 /* 80071740 0006D580 90 61 00 5C */ stw r3, 0x5c(r1) /* 80071744 0006D584 6C 04 80 00 */ xoris r4, r0, 0x8000 /* 80071748 0006D588 6F E0 80 00 */ xoris r0, r31, 0x8000 /* 8007174C 0006D58C C8 01 00 58 */ lfd f0, 0x58(r1) /* 80071750 0006D590 6E 23 80 00 */ xoris r3, r17, 0x8000 /* 80071754 0006D594 90 81 00 54 */ stw r4, 0x54(r1) /* 80071758 0006D598 2C 15 00 00 */ cmpwi r21, 0x0 /* 8007175C 0006D59C EC 60 E0 28 */ fsubs f3, f0, f28 /* 80071760 0006D5A0 C0 30 00 00 */ lfs f1, 0x0(r16) /* 80071764 0006D5A4 C8 01 00 50 */ lfd f0, 0x50(r1) /* 80071768 0006D5A8 90 61 00 5C */ stw r3, 0x5c(r1) /* 8007176C 0006D5AC EC 00 E0 28 */ fsubs f0, f0, f28 /* 80071770 0006D5B0 C8 41 00 58 */ lfd f2, 0x58(r1) /* 80071774 0006D5B4 90 01 00 54 */ stw r0, 0x54(r1) /* 80071778 0006D5B8 EC 63 00 24 */ fdivs f3, f3, f0 /* 8007177C 0006D5BC C8 01 00 50 */ lfd f0, 0x50(r1) /* 80071780 0006D5C0 EC 63 00 F2 */ fmuls f3, f3, f3 /* 80071784 0006D5C4 EC 42 E0 28 */ fsubs f2, f2, f28 /* 80071788 0006D5C8 EC 00 E0 28 */ fsubs f0, f0, f28 /* 8007178C 0006D5CC EC 63 00 F2 */ fmuls f3, f3, f3 /* 80071790 0006D5D0 EC 02 00 24 */ fdivs f0, f2, f0 /* 80071794 0006D5D4 EC 63 00 F2 */ fmuls f3, f3, f3 /* 80071798 0006D5D8 EC 00 08 28 */ fsubs f0, f0, f1 /* 8007179C 0006D5DC EC 63 00 F2 */ fmuls f3, f3, f3 /* 800717A0 0006D5E0 EC 63 00 F2 */ fmuls f3, f3, f3 /* 800717A4 0006D5E4 EC 03 00 32 */ fmuls f0, f3, f0 /* 800717A8 0006D5E8 EC 01 00 2A */ fadds f0, f1, f0 /* 800717AC 0006D5EC D0 10 00 00 */ stfs f0, 0x0(r16) /* 800717B0 0006D5F0 41 82 00 20 */ beq lbl_800717D0 /* 800717B4 0006D5F4 C0 10 00 00 */ lfs f0, 0x0(r16) /* 800717B8 0006D5F8 EC 63 06 B2 */ fmuls f3, f3, f26 /* 800717BC 0006D5FC C0 30 01 70 */ lfs f1, 0x170(r16) /* 800717C0 0006D600 EC 00 08 28 */ fsubs f0, f0, f1 /* 800717C4 0006D604 EC 03 00 32 */ fmuls f0, f3, f0 /* 800717C8 0006D608 EC 01 00 2A */ fadds f0, f1, f0 /* 800717CC 0006D60C D0 10 01 70 */ stfs f0, 0x170(r16) .global lbl_800717D0 lbl_800717D0: /* 800717D0 0006D610 C0 50 00 00 */ lfs f2, 0x0(r16) /* 800717D4 0006D614 C0 30 01 70 */ lfs f1, 0x170(r16) /* 800717D8 0006D618 C0 10 00 54 */ lfs f0, 0x54(r16) /* 800717DC 0006D61C EC 22 08 28 */ fsubs f1, f2, f1 /* 800717E0 0006D620 EC 00 00 72 */ fmuls f0, f0, f1 /* 800717E4 0006D624 D0 10 00 00 */ stfs f0, 0x0(r16) /* 800717E8 0006D628 88 10 00 BD */ lbz r0, 0xbd(r16) /* 800717EC 0006D62C 2C 00 00 00 */ cmpwi r0, 0x0 /* 800717F0 0006D630 41 82 00 5C */ beq lbl_8007184C /* 800717F4 0006D634 C0 30 00 C8 */ lfs f1, 0xc8(r16) /* 800717F8 0006D638 C0 50 00 00 */ lfs f2, 0x0(r16) /* 800717FC 0006D63C FC 00 08 50 */ fneg f0, f1 /* 80071800 0006D640 FC 02 00 40 */ fcmpo cr0, f2, f0 /* 80071804 0006D644 4C 41 13 82 */ cror eq, gt, eq /* 80071808 0006D648 40 82 00 40 */ bne lbl_80071848 /* 8007180C 0006D64C FC 02 08 40 */ fcmpo cr0, f2, f1 /* 80071810 0006D650 4C 40 13 82 */ cror eq, lt, eq /* 80071814 0006D654 40 82 00 34 */ bne lbl_80071848 /* 80071818 0006D658 FC 02 E8 40 */ fcmpo cr0, f2, f29 /* 8007181C 0006D65C 40 80 00 08 */ bge lbl_80071824 /* 80071820 0006D660 FC 40 10 50 */ fneg f2, f2 .global lbl_80071824 lbl_80071824: /* 80071824 0006D664 C0 30 00 C8 */ lfs f1, 0xc8(r16) /* 80071828 0006D668 C0 10 00 E8 */ lfs f0, 0xe8(r16) /* 8007182C 0006D66C EC 22 08 24 */ fdivs f1, f2, f1 /* 80071830 0006D670 EC 3B 08 28 */ fsubs f1, f27, f1 /* 80071834 0006D674 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071838 0006D678 40 80 00 08 */ bge lbl_80071840 /* 8007183C 0006D67C D0 30 00 E8 */ stfs f1, 0xe8(r16) .global lbl_80071840 lbl_80071840: /* 80071840 0006D680 D3 D0 00 00 */ stfs f30, 0x0(r16) /* 80071844 0006D684 48 00 00 08 */ b lbl_8007184C .global lbl_80071848 lbl_80071848: /* 80071848 0006D688 D3 D0 00 E8 */ stfs f30, 0xe8(r16) .global lbl_8007184C lbl_8007184C: /* 8007184C 0006D68C 88 10 00 BC */ lbz r0, 0xbc(r16) /* 80071850 0006D690 28 00 00 01 */ cmplwi r0, 0x1 /* 80071854 0006D694 40 82 00 1C */ bne lbl_80071870 /* 80071858 0006D698 C0 30 00 00 */ lfs f1, 0x0(r16) /* 8007185C 0006D69C C0 01 00 08 */ lfs f0, 0x8(r1) /* 80071860 0006D6A0 EC 01 00 28 */ fsubs f0, f1, f0 /* 80071864 0006D6A4 EC 1F 00 32 */ fmuls f0, f31, f0 /* 80071868 0006D6A8 D0 10 00 48 */ stfs f0, 0x48(r16) /* 8007186C 0006D6AC 48 00 00 14 */ b lbl_80071880 .global lbl_80071870 lbl_80071870: /* 80071870 0006D6B0 C0 30 00 00 */ lfs f1, 0x0(r16) /* 80071874 0006D6B4 C0 10 00 3C */ lfs f0, 0x3c(r16) /* 80071878 0006D6B8 EC 01 00 28 */ fsubs f0, f1, f0 /* 8007187C 0006D6BC D0 10 00 48 */ stfs f0, 0x48(r16) .global lbl_80071880 lbl_80071880: /* 80071880 0006D6C0 88 10 00 BC */ lbz r0, 0xbc(r16) /* 80071884 0006D6C4 28 00 00 02 */ cmplwi r0, 0x2 /* 80071888 0006D6C8 40 80 00 18 */ bge lbl_800718A0 /* 8007188C 0006D6CC 7E 03 83 78 */ mr r3, r16 /* 80071890 0006D6D0 7D E4 7B 78 */ mr r4, r15 /* 80071894 0006D6D4 4B FF F9 6D */ bl get_mpls_data_y /* 80071898 0006D6D8 7C 71 1B 78 */ mr r17, r3 /* 8007189C 0006D6DC 48 00 00 0C */ b lbl_800718A8 .global lbl_800718A0 lbl_800718A0: /* 800718A0 0006D6E0 A8 0F 00 2A */ lha r0, 0x2a(r15) /* 800718A4 0006D6E4 7E 20 00 D0 */ neg r17, r0 .global lbl_800718A8 lbl_800718A8: /* 800718A8 0006D6E8 80 10 01 7C */ lwz r0, 0x17c(r16) /* 800718AC 0006D6EC 3B C0 00 01 */ li r30, 0x1 /* 800718B0 0006D6F0 54 00 10 3A */ slwi r0, r0, 2 /* 800718B4 0006D6F4 7C 70 02 14 */ add r3, r16, r0 /* 800718B8 0006D6F8 92 23 05 80 */ stw r17, 0x580(r3) /* 800718BC 0006D6FC C0 30 01 74 */ lfs f1, 0x174(r16) /* 800718C0 0006D700 48 00 0C 01 */ bl __KMPLS_f2i /* 800718C4 0006D704 7C 03 88 50 */ subf r0, r3, r17 /* 800718C8 0006D708 7C 00 70 00 */ cmpw r0, r14 /* 800718CC 0006D70C 40 81 00 0C */ ble lbl_800718D8 /* 800718D0 0006D710 7C 00 E0 00 */ cmpw r0, r28 /* 800718D4 0006D714 41 80 00 38 */ blt lbl_8007190C .global lbl_800718D8 lbl_800718D8: /* 800718D8 0006D718 80 6D EA 98 */ lwz r3, kmpls@sda21(r13) /* 800718DC 0006D71C C0 30 00 4C */ lfs f1, 0x4c(r16) /* 800718E0 0006D720 C0 03 00 00 */ lfs f0, 0x0(r3) /* 800718E4 0006D724 EC 21 00 32 */ fmuls f1, f1, f0 /* 800718E8 0006D728 D0 30 00 4C */ stfs f1, 0x4c(r16) /* 800718EC 0006D72C C0 10 00 04 */ lfs f0, 0x4(r16) /* 800718F0 0006D730 EC 00 08 2A */ fadds f0, f0, f1 /* 800718F4 0006D734 D0 10 00 04 */ stfs f0, 0x4(r16) /* 800718F8 0006D738 88 70 00 BA */ lbz r3, 0xba(r16) /* 800718FC 0006D73C 38 03 00 01 */ addi r0, r3, 0x1 /* 80071900 0006D740 98 10 00 BA */ stb r0, 0xba(r16) /* 80071904 0006D744 D3 D0 00 E8 */ stfs f30, 0xe8(r16) /* 80071908 0006D748 48 00 01 B8 */ b lbl_80071AC0 .global lbl_8007190C lbl_8007190C: /* 8007190C 0006D74C 6E 20 80 00 */ xoris r0, r17, 0x8000 /* 80071910 0006D750 90 01 00 5C */ stw r0, 0x5c(r1) /* 80071914 0006D754 7C B8 88 50 */ subf r5, r24, r17 /* 80071918 0006D758 7C D1 C2 14 */ add r6, r17, r24 /* 8007191C 0006D75C C8 01 00 58 */ lfd f0, 0x58(r1) /* 80071920 0006D760 EC 00 E0 28 */ fsubs f0, f0, f28 /* 80071924 0006D764 D0 10 00 04 */ stfs f0, 0x4(r16) /* 80071928 0006D768 80 90 01 7C */ lwz r4, 0x17c(r16) /* 8007192C 0006D76C 7C 16 20 50 */ subf r0, r22, r4 /* 80071930 0006D770 38 64 FF FF */ addi r3, r4, -0x1 /* 80071934 0006D774 54 64 06 3E */ clrlwi r4, r3, 24 /* 80071938 0006D778 54 07 06 3E */ clrlwi r7, r0, 24 /* 8007193C 0006D77C 60 00 00 00 */ nop .global lbl_80071940 lbl_80071940: /* 80071940 0006D780 54 80 10 3A */ slwi r0, r4, 2 /* 80071944 0006D784 7C 70 02 14 */ add r3, r16, r0 /* 80071948 0006D788 80 63 05 80 */ lwz r3, 0x580(r3) /* 8007194C 0006D78C 7C 03 28 00 */ cmpw r3, r5 /* 80071950 0006D790 41 80 00 24 */ blt lbl_80071974 /* 80071954 0006D794 7C 03 30 00 */ cmpw r3, r6 /* 80071958 0006D798 41 81 00 1C */ bgt lbl_80071974 /* 8007195C 0006D79C 38 04 FF FF */ addi r0, r4, -0x1 /* 80071960 0006D7A0 7E 31 1A 14 */ add r17, r17, r3 /* 80071964 0006D7A4 54 04 06 3E */ clrlwi r4, r0, 24 /* 80071968 0006D7A8 3B DE 00 01 */ addi r30, r30, 0x1 /* 8007196C 0006D7AC 7C 04 38 00 */ cmpw r4, r7 /* 80071970 0006D7B0 40 82 FF D0 */ bne lbl_80071940 .global lbl_80071974 lbl_80071974: /* 80071974 0006D7B4 38 7E FF FF */ addi r3, r30, -0x1 /* 80071978 0006D7B8 38 16 FF FF */ addi r0, r22, -0x1 /* 8007197C 0006D7BC 6C 63 80 00 */ xoris r3, r3, 0x8000 /* 80071980 0006D7C0 90 61 00 54 */ stw r3, 0x54(r1) /* 80071984 0006D7C4 6C 04 80 00 */ xoris r4, r0, 0x8000 /* 80071988 0006D7C8 6F C0 80 00 */ xoris r0, r30, 0x8000 /* 8007198C 0006D7CC C8 01 00 50 */ lfd f0, 0x50(r1) /* 80071990 0006D7D0 6E 23 80 00 */ xoris r3, r17, 0x8000 /* 80071994 0006D7D4 90 81 00 5C */ stw r4, 0x5c(r1) /* 80071998 0006D7D8 2C 15 00 00 */ cmpwi r21, 0x0 /* 8007199C 0006D7DC EC 60 E0 28 */ fsubs f3, f0, f28 /* 800719A0 0006D7E0 C0 30 00 04 */ lfs f1, 0x4(r16) /* 800719A4 0006D7E4 C8 01 00 58 */ lfd f0, 0x58(r1) /* 800719A8 0006D7E8 90 61 00 54 */ stw r3, 0x54(r1) /* 800719AC 0006D7EC EC 00 E0 28 */ fsubs f0, f0, f28 /* 800719B0 0006D7F0 C8 41 00 50 */ lfd f2, 0x50(r1) /* 800719B4 0006D7F4 90 01 00 5C */ stw r0, 0x5c(r1) /* 800719B8 0006D7F8 EC 63 00 24 */ fdivs f3, f3, f0 /* 800719BC 0006D7FC C8 01 00 58 */ lfd f0, 0x58(r1) /* 800719C0 0006D800 EC 63 00 F2 */ fmuls f3, f3, f3 /* 800719C4 0006D804 EC 42 E0 28 */ fsubs f2, f2, f28 /* 800719C8 0006D808 EC 00 E0 28 */ fsubs f0, f0, f28 /* 800719CC 0006D80C EC 63 00 F2 */ fmuls f3, f3, f3 /* 800719D0 0006D810 EC 02 00 24 */ fdivs f0, f2, f0 /* 800719D4 0006D814 EC 63 00 F2 */ fmuls f3, f3, f3 /* 800719D8 0006D818 EC 00 08 28 */ fsubs f0, f0, f1 /* 800719DC 0006D81C EC 63 00 F2 */ fmuls f3, f3, f3 /* 800719E0 0006D820 EC 63 00 F2 */ fmuls f3, f3, f3 /* 800719E4 0006D824 EC 03 00 32 */ fmuls f0, f3, f0 /* 800719E8 0006D828 EC 01 00 2A */ fadds f0, f1, f0 /* 800719EC 0006D82C D0 10 00 04 */ stfs f0, 0x4(r16) /* 800719F0 0006D830 41 82 00 20 */ beq lbl_80071A10 /* 800719F4 0006D834 C0 10 00 04 */ lfs f0, 0x4(r16) /* 800719F8 0006D838 EC 63 06 B2 */ fmuls f3, f3, f26 /* 800719FC 0006D83C C0 30 01 74 */ lfs f1, 0x174(r16) /* 80071A00 0006D840 EC 00 08 28 */ fsubs f0, f0, f1 /* 80071A04 0006D844 EC 03 00 32 */ fmuls f0, f3, f0 /* 80071A08 0006D848 EC 01 00 2A */ fadds f0, f1, f0 /* 80071A0C 0006D84C D0 10 01 74 */ stfs f0, 0x174(r16) .global lbl_80071A10 lbl_80071A10: /* 80071A10 0006D850 C0 50 00 04 */ lfs f2, 0x4(r16) /* 80071A14 0006D854 C0 30 01 74 */ lfs f1, 0x174(r16) /* 80071A18 0006D858 C0 10 00 58 */ lfs f0, 0x58(r16) /* 80071A1C 0006D85C EC 22 08 28 */ fsubs f1, f2, f1 /* 80071A20 0006D860 EC 00 00 72 */ fmuls f0, f0, f1 /* 80071A24 0006D864 D0 10 00 04 */ stfs f0, 0x4(r16) /* 80071A28 0006D868 88 10 00 BD */ lbz r0, 0xbd(r16) /* 80071A2C 0006D86C 2C 00 00 00 */ cmpwi r0, 0x0 /* 80071A30 0006D870 41 82 00 5C */ beq lbl_80071A8C /* 80071A34 0006D874 C0 30 00 C8 */ lfs f1, 0xc8(r16) /* 80071A38 0006D878 C0 50 00 04 */ lfs f2, 0x4(r16) /* 80071A3C 0006D87C FC 00 08 50 */ fneg f0, f1 /* 80071A40 0006D880 FC 02 00 40 */ fcmpo cr0, f2, f0 /* 80071A44 0006D884 4C 41 13 82 */ cror eq, gt, eq /* 80071A48 0006D888 40 82 00 40 */ bne lbl_80071A88 /* 80071A4C 0006D88C FC 02 08 40 */ fcmpo cr0, f2, f1 /* 80071A50 0006D890 4C 40 13 82 */ cror eq, lt, eq /* 80071A54 0006D894 40 82 00 34 */ bne lbl_80071A88 /* 80071A58 0006D898 FC 02 E8 40 */ fcmpo cr0, f2, f29 /* 80071A5C 0006D89C 40 80 00 08 */ bge lbl_80071A64 /* 80071A60 0006D8A0 FC 40 10 50 */ fneg f2, f2 .global lbl_80071A64 lbl_80071A64: /* 80071A64 0006D8A4 C0 30 00 C8 */ lfs f1, 0xc8(r16) /* 80071A68 0006D8A8 C0 10 00 E8 */ lfs f0, 0xe8(r16) /* 80071A6C 0006D8AC EC 22 08 24 */ fdivs f1, f2, f1 /* 80071A70 0006D8B0 EC 3B 08 28 */ fsubs f1, f27, f1 /* 80071A74 0006D8B4 FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071A78 0006D8B8 40 80 00 08 */ bge lbl_80071A80 /* 80071A7C 0006D8BC D0 30 00 E8 */ stfs f1, 0xe8(r16) .global lbl_80071A80 lbl_80071A80: /* 80071A80 0006D8C0 D3 D0 00 04 */ stfs f30, 0x4(r16) /* 80071A84 0006D8C4 48 00 00 08 */ b lbl_80071A8C .global lbl_80071A88 lbl_80071A88: /* 80071A88 0006D8C8 D3 D0 00 E8 */ stfs f30, 0xe8(r16) .global lbl_80071A8C lbl_80071A8C: /* 80071A8C 0006D8CC 88 10 00 BC */ lbz r0, 0xbc(r16) /* 80071A90 0006D8D0 28 00 00 01 */ cmplwi r0, 0x1 /* 80071A94 0006D8D4 40 82 00 1C */ bne lbl_80071AB0 /* 80071A98 0006D8D8 C0 30 00 04 */ lfs f1, 0x4(r16) /* 80071A9C 0006D8DC C0 01 00 0C */ lfs f0, 0xc(r1) /* 80071AA0 0006D8E0 EC 01 00 28 */ fsubs f0, f1, f0 /* 80071AA4 0006D8E4 EC 1F 00 32 */ fmuls f0, f31, f0 /* 80071AA8 0006D8E8 D0 10 00 4C */ stfs f0, 0x4c(r16) /* 80071AAC 0006D8EC 48 00 00 14 */ b lbl_80071AC0 .global lbl_80071AB0 lbl_80071AB0: /* 80071AB0 0006D8F0 C0 30 00 04 */ lfs f1, 0x4(r16) /* 80071AB4 0006D8F4 C0 10 00 40 */ lfs f0, 0x40(r16) /* 80071AB8 0006D8F8 EC 01 00 28 */ fsubs f0, f1, f0 /* 80071ABC 0006D8FC D0 10 00 4C */ stfs f0, 0x4c(r16) .global lbl_80071AC0 lbl_80071AC0: /* 80071AC0 0006D900 88 10 00 BC */ lbz r0, 0xbc(r16) /* 80071AC4 0006D904 28 00 00 02 */ cmplwi r0, 0x2 /* 80071AC8 0006D908 40 80 00 18 */ bge lbl_80071AE0 /* 80071ACC 0006D90C 7E 03 83 78 */ mr r3, r16 /* 80071AD0 0006D910 7D E4 7B 78 */ mr r4, r15 /* 80071AD4 0006D914 4B FF F8 1D */ bl get_mpls_data_z /* 80071AD8 0006D918 7C 71 1B 78 */ mr r17, r3 /* 80071ADC 0006D91C 48 00 00 08 */ b lbl_80071AE4 .global lbl_80071AE0 lbl_80071AE0: /* 80071AE0 0006D920 AA 2F 00 2C */ lha r17, 0x2c(r15) .global lbl_80071AE4 lbl_80071AE4: /* 80071AE4 0006D924 80 10 01 7C */ lwz r0, 0x17c(r16) /* 80071AE8 0006D928 39 E0 00 01 */ li r15, 0x1 /* 80071AEC 0006D92C 54 00 10 3A */ slwi r0, r0, 2 /* 80071AF0 0006D930 7C 70 02 14 */ add r3, r16, r0 /* 80071AF4 0006D934 92 23 09 80 */ stw r17, 0x980(r3) /* 80071AF8 0006D938 C0 30 01 78 */ lfs f1, 0x178(r16) /* 80071AFC 0006D93C 48 00 09 C5 */ bl __KMPLS_f2i /* 80071B00 0006D940 7C 03 88 50 */ subf r0, r3, r17 /* 80071B04 0006D944 7C 00 D8 00 */ cmpw r0, r27 /* 80071B08 0006D948 40 81 00 0C */ ble lbl_80071B14 /* 80071B0C 0006D94C 7C 00 D0 00 */ cmpw r0, r26 /* 80071B10 0006D950 41 80 00 38 */ blt lbl_80071B48 .global lbl_80071B14 lbl_80071B14: /* 80071B14 0006D954 80 6D EA 98 */ lwz r3, kmpls@sda21(r13) /* 80071B18 0006D958 C0 30 00 50 */ lfs f1, 0x50(r16) /* 80071B1C 0006D95C C0 03 00 00 */ lfs f0, 0x0(r3) /* 80071B20 0006D960 EC 21 00 32 */ fmuls f1, f1, f0 /* 80071B24 0006D964 D0 30 00 50 */ stfs f1, 0x50(r16) /* 80071B28 0006D968 C0 10 00 08 */ lfs f0, 0x8(r16) /* 80071B2C 0006D96C EC 00 08 2A */ fadds f0, f0, f1 /* 80071B30 0006D970 D0 10 00 08 */ stfs f0, 0x8(r16) /* 80071B34 0006D974 88 70 00 BB */ lbz r3, 0xbb(r16) /* 80071B38 0006D978 38 03 00 01 */ addi r0, r3, 0x1 /* 80071B3C 0006D97C 98 10 00 BB */ stb r0, 0xbb(r16) /* 80071B40 0006D980 D3 D0 00 E8 */ stfs f30, 0xe8(r16) /* 80071B44 0006D984 48 00 01 B4 */ b lbl_80071CF8 .global lbl_80071B48 lbl_80071B48: /* 80071B48 0006D988 6E 20 80 00 */ xoris r0, r17, 0x8000 /* 80071B4C 0006D98C 90 01 00 54 */ stw r0, 0x54(r1) /* 80071B50 0006D990 7C B7 88 50 */ subf r5, r23, r17 /* 80071B54 0006D994 7C D1 BA 14 */ add r6, r17, r23 /* 80071B58 0006D998 C8 01 00 50 */ lfd f0, 0x50(r1) /* 80071B5C 0006D99C EC 00 E0 28 */ fsubs f0, f0, f28 /* 80071B60 0006D9A0 D0 10 00 08 */ stfs f0, 0x8(r16) /* 80071B64 0006D9A4 80 90 01 7C */ lwz r4, 0x17c(r16) /* 80071B68 0006D9A8 7C 16 20 50 */ subf r0, r22, r4 /* 80071B6C 0006D9AC 38 64 FF FF */ addi r3, r4, -0x1 /* 80071B70 0006D9B0 54 64 06 3E */ clrlwi r4, r3, 24 /* 80071B74 0006D9B4 54 07 06 3E */ clrlwi r7, r0, 24 .global lbl_80071B78 lbl_80071B78: /* 80071B78 0006D9B8 54 80 10 3A */ slwi r0, r4, 2 /* 80071B7C 0006D9BC 7C 70 02 14 */ add r3, r16, r0 /* 80071B80 0006D9C0 80 63 09 80 */ lwz r3, 0x980(r3) /* 80071B84 0006D9C4 7C 03 28 00 */ cmpw r3, r5 /* 80071B88 0006D9C8 41 80 00 24 */ blt lbl_80071BAC /* 80071B8C 0006D9CC 7C 03 30 00 */ cmpw r3, r6 /* 80071B90 0006D9D0 41 81 00 1C */ bgt lbl_80071BAC /* 80071B94 0006D9D4 38 04 FF FF */ addi r0, r4, -0x1 /* 80071B98 0006D9D8 7E 31 1A 14 */ add r17, r17, r3 /* 80071B9C 0006D9DC 54 04 06 3E */ clrlwi r4, r0, 24 /* 80071BA0 0006D9E0 39 EF 00 01 */ addi r15, r15, 0x1 /* 80071BA4 0006D9E4 7C 04 38 00 */ cmpw r4, r7 /* 80071BA8 0006D9E8 40 82 FF D0 */ bne lbl_80071B78 .global lbl_80071BAC lbl_80071BAC: /* 80071BAC 0006D9EC 38 6F FF FF */ addi r3, r15, -0x1 /* 80071BB0 0006D9F0 38 16 FF FF */ addi r0, r22, -0x1 /* 80071BB4 0006D9F4 6C 63 80 00 */ xoris r3, r3, 0x8000 /* 80071BB8 0006D9F8 90 61 00 5C */ stw r3, 0x5c(r1) /* 80071BBC 0006D9FC 6C 04 80 00 */ xoris r4, r0, 0x8000 /* 80071BC0 0006DA00 6D E0 80 00 */ xoris r0, r15, 0x8000 /* 80071BC4 0006DA04 C8 01 00 58 */ lfd f0, 0x58(r1) /* 80071BC8 0006DA08 6E 23 80 00 */ xoris r3, r17, 0x8000 /* 80071BCC 0006DA0C 90 81 00 54 */ stw r4, 0x54(r1) /* 80071BD0 0006DA10 2C 15 00 00 */ cmpwi r21, 0x0 /* 80071BD4 0006DA14 EC 60 E0 28 */ fsubs f3, f0, f28 /* 80071BD8 0006DA18 C0 30 00 08 */ lfs f1, 0x8(r16) /* 80071BDC 0006DA1C C8 01 00 50 */ lfd f0, 0x50(r1) /* 80071BE0 0006DA20 90 61 00 5C */ stw r3, 0x5c(r1) /* 80071BE4 0006DA24 EC 00 E0 28 */ fsubs f0, f0, f28 /* 80071BE8 0006DA28 C8 41 00 58 */ lfd f2, 0x58(r1) /* 80071BEC 0006DA2C 90 01 00 54 */ stw r0, 0x54(r1) /* 80071BF0 0006DA30 EC 63 00 24 */ fdivs f3, f3, f0 /* 80071BF4 0006DA34 C8 01 00 50 */ lfd f0, 0x50(r1) /* 80071BF8 0006DA38 EC 63 00 F2 */ fmuls f3, f3, f3 /* 80071BFC 0006DA3C EC 42 E0 28 */ fsubs f2, f2, f28 /* 80071C00 0006DA40 EC 00 E0 28 */ fsubs f0, f0, f28 /* 80071C04 0006DA44 EC 63 00 F2 */ fmuls f3, f3, f3 /* 80071C08 0006DA48 EC 02 00 24 */ fdivs f0, f2, f0 /* 80071C0C 0006DA4C EC 63 00 F2 */ fmuls f3, f3, f3 /* 80071C10 0006DA50 EC 00 08 28 */ fsubs f0, f0, f1 /* 80071C14 0006DA54 EC 63 00 F2 */ fmuls f3, f3, f3 /* 80071C18 0006DA58 EC 63 00 F2 */ fmuls f3, f3, f3 /* 80071C1C 0006DA5C EC 03 00 32 */ fmuls f0, f3, f0 /* 80071C20 0006DA60 EC 01 00 2A */ fadds f0, f1, f0 /* 80071C24 0006DA64 D0 10 00 08 */ stfs f0, 0x8(r16) /* 80071C28 0006DA68 41 82 00 20 */ beq lbl_80071C48 /* 80071C2C 0006DA6C C0 10 00 08 */ lfs f0, 0x8(r16) /* 80071C30 0006DA70 EC 63 06 B2 */ fmuls f3, f3, f26 /* 80071C34 0006DA74 C0 30 01 78 */ lfs f1, 0x178(r16) /* 80071C38 0006DA78 EC 00 08 28 */ fsubs f0, f0, f1 /* 80071C3C 0006DA7C EC 03 00 32 */ fmuls f0, f3, f0 /* 80071C40 0006DA80 EC 01 00 2A */ fadds f0, f1, f0 /* 80071C44 0006DA84 D0 10 01 78 */ stfs f0, 0x178(r16) .global lbl_80071C48 lbl_80071C48: /* 80071C48 0006DA88 C0 50 00 08 */ lfs f2, 0x8(r16) /* 80071C4C 0006DA8C C0 30 01 78 */ lfs f1, 0x178(r16) /* 80071C50 0006DA90 C0 10 00 5C */ lfs f0, 0x5c(r16) /* 80071C54 0006DA94 EC 22 08 28 */ fsubs f1, f2, f1 /* 80071C58 0006DA98 EC 00 00 72 */ fmuls f0, f0, f1 /* 80071C5C 0006DA9C D0 10 00 08 */ stfs f0, 0x8(r16) /* 80071C60 0006DAA0 88 10 00 BD */ lbz r0, 0xbd(r16) /* 80071C64 0006DAA4 2C 00 00 00 */ cmpwi r0, 0x0 /* 80071C68 0006DAA8 41 82 00 5C */ beq lbl_80071CC4 /* 80071C6C 0006DAAC C0 30 00 C8 */ lfs f1, 0xc8(r16) /* 80071C70 0006DAB0 C0 50 00 08 */ lfs f2, 0x8(r16) /* 80071C74 0006DAB4 FC 00 08 50 */ fneg f0, f1 /* 80071C78 0006DAB8 FC 02 00 40 */ fcmpo cr0, f2, f0 /* 80071C7C 0006DABC 4C 41 13 82 */ cror eq, gt, eq /* 80071C80 0006DAC0 40 82 00 40 */ bne lbl_80071CC0 /* 80071C84 0006DAC4 FC 02 08 40 */ fcmpo cr0, f2, f1 /* 80071C88 0006DAC8 4C 40 13 82 */ cror eq, lt, eq /* 80071C8C 0006DACC 40 82 00 34 */ bne lbl_80071CC0 /* 80071C90 0006DAD0 FC 02 E8 40 */ fcmpo cr0, f2, f29 /* 80071C94 0006DAD4 40 80 00 08 */ bge lbl_80071C9C /* 80071C98 0006DAD8 FC 40 10 50 */ fneg f2, f2 .global lbl_80071C9C lbl_80071C9C: /* 80071C9C 0006DADC C0 30 00 C8 */ lfs f1, 0xc8(r16) /* 80071CA0 0006DAE0 C0 10 00 E8 */ lfs f0, 0xe8(r16) /* 80071CA4 0006DAE4 EC 22 08 24 */ fdivs f1, f2, f1 /* 80071CA8 0006DAE8 EC 3B 08 28 */ fsubs f1, f27, f1 /* 80071CAC 0006DAEC FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071CB0 0006DAF0 40 80 00 08 */ bge lbl_80071CB8 /* 80071CB4 0006DAF4 D0 30 00 E8 */ stfs f1, 0xe8(r16) .global lbl_80071CB8 lbl_80071CB8: /* 80071CB8 0006DAF8 D3 D0 00 08 */ stfs f30, 0x8(r16) /* 80071CBC 0006DAFC 48 00 00 08 */ b lbl_80071CC4 .global lbl_80071CC0 lbl_80071CC0: /* 80071CC0 0006DB00 D3 D0 00 E8 */ stfs f30, 0xe8(r16) .global lbl_80071CC4 lbl_80071CC4: /* 80071CC4 0006DB04 88 10 00 BC */ lbz r0, 0xbc(r16) /* 80071CC8 0006DB08 28 00 00 01 */ cmplwi r0, 0x1 /* 80071CCC 0006DB0C 40 82 00 1C */ bne lbl_80071CE8 /* 80071CD0 0006DB10 C0 30 00 08 */ lfs f1, 0x8(r16) /* 80071CD4 0006DB14 C0 01 00 10 */ lfs f0, 0x10(r1) /* 80071CD8 0006DB18 EC 01 00 28 */ fsubs f0, f1, f0 /* 80071CDC 0006DB1C EC 1F 00 32 */ fmuls f0, f31, f0 /* 80071CE0 0006DB20 D0 10 00 50 */ stfs f0, 0x50(r16) /* 80071CE4 0006DB24 48 00 00 14 */ b lbl_80071CF8 .global lbl_80071CE8 lbl_80071CE8: /* 80071CE8 0006DB28 C0 30 00 08 */ lfs f1, 0x8(r16) /* 80071CEC 0006DB2C C0 10 00 44 */ lfs f0, 0x44(r16) /* 80071CF0 0006DB30 EC 01 00 28 */ fsubs f0, f1, f0 /* 80071CF4 0006DB34 D0 10 00 50 */ stfs f0, 0x50(r16) .global lbl_80071CF8 lbl_80071CF8: /* 80071CF8 0006DB38 7C 1F F0 00 */ cmpw r31, r30 /* 80071CFC 0006DB3C 40 80 00 14 */ bge lbl_80071D10 /* 80071D00 0006DB40 7C 1F 78 00 */ cmpw r31, r15 /* 80071D04 0006DB44 40 80 00 18 */ bge lbl_80071D1C /* 80071D08 0006DB48 7F EF FB 78 */ mr r15, r31 /* 80071D0C 0006DB4C 48 00 00 10 */ b lbl_80071D1C .global lbl_80071D10 lbl_80071D10: /* 80071D10 0006DB50 7C 1E 78 00 */ cmpw r30, r15 /* 80071D14 0006DB54 40 80 00 08 */ bge lbl_80071D1C /* 80071D18 0006DB58 7F CF F3 78 */ mr r15, r30 .global lbl_80071D1C lbl_80071D1C: /* 80071D1C 0006DB5C 38 6F FF FF */ addi r3, r15, -0x1 /* 80071D20 0006DB60 38 16 FF FF */ addi r0, r22, -0x1 /* 80071D24 0006DB64 6C 63 80 00 */ xoris r3, r3, 0x8000 /* 80071D28 0006DB68 90 61 00 5C */ stw r3, 0x5c(r1) /* 80071D2C 0006DB6C 6C 00 80 00 */ xoris r0, r0, 0x8000 /* 80071D30 0006DB70 C0 10 00 EC */ lfs f0, 0xec(r16) /* 80071D34 0006DB74 90 01 00 54 */ stw r0, 0x54(r1) /* 80071D38 0006DB78 C8 41 00 58 */ lfd f2, 0x58(r1) /* 80071D3C 0006DB7C C8 21 00 50 */ lfd f1, 0x50(r1) /* 80071D40 0006DB80 EC 42 E0 28 */ fsubs f2, f2, f28 /* 80071D44 0006DB84 EC 21 E0 28 */ fsubs f1, f1, f28 /* 80071D48 0006DB88 EC 22 08 24 */ fdivs f1, f2, f1 /* 80071D4C 0006DB8C FC 01 00 40 */ fcmpo cr0, f1, f0 /* 80071D50 0006DB90 40 80 00 08 */ bge lbl_80071D58 /* 80071D54 0006DB94 D0 30 00 EC */ stfs f1, 0xec(r16) .global lbl_80071D58 lbl_80071D58: /* 80071D58 0006DB98 C0 50 00 AC */ lfs f2, 0xac(r16) /* 80071D5C 0006DB9C 7E 03 83 78 */ mr r3, r16 /* 80071D60 0006DBA0 C0 30 00 00 */ lfs f1, 0x0(r16) /* 80071D64 0006DBA4 C0 10 00 0C */ lfs f0, 0xc(r16) /* 80071D68 0006DBA8 EC 22 00 72 */ fmuls f1, f2, f1 /* 80071D6C 0006DBAC EC 00 08 2A */ fadds f0, f0, f1 /* 80071D70 0006DBB0 D0 10 00 0C */ stfs f0, 0xc(r16) /* 80071D74 0006DBB4 C0 50 00 AC */ lfs f2, 0xac(r16) /* 80071D78 0006DBB8 C0 30 00 04 */ lfs f1, 0x4(r16) /* 80071D7C 0006DBBC C0 10 00 10 */ lfs f0, 0x10(r16) /* 80071D80 0006DBC0 EC 22 00 72 */ fmuls f1, f2, f1 /* 80071D84 0006DBC4 EC 00 08 2A */ fadds f0, f0, f1 /* 80071D88 0006DBC8 D0 10 00 10 */ stfs f0, 0x10(r16) /* 80071D8C 0006DBCC C0 50 00 AC */ lfs f2, 0xac(r16) /* 80071D90 0006DBD0 C0 30 00 08 */ lfs f1, 0x8(r16) /* 80071D94 0006DBD4 C0 10 00 14 */ lfs f0, 0x14(r16) /* 80071D98 0006DBD8 EC 22 00 72 */ fmuls f1, f2, f1 /* 80071D9C 0006DBDC EC 00 08 2A */ fadds f0, f0, f1 /* 80071DA0 0006DBE0 D0 10 00 14 */ stfs f0, 0x14(r16) /* 80071DA4 0006DBE4 4B FF F0 AD */ bl calc_mpls_dir /* 80071DA8 0006DBE8 80 AD EA 98 */ lwz r5, kmpls@sda21(r13) /* 80071DAC 0006DBEC 80 05 00 04 */ lwz r0, 0x4(r5) /* 80071DB0 0006DBF0 2C 00 00 00 */ cmpwi r0, 0x0 /* 80071DB4 0006DBF4 41 82 00 90 */ beq lbl_80071E44 /* 80071DB8 0006DBF8 80 D0 00 00 */ lwz r6, 0x0(r16) /* 80071DBC 0006DBFC 7E 43 93 78 */ mr r3, r18 /* 80071DC0 0006DC00 80 10 00 04 */ lwz r0, 0x4(r16) /* 80071DC4 0006DC04 38 81 00 14 */ addi r4, r1, 0x14 /* 80071DC8 0006DC08 90 01 00 18 */ stw r0, 0x18(r1) /* 80071DCC 0006DC0C 90 C1 00 14 */ stw r6, 0x14(r1) /* 80071DD0 0006DC10 80 10 00 08 */ lwz r0, 0x8(r16) /* 80071DD4 0006DC14 90 01 00 1C */ stw r0, 0x1c(r1) /* 80071DD8 0006DC18 80 D0 00 0C */ lwz r6, 0xc(r16) /* 80071DDC 0006DC1C 80 10 00 10 */ lwz r0, 0x10(r16) /* 80071DE0 0006DC20 90 01 00 24 */ stw r0, 0x24(r1) /* 80071DE4 0006DC24 90 C1 00 20 */ stw r6, 0x20(r1) /* 80071DE8 0006DC28 80 10 00 14 */ lwz r0, 0x14(r16) /* 80071DEC 0006DC2C 90 01 00 28 */ stw r0, 0x28(r1) /* 80071DF0 0006DC30 80 D0 00 18 */ lwz r6, 0x18(r16) /* 80071DF4 0006DC34 80 10 00 1C */ lwz r0, 0x1c(r16) /* 80071DF8 0006DC38 90 01 00 30 */ stw r0, 0x30(r1) /* 80071DFC 0006DC3C 90 C1 00 2C */ stw r6, 0x2c(r1) /* 80071E00 0006DC40 80 D0 00 20 */ lwz r6, 0x20(r16) /* 80071E04 0006DC44 80 10 00 24 */ lwz r0, 0x24(r16) /* 80071E08 0006DC48 90 01 00 38 */ stw r0, 0x38(r1) /* 80071E0C 0006DC4C 90 C1 00 34 */ stw r6, 0x34(r1) /* 80071E10 0006DC50 80 D0 00 28 */ lwz r6, 0x28(r16) /* 80071E14 0006DC54 80 10 00 2C */ lwz r0, 0x2c(r16) /* 80071E18 0006DC58 90 01 00 40 */ stw r0, 0x40(r1) /* 80071E1C 0006DC5C 90 C1 00 3C */ stw r6, 0x3c(r1) /* 80071E20 0006DC60 80 D0 00 30 */ lwz r6, 0x30(r16) /* 80071E24 0006DC64 80 10 00 34 */ lwz r0, 0x34(r16) /* 80071E28 0006DC68 90 01 00 48 */ stw r0, 0x48(r1) /* 80071E2C 0006DC6C 90 C1 00 44 */ stw r6, 0x44(r1) /* 80071E30 0006DC70 80 10 00 38 */ lwz r0, 0x38(r16) /* 80071E34 0006DC74 90 01 00 4C */ stw r0, 0x4c(r1) /* 80071E38 0006DC78 81 85 00 04 */ lwz r12, 0x4(r5) /* 80071E3C 0006DC7C 7D 89 03 A6 */ mtctr r12 /* 80071E40 0006DC80 4E 80 04 21 */ bctrl .global lbl_80071E44 lbl_80071E44: /* 80071E44 0006DC84 36 94 FF FF */ addic. r20, r20, -0x1 /* 80071E48 0006DC88 40 82 F7 04 */ bne lbl_8007154C /* 80071E4C 0006DC8C 80 6D EA 98 */ lwz r3, kmpls@sda21(r13) /* 80071E50 0006DC90 38 00 00 00 */ li r0, 0x0 /* 80071E54 0006DC94 90 03 00 04 */ stw r0, 0x4(r3) .global lbl_80071E58 lbl_80071E58: /* 80071E58 0006DC98 39 61 00 C0 */ addi r11, r1, 0xc0 /* 80071E5C 0006DC9C E3 E1 01 18 */ psq_l f31, 0x118(r1), 0, qr0 /* 80071E60 0006DCA0 CB E1 01 10 */ lfd f31, 0x110(r1) /* 80071E64 0006DCA4 E3 C1 01 08 */ psq_l f30, 0x108(r1), 0, qr0 /* 80071E68 0006DCA8 CB C1 01 00 */ lfd f30, 0x100(r1) /* 80071E6C 0006DCAC E3 A1 00 F8 */ psq_l f29, 0xf8(r1), 0, qr0 /* 80071E70 0006DCB0 CB A1 00 F0 */ lfd f29, 0xf0(r1) /* 80071E74 0006DCB4 E3 81 00 E8 */ psq_l f28, 0xe8(r1), 0, qr0 /* 80071E78 0006DCB8 CB 81 00 E0 */ lfd f28, 0xe0(r1) /* 80071E7C 0006DCBC E3 61 00 D8 */ psq_l f27, 0xd8(r1), 0, qr0 /* 80071E80 0006DCC0 CB 61 00 D0 */ lfd f27, 0xd0(r1) /* 80071E84 0006DCC4 E3 41 00 C8 */ psq_l f26, 0xc8(r1), 0, qr0 /* 80071E88 0006DCC8 CB 41 00 C0 */ lfd f26, 0xc0(r1) /* 80071E8C 0006DCCC 4B F9 54 C9 */ bl __restore_gpr /* 80071E90 0006DCD0 80 01 01 24 */ lwz r0, 0x124(r1) /* 80071E94 0006DCD4 7C 08 03 A6 */ mtlr r0 /* 80071E98 0006DCD8 38 21 01 20 */ addi r1, r1, 0x120 /* 80071E9C 0006DCDC 4E 80 00 20 */ blr .global set_calibration_data set_calibration_data: /* 80071EA0 0006DCE0 94 21 FF E0 */ stwu r1, -0x20(r1) /* 80071EA4 0006DCE4 7C 08 02 A6 */ mflr r0 /* 80071EA8 0006DCE8 90 01 00 24 */ stw r0, 0x24(r1) /* 80071EAC 0006DCEC 93 E1 00 1C */ stw r31, 0x1c(r1) /* 80071EB0 0006DCF0 93 C1 00 18 */ stw r30, 0x18(r1) /* 80071EB4 0006DCF4 1F C3 0D B0 */ mulli r30, r3, 0xdb0 /* 80071EB8 0006DCF8 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80071EBC 0006DCFC 2C 00 00 00 */ cmpwi r0, 0x0 /* 80071EC0 0006DD00 7F E0 F2 14 */ add r31, r0, r30 /* 80071EC4 0006DD04 41 82 01 64 */ beq lbl_80072028 /* 80071EC8 0006DD08 88 1F 00 C4 */ lbz r0, 0xc4(r31) /* 80071ECC 0006DD0C 28 00 00 02 */ cmplwi r0, 0x2 /* 80071ED0 0006DD10 41 80 00 10 */ blt lbl_80071EE0 /* 80071ED4 0006DD14 C8 02 89 00 */ lfd f0, "@2679"@sda21(r2) /* 80071ED8 0006DD18 D8 1F 01 10 */ stfd f0, 0x110(r31) /* 80071EDC 0006DD1C 48 00 01 4C */ b lbl_80072028 .global lbl_80071EE0 lbl_80071EE0: /* 80071EE0 0006DD20 38 9F 01 40 */ addi r4, r31, 0x140 /* 80071EE4 0006DD24 38 BF 01 5C */ addi r5, r31, 0x15c /* 80071EE8 0006DD28 4B FE AE 09 */ bl WPADiGetMplsCalibration /* 80071EEC 0006DD2C C0 82 88 F0 */ lfs f4, "@2647_8055E870"@sda21(r2) /* 80071EF0 0006DD30 C0 3F 01 44 */ lfs f1, 0x144(r31) /* 80071EF4 0006DD34 FC 04 08 00 */ fcmpu cr0, f4, f1 /* 80071EF8 0006DD38 41 82 00 40 */ beq lbl_80071F38 /* 80071EFC 0006DD3C C0 1F 01 4C */ lfs f0, 0x14c(r31) /* 80071F00 0006DD40 FC 04 00 00 */ fcmpu cr0, f4, f0 /* 80071F04 0006DD44 41 82 00 34 */ beq lbl_80071F38 /* 80071F08 0006DD48 C0 1F 01 54 */ lfs f0, 0x154(r31) /* 80071F0C 0006DD4C FC 04 00 00 */ fcmpu cr0, f4, f0 /* 80071F10 0006DD50 41 82 00 28 */ beq lbl_80071F38 /* 80071F14 0006DD54 C0 1F 01 60 */ lfs f0, 0x160(r31) /* 80071F18 0006DD58 FC 04 00 00 */ fcmpu cr0, f4, f0 /* 80071F1C 0006DD5C 41 82 00 1C */ beq lbl_80071F38 /* 80071F20 0006DD60 C0 1F 01 68 */ lfs f0, 0x168(r31) /* 80071F24 0006DD64 FC 04 00 00 */ fcmpu cr0, f4, f0 /* 80071F28 0006DD68 41 82 00 10 */ beq lbl_80071F38 /* 80071F2C 0006DD6C C0 1F 01 70 */ lfs f0, 0x170(r31) /* 80071F30 0006DD70 FC 04 00 00 */ fcmpu cr0, f4, f0 /* 80071F34 0006DD74 40 82 00 10 */ bne lbl_80071F44 .global lbl_80071F38 lbl_80071F38: /* 80071F38 0006DD78 C8 02 89 00 */ lfd f0, "@2679"@sda21(r2) /* 80071F3C 0006DD7C D8 1F 01 10 */ stfd f0, 0x110(r31) /* 80071F40 0006DD80 48 00 00 E8 */ b lbl_80072028 .global lbl_80071F44 lbl_80071F44: /* 80071F44 0006DD84 80 9F 01 58 */ lwz r4, 0x158(r31) /* 80071F48 0006DD88 3C 60 43 30 */ lis r3, 0x4330 /* 80071F4C 0006DD8C 90 61 00 08 */ stw r3, 0x8(r1) /* 80071F50 0006DD90 38 00 00 01 */ li r0, 0x1 /* 80071F54 0006DD94 6C 84 80 00 */ xoris r4, r4, 0x8000 /* 80071F58 0006DD98 C8 62 89 18 */ lfd f3, "@2685_8055E898"@sda21(r2) /* 80071F5C 0006DD9C 90 81 00 0C */ stw r4, 0xc(r1) /* 80071F60 0006DDA0 C8 42 89 68 */ lfd f2, "@3492_8055E8E8"@sda21(r2) /* 80071F64 0006DDA4 C8 01 00 08 */ lfd f0, 0x8(r1) /* 80071F68 0006DDA8 90 61 00 10 */ stw r3, 0x10(r1) /* 80071F6C 0006DDAC FC 00 18 28 */ fsub f0, f0, f3 /* 80071F70 0006DDB0 FC A2 00 32 */ fmul f5, f2, f0 /* 80071F74 0006DDB4 FC 05 08 24 */ fdiv f0, f5, f1 /* 80071F78 0006DDB8 D8 1F 01 10 */ stfd f0, 0x110(r31) /* 80071F7C 0006DDBC C0 1F 01 4C */ lfs f0, 0x14c(r31) /* 80071F80 0006DDC0 FC 05 00 24 */ fdiv f0, f5, f0 /* 80071F84 0006DDC4 D8 1F 01 18 */ stfd f0, 0x118(r31) /* 80071F88 0006DDC8 C0 1F 01 54 */ lfs f0, 0x154(r31) /* 80071F8C 0006DDCC FC 05 00 24 */ fdiv f0, f5, f0 /* 80071F90 0006DDD0 D8 1F 01 20 */ stfd f0, 0x120(r31) /* 80071F94 0006DDD4 80 7F 01 74 */ lwz r3, 0x174(r31) /* 80071F98 0006DDD8 C0 1F 01 60 */ lfs f0, 0x160(r31) /* 80071F9C 0006DDDC 6C 63 80 00 */ xoris r3, r3, 0x8000 /* 80071FA0 0006DDE0 90 61 00 14 */ stw r3, 0x14(r1) /* 80071FA4 0006DDE4 C8 21 00 10 */ lfd f1, 0x10(r1) /* 80071FA8 0006DDE8 FC 21 18 28 */ fsub f1, f1, f3 /* 80071FAC 0006DDEC FC 22 00 72 */ fmul f1, f2, f1 /* 80071FB0 0006DDF0 FC 01 00 24 */ fdiv f0, f1, f0 /* 80071FB4 0006DDF4 D8 1F 01 28 */ stfd f0, 0x128(r31) /* 80071FB8 0006DDF8 C0 1F 01 68 */ lfs f0, 0x168(r31) /* 80071FBC 0006DDFC FC 01 00 24 */ fdiv f0, f1, f0 /* 80071FC0 0006DE00 D8 1F 01 30 */ stfd f0, 0x130(r31) /* 80071FC4 0006DE04 C0 1F 01 70 */ lfs f0, 0x170(r31) /* 80071FC8 0006DE08 FC 01 00 24 */ fdiv f0, f1, f0 /* 80071FCC 0006DE0C D8 1F 01 38 */ stfd f0, 0x138(r31) /* 80071FD0 0006DE10 98 1F 00 CA */ stb r0, 0xca(r31) /* 80071FD4 0006DE14 80 6D EA 98 */ lwz r3, kmpls@sda21(r13) /* 80071FD8 0006DE18 2C 03 00 00 */ cmpwi r3, 0x0 /* 80071FDC 0006DE1C 7C 63 F2 14 */ add r3, r3, r30 /* 80071FE0 0006DE20 41 82 00 48 */ beq lbl_80072028 /* 80071FE4 0006DE24 98 03 00 C0 */ stb r0, 0xc0(r3) /* 80071FE8 0006DE28 C0 02 89 24 */ lfs f0, "@2758"@sda21(r2) /* 80071FEC 0006DE2C D0 03 00 CC */ stfs f0, 0xcc(r3) /* 80071FF0 0006DE30 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80071FF4 0006DE34 2C 00 00 00 */ cmpwi r0, 0x0 /* 80071FF8 0006DE38 7C 60 F2 14 */ add r3, r0, r30 /* 80071FFC 0006DE3C 38 83 00 08 */ addi r4, r3, 0x8 /* 80072000 0006DE40 41 82 00 28 */ beq lbl_80072028 /* 80072004 0006DE44 80 64 01 7C */ lwz r3, 0x17c(r4) /* 80072008 0006DE48 3C 00 80 00 */ lis r0, 0x8000 /* 8007200C 0006DE4C 38 63 00 FF */ addi r3, r3, 0xff /* 80072010 0006DE50 54 63 15 BA */ rlwinm r3, r3, 2, 22, 29 /* 80072014 0006DE54 7C 64 1A 14 */ add r3, r4, r3 /* 80072018 0006DE58 90 03 09 80 */ stw r0, 0x980(r3) /* 8007201C 0006DE5C 90 03 05 80 */ stw r0, 0x580(r3) /* 80072020 0006DE60 90 03 01 80 */ stw r0, 0x180(r3) /* 80072024 0006DE64 D0 84 00 EC */ stfs f4, 0xec(r4) .global lbl_80072028 lbl_80072028: /* 80072028 0006DE68 80 01 00 24 */ lwz r0, 0x24(r1) /* 8007202C 0006DE6C 83 E1 00 1C */ lwz r31, 0x1c(r1) /* 80072030 0006DE70 83 C1 00 18 */ lwz r30, 0x18(r1) /* 80072034 0006DE74 7C 08 03 A6 */ mtlr r0 /* 80072038 0006DE78 38 21 00 20 */ addi r1, r1, 0x20 /* 8007203C 0006DE7C 4E 80 00 20 */ blr .global KMPLSSetKpadRingBuffer KMPLSSetKpadRingBuffer: /* 80072040 0006DE80 80 ED EA 98 */ lwz r7, kmpls@sda21(r13) /* 80072044 0006DE84 1C 03 0D B0 */ mulli r0, r3, 0xdb0 /* 80072048 0006DE88 2C 07 00 00 */ cmpwi r7, 0x0 /* 8007204C 0006DE8C 7C 67 02 14 */ add r3, r7, r0 /* 80072050 0006DE90 4D 82 00 20 */ beqlr /* 80072054 0006DE94 90 83 0D A0 */ stw r4, 0xda0(r3) /* 80072058 0006DE98 90 A3 0D A4 */ stw r5, 0xda4(r3) /* 8007205C 0006DE9C 90 C3 0D A8 */ stw r6, 0xda8(r3) /* 80072060 0006DEA0 4E 80 00 20 */ blr /* 80072064 0006DEA4 00 00 00 00 */ .4byte 0x00000000 /* 80072068 0006DEA8 00 00 00 00 */ .4byte 0x00000000 /* 8007206C 0006DEAC 00 00 00 00 */ .4byte 0x00000000 .global KMPLSRead KMPLSRead: /* 80072070 0006DEB0 94 21 FF B0 */ stwu r1, -0x50(r1) /* 80072074 0006DEB4 7C 08 02 A6 */ mflr r0 /* 80072078 0006DEB8 90 01 00 54 */ stw r0, 0x54(r1) /* 8007207C 0006DEBC 39 61 00 40 */ addi r11, r1, 0x40 /* 80072080 0006DEC0 DB E1 00 40 */ stfd f31, 0x40(r1) /* 80072084 0006DEC4 F3 E1 00 48 */ psq_st f31, 0x48(r1), 0, qr0 /* 80072088 0006DEC8 4B F9 52 A9 */ bl lbl_80007330 /* 8007208C 0006DECC 81 0D EA 98 */ lwz r8, kmpls@sda21(r13) /* 80072090 0006DED0 3C 00 43 30 */ lis r0, 0x4330 /* 80072094 0006DED4 1F C3 0D B0 */ mulli r30, r3, 0xdb0 /* 80072098 0006DED8 FF E0 08 90 */ fmr f31, f1 /* 8007209C 0006DEDC 2C 08 00 00 */ cmpwi r8, 0x0 /* 800720A0 0006DEE0 90 01 00 10 */ stw r0, 0x10(r1) /* 800720A4 0006DEE4 7C FC 3B 78 */ mr r28, r7 /* 800720A8 0006DEE8 90 01 00 18 */ stw r0, 0x18(r1) /* 800720AC 0006DEEC 7C 78 1B 78 */ mr r24, r3 /* 800720B0 0006DEF0 7C 99 23 78 */ mr r25, r4 /* 800720B4 0006DEF4 7C BA 2B 78 */ mr r26, r5 /* 800720B8 0006DEF8 7C DB 33 78 */ mr r27, r6 /* 800720BC 0006DEFC 7F E8 F2 14 */ add r31, r8, r30 /* 800720C0 0006DF00 41 82 03 BC */ beq lbl_8007247C /* 800720C4 0006DF04 38 81 00 08 */ addi r4, r1, 0x8 /* 800720C8 0006DF08 3B A0 00 02 */ li r29, 0x2 /* 800720CC 0006DF0C 4B FE 5A E5 */ bl WPADProbe /* 800720D0 0006DF10 2C 03 FF FF */ cmpwi r3, -0x1 /* 800720D4 0006DF14 41 82 00 58 */ beq lbl_8007212C /* 800720D8 0006DF18 80 61 00 08 */ lwz r3, 0x8(r1) /* 800720DC 0006DF1C 38 03 FF FB */ addi r0, r3, -0x5 /* 800720E0 0006DF20 28 00 00 02 */ cmplwi r0, 0x2 /* 800720E4 0006DF24 40 81 00 0C */ ble lbl_800720F0 /* 800720E8 0006DF28 28 03 00 FA */ cmplwi r3, 0xfa /* 800720EC 0006DF2C 40 82 00 40 */ bne lbl_8007212C .global lbl_800720F0 lbl_800720F0: /* 800720F0 0006DF30 7F 03 C3 78 */ mr r3, r24 /* 800720F4 0006DF34 4B FE 96 AD */ bl WPADiGetMplsStatus /* 800720F8 0006DF38 54 60 06 3E */ clrlwi r0, r3, 24 /* 800720FC 0006DF3C 28 00 00 04 */ cmplwi r0, 0x4 /* 80072100 0006DF40 40 82 00 0C */ bne lbl_8007210C /* 80072104 0006DF44 3B A0 00 00 */ li r29, 0x0 /* 80072108 0006DF48 48 00 00 24 */ b lbl_8007212C .global lbl_8007210C lbl_8007210C: /* 8007210C 0006DF4C 2C 00 00 00 */ cmpwi r0, 0x0 /* 80072110 0006DF50 41 82 00 1C */ beq lbl_8007212C /* 80072114 0006DF54 80 81 00 08 */ lwz r4, 0x8(r1) /* 80072118 0006DF58 20 64 00 05 */ subfic r3, r4, 0x5 /* 8007211C 0006DF5C 38 04 FF FB */ addi r0, r4, -0x5 /* 80072120 0006DF60 7C 60 03 78 */ or r0, r3, r0 /* 80072124 0006DF64 54 1D 0F FE */ srwi r29, r0, 31 /* 80072128 0006DF68 9B BF 00 C4 */ stb r29, 0xc4(r31) .global lbl_8007212C lbl_8007212C: /* 8007212C 0006DF6C 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80072130 0006DF70 2C 00 00 00 */ cmpwi r0, 0x0 /* 80072134 0006DF74 7C 60 F2 14 */ add r3, r0, r30 /* 80072138 0006DF78 41 82 01 14 */ beq lbl_8007224C /* 8007213C 0006DF7C 88 03 00 C4 */ lbz r0, 0xc4(r3) /* 80072140 0006DF80 7C 00 E8 00 */ cmpw r0, r29 /* 80072144 0006DF84 41 82 00 0C */ beq lbl_80072150 /* 80072148 0006DF88 C8 02 89 00 */ lfd f0, "@2679"@sda21(r2) /* 8007214C 0006DF8C D8 03 01 10 */ stfd f0, 0x110(r3) .global lbl_80072150 lbl_80072150: /* 80072150 0006DF90 57 A0 06 3E */ clrlwi r0, r29, 24 /* 80072154 0006DF94 3C E0 80 44 */ lis r7, mpls_assign_deg@ha /* 80072158 0006DF98 1C 00 00 0C */ mulli r0, r0, 0xc /* 8007215C 0006DF9C 3C C0 80 44 */ lis r6, mpls_assign_ct@ha /* 80072160 0006DFA0 9B A3 00 C4 */ stb r29, 0xc4(r3) /* 80072164 0006DFA4 38 E7 9F C8 */ addi r7, r7, mpls_assign_deg@l /* 80072168 0006DFA8 C8 82 89 18 */ lfd f4, "@2685_8055E898"@sda21(r2) /* 8007216C 0006DFAC 38 C6 9F EC */ addi r6, r6, mpls_assign_ct@l /* 80072170 0006DFB0 7C 87 00 2E */ lwzx r4, r7, r0 /* 80072174 0006DFB4 7C 06 00 2E */ lwzx r0, r6, r0 /* 80072178 0006DFB8 6C 84 80 00 */ xoris r4, r4, 0x8000 /* 8007217C 0006DFBC 90 81 00 14 */ stw r4, 0x14(r1) /* 80072180 0006DFC0 6C 00 80 00 */ xoris r0, r0, 0x8000 /* 80072184 0006DFC4 C8 62 89 10 */ lfd f3, "@2681"@sda21(r2) /* 80072188 0006DFC8 C8 01 00 10 */ lfd f0, 0x10(r1) /* 8007218C 0006DFCC 90 01 00 1C */ stw r0, 0x1c(r1) /* 80072190 0006DFD0 FC 20 20 28 */ fsub f1, f0, f4 /* 80072194 0006DFD4 C8 42 89 08 */ lfd f2, "@2680"@sda21(r2) /* 80072198 0006DFD8 C8 01 00 18 */ lfd f0, 0x18(r1) /* 8007219C 0006DFDC FC 23 08 24 */ fdiv f1, f3, f1 /* 800721A0 0006DFE0 FC 00 20 28 */ fsub f0, f0, f4 /* 800721A4 0006DFE4 FC 01 00 32 */ fmul f0, f1, f0 /* 800721A8 0006DFE8 FC 02 00 24 */ fdiv f0, f2, f0 /* 800721AC 0006DFEC FC 00 00 18 */ frsp f0, f0 /* 800721B0 0006DFF0 D0 03 00 5C */ stfs f0, 0x5c(r3) /* 800721B4 0006DFF4 88 03 00 C4 */ lbz r0, 0xc4(r3) /* 800721B8 0006DFF8 1C 00 00 0C */ mulli r0, r0, 0xc /* 800721BC 0006DFFC 7C 87 02 14 */ add r4, r7, r0 /* 800721C0 0006E000 80 A4 00 04 */ lwz r5, 0x4(r4) /* 800721C4 0006E004 7C 86 02 14 */ add r4, r6, r0 /* 800721C8 0006E008 80 04 00 04 */ lwz r0, 0x4(r4) /* 800721CC 0006E00C 6C A4 80 00 */ xoris r4, r5, 0x8000 /* 800721D0 0006E010 90 81 00 14 */ stw r4, 0x14(r1) /* 800721D4 0006E014 6C 00 80 00 */ xoris r0, r0, 0x8000 /* 800721D8 0006E018 C8 01 00 10 */ lfd f0, 0x10(r1) /* 800721DC 0006E01C 90 01 00 1C */ stw r0, 0x1c(r1) /* 800721E0 0006E020 FC 20 20 28 */ fsub f1, f0, f4 /* 800721E4 0006E024 C8 01 00 18 */ lfd f0, 0x18(r1) /* 800721E8 0006E028 FC 23 08 24 */ fdiv f1, f3, f1 /* 800721EC 0006E02C FC 00 20 28 */ fsub f0, f0, f4 /* 800721F0 0006E030 FC 01 00 32 */ fmul f0, f1, f0 /* 800721F4 0006E034 FC 02 00 24 */ fdiv f0, f2, f0 /* 800721F8 0006E038 FC 00 00 18 */ frsp f0, f0 /* 800721FC 0006E03C D0 03 00 60 */ stfs f0, 0x60(r3) /* 80072200 0006E040 88 03 00 C4 */ lbz r0, 0xc4(r3) /* 80072204 0006E044 1C 00 00 0C */ mulli r0, r0, 0xc /* 80072208 0006E048 7C 87 02 14 */ add r4, r7, r0 /* 8007220C 0006E04C 80 A4 00 08 */ lwz r5, 0x8(r4) /* 80072210 0006E050 7C 86 02 14 */ add r4, r6, r0 /* 80072214 0006E054 80 04 00 08 */ lwz r0, 0x8(r4) /* 80072218 0006E058 6C A4 80 00 */ xoris r4, r5, 0x8000 /* 8007221C 0006E05C 90 81 00 14 */ stw r4, 0x14(r1) /* 80072220 0006E060 6C 00 80 00 */ xoris r0, r0, 0x8000 /* 80072224 0006E064 C8 01 00 10 */ lfd f0, 0x10(r1) /* 80072228 0006E068 90 01 00 1C */ stw r0, 0x1c(r1) /* 8007222C 0006E06C FC 20 20 28 */ fsub f1, f0, f4 /* 80072230 0006E070 C8 01 00 18 */ lfd f0, 0x18(r1) /* 80072234 0006E074 FC 23 08 24 */ fdiv f1, f3, f1 /* 80072238 0006E078 FC 00 20 28 */ fsub f0, f0, f4 /* 8007223C 0006E07C FC 01 00 32 */ fmul f0, f1, f0 /* 80072240 0006E080 FC 02 00 24 */ fdiv f0, f2, f0 /* 80072244 0006E084 FC 00 00 18 */ frsp f0, f0 /* 80072248 0006E088 D0 03 00 64 */ stfs f0, 0x64(r3) .global lbl_8007224C lbl_8007224C: /* 8007224C 0006E08C 2C 1B 00 00 */ cmpwi r27, 0x0 /* 80072250 0006E090 40 81 01 B4 */ ble lbl_80072404 /* 80072254 0006E094 2C 1C 00 00 */ cmpwi r28, 0x0 /* 80072258 0006E098 41 82 01 AC */ beq lbl_80072404 /* 8007225C 0006E09C 2C 1D 00 02 */ cmpwi r29, 0x2 /* 80072260 0006E0A0 41 82 01 A4 */ beq lbl_80072404 /* 80072264 0006E0A4 C8 22 89 10 */ lfd f1, "@2681"@sda21(r2) /* 80072268 0006E0A8 FC 60 F8 18 */ frsp f3, f31 /* 8007226C 0006E0AC C8 02 89 70 */ lfd f0, "@3563"@sda21(r2) /* 80072270 0006E0B0 FC 41 07 F2 */ fmul f2, f1, f31 /* 80072274 0006E0B4 D0 7F 00 B4 */ stfs f3, 0xb4(r31) /* 80072278 0006E0B8 C8 22 89 00 */ lfd f1, "@2679"@sda21(r2) /* 8007227C 0006E0BC FC 00 07 F2 */ fmul f0, f0, f31 /* 80072280 0006E0C0 FC 40 10 18 */ frsp f2, f2 /* 80072284 0006E0C4 D0 5F 00 B8 */ stfs f2, 0xb8(r31) /* 80072288 0006E0C8 FC 00 00 18 */ frsp f0, f0 /* 8007228C 0006E0CC D0 1F 00 BC */ stfs f0, 0xbc(r31) /* 80072290 0006E0D0 C8 1F 01 10 */ lfd f0, 0x110(r31) /* 80072294 0006E0D4 FC 01 00 00 */ fcmpu cr0, f1, f0 /* 80072298 0006E0D8 40 82 00 0C */ bne lbl_800722A4 /* 8007229C 0006E0DC 7F 03 C3 78 */ mr r3, r24 /* 800722A0 0006E0E0 4B FF FC 01 */ bl set_calibration_data .global lbl_800722A4 lbl_800722A4: /* 800722A4 0006E0E4 80 1F 00 24 */ lwz r0, 0x24(r31) /* 800722A8 0006E0E8 7F 03 C3 78 */ mr r3, r24 /* 800722AC 0006E0EC 80 BF 00 20 */ lwz r5, 0x20(r31) /* 800722B0 0006E0F0 7F 44 D3 78 */ mr r4, r26 /* 800722B4 0006E0F4 90 BF 00 68 */ stw r5, 0x68(r31) /* 800722B8 0006E0F8 7F 65 DB 78 */ mr r5, r27 /* 800722BC 0006E0FC 90 1F 00 6C */ stw r0, 0x6c(r31) /* 800722C0 0006E100 80 1F 00 2C */ lwz r0, 0x2c(r31) /* 800722C4 0006E104 80 DF 00 28 */ lwz r6, 0x28(r31) /* 800722C8 0006E108 90 DF 00 70 */ stw r6, 0x70(r31) /* 800722CC 0006E10C 90 1F 00 74 */ stw r0, 0x74(r31) /* 800722D0 0006E110 80 1F 00 34 */ lwz r0, 0x34(r31) /* 800722D4 0006E114 80 DF 00 30 */ lwz r6, 0x30(r31) /* 800722D8 0006E118 90 DF 00 78 */ stw r6, 0x78(r31) /* 800722DC 0006E11C 90 1F 00 7C */ stw r0, 0x7c(r31) /* 800722E0 0006E120 80 1F 00 3C */ lwz r0, 0x3c(r31) /* 800722E4 0006E124 80 DF 00 38 */ lwz r6, 0x38(r31) /* 800722E8 0006E128 90 DF 00 80 */ stw r6, 0x80(r31) /* 800722EC 0006E12C 90 1F 00 84 */ stw r0, 0x84(r31) /* 800722F0 0006E130 80 1F 00 40 */ lwz r0, 0x40(r31) /* 800722F4 0006E134 90 1F 00 88 */ stw r0, 0x88(r31) /* 800722F8 0006E138 4B FF F0 E9 */ bl read_mpls /* 800722FC 0006E13C 88 1F 00 C0 */ lbz r0, 0xc0(r31) /* 80072300 0006E140 2C 00 00 00 */ cmpwi r0, 0x0 /* 80072304 0006E144 41 82 00 0C */ beq lbl_80072310 /* 80072308 0006E148 7F 03 C3 78 */ mr r3, r24 /* 8007230C 0006E14C 4B FF E0 C5 */ bl work_calibration .global lbl_80072310 lbl_80072310: /* 80072310 0006E150 88 1F 00 C7 */ lbz r0, 0xc7(r31) /* 80072314 0006E154 2C 00 00 00 */ cmpwi r0, 0x0 /* 80072318 0006E158 41 82 00 8C */ beq lbl_800723A4 /* 8007231C 0006E15C 80 0D EA 98 */ lwz r0, kmpls@sda21(r13) /* 80072320 0006E160 2C 00 00 00 */ cmpwi r0, 0x0 /* 80072324 0006E164 7C 60 F2 14 */ add r3, r0, r30 /* 80072328 0006E168 3B 43 00 08 */ addi r26, r3, 0x8 /* 8007232C 0006E16C 40 82 00 0C */ bne lbl_80072338 /* 80072330 0006E170 C3 E2 88 F0 */ lfs f31, "@2647_8055E870"@sda21(r2) /* 80072334 0006E174 48 00 00 68 */ b lbl_8007239C .global lbl_80072338 lbl_80072338: /* 80072338 0006E178 7F 43 D3 78 */ mr r3, r26 /* 8007233C 0006E17C 38 9A 00 18 */ addi r4, r26, 0x18 /* 80072340 0006E180 38 BA 00 60 */ addi r5, r26, 0x60 /* 80072344 0006E184 38 DA 00 84 */ addi r6, r26, 0x84 /* 80072348 0006E188 4B FF E3 19 */ bl move_mpls_orient /* 8007234C 0006E18C FF E0 08 90 */ fmr f31, f1 /* 80072350 0006E190 7F 43 D3 78 */ mr r3, r26 /* 80072354 0006E194 38 9A 00 24 */ addi r4, r26, 0x24 /* 80072358 0006E198 38 BA 00 6C */ addi r5, r26, 0x6c /* 8007235C 0006E19C 38 DA 00 90 */ addi r6, r26, 0x90 /* 80072360 0006E1A0 4B FF E3 01 */ bl move_mpls_orient /* 80072364 0006E1A4 FC 01 F8 40 */ fcmpo cr0, f1, f31 /* 80072368 0006E1A8 40 81 00 08 */ ble lbl_80072370 /* 8007236C 0006E1AC FF E0 08 90 */ fmr f31, f1 .global lbl_80072370 lbl_80072370: /* 80072370 0006E1B0 7F 43 D3 78 */ mr r3, r26 /* 80072374 0006E1B4 38 9A 00 30 */ addi r4, r26, 0x30 /* 80072378 0006E1B8 38 BA 00 78 */ addi r5, r26, 0x78 /* 8007237C 0006E1BC 38 DA 00 9C */ addi r6, r26, 0x9c /* 80072380 0006E1C0 4B FF E2 E1 */ bl move_mpls_orient /* 80072384 0006E1C4 FC 01 F8 40 */ fcmpo cr0, f1, f31 /* 80072388 0006E1C8 40 81 00 08 */ ble lbl_80072390 /* 8007238C 0006E1CC FF E0 08 90 */ fmr f31, f1 .global lbl_80072390 lbl_80072390: /* 80072390 0006E1D0 C0 22 89 3C */ lfs f1, "@3197_8055E8BC"@sda21(r2) /* 80072394 0006E1D4 38 7A 00 18 */ addi r3, r26, 0x18 /* 80072398 0006E1D8 48 00 02 09 */ bl __KMPLS_normalize_directionXYZ .global lbl_8007239C lbl_8007239C: /* 8007239C 0006E1DC D3 FF 00 F8 */ stfs f31, 0xf8(r31) /* 800723A0 0006E1E0 48 00 00 0C */ b lbl_800723AC .global lbl_800723A4 lbl_800723A4: /* 800723A4 0006E1E4 C0 02 88 F0 */ lfs f0, "@2647_8055E870"@sda21(r2) /* 800723A8 0006E1E8 D0 1F 00 F8 */ stfs f0, 0xf8(r31) .global lbl_800723AC lbl_800723AC: /* 800723AC 0006E1EC 88 1F 00 C8 */ lbz r0, 0xc8(r31) /* 800723B0 0006E1F0 2C 00 00 00 */ cmpwi r0, 0x0 /* 800723B4 0006E1F4 41 82 00 1C */ beq lbl_800723D0 /* 800723B8 0006E1F8 7F 03 C3 78 */ mr r3, r24 /* 800723BC 0006E1FC 38 9F 00 20 */ addi r4, r31, 0x20 /* 800723C0 0006E200 38 BC 00 0C */ addi r5, r28, 0xc /* 800723C4 0006E204 4B FF E4 4D */ bl revise_dir_acc /* 800723C8 0006E208 D0 3F 00 FC */ stfs f1, 0xfc(r31) /* 800723CC 0006E20C 48 00 00 0C */ b lbl_800723D8 .global lbl_800723D0 lbl_800723D0: /* 800723D0 0006E210 C0 02 88 F0 */ lfs f0, "@2647_8055E870"@sda21(r2) /* 800723D4 0006E214 D0 1F 00 FC */ stfs f0, 0xfc(r31) .global lbl_800723D8 lbl_800723D8: /* 800723D8 0006E218 88 1F 00 C9 */ lbz r0, 0xc9(r31) /* 800723DC 0006E21C 2C 00 00 00 */ cmpwi r0, 0x0 /* 800723E0 0006E220 41 82 00 1C */ beq lbl_800723FC /* 800723E4 0006E224 7F 03 C3 78 */ mr r3, r24 /* 800723E8 0006E228 7F 85 E3 78 */ mr r5, r28 /* 800723EC 0006E22C 38 9F 00 20 */ addi r4, r31, 0x20 /* 800723F0 0006E230 4B FF E6 D1 */ bl revise_dir_dpd /* 800723F4 0006E234 D0 3F 01 00 */ stfs f1, 0x100(r31) /* 800723F8 0006E238 48 00 00 0C */ b lbl_80072404 .global lbl_800723FC lbl_800723FC: /* 800723FC 0006E23C C0 02 88 F0 */ lfs f0, "@2647_8055E870"@sda21(r2) /* 80072400 0006E240 D0 1F 01 00 */ stfs f0, 0x100(r31) .global lbl_80072404 lbl_80072404: /* 80072404 0006E244 80 7F 00 08 */ lwz r3, 0x8(r31) /* 80072408 0006E248 80 1F 00 0C */ lwz r0, 0xc(r31) /* 8007240C 0006E24C 90 19 00 04 */ stw r0, 0x4(r25) /* 80072410 0006E250 90 79 00 00 */ stw r3, 0x0(r25) /* 80072414 0006E254 80 1F 00 10 */ lwz r0, 0x10(r31) /* 80072418 0006E258 90 19 00 08 */ stw r0, 0x8(r25) /* 8007241C 0006E25C 80 7F 00 14 */ lwz r3, 0x14(r31) /* 80072420 0006E260 80 1F 00 18 */ lwz r0, 0x18(r31) /* 80072424 0006E264 90 19 00 10 */ stw r0, 0x10(r25) /* 80072428 0006E268 90 79 00 0C */ stw r3, 0xc(r25) /* 8007242C 0006E26C 80 1F 00 1C */ lwz r0, 0x1c(r31) /* 80072430 0006E270 90 19 00 14 */ stw r0, 0x14(r25) /* 80072434 0006E274 80 7F 00 20 */ lwz r3, 0x20(r31) /* 80072438 0006E278 80 1F 00 24 */ lwz r0, 0x24(r31) /* 8007243C 0006E27C 90 19 00 1C */ stw r0, 0x1c(r25) /* 80072440 0006E280 90 79 00 18 */ stw r3, 0x18(r25) /* 80072444 0006E284 80 7F 00 28 */ lwz r3, 0x28(r31) /* 80072448 0006E288 80 1F 00 2C */ lwz r0, 0x2c(r31) /* 8007244C 0006E28C 90 19 00 24 */ stw r0, 0x24(r25) /* 80072450 0006E290 90 79 00 20 */ stw r3, 0x20(r25) /* 80072454 0006E294 80 7F 00 30 */ lwz r3, 0x30(r31) /* 80072458 0006E298 80 1F 00 34 */ lwz r0, 0x34(r31) /* 8007245C 0006E29C 90 19 00 2C */ stw r0, 0x2c(r25) /* 80072460 0006E2A0 90 79 00 28 */ stw r3, 0x28(r25) /* 80072464 0006E2A4 80 7F 00 38 */ lwz r3, 0x38(r31) /* 80072468 0006E2A8 80 1F 00 3C */ lwz r0, 0x3c(r31) /* 8007246C 0006E2AC 90 19 00 34 */ stw r0, 0x34(r25) /* 80072470 0006E2B0 90 79 00 30 */ stw r3, 0x30(r25) /* 80072474 0006E2B4 80 1F 00 40 */ lwz r0, 0x40(r31) /* 80072478 0006E2B8 90 19 00 38 */ stw r0, 0x38(r25) .global lbl_8007247C lbl_8007247C: /* 8007247C 0006E2BC 39 61 00 40 */ addi r11, r1, 0x40 /* 80072480 0006E2C0 E3 E1 00 48 */ psq_l f31, 0x48(r1), 0, qr0 /* 80072484 0006E2C4 CB E1 00 40 */ lfd f31, 0x40(r1) /* 80072488 0006E2C8 4B F9 4E F5 */ bl lbl_8000737C /* 8007248C 0006E2CC 80 01 00 54 */ lwz r0, 0x54(r1) /* 80072490 0006E2D0 7C 08 03 A6 */ mtlr r0 /* 80072494 0006E2D4 38 21 00 50 */ addi r1, r1, 0x50 /* 80072498 0006E2D8 4E 80 00 20 */ blr /* 8007249C 0006E2DC 00 00 00 00 */ .4byte 0x00000000 .global KMPLSSetSamplingCallback KMPLSSetSamplingCallback: /* 800724A0 0006E2E0 80 8D EA 98 */ lwz r4, kmpls@sda21(r13) /* 800724A4 0006E2E4 2C 04 00 00 */ cmpwi r4, 0x0 /* 800724A8 0006E2E8 4D 82 00 20 */ beqlr /* 800724AC 0006E2EC 90 64 00 04 */ stw r3, 0x4(r4) /* 800724B0 0006E2F0 4E 80 00 20 */ blr /* 800724B4 0006E2F4 00 00 00 00 */ .4byte 0x00000000 /* 800724B8 0006E2F8 00 00 00 00 */ .4byte 0x00000000 /* 800724BC 0006E2FC 00 00 00 00 */ .4byte 0x00000000 .include "macros.inc" .section .data, "wa" # 0x80421040 - 0x80496700 ; 0x000756C0 .global mpls_assign_deg mpls_assign_deg: .4byte 0x00000640 .4byte 0x00000640 .4byte 0x00000640 .4byte 0x00000640 .4byte 0x00000640 .4byte 0x00000640 .4byte 0x00000640 .4byte 0x00000640 .4byte 0x00000640 .global mpls_assign_ct mpls_assign_ct: .4byte 0x007FFFFF .4byte 0x007FFFFF .4byte 0x007FFFFF .4byte 0x007FFFFF .4byte 0x007FFFFF .4byte 0x007FFFFF .4byte 0x007FFFFF .4byte 0x007FFFFF .4byte 0x007FFFFF .include "macros.inc" .section .sbss, "", @nobits # 0x8055C6E0 - 0x8055DF80 ; 0x000018A0 .global kmpls kmpls: .skip 0x8 .include "macros.inc" .section .sdata2, "wa" # 0x8055DF80 - 0x805643C0 ; 0x00006440 .global "@2647_8055E870" "@2647_8055E870": .4byte 0 .global "@2648_8055E874" "@2648_8055E874": .4byte 0x3F800000 .global "@2649_8055E878" "@2649_8055E878": .4byte 0x3C23D70A .4byte 0 .global "@2679" "@2679": .4byte 0 .4byte 0 .global "@2680" "@2680": .4byte 0x3FF00000 .4byte 0 .global "@2681" "@2681": .4byte 0x40768000 .4byte 0 .global "@2685_8055E898" "@2685_8055E898": .4byte 0x43300000 .4byte 0x80000000 .global "@2757_8055E8A0" "@2757_8055E8A0": .4byte 0x3F000000 .global "@2758" "@2758": .4byte 0x3CF5C28F .global "@2817_8055E8A8" "@2817_8055E8A8": .4byte 0xBF800000 .global "@3075" "@3075": .4byte 0xBE4CCCCD .global "@3076" "@3076": .4byte 0x3E4CCCCD .global "@3077" "@3077": .4byte 0x3F400000 .global "@3168" "@3168": .4byte 0x3A83126F .global "@3197_8055E8BC" "@3197_8055E8BC": .4byte 0x403FEF9E .global "@3230" "@3230": .4byte 0x3EC489D2 .global "@3248_8055E8C4" "@3248_8055E8C4": .4byte 0x38D1B717 .global "@3259" "@3259": .4byte 0x40490000 .4byte 0 .global "@3260" "@3260": .4byte 0x3FB99999 .4byte 0x9999999A .global "@3261" "@3261": .4byte 0x3FE00000 .4byte 0 .global "@3463" "@3463": .4byte 0x44BB8000 .global "@3464" "@3464": .4byte 0x3F666666 .global "@3492_8055E8E8" "@3492_8055E8E8": .4byte 0x40B47AE1 .4byte 0x1EB851EC .global "@3563" "@3563": .4byte 0x401921FB .4byte 0x54442D18