blob: 2e6d6ba71b2840b9625382010381f6bb5994e194 (
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
|
#include "ultra64.h"
OSTimer __osBaseTimer;
OSTime __osCurrentTime;
u32 __osBaseCounter;
u32 __osViIntrCount;
u32 __osTimerCounter;
OSTimer* __osTimerList = &__osBaseTimer;
void __osTimerServicesInit(void) {
__osCurrentTime = 0;
__osBaseCounter = 0;
__osViIntrCount = 0;
__osTimerList->next = __osTimerList->prev = __osTimerList;
__osTimerList->interval = __osTimerList->value = 0;
__osTimerList->mq = NULL;
__osTimerList->msg = NULL;
}
void __osTimerInterrupt(void) {
OSTimer* timer;
u32 sp20;
u32 sp1c;
if (__osTimerList->next == __osTimerList) {
return;
}
for (;;) {
timer = __osTimerList->next;
if (timer == __osTimerList) {
__osSetCompare(0);
__osTimerCounter = 0;
break;
}
sp20 = osGetCount();
sp1c = sp20 - __osTimerCounter;
__osTimerCounter = sp20;
if (sp1c < timer->value) {
timer->value -= sp1c;
__osSetTimerIntr(timer->value);
break;
}
timer->prev->next = timer->next;
timer->next->prev = timer->prev;
timer->next = NULL;
timer->prev = NULL;
if (timer->mq != NULL) {
osSendMesg(timer->mq, timer->msg, OS_MESG_NOBLOCK);
}
if (timer->interval != 0) {
timer->value = timer->interval;
__osInsertTimer(timer);
}
}
}
void __osSetTimerIntr(OSTime time) {
OSTime newTime;
u32 prevInt;
#if LIBULTRA_VERSION >= LIBULTRA_VERSION_K
if (time < 468) {
time = 468;
}
#endif
prevInt = __osDisableInt();
__osTimerCounter = osGetCount();
newTime = __osTimerCounter + time;
__osSetCompare((u32)newTime);
__osRestoreInt(prevInt);
}
OSTime __osInsertTimer(OSTimer* timer) {
OSTimer* nextTimer;
u64 timerValue;
u32 prevInt = __osDisableInt();
for (nextTimer = __osTimerList->next, timerValue = timer->value;
nextTimer != __osTimerList && timerValue > nextTimer->value;
timerValue -= nextTimer->value, nextTimer = nextTimer->next) {
;
}
timer->value = timerValue;
if (nextTimer != __osTimerList) {
nextTimer->value -= timerValue;
}
timer->next = nextTimer;
timer->prev = nextTimer->prev;
nextTimer->prev->next = timer;
nextTimer->prev = timer;
__osRestoreInt(prevInt);
return timerValue;
}
|
