-
Notifications
You must be signed in to change notification settings - Fork 39
/
pfsgetstatus.c
executable file
·65 lines (61 loc) · 2.02 KB
/
pfsgetstatus.c
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
#include <os_internal.h>
#include "controller.h"
#include "siint.h"
void __osPfsRequestOneChannel(int channel);
void __osPfsGetOneChannelData(int channel, OSContStatus *data);
s32 __osPfsGetStatus(OSMesgQueue *queue, int channel)
{
s32 ret;
OSMesg dummy;
OSContStatus data;
ret = 0;
__osPfsRequestOneChannel(channel);
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;
if ((data.errno != 0) || ((data.status & CONT_CARD_ON) == 0))
return PFS_ERR_NOPACK;
if ((data.status & CONT_ADDR_CRC_ER) != 0)
return PFS_ERR_CONTRFAIL;
return ret;
}
void __osPfsRequestOneChannel(int channel)
{
u8 *ptr;
__OSContRequesFormatShort requestformat;
int i;
__osContLastCmd = CONT_CMD_REQUEST_STATUS;
__osPfsPifRam.pifstatus = CONT_CMD_EXE;
ptr = (u8 *)&__osPfsPifRam;
requestformat.txsize = CONT_CMD_REQUEST_STATUS_TX;
requestformat.rxsize = CONT_CMD_REQUEST_STATUS_RX;
requestformat.cmd = CONT_CMD_REQUEST_STATUS;
requestformat.typeh = CONT_CMD_NOP;
requestformat.typel = CONT_CMD_NOP;
requestformat.status = CONT_CMD_NOP;
for (i = 0; i < channel; i++)
*ptr++ = 0;
*(__OSContRequesFormatShort *)ptr = requestformat;
ptr += sizeof(__OSContRequesFormatShort);
*ptr = CONT_CMD_END;
}
void __osPfsGetOneChannelData(int channel, OSContStatus *data)
{
u8 *ptr;
__OSContRequesFormatShort requestformat;
int i;
ptr = (u8*)&__osPfsPifRam;
for (i = 0; i < channel; i++)
ptr++;
requestformat = *(__OSContRequesFormatShort *)ptr;
data->errno = CHNL_ERR(requestformat);
if (data->errno == 0)
{
data->type = (requestformat.typel << 8) | (requestformat.typeh);
data->status = requestformat.status;
}
}