2020-04-14 17:17:25 +00:00
|
|
|
#include <ultra64.h>
|
|
|
|
#include <global.h>
|
|
|
|
#include <ultra64/controller.h>
|
|
|
|
|
2020-06-17 11:16:30 +00:00
|
|
|
#define BLOCKSIZE 32
|
|
|
|
|
2020-07-07 00:15:01 +00:00
|
|
|
s32 __osPfsLastChannel = -1;
|
|
|
|
|
|
|
|
s32 __osContRamRead(OSMesgQueue* ctrlrqueue, s32 channel, u16 addr, u8* data) {
|
2020-04-14 17:17:25 +00:00
|
|
|
s32 ret;
|
|
|
|
s32 i;
|
|
|
|
u8* bufptr;
|
2020-06-17 11:16:30 +00:00
|
|
|
s32 retryCount = 2;
|
2020-04-14 17:17:25 +00:00
|
|
|
|
|
|
|
__osSiGetAccess();
|
|
|
|
do {
|
2020-06-17 11:16:30 +00:00
|
|
|
bufptr = &pifMempakBuf;
|
|
|
|
if ((__osContLastPoll != 2) || (__osPfsLastChannel != channel)) {
|
|
|
|
|
|
|
|
__osContLastPoll = 2;
|
|
|
|
__osPfsLastChannel = channel;
|
2020-04-14 17:17:25 +00:00
|
|
|
// clang-format off
|
2020-06-17 11:16:30 +00:00
|
|
|
for (i = 0; i < channel; i++) { *bufptr++ = 0; }
|
2020-04-14 17:17:25 +00:00
|
|
|
// clang-format on
|
2020-06-17 11:16:30 +00:00
|
|
|
pifMempakBuf.status = 1;
|
|
|
|
((__OSContRamHeader*)bufptr)->unk_00 = 0xFF;
|
|
|
|
((__OSContRamHeader*)bufptr)->txsize = 3;
|
|
|
|
((__OSContRamHeader*)bufptr)->rxsize = 0x21;
|
|
|
|
((__OSContRamHeader*)bufptr)->poll = CONT_CMD_READ_MEMPACK; // read mempak; send byte 0
|
|
|
|
((__OSContRamHeader*)bufptr)->datacrc = 0xFF; // read mempak; send byte 0
|
2020-04-14 17:17:25 +00:00
|
|
|
// Received bytes are 6-26 inclusive
|
2020-06-17 11:16:30 +00:00
|
|
|
bufptr[sizeof(__OSContRamHeader)] = CONT_CMD_END; // End of commands
|
2020-04-14 17:17:25 +00:00
|
|
|
} else {
|
2020-06-17 11:16:30 +00:00
|
|
|
bufptr += channel;
|
2020-04-14 17:17:25 +00:00
|
|
|
}
|
2020-07-07 00:15:01 +00:00
|
|
|
((__OSContRamHeader*)bufptr)->hi = addr >> 3; // send byte 1
|
|
|
|
((__OSContRamHeader*)bufptr)->lo = (s8)(__osContAddressCrc(addr) | (addr << 5)); // send byte 2
|
2020-06-17 11:16:30 +00:00
|
|
|
__osSiRawStartDma(OS_WRITE, &pifMempakBuf);
|
|
|
|
osRecvMesg(ctrlrqueue, NULL, OS_MESG_BLOCK);
|
|
|
|
__osSiRawStartDma(OS_READ, &pifMempakBuf);
|
|
|
|
osRecvMesg(ctrlrqueue, NULL, OS_MESG_BLOCK);
|
|
|
|
ret = (((__OSContRamHeader*)bufptr)->rxsize & 0xC0) >> 4;
|
2020-04-14 17:17:25 +00:00
|
|
|
if (!ret) {
|
2020-07-07 00:15:01 +00:00
|
|
|
if (((__OSContRamHeader*)bufptr)->datacrc != __osContDataCrc(bufptr + 6)) {
|
2020-06-17 11:16:30 +00:00
|
|
|
ret = __osPfsGetStatus(ctrlrqueue, channel);
|
2020-04-16 18:08:23 +00:00
|
|
|
if (ret) {
|
2020-04-14 17:17:25 +00:00
|
|
|
break;
|
2020-04-16 18:08:23 +00:00
|
|
|
}
|
2020-04-14 17:17:25 +00:00
|
|
|
ret = 4; // Retry
|
|
|
|
} else {
|
2020-06-17 11:16:30 +00:00
|
|
|
bcopy(bufptr + 6, data, BLOCKSIZE);
|
2020-04-14 17:17:25 +00:00
|
|
|
}
|
|
|
|
} else {
|
|
|
|
ret = 1; // Error
|
|
|
|
}
|
2020-04-16 18:08:23 +00:00
|
|
|
if (ret != 4) {
|
2020-04-14 17:17:25 +00:00
|
|
|
break;
|
2020-04-16 18:08:23 +00:00
|
|
|
}
|
2020-06-17 11:16:30 +00:00
|
|
|
} while (0 <= retryCount--);
|
2020-04-14 17:17:25 +00:00
|
|
|
__osSiRelAccess();
|
|
|
|
return ret;
|
|
|
|
}
|