blob: a6f09fa63beee3b57a09e39027abe24a6f041ba6 (
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
|
#include "ultra64.h"
s32 __osPfsGetStatus(OSMesgQueue* queue, s32 channel) {
#ifndef BBPLAYER
s32 ret = 0;
OSMesg msg;
OSContStatus data;
__osPfsInodeCacheBank = 250;
__osPfsRequestOneChannel(channel, CONT_CMD_REQUEST_STATUS);
ret = __osSiRawStartDma(OS_WRITE, &__osPfsPifRam);
osRecvMesg(queue, &msg, OS_MESG_BLOCK);
ret = __osSiRawStartDma(OS_READ, &__osPfsPifRam);
osRecvMesg(queue, &msg, OS_MESG_BLOCK);
__osPfsGetOneChannelData(channel, &data);
if ((data.status & CONT_CARD_ON) && (data.status & CONT_CARD_PULL)) {
return PFS_ERR_NEW_PACK;
} else if (data.errno != 0 || !(data.status & CONT_CARD_ON)) {
return PFS_ERR_NOPACK;
} else if (data.status & CONT_ADDR_CRC_ER) {
return PFS_ERR_CONTRFAIL;
}
return ret;
#else
if (__osBbPakAddress[channel] != 0) {
return 0;
}
return PFS_ERR_NOPACK;
#endif
}
void __osPfsRequestOneChannel(s32 channel, u8 cmd) {
u8* ptr;
__OSContRequesFormatShort req;
s32 idx;
__osContLastCmd = CONT_CMD_END;
__osPfsPifRam.status = CONT_CMD_EXE;
ptr = (u8*)&__osPfsPifRam;
req.txsize = CONT_CMD_REQUEST_STATUS_TX;
req.rxsize = CONT_CMD_REQUEST_STATUS_RX;
req.cmd = cmd;
req.typeh = CONT_CMD_NOP;
req.typel = CONT_CMD_NOP;
req.status = CONT_CMD_NOP;
for (idx = 0; idx < channel; idx++) {
*ptr++ = CONT_CMD_SKIP_CHNL;
}
*((__OSContRequesFormatShort*)ptr) = req;
ptr += sizeof(req);
*ptr = CONT_CMD_END;
}
void __osPfsGetOneChannelData(s32 channel, OSContStatus* contData) {
u8* ptr = (u8*)&__osPfsPifRam;
__OSContRequesFormatShort req;
s32 idx;
for (idx = 0; idx < channel; idx++) {
ptr++;
}
req = *((__OSContRequesFormatShort*)ptr);
contData->errno = CHNL_ERR(req);
if (contData->errno) {
return;
}
contData->type = (req.typel << 8) | req.typeh;
contData->status = req.status;
}
|