mirror of
https://github.com/pret/pokeplatinum.git
synced 2026-04-26 00:32:20 -05:00
1366 lines
26 KiB
ArmAsm
1366 lines
26 KiB
ArmAsm
.include "macros/function.inc"
|
|
.include "include/unk_020A05BC.inc"
|
|
|
|
.extern Unk_021C3A38
|
|
.extern Unk_021C3A38
|
|
|
|
.text
|
|
|
|
|
|
arm_func_start sub_020A05BC
|
|
sub_020A05BC: ; 0x020A05BC
|
|
stmfd sp!, {r4, r5, r6, r7, r8, sb, sl, fp, lr}
|
|
sub sp, sp, #0x24
|
|
ldr r3, [r1, #0x20]
|
|
str r1, [sp]
|
|
ldr r6, [r3, #0x14]
|
|
mov r8, r0
|
|
ldrb r3, [r6, #8]
|
|
ldrb r0, [r6, #0xc]
|
|
str r2, [sp, #4]
|
|
mov r3, r3, lsl #0xc
|
|
mov r2, r3, asr #0x1f
|
|
mov r2, r2, lsl #4
|
|
mov r1, #0x800
|
|
mov r4, r3, lsl #4
|
|
adds r4, r4, r1
|
|
orr r2, r2, r3, lsr #28
|
|
adc r1, r2, #0
|
|
mov r5, r4, lsr #0xc
|
|
cmp r0, #0
|
|
mov r0, #0
|
|
str r0, [sp, #8]
|
|
orr r5, r5, r1, lsl #20
|
|
addle sp, sp, #0x24
|
|
ldmleia sp!, {r4, r5, r6, r7, r8, sb, sl, fp, lr}
|
|
bxle lr
|
|
ldr sb, _020A08CC ; =0x021C3A38
|
|
str r0, [sp, #0x18]
|
|
str r0, [sp, #0x14]
|
|
str r0, [sp, #0x1c]
|
|
str r0, [sp, #0x20]
|
|
mov r0, #0x1000
|
|
mov r4, r5, asr #0x1f
|
|
str r0, [sp, #0x10]
|
|
_020A0640:
|
|
ldr r0, [sp, #4]
|
|
bl sub_020A22B8
|
|
movs r7, r0
|
|
addeq sp, sp, #0x24
|
|
ldmeqia sp!, {r4, r5, r6, r7, r8, sb, sl, fp, lr}
|
|
bxeq lr
|
|
ldr r0, [sp]
|
|
mov r1, r7
|
|
add r0, r0, #0x14
|
|
bl sub_020A2304
|
|
add r0, r7, #0x38
|
|
add r1, r8, #8
|
|
str r0, [sp, #0xc]
|
|
add sl, r7, #8
|
|
ldmia r1, {r0, r1, r2}
|
|
stmia sl, {r0, r1, r2}
|
|
ldr sl, [r8, #0x14]
|
|
ldr ip, [sb]
|
|
ldr r1, _020A08D0 ; =0x5EEDF715
|
|
ldr r0, _020A08D4 ; =0x1B0CB173
|
|
mov r2, sl, asr #0x1f
|
|
mla r0, ip, r1, r0
|
|
str r0, [sb]
|
|
umull lr, ip, sl, r5
|
|
mla ip, sl, r4, ip
|
|
ldrsh r1, [r6, #2]
|
|
mov r0, r0, lsr #0x17
|
|
mla ip, r2, r5, ip
|
|
mul r0, r1, r0
|
|
mov r3, #0x800
|
|
adds r2, lr, r3
|
|
sub r0, r0, r1, lsl #8
|
|
adc sl, ip, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, sl, lsl #20
|
|
add r0, r2, r0, asr #8
|
|
str r0, [r7, #0x14]
|
|
ldr sl, [r8, #0x18]
|
|
ldr ip, [sb]
|
|
ldr r1, _020A08D0 ; =0x5EEDF715
|
|
ldr r0, _020A08D4 ; =0x1B0CB173
|
|
mov r2, sl, asr #0x1f
|
|
mla r0, ip, r1, r0
|
|
str r0, [sb]
|
|
umull lr, ip, sl, r5
|
|
mla ip, sl, r4, ip
|
|
mla ip, r2, r5, ip
|
|
adds r2, lr, r3
|
|
ldrsh r1, [r6, #2]
|
|
mov r0, r0, lsr #0x17
|
|
adc sl, ip, #0
|
|
mul r0, r1, r0
|
|
mov r2, r2, lsr #0xc
|
|
sub r0, r0, r1, lsl #8
|
|
orr r2, r2, sl, lsl #20
|
|
add r0, r2, r0, asr #8
|
|
str r0, [r7, #0x18]
|
|
ldr ip, [r8, #0x1c]
|
|
ldr sl, [sb]
|
|
ldr r1, _020A08D0 ; =0x5EEDF715
|
|
ldr r0, _020A08D4 ; =0x1B0CB173
|
|
mov r2, ip, asr #0x1f
|
|
mla r0, sl, r1, r0
|
|
umull sl, lr, ip, r5
|
|
str r0, [sb]
|
|
mla lr, ip, r4, lr
|
|
adds r3, sl, r3
|
|
mla lr, r2, r5, lr
|
|
ldrsh r1, [r6, #2]
|
|
mov r0, r0, lsr #0x17
|
|
adc r2, lr, #0
|
|
mul r0, r1, r0
|
|
mov r3, r3, lsr #0xc
|
|
orr r3, r3, r2, lsl #20
|
|
sub r0, r0, r1, lsl #8
|
|
add r0, r3, r0, asr #8
|
|
ldr r3, [sp, #0xc]
|
|
add fp, r8, #0x38
|
|
str r0, [r7, #0x1c]
|
|
ldmia fp, {r0, r1, r2}
|
|
stmia r3, {r0, r1, r2}
|
|
ldrb r0, [r6, #9]
|
|
ldrsh r1, [r8, #0x34]
|
|
ldr r2, [r8, #0x30]
|
|
add r0, r0, #1
|
|
mul r1, r2, r1
|
|
mov r1, r1, asr #0xc
|
|
mul r0, r1, r0
|
|
mov r0, r0, asr #6
|
|
str r0, [r7, #0x30]
|
|
ldr r0, [sp, #0x10]
|
|
strh r0, [r7, #0x34]
|
|
ldrh r0, [r6]
|
|
mov r0, r0, lsl #0x19
|
|
movs r0, r0, lsr #0x1f
|
|
ldrneh r0, [r6, #0xa]
|
|
strneh r0, [r7, #0x36]
|
|
ldreqh r0, [r8, #0x36]
|
|
streqh r0, [r7, #0x36]
|
|
ldrh r1, [r8, #0x2e]
|
|
ldrh r0, [r7, #0x2e]
|
|
mov r2, r1, lsl #0x1b
|
|
mov r1, r1, lsl #0x16
|
|
mov r1, r1, lsr #0x1b
|
|
mov r2, r2, lsr #0x1b
|
|
add r1, r1, #1
|
|
mul r1, r2, r1
|
|
mov r1, r1, lsl #0xb
|
|
mov r1, r1, lsr #0x10
|
|
bic r0, r0, #0x1f
|
|
and r1, r1, #0x1f
|
|
orr r0, r0, r1
|
|
strh r0, [r7, #0x2e]
|
|
ldrh r0, [r7, #0x2e]
|
|
bic r0, r0, #0x3e0
|
|
orr r0, r0, #0x3e0
|
|
strh r0, [r7, #0x2e]
|
|
ldrh r0, [r6]
|
|
mov r0, r0, lsl #0x1b
|
|
movs r0, r0, lsr #0x1e
|
|
beq _020A0844
|
|
cmp r0, #1
|
|
beq _020A0854
|
|
cmp r0, #2
|
|
ldreqh r0, [r8, #0x20]
|
|
streqh r0, [r7, #0x20]
|
|
ldreqsh r0, [r8, #0x22]
|
|
streqh r0, [r7, #0x22]
|
|
b _020A0864
|
|
_020A0844:
|
|
ldr r0, [sp, #0x14]
|
|
strh r0, [r7, #0x20]
|
|
strh r0, [r7, #0x22]
|
|
b _020A0864
|
|
_020A0854:
|
|
ldrh r0, [r8, #0x20]
|
|
strh r0, [r7, #0x20]
|
|
ldr r0, [sp, #0x18]
|
|
strh r0, [r7, #0x22]
|
|
_020A0864:
|
|
ldrh r1, [r6, #6]
|
|
ldr r0, _020A08D8 ; =0x0000FFFF
|
|
strh r1, [r7, #0x24]
|
|
ldr r1, [sp, #0x1c]
|
|
strh r1, [r7, #0x26]
|
|
ldrb r1, [r6, #0xf]
|
|
strb r1, [r7, #0x2c]
|
|
ldrh r1, [r8, #0x24]
|
|
mov r1, r1, lsr #1
|
|
bl _s32_div_f
|
|
strh r0, [r7, #0x28]
|
|
ldrh r1, [r8, #0x24]
|
|
ldr r0, _020A08D8 ; =0x0000FFFF
|
|
bl _s32_div_f
|
|
strh r0, [r7, #0x2a]
|
|
ldr r0, [sp, #0x20]
|
|
strb r0, [r7, #0x2d]
|
|
ldr r0, [sp, #8]
|
|
ldrb r1, [r6, #0xc]
|
|
add r0, r0, #1
|
|
str r0, [sp, #8]
|
|
cmp r0, r1
|
|
blt _020A0640
|
|
add sp, sp, #0x24
|
|
ldmia sp!, {r4, r5, r6, r7, r8, sb, sl, fp, lr}
|
|
bx lr
|
|
; .align 2, 0
|
|
_020A08CC: .word Unk_021C3A38
|
|
_020A08D0: .word 0x5EEDF715
|
|
_020A08D4: .word 0x1B0CB173
|
|
_020A08D8: .word 0x0000FFFF
|
|
arm_func_end sub_020A05BC
|
|
|
|
arm_func_start sub_020A08DC
|
|
sub_020A08DC: ; 0x020A08DC
|
|
stmfd sp!, {r4, r5, r6, r7, r8, sb, sl, fp, lr}
|
|
sub sp, sp, #0xc4
|
|
mov sb, r0
|
|
ldr r0, [sb, #0x20]
|
|
ldrsh r3, [sb, #0x4e]
|
|
str r0, [sp, #4]
|
|
ldr r0, [sb, #0x58]
|
|
ldr r2, _020A15E8 ; =0x00000FFF
|
|
add r3, r0, r3
|
|
ldr r0, [sp, #4]
|
|
str r1, [sp]
|
|
ldr r8, [r0]
|
|
and r0, r3, r2
|
|
strh r0, [sb, #0x4e]
|
|
ldr r0, [r8]
|
|
mov r0, r0, lsl #0x1c
|
|
mov r1, r0, lsr #0x1c
|
|
mov r0, r3, asr #0xc
|
|
cmp r1, #2
|
|
str r0, [sp, #0xc]
|
|
beq _020A0944
|
|
cmp r1, #3
|
|
beq _020A0944
|
|
sub r0, r1, #5
|
|
cmp r0, #4
|
|
bhi _020A094C
|
|
_020A0944:
|
|
mov r0, sb
|
|
bl sub_020A1768
|
|
_020A094C:
|
|
ldr r0, [sp, #0xc]
|
|
cmp r0, #0
|
|
mov r0, #0
|
|
str r0, [sp, #8]
|
|
addle sp, sp, #0xc4
|
|
ldmleia sp!, {r4, r5, r6, r7, r8, sb, sl, fp, lr}
|
|
bxle lr
|
|
str r0, [sp, #0x18]
|
|
str r0, [sp, #0x24]
|
|
str r0, [sp, #0x20]
|
|
str r0, [sp, #0x1c]
|
|
mov r0, #0x1000
|
|
str r0, [sp, #0x34]
|
|
ldr r0, [sp, #8]
|
|
ldr r6, _020A15EC ; =0x021C3A38
|
|
ldr r4, _020A15F0 ; =0x5EEDF715
|
|
ldr r5, _020A15F4 ; =0x1B0CB173
|
|
str r0, [sp, #0x38]
|
|
str r0, [sp, #0x3c]
|
|
str r0, [sp, #0x40]
|
|
_020A099C:
|
|
ldr r0, [sp]
|
|
bl sub_020A22B8
|
|
movs r7, r0
|
|
addeq sp, sp, #0xc4
|
|
ldmeqia sp!, {r4, r5, r6, r7, r8, sb, sl, fp, lr}
|
|
bxeq lr
|
|
add r0, sb, #8
|
|
mov r1, r7
|
|
bl sub_020A2304
|
|
ldr r0, [r8]
|
|
mov r0, r0, lsl #0x1c
|
|
mov r0, r0, lsr #0x1c
|
|
cmp r0, #9
|
|
addls pc, pc, r0, lsl #2
|
|
b _020A10DC
|
|
_020A09D8: ; jump table
|
|
b _020A0A00 ; case 0
|
|
b _020A0A1C ; case 1
|
|
b _020A0A8C ; case 2
|
|
b _020A0AF4 ; case 3
|
|
b _020A0B88 ; case 4
|
|
b _020A0C88 ; case 5
|
|
b _020A0F80 ; case 6
|
|
b _020A1004 ; case 7
|
|
b _020A0D44 ; case 8
|
|
b _020A0E14 ; case 9
|
|
_020A0A00:
|
|
ldr r0, [sp, #0x1c]
|
|
str r0, [r7, #0x10]
|
|
ldr r0, [r7, #0x10]
|
|
str r0, [r7, #0xc]
|
|
ldr r0, [r7, #0xc]
|
|
str r0, [r7, #8]
|
|
b _020A10DC
|
|
_020A0A1C:
|
|
add r0, r7, #8
|
|
bl sub_020A23B0
|
|
ldr r2, [r7, #8]
|
|
ldr r1, [sb, #0x5c]
|
|
mov r0, #0x800
|
|
smull r3, r1, r2, r1
|
|
adds r2, r3, r0
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
str r2, [r7, #8]
|
|
ldr r2, [r7, #0xc]
|
|
ldr r1, [sb, #0x5c]
|
|
smull r3, r1, r2, r1
|
|
adds r2, r3, r0
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
str r2, [r7, #0xc]
|
|
ldr r2, [r7, #0x10]
|
|
ldr r1, [sb, #0x5c]
|
|
smull r3, r1, r2, r1
|
|
adds r2, r3, r0
|
|
adc r0, r1, #0
|
|
mov r1, r2, lsr #0xc
|
|
orr r1, r1, r0, lsl #20
|
|
str r1, [r7, #0x10]
|
|
b _020A10DC
|
|
_020A0A8C:
|
|
add r0, sp, #0x58
|
|
bl sub_020A2354
|
|
ldr r2, [sp, #0x58]
|
|
ldr r0, [sb, #0x5c]
|
|
mov r1, #0x800
|
|
smull r3, r0, r2, r0
|
|
adds r2, r3, r1
|
|
adc r0, r0, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r0, lsl #20
|
|
str r2, [sp, #0x58]
|
|
ldr r3, [sp, #0x5c]
|
|
ldr r2, [sb, #0x5c]
|
|
add r0, r7, #8
|
|
smull sl, r2, r3, r2
|
|
adds r3, sl, r1
|
|
adc r1, r2, #0
|
|
mov r2, r3, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
ldr r1, [sp, #0x20]
|
|
str r2, [sp, #0x5c]
|
|
str r1, [sp, #0x60]
|
|
add r1, sp, #0x58
|
|
mov r2, sb
|
|
bl sub_020A1608
|
|
b _020A10DC
|
|
_020A0AF4:
|
|
ldr r0, [sp, #0x18]
|
|
ldr r1, [sp, #0xc]
|
|
bl _s32_div_f
|
|
ldr r1, [sp, #0x18]
|
|
mov r0, r0, asr #4
|
|
add r1, r1, #0x10000
|
|
mov r2, r0, lsl #1
|
|
str r1, [sp, #0x18]
|
|
ldr r0, _020A15F8 ; =0x020F983C
|
|
mov r1, r2, lsl #1
|
|
ldrsh r0, [r0, r1]
|
|
add r1, r2, #1
|
|
mov r2, r1, lsl #1
|
|
ldr r1, _020A15F8 ; =0x020F983C
|
|
ldrsh r3, [r1, r2]
|
|
ldr r2, [sb, #0x5c]
|
|
mov r1, #0x800
|
|
smull sl, r2, r0, r2
|
|
adds sl, sl, r1
|
|
adc r0, r2, #0
|
|
mov r2, sl, lsr #0xc
|
|
orr r2, r2, r0, lsl #20
|
|
str r2, [sp, #0x64]
|
|
ldr r2, [sb, #0x5c]
|
|
add r0, r7, #8
|
|
smull sl, r2, r3, r2
|
|
adds r3, sl, r1
|
|
adc r1, r2, #0
|
|
mov r2, r3, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
ldr r1, [sp, #0x24]
|
|
str r2, [sp, #0x68]
|
|
str r1, [sp, #0x6c]
|
|
add r1, sp, #0x64
|
|
mov r2, sb
|
|
bl sub_020A1608
|
|
b _020A10DC
|
|
_020A0B88:
|
|
add r0, r7, #8
|
|
bl sub_020A23B0
|
|
ldr r1, [r6, #0]
|
|
mov r0, #0x800
|
|
mla r2, r1, r4, r5
|
|
str r2, [r6, #0]
|
|
mov r1, r2, lsr #0x17
|
|
mov r1, r1, lsl #0xc
|
|
sub r1, r1, #0x100000
|
|
mov r1, r1, asr #8
|
|
ldr r3, [r7, #8]
|
|
ldr r2, [sb, #0x5c]
|
|
smull sl, r2, r3, r2
|
|
adds r3, sl, r0
|
|
adc r2, r2, #0
|
|
mov r3, r3, lsr #0xc
|
|
orr r3, r3, r2, lsl #20
|
|
smull r2, r1, r3, r1
|
|
adds r2, r2, r0
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
str r2, [r7, #8]
|
|
ldr r1, [r6, #0]
|
|
mla r2, r1, r4, r5
|
|
str r2, [r6, #0]
|
|
mov r1, r2, lsr #0x17
|
|
mov r1, r1, lsl #0xc
|
|
sub r1, r1, #0x100000
|
|
mov r1, r1, asr #8
|
|
ldr r3, [r7, #0xc]
|
|
ldr r2, [sb, #0x5c]
|
|
smull sl, r2, r3, r2
|
|
adds r3, sl, r0
|
|
adc r2, r2, #0
|
|
mov r3, r3, lsr #0xc
|
|
orr r3, r3, r2, lsl #20
|
|
smull r2, r1, r3, r1
|
|
adds r2, r2, r0
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
str r2, [r7, #0xc]
|
|
ldr r1, [r6, #0]
|
|
mla r2, r1, r4, r5
|
|
str r2, [r6, #0]
|
|
mov r1, r2, lsr #0x17
|
|
mov r1, r1, lsl #0xc
|
|
sub r1, r1, #0x100000
|
|
mov r1, r1, asr #8
|
|
ldr r3, [r7, #0x10]
|
|
ldr r2, [sb, #0x5c]
|
|
smull sl, r2, r3, r2
|
|
adds r3, sl, r0
|
|
adc r2, r2, #0
|
|
mov r3, r3, lsr #0xc
|
|
orr r3, r3, r2, lsl #20
|
|
smull r2, r1, r3, r1
|
|
adds r2, r2, r0
|
|
adc r0, r1, #0
|
|
mov r1, r2, lsr #0xc
|
|
orr r1, r1, r0, lsl #20
|
|
str r1, [r7, #0x10]
|
|
b _020A10DC
|
|
_020A0C88:
|
|
add r0, sp, #0x70
|
|
bl sub_020A2354
|
|
ldr r0, [r6, #0]
|
|
ldr r3, [sp, #0x70]
|
|
mla r1, r0, r4, r5
|
|
str r1, [r6, #0]
|
|
ldr r0, [sb, #0x5c]
|
|
mov r2, #0x800
|
|
smull sl, r0, r3, r0
|
|
adds sl, sl, r2
|
|
adc r3, r0, #0
|
|
mov r0, sl, lsr #0xc
|
|
orr r0, r0, r3, lsl #20
|
|
mov r3, r1, lsr #0x17
|
|
mov r3, r3, lsl #0xc
|
|
sub r3, r3, #0x100000
|
|
mov r3, r3, asr #8
|
|
smull sl, r3, r0, r3
|
|
adds sl, sl, r2
|
|
adc r0, r3, #0
|
|
mov r3, sl, lsr #0xc
|
|
orr r3, r3, r0, lsl #20
|
|
mla r0, r1, r4, r5
|
|
str r0, [r6, #0]
|
|
str r3, [sp, #0x70]
|
|
mov r0, r0, lsr #0x17
|
|
mov r0, r0, lsl #0xc
|
|
sub r0, r0, #0x100000
|
|
mov r1, r0, asr #8
|
|
ldr sl, [sp, #0x74]
|
|
ldr r3, [sb, #0x5c]
|
|
add r0, r7, #8
|
|
smull fp, r3, sl, r3
|
|
adds sl, fp, r2
|
|
adc r3, r3, #0
|
|
mov sl, sl, lsr #0xc
|
|
orr sl, sl, r3, lsl #20
|
|
smull r3, r1, sl, r1
|
|
adds r2, r3, r2
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
str r2, [sp, #0x74]
|
|
add r1, sp, #0x70
|
|
mov r2, sb
|
|
bl sub_020A1608
|
|
b _020A10DC
|
|
_020A0D44:
|
|
add r0, r7, #8
|
|
bl sub_020A23B0
|
|
add r0, sb, #0x84
|
|
add r1, sb, #0x8a
|
|
add r2, sp, #0x44
|
|
bl VEC_Fx16CrossProduct
|
|
ldrsh r1, [sp, #0x46]
|
|
ldrsh r0, [sp, #0x48]
|
|
ldrsh r2, [sp, #0x44]
|
|
str r1, [sp, #0x80]
|
|
str r0, [sp, #0x84]
|
|
add r0, sp, #0x7c
|
|
add r1, r7, #8
|
|
str r2, [sp, #0x7c]
|
|
bl VEC_DotProduct
|
|
cmp r0, #0
|
|
bgt _020A0DAC
|
|
ldr r0, [r7, #8]
|
|
rsb r0, r0, #0
|
|
str r0, [r7, #8]
|
|
ldr r0, [r7, #0xc]
|
|
rsb r0, r0, #0
|
|
str r0, [r7, #0xc]
|
|
ldr r0, [r7, #0x10]
|
|
rsb r0, r0, #0
|
|
str r0, [r7, #0x10]
|
|
_020A0DAC:
|
|
ldr r2, [r7, #8]
|
|
ldr r1, [sb, #0x5c]
|
|
mov r0, #0x800
|
|
smull r3, r1, r2, r1
|
|
adds r2, r3, r0
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
str r2, [r7, #8]
|
|
ldr r2, [r7, #0xc]
|
|
ldr r1, [sb, #0x5c]
|
|
smull r3, r1, r2, r1
|
|
adds r2, r3, r0
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
str r2, [r7, #0xc]
|
|
ldr r2, [r7, #0x10]
|
|
ldr r1, [sb, #0x5c]
|
|
smull r3, r1, r2, r1
|
|
adds r2, r3, r0
|
|
adc r0, r1, #0
|
|
mov r1, r2, lsr #0xc
|
|
orr r1, r1, r0, lsl #20
|
|
str r1, [r7, #0x10]
|
|
b _020A10DC
|
|
_020A0E14:
|
|
add r0, r7, #8
|
|
bl sub_020A23B0
|
|
add r0, sb, #0x84
|
|
add r1, sb, #0x8a
|
|
add r2, sp, #0x4a
|
|
bl VEC_Fx16CrossProduct
|
|
ldrsh r1, [sp, #0x4c]
|
|
ldrsh r0, [sp, #0x4e]
|
|
ldrsh r2, [sp, #0x4a]
|
|
str r1, [sp, #0x8c]
|
|
str r0, [sp, #0x90]
|
|
add r0, sp, #0x88
|
|
add r1, r7, #8
|
|
str r2, [sp, #0x88]
|
|
bl VEC_DotProduct
|
|
cmp r0, #0
|
|
bge _020A0E7C
|
|
ldr r0, [r7, #8]
|
|
rsb r0, r0, #0
|
|
str r0, [r7, #8]
|
|
ldr r0, [r7, #0xc]
|
|
rsb r0, r0, #0
|
|
str r0, [r7, #0xc]
|
|
ldr r0, [r7, #0x10]
|
|
rsb r0, r0, #0
|
|
str r0, [r7, #0x10]
|
|
_020A0E7C:
|
|
ldr r1, [r6, #0]
|
|
mov r0, #0x800
|
|
mla r2, r1, r4, r5
|
|
str r2, [r6, #0]
|
|
mov r1, r2, lsr #0x17
|
|
mov r1, r1, lsl #0xc
|
|
sub r1, r1, #0x100000
|
|
mov r1, r1, asr #9
|
|
add r1, r1, #0x800
|
|
ldr r3, [r7, #8]
|
|
ldr r2, [sb, #0x5c]
|
|
smull sl, r2, r3, r2
|
|
adds r3, sl, r0
|
|
adc r2, r2, #0
|
|
mov r3, r3, lsr #0xc
|
|
orr r3, r3, r2, lsl #20
|
|
smull r2, r1, r3, r1
|
|
adds r2, r2, r0
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
str r2, [r7, #8]
|
|
ldr r1, [r6, #0]
|
|
mla r2, r1, r4, r5
|
|
str r2, [r6, #0]
|
|
mov r1, r2, lsr #0x17
|
|
mov r1, r1, lsl #0xc
|
|
sub r1, r1, #0x100000
|
|
mov r1, r1, asr #9
|
|
add r1, r1, #0x800
|
|
ldr r3, [r7, #0xc]
|
|
ldr r2, [sb, #0x5c]
|
|
smull sl, r2, r3, r2
|
|
adds r3, sl, r0
|
|
adc r2, r2, #0
|
|
mov r3, r3, lsr #0xc
|
|
orr r3, r3, r2, lsl #20
|
|
smull r2, r1, r3, r1
|
|
adds r2, r2, r0
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
str r2, [r7, #0xc]
|
|
ldr r1, [r6, #0]
|
|
mla r2, r1, r4, r5
|
|
str r2, [r6, #0]
|
|
mov r1, r2, lsr #0x17
|
|
mov r1, r1, lsl #0xc
|
|
sub r1, r1, #0x100000
|
|
mov r1, r1, asr #9
|
|
add r1, r1, #0x800
|
|
ldr r3, [r7, #0x10]
|
|
ldr r2, [sb, #0x5c]
|
|
smull sl, r2, r3, r2
|
|
adds r3, sl, r0
|
|
adc r2, r2, #0
|
|
mov r3, r3, lsr #0xc
|
|
orr r3, r3, r2, lsl #20
|
|
smull r2, r1, r3, r1
|
|
adds r2, r2, r0
|
|
adc r0, r1, #0
|
|
mov r1, r2, lsr #0xc
|
|
orr r1, r1, r0, lsl #20
|
|
str r1, [r7, #0x10]
|
|
b _020A10DC
|
|
_020A0F80:
|
|
add r0, r7, #0x14
|
|
bl sub_020A2354
|
|
ldr r2, [r7, #0x14]
|
|
ldr r1, [sb, #0x5c]
|
|
mov r0, #0x800
|
|
smull r3, r1, r2, r1
|
|
adds r2, r3, r0
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
str r2, [sp, #0x94]
|
|
ldr r3, [r7, #0x18]
|
|
ldr r2, [sb, #0x5c]
|
|
ldr r1, [r6, #0]
|
|
smull sl, r2, r3, r2
|
|
adds r3, sl, r0
|
|
adc r0, r2, #0
|
|
mov r2, r3, lsr #0xc
|
|
orr r2, r2, r0, lsl #20
|
|
mla r0, r1, r4, r5
|
|
str r0, [r6, #0]
|
|
str r2, [sp, #0x98]
|
|
mov r1, r0, lsr #0x17
|
|
ldr r2, [sb, #0x60]
|
|
add r0, r7, #8
|
|
mul r1, r2, r1
|
|
sub r1, r1, r2, lsl #8
|
|
mov r1, r1, asr #8
|
|
str r1, [sp, #0x9c]
|
|
add r1, sp, #0x94
|
|
mov r2, sb
|
|
bl sub_020A1608
|
|
b _020A10DC
|
|
_020A1004:
|
|
add r0, r7, #0x14
|
|
bl sub_020A2354
|
|
ldr r0, [r6, #0]
|
|
mov r3, #0x800
|
|
mla r2, r0, r4, r5
|
|
str r2, [r6, #0]
|
|
ldr sl, [r7, #0x14]
|
|
ldr r0, [sb, #0x5c]
|
|
mov r1, r2, lsr #0x17
|
|
smull fp, r0, sl, r0
|
|
adds fp, fp, r3
|
|
mov r1, r1, lsl #0xc
|
|
adc sl, r0, #0
|
|
mov r0, fp, lsr #0xc
|
|
sub r1, r1, #0x100000
|
|
orr r0, r0, sl, lsl #20
|
|
mov r1, r1, asr #8
|
|
smull sl, r1, r0, r1
|
|
adds sl, sl, r3
|
|
adc r0, r1, #0
|
|
mov r1, sl, lsr #0xc
|
|
orr r1, r1, r0, lsl #20
|
|
str r1, [sp, #0xa0]
|
|
mla r1, r2, r4, r5
|
|
str r1, [r6, #0]
|
|
mov r2, r1, lsr #0x17
|
|
mov r2, r2, lsl #0xc
|
|
sub r2, r2, #0x100000
|
|
ldr sl, [r7, #0x18]
|
|
ldr r0, [sb, #0x5c]
|
|
mov r2, r2, asr #8
|
|
smull fp, r0, sl, r0
|
|
adds fp, fp, r3
|
|
adc sl, r0, #0
|
|
mov r0, fp, lsr #0xc
|
|
orr r0, r0, sl, lsl #20
|
|
smull sl, r2, r0, r2
|
|
adds r3, sl, r3
|
|
adc r0, r2, #0
|
|
mov r2, r3, lsr #0xc
|
|
orr r2, r2, r0, lsl #20
|
|
mla r0, r1, r4, r5
|
|
str r0, [r6, #0]
|
|
str r2, [sp, #0xa4]
|
|
mov r1, r0, lsr #0x17
|
|
ldr r2, [sb, #0x60]
|
|
add r0, r7, #8
|
|
mul r1, r2, r1
|
|
sub r1, r1, r2, lsl #8
|
|
mov r1, r1, asr #8
|
|
str r1, [sp, #0xa8]
|
|
add r1, sp, #0xa0
|
|
mov r2, sb
|
|
bl sub_020A1608
|
|
_020A10DC:
|
|
ldr r1, [r6, #0]
|
|
mla r0, r1, r4, r5
|
|
str r0, [r6, #0]
|
|
ldrb r2, [r8, #0x42]
|
|
mov r1, r0, lsr #0x18
|
|
ldr r3, [sb, #0x64]
|
|
mul r1, r2, r1
|
|
add r2, r2, #0xff
|
|
sub r1, r2, r1, asr #7
|
|
mul r1, r3, r1
|
|
mov r1, r1, asr #8
|
|
str r1, [sp, #0x10]
|
|
mla r1, r0, r4, r5
|
|
str r1, [r6, #0]
|
|
mov r0, r1, lsr #0x18
|
|
ldrb r2, [r8, #0x42]
|
|
ldr r3, [sb, #0x68]
|
|
ldr r1, [r8]
|
|
mul r0, r2, r0
|
|
add r2, r2, #0xff
|
|
sub r0, r2, r0, asr #7
|
|
mul r0, r3, r0
|
|
mov r0, r0, asr #8
|
|
str r0, [sp, #0x14]
|
|
mov r0, r1, lsl #0x1c
|
|
mov r0, r0, lsr #0x1c
|
|
cmp r0, #6
|
|
bne _020A1228
|
|
ldrsh r0, [sb, #0x84]
|
|
ldr r1, [r7, #0x14]
|
|
mov r2, #0x800
|
|
smull r3, r0, r1, r0
|
|
adds r1, r3, r2
|
|
ldrsh r3, [sb, #0x8a]
|
|
ldr lr, [r7, #0x18]
|
|
mov ip, r1, lsr #0xc
|
|
smull sl, r3, lr, r3
|
|
adc r0, r0, #0
|
|
adds sl, sl, r2
|
|
orr ip, ip, r0, lsl #20
|
|
adc r3, r3, #0
|
|
mov sl, sl, lsr #0xc
|
|
orr sl, sl, r3, lsl #20
|
|
add r3, ip, sl
|
|
str r3, [sp, #0xb8]
|
|
ldrsh sl, [sb, #0x86]
|
|
ldr r3, [r7, #0x14]
|
|
ldrsh lr, [sb, #0x8c]
|
|
smull ip, sl, r3, sl
|
|
adds ip, ip, r2
|
|
ldr fp, [r7, #0x18]
|
|
adc sl, sl, #0
|
|
smull r3, lr, fp, lr
|
|
mov ip, ip, lsr #0xc
|
|
adds r3, r3, r2
|
|
orr ip, ip, sl, lsl #20
|
|
adc sl, lr, #0
|
|
mov r3, r3, lsr #0xc
|
|
orr r3, r3, sl, lsl #20
|
|
add r3, ip, r3
|
|
str r3, [sp, #0xbc]
|
|
ldr sl, [r7, #0x18]
|
|
ldrsh fp, [sb, #0x88]
|
|
ldr r3, [r7, #0x14]
|
|
str sl, [sp, #0x28]
|
|
smull ip, fp, r3, fp
|
|
ldrsh sl, [sb, #0x8e]
|
|
ldr r3, [sp, #0x28]
|
|
adds ip, ip, r2
|
|
smull sl, lr, r3, sl
|
|
adc r3, fp, #0
|
|
adds r2, sl, r2
|
|
mov sl, ip, lsr #0xc
|
|
orr sl, sl, r3, lsl #20
|
|
adc r3, lr, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r3, lsl #20
|
|
add r2, sl, r2
|
|
add r0, sp, #0xb8
|
|
add r1, sp, #0xac
|
|
str r2, [sp, #0xc0]
|
|
bl VEC_Normalize
|
|
b _020A1264
|
|
_020A1228:
|
|
ldr r0, [r7, #8]
|
|
cmp r0, #0
|
|
bne _020A1258
|
|
ldr r0, [r7, #0xc]
|
|
cmp r0, #0
|
|
bne _020A1258
|
|
ldr r0, [r7, #0x10]
|
|
cmp r0, #0
|
|
bne _020A1258
|
|
add r0, sp, #0xac
|
|
bl sub_020A23B0
|
|
b _020A1264
|
|
_020A1258:
|
|
add r0, r7, #8
|
|
add r1, sp, #0xac
|
|
bl VEC_Normalize
|
|
_020A1264:
|
|
ldr r2, [sp, #0xac]
|
|
ldr r1, [sp, #0x10]
|
|
mov r0, #0x800
|
|
smull sl, r1, r2, r1
|
|
adds r2, sl, r0
|
|
add sl, sb, #0x28
|
|
str sl, [sp, #0x2c]
|
|
add sl, r7, #0x38
|
|
str sl, [sp, #0x30]
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
ldrsh r1, [sb, #0x50]
|
|
ldr sl, [sp, #0x14]
|
|
ldr r3, [sb, #0x40]
|
|
smull fp, sl, r1, sl
|
|
adds fp, fp, r0
|
|
adc r1, sl, #0
|
|
mov sl, fp, lsr #0xc
|
|
orr sl, sl, r1, lsl #20
|
|
add r1, r2, sl
|
|
add r1, r3, r1
|
|
str r1, [r7, #0x14]
|
|
ldr r3, [sp, #0xb0]
|
|
ldr r1, [sp, #0x10]
|
|
ldrsh sl, [sb, #0x52]
|
|
smull fp, r1, r3, r1
|
|
adds fp, fp, r0
|
|
adc r3, r1, #0
|
|
mov r1, fp, lsr #0xc
|
|
orr r1, r1, r3, lsl #20
|
|
ldr r3, [sp, #0x14]
|
|
ldr r2, [sb, #0x44]
|
|
smull fp, r3, sl, r3
|
|
adds sl, fp, r0
|
|
adc r3, r3, #0
|
|
mov sl, sl, lsr #0xc
|
|
orr sl, sl, r3, lsl #20
|
|
add r1, r1, sl
|
|
add r1, r2, r1
|
|
str r1, [r7, #0x18]
|
|
ldr r1, [sp, #0xb4]
|
|
ldr r2, [sp, #0x10]
|
|
ldrsh lr, [sb, #0x54]
|
|
smull sl, r3, r1, r2
|
|
ldr r1, [sp, #0x14]
|
|
adds sl, sl, r0
|
|
smull r2, r1, lr, r1
|
|
adc r3, r3, #0
|
|
adds r0, r2, r0
|
|
mov r2, sl, lsr #0xc
|
|
orr r2, r2, r3, lsl #20
|
|
adc r1, r1, #0
|
|
mov r0, r0, lsr #0xc
|
|
orr r0, r0, r1, lsl #20
|
|
ldr ip, [sb, #0x48]
|
|
add r0, r2, r0
|
|
add r0, ip, r0
|
|
str r0, [r7, #0x1c]
|
|
ldr r0, [sp, #0x2c]
|
|
ldr r3, [sp, #0x30]
|
|
ldmia r0, {r0, r1, r2}
|
|
stmia r3, {r0, r1, r2}
|
|
ldr r0, [r6, #0]
|
|
mla r1, r0, r4, r5
|
|
str r1, [r6, #0]
|
|
mov r0, r1, lsr #0x18
|
|
ldrb r1, [r8, #0x40]
|
|
ldr r2, [sb, #0x6c]
|
|
mul r0, r1, r0
|
|
add r1, r1, #0xff
|
|
sub r0, r1, r0, asr #7
|
|
mul r0, r2, r0
|
|
mov r0, r0, asr #8
|
|
str r0, [r7, #0x30]
|
|
ldr r0, [sp, #0x34]
|
|
strh r0, [r7, #0x34]
|
|
ldr r0, [r8]
|
|
mov r0, r0, lsl #0x16
|
|
movs r0, r0, lsr #0x1f
|
|
beq _020A141C
|
|
ldr r0, [sp, #4]
|
|
ldr r0, [r0, #8]
|
|
ldrh r0, [r0, #8]
|
|
mov r0, r0, lsl #0x1f
|
|
movs r0, r0, lsr #0x1f
|
|
beq _020A141C
|
|
ldr r0, [r6, #0]
|
|
ldr r3, _020A15FC ; =0x00000003
|
|
mla r1, r0, r4, r5
|
|
str r1, [r6, #0]
|
|
mov r0, r1, lsr #0x14
|
|
ldr r1, [sp, #4]
|
|
ldr r2, [r1, #8]
|
|
ldr r1, _020A1600 ; =0xAAAAAAAB
|
|
umull r1, sl, r0, r1
|
|
mov sl, sl, lsr #1
|
|
umull sl, fp, r3, sl
|
|
ldrh r1, [r2]
|
|
sub sl, r0, sl
|
|
strh r1, [sp, #0x50]
|
|
ldrh r0, [r8, #0x22]
|
|
mov r1, sl, lsl #1
|
|
strh r0, [sp, #0x52]
|
|
ldrh r0, [r2, #2]
|
|
strh r0, [sp, #0x54]
|
|
add r0, sp, #0x50
|
|
ldrh r0, [r0, r1]
|
|
strh r0, [r7, #0x36]
|
|
b _020A1424
|
|
_020A141C:
|
|
ldrh r0, [r8, #0x22]
|
|
strh r0, [r7, #0x36]
|
|
_020A1424:
|
|
ldrh r1, [r7, #0x2e]
|
|
ldrb r0, [sb, #0x81]
|
|
bic r1, r1, #0x1f
|
|
and r0, r0, #0x1f
|
|
orr r0, r1, r0
|
|
strh r0, [r7, #0x2e]
|
|
ldrh r0, [r7, #0x2e]
|
|
bic r0, r0, #0x3e0
|
|
orr r0, r0, #0x3e0
|
|
strh r0, [r7, #0x2e]
|
|
ldr r0, [r8]
|
|
mov r0, r0, lsl #0x12
|
|
movs r0, r0, lsr #0x1f
|
|
ldrne r0, [r6]
|
|
mlane r1, r0, r4, r5
|
|
strne r1, [r6]
|
|
strneh r1, [r7, #0x20]
|
|
ldreqh r0, [sb, #0x56]
|
|
streqh r0, [r7, #0x20]
|
|
ldr r0, [r8]
|
|
mov r0, r0, lsl #0x13
|
|
movs r0, r0, lsr #0x1f
|
|
ldreq r0, [sp, #0x38]
|
|
streqh r0, [r7, #0x22]
|
|
beq _020A14B4
|
|
ldr r0, [r6, #0]
|
|
mla r1, r0, r4, r5
|
|
str r1, [r6, #0]
|
|
mov r0, r1, lsr #0x14
|
|
ldrsh r2, [r8, #0x34]
|
|
ldrsh r1, [r8, #0x36]
|
|
sub r1, r1, r2
|
|
mul r0, r1, r0
|
|
add r0, r0, r2, lsl #12
|
|
mov r0, r0, lsr #0xc
|
|
strh r0, [r7, #0x22]
|
|
_020A14B4:
|
|
ldr r0, [r6, #0]
|
|
mla r1, r0, r4, r5
|
|
str r1, [r6, #0]
|
|
mov r0, r1, lsr #0x18
|
|
ldrb r1, [r8, #0x41]
|
|
ldrh r2, [sb, #0x70]
|
|
mul r0, r1, r0
|
|
mov r0, r0, asr #8
|
|
rsb r0, r0, #0xff
|
|
mul r0, r2, r0
|
|
mov r0, r0, asr #8
|
|
add r0, r0, #1
|
|
strh r0, [r7, #0x24]
|
|
ldr r0, [sp, #0x3c]
|
|
strh r0, [r7, #0x26]
|
|
ldr r0, [r8]
|
|
mov r0, r0, lsl #0x14
|
|
movs r1, r0, lsr #0x1f
|
|
beq _020A1544
|
|
ldr r0, [sp, #4]
|
|
ldr r0, [r0, #0x10]
|
|
ldr r0, [r0, #8]
|
|
mov r0, r0, lsl #0xf
|
|
movs r0, r0, lsr #0x1f
|
|
beq _020A1544
|
|
ldr r0, [r6, #0]
|
|
mla r1, r0, r4, r5
|
|
str r1, [r6, #0]
|
|
mov r0, r1, lsr #0x14
|
|
ldr r1, [sp, #4]
|
|
ldr sl, [r1, #0x10]
|
|
ldrb r1, [sl, #8]
|
|
bl _u32_div_f
|
|
ldrb r0, [sl, r1]
|
|
strb r0, [r7, #0x2c]
|
|
b _020A1574
|
|
_020A1544:
|
|
cmp r1, #0
|
|
beq _020A156C
|
|
ldr r0, [sp, #4]
|
|
ldr r1, [r0, #0x10]
|
|
ldr r0, [r1, #8]
|
|
mov r0, r0, lsl #0xf
|
|
movs r0, r0, lsr #0x1f
|
|
ldreqb r0, [r1]
|
|
streqb r0, [r7, #0x2c]
|
|
beq _020A1574
|
|
_020A156C:
|
|
ldrb r0, [r8, #0x47]
|
|
strb r0, [r7, #0x2c]
|
|
_020A1574:
|
|
ldr r1, [sp, #4]
|
|
ldr r0, _020A1604 ; =0x0000FFFF
|
|
ldr r1, [r1, #0]
|
|
ldrb r1, [r1, #0x48]
|
|
bl _s32_div_f
|
|
strh r0, [r7, #0x28]
|
|
ldrh r1, [r7, #0x24]
|
|
ldr r0, _020A1604 ; =0x0000FFFF
|
|
bl _s32_div_f
|
|
strh r0, [r7, #0x2a]
|
|
ldr r0, [sp, #0x40]
|
|
strb r0, [r7, #0x2d]
|
|
ldr r0, [r8]
|
|
mov r0, r0, lsl #0xb
|
|
movs r0, r0, lsr #0x1f
|
|
ldrne r0, [r6]
|
|
mlane r1, r0, r4, r5
|
|
strne r1, [r6]
|
|
movne r0, r1, lsr #0x18
|
|
strneb r0, [r7, #0x2d]
|
|
ldr r0, [sp, #8]
|
|
add r1, r0, #1
|
|
ldr r0, [sp, #0xc]
|
|
str r1, [sp, #8]
|
|
cmp r1, r0
|
|
blt _020A099C
|
|
add sp, sp, #0xc4
|
|
ldmia sp!, {r4, r5, r6, r7, r8, sb, sl, fp, lr}
|
|
bx lr
|
|
; .align 2, 0
|
|
_020A15E8: .word 0x00000FFF
|
|
_020A15EC: .word Unk_021C3A38
|
|
_020A15F0: .word 0x5EEDF715
|
|
_020A15F4: .word 0x1B0CB173
|
|
_020A15F8: .word 0x020F983C
|
|
_020A15FC: .word 0x00000003
|
|
_020A1600: .word 0xAAAAAAAB
|
|
_020A1604: .word 0x0000FFFF
|
|
arm_func_end sub_020A08DC
|
|
|
|
arm_func_start sub_020A1608
|
|
sub_020A1608: ; 0x020A1608
|
|
stmfd sp!, {r4, r5, r6, r7, r8, lr}
|
|
sub sp, sp, #8
|
|
mov r4, r2
|
|
mov r6, r0
|
|
mov r5, r1
|
|
add r2, sp, #0
|
|
add r0, r4, #0x84
|
|
add r1, r4, #0x8a
|
|
bl VEC_Fx16CrossProduct
|
|
add r0, sp, #0
|
|
mov r1, r0
|
|
bl VEC_Fx16Normalize
|
|
ldrsh r1, [sp]
|
|
ldr lr, [r5, #8]
|
|
ldrsh r0, [r4, #0x84]
|
|
ldr ip, [r5]
|
|
smull r3, r2, lr, r1
|
|
smull r1, r0, ip, r0
|
|
ldrsh r7, [r4, #0x8a]
|
|
ldr r8, [r5, #4]
|
|
mov ip, #0x800
|
|
smull lr, r7, r8, r7
|
|
adds r8, r3, ip
|
|
adc r3, r2, #0
|
|
mov r2, r8, lsr #0xc
|
|
adds r1, r1, ip
|
|
orr r2, r2, r3, lsl #20
|
|
adc r0, r0, #0
|
|
mov r3, r1, lsr #0xc
|
|
adds r1, lr, ip
|
|
orr r3, r3, r0, lsl #20
|
|
adc r0, r7, #0
|
|
mov r1, r1, lsr #0xc
|
|
orr r1, r1, r0, lsl #20
|
|
add r0, r3, r1
|
|
add r0, r2, r0
|
|
str r0, [r6, #0]
|
|
ldrsh r0, [sp, #2]
|
|
ldr r1, [r5, #8]
|
|
ldrsh r3, [r4, #0x86]
|
|
smull r2, r0, r1, r0
|
|
adds r2, r2, ip
|
|
ldr lr, [r5]
|
|
adc r1, r0, #0
|
|
mov r0, r2, lsr #0xc
|
|
orr r0, r0, r1, lsl #20
|
|
smull r8, r7, lr, r3
|
|
ldrsh r1, [r4, #0x8c]
|
|
ldr r2, [r5, #4]
|
|
adds r8, r8, ip
|
|
smull r3, r1, r2, r1
|
|
adc r2, r7, #0
|
|
mov r7, r8, lsr #0xc
|
|
orr r7, r7, r2, lsl #20
|
|
adds r2, r3, ip
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
add r1, r7, r2
|
|
add r0, r0, r1
|
|
str r0, [r6, #4]
|
|
ldrsh r0, [sp, #4]
|
|
ldr r1, [r5, #8]
|
|
ldr lr, [r5]
|
|
smull r3, r0, r1, r0
|
|
adds r3, r3, ip
|
|
adc r1, r0, #0
|
|
mov r0, r3, lsr #0xc
|
|
orr r0, r0, r1, lsl #20
|
|
ldrsh r3, [r4, #0x88]
|
|
ldrsh r1, [r4, #0x8e]
|
|
ldr r2, [r5, #4]
|
|
smull r5, r4, lr, r3
|
|
adds r5, r5, ip
|
|
smull r3, r1, r2, r1
|
|
adc r4, r4, #0
|
|
adds r2, r3, ip
|
|
mov r3, r5, lsr #0xc
|
|
adc r1, r1, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r3, r3, r4, lsl #20
|
|
orr r2, r2, r1, lsl #20
|
|
add r1, r3, r2
|
|
add r0, r0, r1
|
|
str r0, [r6, #8]
|
|
add sp, sp, #8
|
|
ldmia sp!, {r4, r5, r6, r7, r8, lr}
|
|
bx lr
|
|
arm_func_end sub_020A1608
|
|
|
|
arm_func_start sub_020A1768
|
|
sub_020A1768: ; 0x020A1768
|
|
stmfd sp!, {r4, r5, r6, lr}
|
|
sub sp, sp, #0x10
|
|
ldr r1, _020A19EC ; =0x02100DB0
|
|
mov r4, r0
|
|
ldrh r3, [r1]
|
|
ldrh r2, [r1, #2]
|
|
ldrh r0, [r1, #4]
|
|
strh r3, [sp]
|
|
strh r2, [sp, #2]
|
|
strh r0, [sp, #4]
|
|
ldr r0, [r4, #0x20]
|
|
ldr r0, [r0, #0]
|
|
ldr r0, [r0, #0]
|
|
mov r0, r0, lsl #0x18
|
|
movs r0, r0, lsr #0x1e
|
|
beq _020A17E8
|
|
cmp r0, #1
|
|
beq _020A17D0
|
|
cmp r0, #2
|
|
bne _020A1800
|
|
mov r0, #0
|
|
mov r1, #0x1000
|
|
strh r1, [sp, #6]
|
|
strh r0, [sp, #8]
|
|
strh r0, [sp, #0xa]
|
|
b _020A180C
|
|
_020A17D0:
|
|
mov r1, #0
|
|
mov r0, #0x1000
|
|
strh r1, [sp, #6]
|
|
strh r0, [sp, #8]
|
|
strh r1, [sp, #0xa]
|
|
b _020A180C
|
|
_020A17E8:
|
|
mov r1, #0
|
|
mov r0, #0x1000
|
|
strh r1, [sp, #6]
|
|
strh r1, [sp, #8]
|
|
strh r0, [sp, #0xa]
|
|
b _020A180C
|
|
_020A1800:
|
|
add r1, sp, #6
|
|
add r0, r4, #0x50
|
|
bl VEC_Fx16Normalize
|
|
_020A180C:
|
|
add r0, sp, #0
|
|
add r1, sp, #6
|
|
bl VEC_Fx16DotProduct
|
|
cmp r0, #0x1000
|
|
beq _020A1830
|
|
mov r1, #0x1000
|
|
rsb r1, r1, #0
|
|
cmp r0, r1
|
|
bne _020A1844
|
|
_020A1830:
|
|
mov r0, #0
|
|
mov r1, #0x1000
|
|
strh r1, [sp]
|
|
strh r0, [sp, #2]
|
|
strh r0, [sp, #4]
|
|
_020A1844:
|
|
ldrsh r3, [sp, #8]
|
|
ldrsh r1, [sp, #4]
|
|
ldrsh r2, [sp, #0xa]
|
|
ldrsh r0, [sp, #2]
|
|
smull r6, r5, r3, r1
|
|
mov r1, #0x800
|
|
adds r6, r6, r1
|
|
smull r3, r0, r2, r0
|
|
adc r5, r5, #0
|
|
adds r2, r3, r1
|
|
mov r3, r6, lsr #0xc
|
|
adc r0, r0, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r3, r3, r5, lsl #20
|
|
orr r2, r2, r0, lsl #20
|
|
sub r0, r3, r2
|
|
strh r0, [r4, #0x84]
|
|
ldrsh r5, [sp, #0xa]
|
|
ldrsh r3, [sp]
|
|
ldrsh r2, [sp, #6]
|
|
ldrsh r0, [sp, #4]
|
|
smull r3, r6, r5, r3
|
|
adds ip, r3, r1
|
|
smull r3, r0, r2, r0
|
|
adc r5, r6, #0
|
|
adds r2, r3, r1
|
|
mov r3, ip, lsr #0xc
|
|
adc r0, r0, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r3, r3, r5, lsl #20
|
|
orr r2, r2, r0, lsl #20
|
|
sub r0, r3, r2
|
|
strh r0, [r4, #0x86]
|
|
ldrsh r5, [sp, #6]
|
|
ldrsh r3, [sp, #2]
|
|
ldrsh r2, [sp, #8]
|
|
ldrsh r0, [sp]
|
|
smull r3, r6, r5, r3
|
|
adds ip, r3, r1
|
|
smull r3, r0, r2, r0
|
|
adc r5, r6, #0
|
|
adds r2, r3, r1
|
|
mov r3, ip, lsr #0xc
|
|
adc r0, r0, #0
|
|
mov r2, r2, lsr #0xc
|
|
orr r3, r3, r5, lsl #20
|
|
orr r2, r2, r0, lsl #20
|
|
sub r0, r3, r2
|
|
strh r0, [r4, #0x88]
|
|
ldrsh r6, [sp, #8]
|
|
ldrsh r5, [r4, #0x88]
|
|
add r0, r4, #0x84
|
|
ldrsh r3, [sp, #0xa]
|
|
ldrsh r2, [r4, #0x86]
|
|
smull r5, ip, r6, r5
|
|
adds lr, r5, r1
|
|
smull r5, r2, r3, r2
|
|
adc r6, ip, #0
|
|
adds r3, r5, r1
|
|
mov r5, lr, lsr #0xc
|
|
adc r2, r2, #0
|
|
mov r3, r3, lsr #0xc
|
|
orr r5, r5, r6, lsl #20
|
|
orr r3, r3, r2, lsl #20
|
|
sub r2, r5, r3
|
|
strh r2, [r4, #0x8a]
|
|
ldrsh r6, [sp, #0xa]
|
|
ldrsh r5, [r4, #0x84]
|
|
ldrsh r3, [sp, #6]
|
|
ldrsh r2, [r4, #0x88]
|
|
smull lr, ip, r6, r5
|
|
smull r5, r2, r3, r2
|
|
adds r6, lr, r1
|
|
adc r3, ip, #0
|
|
mov r6, r6, lsr #0xc
|
|
orr r6, r6, r3, lsl #20
|
|
adds r3, r5, r1
|
|
adc r2, r2, #0
|
|
mov r3, r3, lsr #0xc
|
|
orr r3, r3, r2, lsl #20
|
|
sub r2, r6, r3
|
|
strh r2, [r4, #0x8c]
|
|
ldrsh lr, [sp, #6]
|
|
ldrsh ip, [r4, #0x86]
|
|
ldrsh r3, [sp, #8]
|
|
ldrsh r2, [r4, #0x84]
|
|
smull r6, r5, lr, ip
|
|
smull ip, r2, r3, r2
|
|
adds r6, r6, r1
|
|
adc r5, r5, #0
|
|
adds r3, ip, r1
|
|
mov r6, r6, lsr #0xc
|
|
orr r6, r6, r5, lsl #20
|
|
adc r1, r2, #0
|
|
mov r2, r3, lsr #0xc
|
|
orr r2, r2, r1, lsl #20
|
|
sub r1, r6, r2
|
|
strh r1, [r4, #0x8e]
|
|
mov r1, r0
|
|
bl VEC_Fx16Normalize
|
|
add r0, r4, #0x8a
|
|
mov r1, r0
|
|
bl VEC_Fx16Normalize
|
|
add sp, sp, #0x10
|
|
ldmia sp!, {r4, r5, r6, lr}
|
|
bx lr
|
|
; .align 2, 0
|
|
_020A19EC: .word Unk_02100DB0
|
|
arm_func_end sub_020A1768
|
|
|
|
.data
|
|
|
|
|
|
.global Unk_02100DB0
|
|
Unk_02100DB0: ; 0x02100DB0
|
|
.word 0x10000000
|
|
.space 0x2
|
|
|