summaryrefslogtreecommitdiff
path: root/arm7/asm/OS_alarm.s
blob: fe55ccb26ee531c1a2a559e2cecddbe899e6a794 (plain)
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
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
	.include "asm/macros.inc"
	.include "global.inc"

    .section .bss

	.global _03807930
_03807930: ;0x03807930
	.space 0x03807934 - 0x03807930

	.global _03807934
_03807934: ;0x03807934
	.space 0x0380793C - 0x03807934

	.section .text

	arm_func_start OSi_AlarmHandler
OSi_AlarmHandler: ; 0x037FA540
	stmdb	sp!, {r0, lr}
	bl	OSi_ArrangeTimer
	ldmia	sp!, {r0, lr}
	bx	lr

	arm_func_start OSi_ArrangeTimer
OSi_ArrangeTimer: ; 0x037FA550
	stmdb	sp!, {r4, r5, lr}
	sub	sp, sp, #4
	mov	r1, #0
	ldr	r0, _037FA644	; =0x04000106
	strh	r1, [r0]
	mov	r0, #16
	bl	OS_DisableIrqMask
	ldr	r1, _037FA648	; =0x0380FFF8
	ldr	r0, [r1]
	orr	r0, r0, #16
	str	r0, [r1]
	bl	OS_GetTick
	ldr	r2, _037FA64C	; =_03807934
	ldr	r4, [r2]
	cmp	r4, #0
	beq	_037FA638
	ldr	ip, [r4, #12]
	ldr	r3, [r4, #16]
	cmp	r1, r3
	cmpeq	r0, ip
	bcs	_037FA5B0
	mov	r0, r4
	bl	OSi_SetTimer
	b	_037FA638
_037FA5B0:
	ldr	r1, [r4, #24]
	str	r1, [r2]
	cmp	r1, #0
	moveq	r0, #0
	streq	r0, [r2, #4]
	movne	r0, #0
	strne	r0, [r1, #20]
	ldr	r5, [r4]
	ldr	r2, [r4, #28]
	ldr	r1, [r4, #32]
	mov	r0, #0
	cmp	r1, r0
	cmpeq	r2, r0
	streq	r0, [r4]
	cmp	r5, #0
	beq	_037FA5FC
	ldr	r0, [r4, #4]
	mov	lr, pc
	bx	r5
_037FA5FC:
	ldr	r2, [r4, #28]
	ldr	r0, [r4, #32]
	mov	r1, #0
	cmp	r0, r1
	cmpeq	r2, r1
	beq	_037FA624
	str	r5, [r4]
	mov	r0, r4
	mov	r2, r1
	bl	OSi_InsertAlarm
_037FA624:
	ldr	r0, _037FA64C	; =_03807934
	ldr	r0, [r0]
	cmp	r0, #0
	beq	_037FA638
	bl	OSi_SetTimer
_037FA638:
	add	sp, sp, #4
	ldmia	sp!, {r4, r5, lr}
	bx	lr
_037FA644:	.word	0x04000106
_037FA648:	.word	0x0380FFF8
_037FA64C:	.word	_03807934

	arm_func_start OS_CancelAlarm
OS_CancelAlarm: ; 0x037FA650
	stmdb	sp!, {r4, r5, lr}
	sub	sp, sp, #4
	mov	r5, r0
	bl	OS_DisableInterrupts
	mov	r4, r0
	ldr	r1, [r5]
	cmp	r1, #0
	bne	_037FA678
	bl	OS_RestoreInterrupts
	b	_037FA6D0
_037FA678:
	ldr	r0, [r5, #24]
	cmp	r0, #0
	ldreq	r2, [r5, #20]
	ldreq	r1, _037FA6DC	; =_03807934
	streq	r2, [r1, #4]
	ldrne	r1, [r5, #20]
	strne	r1, [r0, #20]
	ldr	r1, [r5, #20]
	cmp	r1, #0
	strne	r0, [r1, #24]
	bne	_037FA6B8
	ldr	r1, _037FA6DC	; =_03807934
	str	r0, [r1]
	cmp	r0, #0
	beq	_037FA6B8
	bl	OSi_SetTimer
_037FA6B8:
	mov	r0, #0
	str	r0, [r5]
	str	r0, [r5, #28]
	str	r0, [r5, #32]
	mov	r0, r4
	bl	OS_RestoreInterrupts
_037FA6D0:
	add	sp, sp, #4
	ldmia	sp!, {r4, r5, lr}
	bx	lr
_037FA6DC:	.word	_03807934

	arm_func_start OS_SetPeriodicAlarm
OS_SetPeriodicAlarm: ; 0x037FA6E0
	stmdb	sp!, {r4, r5, r6, r7, r8, r9, lr}
	sub	sp, sp, #4
	movs	r4, r0
	mov	r9, r1
	mov	r8, r2
	mov	r7, r3
	ldr	r6, [sp, #32]
	beq	_037FA70C
	ldr	r0, [r4]
	cmp	r0, #0
	beq	_037FA710
_037FA70C:
	bl	OS_Terminate
_037FA710:
	bl	OS_DisableInterrupts
	mov	r5, r0
	str	r7, [r4, #28]
	str	r6, [r4, #32]
	str	r9, [r4, #36]	; 0x24
	str	r8, [r4, #40]	; 0x28
	ldr	r0, [sp, #36]	; 0x24
	str	r0, [r4]
	ldr	r0, [sp, #40]	; 0x28
	str	r0, [r4, #4]
	mov	r0, r4
	mov	r1, #0
	mov	r2, r1
	bl	OSi_InsertAlarm
	mov	r0, r5
	bl	OS_RestoreInterrupts
	add	sp, sp, #4
	ldmia	sp!, {r4, r5, r6, r7, r8, r9, lr}
	bx	lr

	arm_func_start OS_SetAlarm
OS_SetAlarm: ; 0x037FA75C
	stmdb	sp!, {r4, r5, r6, r7, r8, lr}
	movs	r7, r0
	mov	r6, r1
	mov	r5, r2
	mov	r8, r3
	beq	_037FA780
	ldr	r0, [r7]
	cmp	r0, #0
	beq	_037FA784
_037FA780:
	bl	OS_Terminate
_037FA784:
	bl	OS_DisableInterrupts
	mov	r4, r0
	mov	r0, #0
	str	r0, [r7, #28]
	str	r0, [r7, #32]
	str	r8, [r7]
	ldr	r0, [sp, #24]
	str	r0, [r7, #4]
	bl	OS_GetTick
	mov	r2, r0
	mov	r0, r7
	adds	r3, r6, r2
	adc	r2, r5, r1
	mov	r1, r3
	bl	OSi_InsertAlarm
	mov	r0, r4
	bl	OS_RestoreInterrupts
	ldmia	sp!, {r4, r5, r6, r7, r8, lr}
	bx	lr

	arm_func_start OSi_InsertAlarm
OSi_InsertAlarm: ; 0x037FA7D0
	stmdb	sp!, {r4, r5, r6, r7, r8, lr}
	mov	r8, r0
	mov	r7, r1
	mov	r6, r2
	ldr	r2, [r8, #28]
	ldr	r1, [r8, #32]
	mov	r0, #0
	cmp	r1, r0
	cmpeq	r2, r0
	beq	_037FA84C
	bl	OS_GetTick
	ldr	r7, [r8, #36]	; 0x24
	ldr	r6, [r8, #40]	; 0x28
	cmp	r6, r1
	cmpeq	r7, r0
	bcs	_037FA84C
	ldr	r5, [r8, #28]
	ldr	r4, [r8, #32]
	subs	r0, r0, r7
	sbc	r1, r1, r6
	mov	r2, r5
	mov	r3, r4
	bl	_ll_udiv
	mov	r2, #1
	adds	r2, r0, r2
	adc	r0, r1, #0
	umull	r3, r1, r5, r2
	mla	r1, r5, r0, r1
	mla	r1, r4, r2, r1
	adds	r7, r7, r3
	adc	r6, r6, r1
_037FA84C:
	str	r7, [r8, #12]
	str	r6, [r8, #16]
	ldr	r0, _037FA8FC	; =_03807934
	ldr	r4, [r0]
	mov	r1, #0
	b	_037FA8B8
_037FA864:
	ldr	r2, [r4, #12]
	ldr	r0, [r4, #16]
	subs	r3, r7, r2
	sbc	r2, r6, r0
	subs	r0, r3, r1
	sbcs	r0, r2, r1
	bge	_037FA8B4
	ldr	r0, [r4, #20]
	str	r0, [r8, #20]
	str	r8, [r4, #20]
	str	r4, [r8, #24]
	ldr	r0, [r8, #20]
	cmp	r0, #0
	strne	r8, [r0, #24]
	bne	_037FA8F4
	ldr	r0, _037FA8FC	; =_03807934
	str	r8, [r0]
	mov	r0, r8
	bl	OSi_SetTimer
	b	_037FA8F4
_037FA8B4:
	ldr	r4, [r4, #24]
_037FA8B8:
	cmp	r4, #0
	bne	_037FA864
	mov	r0, #0
	str	r0, [r8, #24]
	ldr	r0, _037FA8FC	; =_03807934
	ldr	r1, [r0, #4]
	str	r8, [r0, #4]
	str	r1, [r8, #20]
	cmp	r1, #0
	strne	r8, [r1, #24]
	bne	_037FA8F4
	str	r8, [r0, #4]
	str	r8, [r0]
	mov	r0, r8
	bl	OSi_SetTimer
_037FA8F4:
	ldmia	sp!, {r4, r5, r6, r7, r8, lr}
	bx	lr
_037FA8FC:	.word	_03807934

	arm_func_start OS_CreateAlarm
OS_CreateAlarm: ; 0x037FA900
	mov	r1, #0
	str	r1, [r0]
	str	r1, [r0, #8]
	bx	lr

	arm_func_start OS_IsAlarmAvailable
OS_IsAlarmAvailable: ; 0x037FA910
	ldr	r0, _037FA91C	; =_03807930
	ldrh	r0, [r0]
	bx	lr
_037FA91C:	.word	_03807930

	arm_func_start OS_InitAlarm
OS_InitAlarm: ; 0x037FA920
	stmfd	sp!, {lr}
	sub	sp, sp, #4
	ldr	r1, _037FA968	; =_03807930
	ldrh	r0, [r1]
	cmp	r0, #0
	bne	_037FA95C
	mov	r0, #1
	strh	r0, [r1]
	bl	OSi_SetTimerReserved
	mov	r1, #0
	ldr	r0, _037FA96C	; =_03807934
	str	r1, [r0]
	str	r1, [r0, #4]
	mov	r0, #16
	bl	OS_DisableIrqMask
_037FA95C:
	add	sp, sp, #4
	ldmia	sp!, {lr}
	bx	lr
_037FA968:	.word	_03807930
_037FA96C:	.word	_03807934

	arm_func_start OSi_SetTimer
OSi_SetTimer: ; 0x037FA970
	stmdb	sp!, {r4, r5, lr}
	sub	sp, sp, #4
	mov	r4, r0
	bl	OS_GetTick
	mov	r2, #0
	ldr	r3, _037FA9FC	; =0x04000106
	strh	r2, [r3]
	ldr	ip, [r4, #12]
	ldr	r3, [r4, #16]
	subs	r5, ip, r0
	sbc	r4, r3, r1
	mov	r0, #1
	ldr	r1, _037FAA00	; =OSi_AlarmHandler
	bl	OSi_EnterTimerCallback
	mov	r1, #0
	subs	r0, r5, r1
	sbcs	r0, r4, r1
	ldrlt	r1, _037FAA04	; =0x0000FFFE
	blt	_037FA9D4
	mov	r0, #65536	; 0x10000
	subs	r0, r5, r0
	sbcs	r0, r4, r1
	mvnlt	r0, r5
	movlt	r0, r0, lsl #16
	movlt	r1, r0, lsr #16
_037FA9D4:
	ldr	r0, _037FAA08	; =0x04000104
	strh	r1, [r0]
	mov	r1, #193	; 0xc1
	ldr	r0, _037FA9FC	; =0x04000106
	strh	r1, [r0]
	mov	r0, #16
	bl	OS_EnableIrqMask
	add	sp, sp, #4
	ldmia	sp!, {r4, r5, lr}
	bx	lr
_037FA9FC:	.word	0x04000106
_037FAA00:	.word	OSi_AlarmHandler
_037FAA04:	.word	0x0000FFFE
_037FAA08:	.word	0x04000104