.cpu arm946e-s
.arch armv5te

.section .text.start

.global _start
.arm
.align 2
_start:
    ldr r0, =gain_control
    svc 0x7B
    bl main
    b .

.global _f_open
_f_open:
    STMFD   SP!, {R4-R10,LR}
    SUB     SP, SP, #0x30
    ADD     r7, r0, #0
    LDR     R5, =0x809797C
    LDR     R5, [R5]
    ADD     R5, #8
    LDR     R1, =0x2EA0
    ADD     R0, R5, R1
    ADD     R1, SP, #8
    LDR     R4, =0x8061451
    BLX     R4
    MOV     R3, #0
    STR     R3, [SP,#0x1C]
    STR     R3, [SP]
    STR     R3, [SP,#4]
    ADD     R0, SP, #0x10
    MOV     R1, R5
    LDR     R2, [SP,#8]
    LDR     R3, [SP,#0xC]
    LDR     R4, =0x8063F91
    BLX     R4
    LDR     R6, [SP,#0x1C]
    ADD     R0, SP, #0x24
    MOV     R1, #4
    STR     R1, [R0]
    MOV     R1, #0x1C
    STR     R1, [R0,#8]
    ADD     r1, r7, #0
    STR     R1, [R0,#4]
    MOV     R0, #0
    STR     R0, [SP, #0x20]
    MOV     R3, #7
    STR     R3, [SP]
    STR     R0, [SP,#4]
    ADD     R1, SP, #0x20
    MOV     R2, #0
    ADD     R3, SP, #0x24
    LDR     R10, =0x8084739
    MOV     R0, R6
    BLX     R10
    LDR     R0, [SP, #0x20]
    ADD     SP, SP, #0x30
    LDMFD   SP!, {R4-R10,PC}

.global _f_read
_f_read:
    STMFD   SP!, {R4,LR}
    SUB     SP, SP, #0x20
    ADD     R3, SP, #0x10
    STR     R2, [SP,#0x8]
    LDR     R2, =0x80944C8
    STR     R2, [R3]
    STR     R1, [R3,#4]
    STR     R3, [SP,#0x0]
    MOV     R1, #0
    STR     R1, [SP,#0x4]
    ADD     R1, SP, #0xC
    mov     R2, #0
    MOV     R3, #0
    LDR     R4, [R0]
    LDR     R4, [R4, #0x38]
    BLX     R4
    ADD     SP, SP, #0x20
    LDMFD   SP!, {R4,PC}

.global _f_write
_f_write:
    STMFD   SP!, {R3-R12,LR}
    SUB     SP, SP, #0x20
    ADD     R3, SP, #0x10
    STR     R2, [SP,#0x8]
    LDR     R2, =0x8094490
    STR     R2, [R3]
    STR     R1, [R3,#4]
    STR     R3, [SP,#0x0]
    MOV     R1, #0
    STR     R1, [SP,#0x4]
    ADD     R1, SP, #0xC
    MOV     R2, #0
    MOV     R3, #0
    LDR     R4, [R0]
    LDR     R4, [R4, #0x3C]
    BLX     R4
    ADD     SP, SP, #0x20
    LDMFD   SP!, {R3-R12,PC}

.global gain_control
gain_control:
    push {r5,r6,LR}

    MRS r5,CPSR
    MSR CPSR_c, #0xDF

    mov r6, sp
    ldr sp, =0x080f0000

    ldr r0, =0x10000035
    mcr p15, 0, r0, c6, c3, 0

    mrc p15, 0, r0, c2, c0, 0
    mrc p15, 0, r12, c2, c0, 1
    mrc p15, 0, r1, c3, c0, 0
    mrc p15, 0, r2, c5, c0, 2
    mrc p15, 0, r3, c5, c0, 3
    and r2,  r2 , #0xfff0ffff
    and r3,  r3 , #0xfff0ffff
    ldr r4, =0x33333333
    mov r2, r4
    mov r3, r4
    orr r0,  r0 , #0x00000010
    orr r12, r12, #0x00000010
    orr r1,  r1 , #0x00000010
    mcr p15, 0, r0,  c2, c0, 0
    mcr p15, 0, r12, c2, c0, 1
    mcr p15, 0, r1,  c3, c0, 0
    mcr p15, 0, r2,  c5, c0, 2
    mcr p15, 0, r3,  c5, c0, 3
    ldr r0, =0x18000035
    mcr p15, 0, r0,  c6, c4, 0

    mrc p15, 0, r0, c2, c0, 0
    mrc p15, 0, r1, c2, c0, 1
    mrc p15, 0, r2, c3, c0, 0
    orr r0,  r0 , #0x20
    orr r1,  r1,  #0x20
    orr r2,  r2 , #0x20
    mcr p15, 0, r0,  c2, c0, 0
    mcr p15, 0, r1,  c2, c0, 1
    mcr p15, 0, r2,  c3, c0, 0

    mov sp, r6
    MSR CPSR, r5

    pop {r5,r6,PC}