blob: fe926025ed7b8569593e944be64cdda015a4fb2a (
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
|
#include "PRinternal/macros.h"
#include "PR/os_internal.h"
#include "PRinternal/osint.h"
OSTime __osCurrentTime;
u32 __osBaseCounter;
u32 __osViIntrCount;
u32 __osTimerCounter;
OSTimer __osBaseTimer;
OSTimer* __osTimerList = &__osBaseTimer;
#ifndef _FINALROM
OSMesgQueue __osProfTimerQ ALIGNED(0x8);
OSProf* __osProfileList;
OSProf* __osProfileListEnd;
u32 __osProfileOverflowBin;
#endif
void __osTimerServicesInit(void) {
__osCurrentTime = 0;
__osBaseCounter = 0;
__osViIntrCount = 0;
__osTimerList->next = __osTimerList->prev = __osTimerList;
__osTimerList->interval = __osTimerList->value = 0;
__osTimerList->mq = NULL;
__osTimerList->msg = 0;
}
void __osTimerInterrupt(void) {
OSTimer* t;
u32 count;
u32 elapsed_cycles;
#ifndef _FINALROM
u32 pc;
s32 offset;
OSProf* prof = __osProfileList;
#endif
if (__osTimerList->next == __osTimerList) {
return;
}
for (;;) {
t = __osTimerList->next;
if (t == __osTimerList) {
__osSetCompare(0);
__osTimerCounter = 0;
break;
}
count = osGetCount();
elapsed_cycles = count - __osTimerCounter;
__osTimerCounter = count;
if (elapsed_cycles < t->value) {
t->value -= elapsed_cycles;
__osSetTimerIntr(t->value);
break;
}
t->prev->next = t->next;
t->next->prev = t->prev;
t->next = NULL;
t->prev = NULL;
if (t->mq != NULL) {
#ifdef _FINALROM
osSendMesg(t->mq, t->msg, OS_MESG_NOBLOCK);
}
#else
if (t->mq != &__osProfTimerQ) {
osSendMesg(t->mq, t->msg, OS_MESG_NOBLOCK);
} else {
pc = __osRunQueue->context.pc;
for (prof = __osProfileList; prof < __osProfileListEnd; prof++) {
offset = pc - (u32)prof->text_start;
if (offset >= 0) {
if ((s32)prof->text_end - (s32)pc > 0) {
(*(u16*)(u32)((offset >> 2) + prof->histo_base))++;
goto __ProfDone;
}
}
}
__osProfileOverflowBin++;
}
}
#endif
__ProfDone:
if (t->interval != 0) {
t->value = t->interval;
__osInsertTimer(t);
}
}
}
void __osSetTimerIntr(OSTime tim) {
OSTime NewTime;
u32 savedMask;
#if BUILD_VERSION >= VERSION_K
if (tim < 468) {
tim = 468;
}
#endif
savedMask = __osDisableInt();
__osTimerCounter = osGetCount();
NewTime = __osTimerCounter + tim;
__osSetCompare(NewTime);
__osRestoreInt(savedMask);
}
OSTime __osInsertTimer(OSTimer* t) {
OSTimer* timep;
OSTime tim;
u32 savedMask = __osDisableInt();
timep = __osTimerList->next;
tim = t->value;
for (; timep != __osTimerList && tim > timep->value; timep = timep->next) {
tim -= timep->value;
}
t->value = tim;
if (timep != __osTimerList) {
timep->value -= tim;
}
t->next = timep;
t->prev = timep->prev;
timep->prev->next = t;
timep->prev = t;
__osRestoreInt(savedMask);
return tim;
}
|
