summaryrefslogtreecommitdiff
path: root/arm7/asm/OS_valarm.s
blob: bfd681df2313e7dc6ea2635b2fe11665399a3ac2 (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
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
	.include "asm/macros.inc"
	.include "global.inc"

    .section .bss

	.global _0380793C
_0380793C: ;0x0380793C
	.space 0x03807940 - 0x0380793C

	.global _03807940
_03807940: ;0x03807940
	.space 0x03807944 - 0x03807940

	.global _03807944
_03807944: ;0x03807944
	.space 0x03807948 - 0x03807944

	.global _03807948
_03807948: ;0x03807948
	.space 0x03807950 - 0x03807948

    .section .text

	arm_func_start OSi_GetVFrame
OSi_GetVFrame: ; 0x037FAA0C
	stmdb	sp!, {r4, lr}
	mov	r4, r0
	bl	OS_DisableInterrupts
	ldr	r1, _037FAA50	; =_03807940
	ldr	r1, [r1]
	cmp	r4, r1
	ldrlt	r1, _037FAA54	; =_03807944
	ldrlt	r2, [r1]
	addlt	r2, r2, #1
	strlt	r2, [r1]
	ldr	r1, _037FAA50	; =_03807940
	str	r4, [r1]
	bl	OS_RestoreInterrupts
	ldr	r0, _037FAA54	; =_03807944
	ldr	r0, [r0]
	ldmia	sp!, {r4, lr}
	bx	lr
_037FAA50:	.word	_03807940
_037FAA54:	.word	_03807944

	arm_func_start OSi_CompareVCount
OSi_CompareVCount: ; 0x037FAA58
	ldr	r3, [r0, #12]
	subs	r3, r1, r3
	ldrsh	r1, [r0, #16]
	sub	r2, r2, r1
	bmi	_037FAA7C
	cmp	r3, #0
	bne	_037FAA84
	cmp	r2, #0
	bge	_037FAA84
_037FAA7C:
	mov	r0, #0
	bx	lr
_037FAA84:
	cmp	r2, #0
	ldrlt	r1, _037FAAA4	; =0x00000107
	addlt	r2, r2, r1
	ldrsh	r0, [r0, #18]
	cmp	r2, r0
	movle	r0, #1
	movgt	r0, #2
	bx	lr
_037FAAA4:	.word	0x00000107

	arm_func_start OSi_VAlarmHandler
OSi_VAlarmHandler: ; 0x037FAAA8
	stmdb	sp!, {r4, r5, r6, r7, r8, r9, sl, fp, lr}
	sub	sp, sp, #4
	mov	r0, #4
	bl	OS_DisableIrqMask
	ldr	r2, _037FAC1C	; =0x04000004
	ldrh	r0, [r2]
	bic	r0, r0, #32
	strh	r0, [r2]
	ldr	r1, _037FAC20	; =0x0380FFF8
	ldr	r0, [r1]
	orr	r0, r0, #4
	str	r0, [r1]
	ldrh	r2, [r2]
	mov	r0, r2, asr #8
	and	r1, r0, #255	; 0xff
	mov	r0, r2, lsl #1
	and	r0, r0, #256	; 0x100
	orr	r0, r1, r0
	sub	r0, r0, #1
	bl	OSi_GetVFrame
	ldr	r9, _037FAC24	; =0x04000006
	mov	r6, #4
	ldr	r5, _037FAC1C	; =0x04000004
	mov	r4, #0
	ldr	fp, _037FAC28	; =_03807944
	b	_037FAC00
_037FAB10:
	ldrh	r8, [r9]
	mov	r0, r8
	bl	OSi_GetVFrame
	mov	r7, r0
	mov	r0, sl
	mov	r1, r7
	mov	r2, r8
	bl	OSi_CompareVCount
	cmp	r0, #0
	beq	_037FAB4C
	cmp	r0, #1
	beq	_037FAB8C
	cmp	r0, #2
	beq	_037FABE4
	b	_037FAC00
_037FAB4C:
	mov	r0, sl
	bl	OSi_SetNextVAlarm
	ldrh	r1, [r9]
	ldrsh	r0, [sl, #16]
	cmp	r0, r1
	bne	_037FAC10
	ldr	r0, [sl, #12]
	cmp	r0, r7
	bne	_037FAC10
	mov	r0, r6
	bl	OS_DisableIrqMask
	ldrh	r0, [r5]
	bic	r0, r0, #32
	strh	r0, [r5]
	mov	r0, r6
	bl	OS_ResetRequestIrqMask
_037FAB8C:
	ldr	r7, [sl]
	mov	r0, sl
	bl	OSi_DetachVAlarm
	str	r4, [sl]
	cmp	r7, #0
	beq	_037FABB0
	ldr	r0, [sl, #4]
	mov	lr, pc
	bx	r7
_037FABB0:
	ldr	r0, [sl, #28]
	cmp	r0, #0
	beq	_037FAC00
	ldr	r0, [sl, #36]	; 0x24
	cmp	r0, #0
	bne	_037FAC00
	str	r7, [sl]
	ldr	r0, [fp]
	add	r0, r0, #1
	str	r0, [sl, #12]
	mov	r0, sl
	bl	OSi_AppendVAlarm
	b	_037FAC00
_037FABE4:
	mov	r0, sl
	bl	OSi_DetachVAlarm
	mov	r0, sl
	bl	OSi_AppendVAlarm
	ldr	r0, [fp]
	add	r0, r0, #1
	str	r0, [sl, #12]
_037FAC00:
	ldr	r0, _037FAC2C	; =_03807948
	ldr	sl, [r0]
	cmp	sl, #0
	bne	_037FAB10
_037FAC10:
	add	sp, sp, #4
	ldmia	sp!, {r4, r5, r6, r7, r8, r9, sl, fp, lr}
	bx	lr
_037FAC1C:	.word	0x04000004
_037FAC20:	.word	0x0380FFF8
_037FAC24:	.word	0x04000006
_037FAC28:	.word	_03807944
_037FAC2C:	.word	_03807948

	arm_func_start OS_CancelVAlarms
OS_CancelVAlarms: ; 0x037FAC30
	stmdb	sp!, {r4, r5, r6, r7, lr}
	sub	sp, sp, #4
	mov	r7, r0
	bl	OS_DisableInterrupts
	mov	r5, r0
	cmp	r7, #0
	bne	_037FAC50
	bl	OS_Terminate
_037FAC50:
	ldr	r0, _037FACA8	; =_03807948
	ldr	r0, [r0]
	cmp	r0, #0
	ldrne	r6, [r0, #24]
	moveq	r6, #0
	mov	r4, #0
	b	_037FAC8C
_037FAC6C:
	ldr	r1, [r0, #8]
	cmp	r1, r7
	bne	_037FAC7C
	bl	OS_CancelVAlarm
_037FAC7C:
	mov	r0, r6
	cmp	r6, #0
	ldrne	r6, [r6, #24]
	moveq	r6, r4
_037FAC8C:
	cmp	r0, #0
	bne	_037FAC6C
	mov	r0, r5
	bl	OS_RestoreInterrupts
	add	sp, sp, #4
	ldmia	sp!, {r4, r5, r6, r7, lr}
	bx	lr
_037FACA8:	.word	_03807948

	arm_func_start OS_CancelVAlarm
OS_CancelVAlarm: ; 0x037FACAC
	stmdb	sp!, {r4, r5, lr}
	sub	sp, sp, #4
	mov	r5, r0
	bl	OS_DisableInterrupts
	mov	r4, r0
	mov	r1, #1
	str	r1, [r5, #36]	; 0x24
	ldr	r1, [r5]
	cmp	r1, #0
	bne	_037FACDC
	bl	OS_RestoreInterrupts
	b	_037FACF4
_037FACDC:
	mov	r0, r5
	bl	OSi_DetachVAlarm
	mov	r0, #0
	str	r0, [r5]
	mov	r0, r4
	bl	OS_RestoreInterrupts
_037FACF4:
	add	sp, sp, #4
	ldmia	sp!, {r4, r5, lr}
	bx	lr

	arm_func_start OS_SetVAlarmTag
OS_SetVAlarmTag: ; 0x037FAD00
	stmdb	sp!, {r4, r5, lr}
	sub	sp, sp, #4
	mov	r5, r0
	movs	r4, r1
	bne	_037FAD18
	bl	OS_Terminate
_037FAD18:
	cmp	r5, #0
	strne	r4, [r5, #8]
	add	sp, sp, #4
	ldmia	sp!, {r4, r5, lr}
	bx	lr

	arm_func_start OSi_SetNextVAlarm
OSi_SetNextVAlarm: ; 0x037FAD2C
	stmdb	sp!, {r4, lr}
	mov	r4, r0
	mov	r0, #4
	ldr	r1, _037FAD80	; =OSi_VAlarmHandler
	bl	OS_SetIrqFunction
	ldrsh	ip, [r4, #16]
	and	r3, ip, #256	; 0x100
	ldr	r1, _037FAD84	; =0x04000004
	ldrh	r0, [r1]
	and	r2, r0, #63	; 0x3f
	and	r0, ip, #255	; 0xff
	orr	r0, r2, r0, lsl #8
	orr	r0, r0, r3, asr #1
	strh	r0, [r1]
	ldrh	r0, [r1]
	orr	r0, r0, #32
	strh	r0, [r1]
	mov	r0, #4
	bl	OS_EnableIrqMask
	ldmia	sp!, {r4, lr}
	bx	lr
_037FAD80:	.word	OSi_VAlarmHandler
_037FAD84:	.word	0x04000004

	arm_func_start OS_SetPeriodicVAlarm
OS_SetPeriodicVAlarm: ; 0x037FAD88
	stmdb	sp!, {r4, r5, r6, r7, r8, r9, lr}
	sub	sp, sp, #4
	mov	r8, r0
	mov	r7, r1
	mov	r6, r2
	mov	r5, r3
	bl	OS_DisableInterrupts
	mov	r4, r0
	cmp	r8, #0
	beq	_037FADBC
	ldr	r0, [r8]
	cmp	r0, #0
	beq	_037FADC0
_037FADBC:
	bl	OS_Terminate
_037FADC0:
	ldr	r0, _037FAE1C	; =0x04000006
	ldrh	r9, [r0]
	mov	r0, r9
	bl	OSi_GetVFrame
	mov	r1, #1
	str	r1, [r8, #28]
	strh	r7, [r8, #16]
	cmp	r7, r9
	addle	r0, r0, #1
	str	r0, [r8, #12]
	strh	r6, [r8, #18]
	str	r5, [r8]
	ldr	r0, [sp, #32]
	str	r0, [r8, #4]
	mov	r0, #0
	str	r0, [r8, #36]	; 0x24
	mov	r0, r8
	bl	OSi_InsertVAlarm
	mov	r0, r4
	bl	OS_RestoreInterrupts
	add	sp, sp, #4
	ldmia	sp!, {r4, r5, r6, r7, r8, r9, lr}
	bx	lr
_037FAE1C:	.word	0x04000006

	arm_func_start OS_SetVAlarm
OS_SetVAlarm: ; 0x037FAE20
	stmdb	sp!, {r4, r5, r6, r7, r8, r9, lr}
	sub	sp, sp, #4
	mov	r8, r0
	mov	r7, r1
	mov	r6, r2
	mov	r5, r3
	bl	OS_DisableInterrupts
	mov	r4, r0
	cmp	r8, #0
	beq	_037FAE54
	ldr	r0, [r8]
	cmp	r0, #0
	beq	_037FAE58
_037FAE54:
	bl	OS_Terminate
_037FAE58:
	ldr	r0, _037FAEB4	; =0x04000006
	ldrh	r9, [r0]
	mov	r0, r9
	bl	OSi_GetVFrame
	mov	r1, #0
	str	r1, [r8, #28]
	strh	r7, [r8, #16]
	cmp	r7, r9
	addle	r0, r0, #1
	str	r0, [r8, #12]
	strh	r6, [r8, #18]
	str	r5, [r8]
	ldr	r0, [sp, #32]
	str	r0, [r8, #4]
	mov	r0, #0
	str	r0, [r8, #36]	; 0x24
	mov	r0, r8
	bl	OSi_InsertVAlarm
	mov	r0, r4
	bl	OS_RestoreInterrupts
	add	sp, sp, #4
	ldmia	sp!, {r4, r5, r6, r7, r8, r9, lr}
	bx	lr
_037FAEB4:	.word	0x04000006

	arm_func_start OS_CreateVAlarm
OS_CreateVAlarm: ; 0x037FAEB8
	mov	r1, #0
	str	r1, [r0]
	str	r1, [r0, #8]
	str	r1, [r0, #32]
	bx	lr

	arm_func_start OSi_DetachVAlarm
OSi_DetachVAlarm: ; 0x037FAECC
	cmp	r0, #0
	bxeq	lr
	ldr	r2, [r0, #20]
	ldr	r1, [r0, #24]
	cmp	r1, #0
	strne	r2, [r1, #20]
	ldreq	r0, _037FAF00	; =_03807948
	streq	r2, [r0, #4]
	cmp	r2, #0
	strne	r1, [r2, #24]
	ldreq	r0, _037FAF00	; =_03807948
	streq	r1, [r0]
	bx	lr
_037FAF00:	.word	_03807948

	arm_func_start OSi_AppendVAlarm
OSi_AppendVAlarm: ; 0x037FAF04
	stmfd	sp!, {lr}
	sub	sp, sp, #4
	ldr	r1, _037FAF44	; =_03807948
	ldr	r3, [r1, #4]
	str	r3, [r0, #20]
	mov	r2, #0
	str	r2, [r0, #24]
	str	r0, [r1, #4]
	cmp	r3, #0
	strne	r0, [r3, #24]
	bne	_037FAF38
	str	r0, [r1]
	bl	OSi_SetNextVAlarm
_037FAF38:
	add	sp, sp, #4
	ldmia	sp!, {lr}
	bx	lr
_037FAF44:	.word	_03807948

	arm_func_start OSi_InsertVAlarm
OSi_InsertVAlarm: ; 0x037FAF48
	stmfd	sp!, {lr}
	sub	sp, sp, #4
	ldr	r1, _037FAFCC	; =_03807948
	ldr	r3, [r1]
	b	_037FAFB4
_037FAF5C:
	ldr	r2, [r0, #12]
	ldr	r1, [r3, #12]
	cmp	r1, r2
	bcc	_037FAFB0
	cmp	r1, r2
	bne	_037FAF84
	ldrsh	r2, [r3, #16]
	ldrsh	r1, [r0, #16]
	cmp	r2, r1
	ble	_037FAFB0
_037FAF84:
	ldr	r1, [r3, #20]
	str	r1, [r0, #20]
	str	r3, [r0, #24]
	str	r0, [r3, #20]
	cmp	r1, #0
	strne	r0, [r1, #24]
	bne	_037FAFC0
	ldr	r1, _037FAFCC	; =_03807948
	str	r0, [r1]
	bl	OSi_SetNextVAlarm
	b	_037FAFC0
_037FAFB0:
	ldr	r3, [r3, #24]
_037FAFB4:
	cmp	r3, #0
	bne	_037FAF5C
	bl	OSi_AppendVAlarm
_037FAFC0:
	add	sp, sp, #4
	ldmia	sp!, {lr}
	bx	lr
_037FAFCC:	.word	_03807948

	arm_func_start OS_IsVAlarmAvailable
OS_IsVAlarmAvailable: ; 0x037FAFD0
	ldr	r0, _037FAFDC	; =_0380793C
	ldrh	r0, [r0]
	bx	lr
_037FAFDC:	.word	_0380793C

	arm_func_start OS_InitVAlarm
OS_InitVAlarm: ; 0x037FAFE0
	stmfd	sp!, {lr}
	sub	sp, sp, #4
	ldr	r0, _037FB038	; =_0380793C
	ldrh	r1, [r0]
	cmp	r1, #0
	bne	_037FB02C
	mov	r1, #1
	strh	r1, [r0]
	mov	r1, #0
	ldr	r0, _037FB03C	; =_03807948
	str	r1, [r0]
	str	r1, [r0, #4]
	mov	r0, #4
	bl	OS_DisableIrqMask
	mov	r1, #0
	ldr	r0, _037FB040	; =_03807944
	str	r1, [r0]
	ldr	r0, _037FB044	; =_03807940
	str	r1, [r0]
_037FB02C:
	add	sp, sp, #4
	ldmia	sp!, {lr}
	bx	lr
_037FB038:	.word	_0380793C
_037FB03C:	.word	_03807948
_037FB040:	.word	_03807944
_037FB044:	.word	_03807940