blob: 1fb438216cb307065e32e7e69ff915731f9edd28 (
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
|
//
// Created by red031000 on 2020-05-07.
//
#include "consts.h"
#include "function_target.h"
#include "OS_interrupt.h"
#include "OS_thread.h"
#pragma optimize_for_size on
extern OSThreadQueue OSi_IrqThreadQueue;
extern OSIrqMask OS_EnableIrqMask(OSIrqMask intr);
ARM_FUNC void OS_InitIrqTable() {
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;
}
|
