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
|
#include "PR/os_internal.h"
#include "controller.h"
#include "siint.h"
#if BUILD_VERSION >= VERSION_J
void __osPfsRequestOneChannel(int channel, u8 cmd);
#else
void __osPfsRequestOneChannel(int channel);
#endif
void __osPfsGetOneChannelData(int channel, OSContStatus* data);
s32 __osPfsGetStatus(OSMesgQueue* queue, int channel) {
s32 ret = 0;
OSMesg dummy;
OSContStatus data;
#if BUILD_VERSION >= VERSION_J
__osPfsInodeCacheBank = 250;
__osPfsRequestOneChannel(channel, CONT_CMD_REQUEST_STATUS);
#else
__osPfsRequestOneChannel(channel);
#endif
ret = __osSiRawStartDma(OS_WRITE, &__osPfsPifRam);
osRecvMesg(queue, &dummy, OS_MESG_BLOCK);
ret = __osSiRawStartDma(OS_READ, &__osPfsPifRam);
osRecvMesg(queue, &dummy, OS_MESG_BLOCK);
__osPfsGetOneChannelData(channel, &data);
if (((data.status & CONT_CARD_ON) != 0) && ((data.status & CONT_CARD_PULL) != 0)) {
return PFS_ERR_NEW_PACK;
} else if ((data.errno != 0) || ((data.status & CONT_CARD_ON) == 0)) {
return PFS_ERR_NOPACK;
} else if ((data.status & CONT_ADDR_CRC_ER) != 0) {
return PFS_ERR_CONTRFAIL;
}
return ret;
}
#if BUILD_VERSION >= VERSION_J
void __osPfsRequestOneChannel(int channel, u8 cmd) {
#else
void __osPfsRequestOneChannel(int channel) {
#endif
u8* ptr;
__OSContRequesFormatShort requestformat;
int i;
#if BUILD_VERSION >= VERSION_J
__osContLastCmd = CONT_CMD_END;
#else
__osContLastCmd = CONT_CMD_REQUEST_STATUS;
#endif
__osPfsPifRam.pifstatus = CONT_CMD_READ_BUTTON;
ptr = (u8*)&__osPfsPifRam;
requestformat.txsize = CONT_CMD_REQUEST_STATUS_TX;
requestformat.rxsize = CONT_CMD_REQUEST_STATUS_RX;
#if BUILD_VERSION >= VERSION_J
requestformat.cmd = cmd;
#else
requestformat.cmd = CONT_CMD_REQUEST_STATUS;
#endif
requestformat.typeh = CONT_CMD_NOP;
requestformat.typel = CONT_CMD_NOP;
requestformat.status = CONT_CMD_NOP;
for (i = 0; i < channel; i++) {
*ptr++ = CONT_CMD_REQUEST_STATUS;
}
*(__OSContRequesFormatShort*)ptr = requestformat;
ptr += sizeof(__OSContRequesFormatShort);
*ptr = CONT_CMD_END;
}
void __osPfsGetOneChannelData(int channel, OSContStatus* data) {
u8* ptr = (u8*)&__osPfsPifRam;
__OSContRequesFormatShort requestformat;
int i;
for (i = 0; i < channel; i++) {
ptr++;
}
requestformat = *(__OSContRequesFormatShort*)ptr;
data->errno = CHNL_ERR(requestformat);
if (data->errno != 0) {
return;
}
data->type = (requestformat.typel << 8) | (requestformat.typeh);
data->status = requestformat.status;
}
|
