blob: 699c79296e7ba4d740ed0a5486e4e17f07068fd3 (
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 "OS_interrupt.h"
#include "global.h"
#include "registers.h"
#include "mmap.h"
#include "OS_thread.h"
#pragma optimize_for_size on
extern OSThreadQueue OSi_IrqThreadQueue;
ARM_FUNC void OS_InitIrqTable(void) {
OS_InitThreadQueue(&OSi_IrqThreadQueue);
}
ARM_FUNC void OS_SetIrqFunction(OSIrqMask intrBit, OSIrqFunction function) {
s32 i;
OSIrqCallbackInfo *info;
for (i = 0; i < 0x16; i++) {
if (intrBit & 1) {
info = NULL;
if (8 <= i && i <= 11) {
info = &OSi_IrqCallbackInfo[i - 8];
}
else if (3 <= i && i <= 6) {
info = &OSi_IrqCallbackInfo[i - 3 + 4];
}
else {
OS_IRQTable[i] = function;
}
if (info) {
info->func = (void (*)(void *))function;
info->arg = 0;
info->enable = TRUE;
}
}
intrBit >>= 1;
}
}
ARM_FUNC OSIrqFunction OS_GetIrqFunction(OSIrqMask intrBit) {
s32 i = 0;
OSIrqFunction *funcPtr = &OS_IRQTable[0];
do {
if (intrBit & 1)
{
if (8 <= i && i <= 11) {
i = i - 8;
return (void (*)(void))OSi_IrqCallbackInfo[i].func;
}
else if (3 <= i && i <= 6) {
i++;
return (void (*)(void))OSi_IrqCallbackInfo[i].func;
}
return *funcPtr;
}
intrBit >>= 1;
funcPtr++;
i++;
} while (i < 0x16);
return 0;
}
ARM_FUNC void OSi_EnterDmaCallback(u32 dmaNo, void (*callback) (void *), void *arg)
{
OSIrqMask mask = 1UL << (dmaNo + 8);
OSi_IrqCallbackInfo[dmaNo].func = callback;
OSi_IrqCallbackInfo[dmaNo].arg = arg;
OSi_IrqCallbackInfo[dmaNo].enable = OS_EnableIrqMask(mask) & mask;
}
ARM_FUNC void OSi_EnterTimerCallback(u32 timerNo, void (*callback) (void *), void *arg)
{
OSIrqMask mask = 1UL << (timerNo + 3);
OSi_IrqCallbackInfo[timerNo + 4].func = callback;
OSi_IrqCallbackInfo[timerNo + 4].arg = arg;
(void)OS_EnableIrqMask(mask);
OSi_IrqCallbackInfo[timerNo + 4].enable = TRUE;
}
ARM_FUNC OSIrqMask OS_SetIrqMask(OSIrqMask mask)
{
u16 regIme = reg_OS_IME;
reg_OS_IME = 0;
OSIrqMask regIe = reg_OS_IE;
reg_OS_IE = mask;
u16 unused = reg_OS_IME; //needed because otherwise it doesn't match
reg_OS_IME = regIme;
return regIe;
}
ARM_FUNC OSIrqMask OS_EnableIrqMask(OSIrqMask mask)
{
u16 regIme = reg_OS_IME;
reg_OS_IME = 0;
OSIrqMask regIe = reg_OS_IE;
reg_OS_IE = regIe | mask;
u16 unused = reg_OS_IME;
reg_OS_IME = regIme;
return regIe;
}
ARM_FUNC OSIrqMask OS_DisableIrqMask(OSIrqMask mask)
{
u16 regIme = reg_OS_IME;
reg_OS_IME = 0;
OSIrqMask regIe = reg_OS_IE;
reg_OS_IE = regIe & ~mask;
u16 unused = reg_OS_IME;
reg_OS_IME = regIme;
return regIe;
}
ARM_FUNC OSIrqMask OS_ResetRequestIrqMask(OSIrqMask mask)
{
u16 regIme = reg_OS_IME;
reg_OS_IME = 0;
OSIrqMask regIf = reg_OS_IF;
reg_OS_IF = mask;
u16 unused = reg_OS_IME;
reg_OS_IME = regIme;
return regIf;
}
extern void SDK_IRQ_STACKSIZE(void);
#define OSi_IRQ_STACK_TOP (HW_DTCM_SVC_STACK - ((s32)SDK_IRQ_STACKSIZE))
#define OSi_IRQ_STACK_BOTTOM HW_DTCM_SVC_STACK
ARM_FUNC void OS_SetIrqStackChecker(void)
{
*(u32 *)(OSi_IRQ_STACK_BOTTOM - sizeof(u32)) = 0xfddb597dUL;
*(u32 *)(OSi_IRQ_STACK_TOP) = 0x7bf9dd5bUL;
}
|
