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
|
#include "dolphin/gba/GBAPriv.h"
static GBASecParam SecParams[4];
GBAControl __GBA[4];
BOOL __GBAReset = FALSE;
static BOOL OnReset(BOOL final);
static OSResetFunctionInfo ResetFunctionInfo = {OnReset, 127};
static void ShortCommandProc(s32 chan) {
GBAControl* gba;
gba = &__GBA[chan];
if (gba->ret != 0) {
return;
}
if (gba->input[0] != 0 || gba->input[1] != 4) {
gba->ret = 1;
return;
}
gba->status[0] = gba->input[2] & GBA_JSTAT_MASK;
}
void GBAInit() {
GBAControl* gba;
s32 chan;
for (chan = 0; chan < 4; ++chan) {
gba = &__GBA[chan];
gba->delay = OSMicrosecondsToTicks(60);
OSInitThreadQueue(&gba->threadQueue);
gba->param = &SecParams[chan];
}
OSInitAlarm();
__GBAReset = FALSE;
OSRegisterResetFunction(&ResetFunctionInfo);
}
s32 GBAGetStatusAsync(s32 chan, u8* status, GBACallback callback) {
GBAControl* gba;
gba = &__GBA[chan];
if (gba->callback != NULL) {
return GBA_BUSY;
}
gba->output[0] = 0;
gba->status = status;
gba->callback = callback;
return __GBATransfer(chan, 1, 3, ShortCommandProc);
}
s32 GBAGetStatus(s32 chan, u8* status) {
GBAControl* gba = &__GBA[chan];
s32 ret = GBAGetStatusAsync(chan, status, __GBASyncCallback);
if (ret != GBA_READY) {
return ret;
}
return __GBASync(chan);
}
s32 GBAResetAsync(s32 chan, u8* status, GBACallback callback) {
GBAControl* gba = &__GBA[chan];
if (gba->callback != NULL) {
return GBA_BUSY;
}
gba->output[0] = 0xFF;
gba->status = status;
gba->callback = callback;
return __GBATransfer(chan, 1, 3, ShortCommandProc);
}
s32 GBAReset(s32 chan, u8* status) {
GBAControl* gba = &__GBA[chan];
s32 ret;
ret = GBAResetAsync(chan, status, __GBASyncCallback);
if (ret != GBA_READY) {
return ret;
}
return __GBASync(chan);
}
BOOL OnReset(BOOL final) {
__GBAReset = TRUE;
return TRUE;
}
|
