mirror of
https://github.com/HarbourMasters/SpaghettiKart
synced 2026-06-04 10:49:12 -04:00
MegaMech
50 lines
1.3 KiB
C
50 lines
1.3 KiB
C
#include "libultra_internal.h"
|
|
#include "controller.h"
|
|
|
|
// osPfsInit
|
|
s32 osPfsInit(OSMesgQueue *queue, OSPfs *pfs, int channel)
|
|
{
|
|
s32 ret;
|
|
ret = 0;
|
|
|
|
__osSiGetAccess();
|
|
ret = __osPfsGetStatus(queue, channel);
|
|
__osSiRelAccess();
|
|
if (ret != 0)
|
|
return ret;
|
|
|
|
pfs->queue = queue;
|
|
pfs->channel = channel;
|
|
pfs->status = 0;
|
|
ERRCK(__osGetId(pfs));
|
|
|
|
ret = osPfsChecker(pfs);
|
|
pfs->status |= PFS_INITIALIZED;
|
|
return ret;
|
|
}
|
|
|
|
// __osPfsGetStatus
|
|
s32 __osPfsGetStatus(OSMesgQueue *queue, int channel)
|
|
{
|
|
s32 ret;
|
|
OSMesg dummy;
|
|
u8 pattern;
|
|
OSContStatus data[MAXCONTROLLERS];
|
|
|
|
ret = 0;
|
|
__osPfsRequestData(0);
|
|
ret = __osSiRawStartDma(OS_WRITE, &__osPfsPifRam);
|
|
osRecvMesg(queue, &dummy, OS_MESG_BLOCK);
|
|
ret = __osSiRawStartDma(OS_READ, &__osPfsPifRam);
|
|
osRecvMesg(queue, &dummy, OS_MESG_BLOCK);
|
|
__osPfsGetInitData(&pattern, &data[0]);
|
|
|
|
if (((data[channel].status & CONT_CARD_ON) != 0) && ((data[channel].status & CONT_CARD_PULL) != 0))
|
|
return PFS_ERR_NEW_PACK;
|
|
if ((data[channel].errnum != 0) || ((data[channel].status & CONT_CARD_ON) == 0))
|
|
return PFS_ERR_NOPACK;
|
|
if ((data[channel].status & CONT_ADDR_CRC_ER) != 0)
|
|
return PFS_ERR_CONTRFAIL;
|
|
return ret;
|
|
}
|