1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
|
RomBase: ; 8000000
b Init
.include "asm/rom_header.s"
_080000C0:
.4byte 0
_080000C4:
.2byte 0
_080000C6:
.2byte 0
_080000C8:
.4byte 0
.incbin "base_emerald.gba", 0xCC, 0x204 - 0xCC
arm_func_start Init
Init:
mov r0, PSR_IRQ_MODE
msr cpsr_cf, r0
ldr sp, sp_irq
mov r0, PSR_SYS_MODE
msr cpsr_cf, r0
ldr sp, sp_sys
ldr r1, =INTR_VECTOR
adr r0, InterruptMain
str r0, [r1]
ldr r1, =Main + 1
mov lr, pc
bx r1
b Init
.align 2, 0
sp_sys: .4byte IWRAM_END - 0x1c0
sp_irq: .4byte IWRAM_END - 0x60
.pool
arm_func_end Init
arm_func_start InterruptMain
InterruptMain:
mov r3, REG_BASE
add r3, r3, 0x200
ldr r2, [r3, OFFSET_REG_IE - 0x200]
ldrh r1, [r3, OFFSET_REG_IME - 0x200]
mrs r0, spsr
stmdb sp!, {r0-r3,lr}
mov r0, 0
strh r0, [r3, OFFSET_REG_IME - 0x200]
and r1, r2, r2, lsr 16
mov r12, 0
ands r0, r1, INTR_FLAG_VCOUNT
bne @foundInterrupt
add r12, r12, 0x4
mov r0, 0x1
strh r0, [r3, OFFSET_REG_IME - 0x200]
ands r0, r1, INTR_FLAG_SERIAL
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_TIMER3
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_HBLANK
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_VBLANK
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_TIMER0
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_TIMER1
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_TIMER2
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_DMA0
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_DMA1
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_DMA2
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_DMA3
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_KEYPAD
bne @foundInterrupt
add r12, r12, 0x4
ands r0, r1, INTR_FLAG_GAMEPAK
strbne r0, [r3, OFFSET_REG_SOUNDCNT_X - 0x200]
@loop:
bne @loop
@foundInterrupt:
strh r0, [r3, OFFSET_REG_IF - 0x200]
bic r2, r2, r0
ldr r0, =0x03007868
ldr r0, [r0]
ldrb r0, [r0, 0xA]
mov r1, 0x8
mov r0, r1, lsl r0
orr r0, r0, INTR_FLAG_GAMEPAK
orr r1, r0, INTR_FLAG_SERIAL | INTR_FLAG_TIMER3 | INTR_FLAG_VCOUNT | INTR_FLAG_HBLANK
and r1, r1, r2
strh r1, [r3, OFFSET_REG_IE - 0x200]
mrs r3, cpsr
bic r3, r3, PSR_I_BIT | PSR_F_BIT | PSR_MODE_MASK
orr r3, r3, PSR_SYS_MODE
msr cpsr_cf, r3
ldr r1, =0x03002710
add r1, r1, r12
ldr r0, [r1]
stmdb sp!, {lr}
add lr, pc, 0
bx r0
ldmia sp!, {lr}
mrs r3, cpsr
bic r3, r3, PSR_I_BIT | PSR_F_BIT | PSR_MODE_MASK
orr r3, r3, PSR_I_BIT | PSR_IRQ_MODE
msr cpsr_cf, r3
ldmia sp!, {r0-r3,lr}
strh r2, [r3, OFFSET_REG_IE - 0x200]
strh r1, [r3, OFFSET_REG_IME - 0x200]
msr spsr_cf, r0
bx lr
.pool
arm_func_end InterruptMain
|
