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
|
#include "macros.h"
#include "PR/os_internal.h"
#include "controller.h"
#include "controller_gbpak.h"
OSTimer __osGbpakTimer;
OSMesgQueue __osGbpakTimerQ ALIGNED(8);
OSMesg __osGbpakTimerMsg;
s32 osGbpakInit(OSMesgQueue* mq, OSPfs* pfs, int channel) {
int i;
s32 ret;
u8 temp[BLOCKSIZE];
pfs->status = 0;
// Turn off the transfer pak
for (i = 0; i < BLOCKSIZE; temp[i++] = GB_POWER_OFF) {
;
}
ret = __osContRamWrite(mq, channel, CONT_BLOCK_GB_POWER, temp, FALSE);
if (ret == PFS_ERR_NEW_PACK) {
ret = __osContRamWrite(mq, channel, CONT_BLOCK_GB_POWER, temp, FALSE);
}
if (ret != 0) {
return ret;
}
ret = __osContRamRead(mq, channel, CONT_BLOCK_GB_POWER, temp);
if (ret == PFS_ERR_NEW_PACK) {
ret = PFS_ERR_CONTRFAIL;
}
if (ret != 0) {
return ret;
} else {
// Check if the power is still off as set earlier
if (temp[BLOCKSIZE - 1] == GB_POWER_OFF) {
return PFS_ERR_DEVICE;
}
}
// Turn on the transfer pak
for (i = 0; i < BLOCKSIZE; temp[i++] = GB_POWER_ON) {
;
}
ret = __osContRamWrite(mq, channel, CONT_BLOCK_GB_POWER, temp, FALSE);
if (ret == PFS_ERR_NEW_PACK) {
ret = PFS_ERR_CONTRFAIL;
}
if (ret != 0) {
return ret;
}
ret = __osContRamRead(mq, channel, CONT_BLOCK_GB_POWER, temp);
if (ret == PFS_ERR_NEW_PACK) {
ret = PFS_ERR_CONTRFAIL;
}
if (ret != 0) {
return ret;
} else {
// Check if the power is still on as set earlier
if (temp[BLOCKSIZE - 1] != GB_POWER_ON) {
return PFS_ERR_DEVICE;
}
}
ERRCK(__osPfsGetStatus(mq, channel));
osCreateMesgQueue(&__osGbpakTimerQ, &__osGbpakTimerMsg, 1);
osSetTimer(&__osGbpakTimer, OS_USEC_TO_CYCLES(192000), 0, &__osGbpakTimerQ, &__osGbpakTimerMsg);
osRecvMesg(&__osGbpakTimerQ, NULL, OS_MESG_BLOCK);
pfs->queue = mq;
pfs->status = PFS_GBPAK_INITIALIZED;
pfs->channel = channel;
pfs->activebank = 0x84;
pfs->banks = 0xFF;
pfs->version = 0xFF;
pfs->dir_size = 0xFF;
return 0;
}
|
