mirror of
https://gitlab.com/ryandwyer/perfect-dark
synced 2026-08-19 13:23:49 -04:00
Ryan Dwyer
72 lines
1.7 KiB
C
72 lines
1.7 KiB
C
#include <libultra_internal.h>
|
|
#include "bss.h"
|
|
#include "data.h"
|
|
|
|
s32 __osContRamWrite(OSMesgQueue* mq, s32 channel, u16 address, u8* buffer, s32 force)
|
|
{
|
|
s32 ret = 0;
|
|
s32 i;
|
|
u8* ptr;
|
|
s32 retry = 2;
|
|
u8 crc;
|
|
|
|
if (force != 1 && address < PFS_LABEL_AREA && address != 0) {
|
|
return 0;
|
|
}
|
|
|
|
__osSiGetAccess();
|
|
|
|
do {
|
|
ptr = (u8*)(&__osPfsPifRam);
|
|
|
|
if (__osContLastCmd != CONT_CMD_WRITE_MEMPACK || __osPfsLastChannel != channel) {
|
|
__osContLastCmd = CONT_CMD_WRITE_MEMPACK;
|
|
__osPfsLastChannel = channel;
|
|
|
|
for (i = 0; i < channel; i++) { *ptr++ = 0; }
|
|
|
|
__osPfsPifRam.pifstatus = 1;
|
|
|
|
((__OSContRamReadFormat*)ptr)->dummy = 255;
|
|
((__OSContRamReadFormat*)ptr)->txsize = 35;
|
|
((__OSContRamReadFormat*)ptr)->rxsize = 1;
|
|
((__OSContRamReadFormat*)ptr)->cmd = CONT_CMD_WRITE_MEMPACK;
|
|
((__OSContRamReadFormat*)ptr)->datacrc = 0xff;
|
|
|
|
ptr[sizeof(__OSContRamReadFormat)] = CONT_CMD_END;
|
|
} else {
|
|
ptr += channel;
|
|
}
|
|
|
|
((__OSContRamReadFormat*)ptr)->hi = address >> 3;
|
|
((__OSContRamReadFormat*)ptr)->lo = ((address << 5) | __osContAddressCrc(address));
|
|
|
|
bcopy(buffer, ((__OSContRamReadFormat*)ptr)->data, BLOCKSIZE);
|
|
|
|
ret = __osSiRawStartDma(OS_WRITE, &__osPfsPifRam);
|
|
crc = __osContDataCrc(buffer);
|
|
osRecvMesg(mq, (OSMesg*)NULL, OS_MESG_BLOCK);
|
|
|
|
ret = __osSiRawStartDma(OS_READ, &__osPfsPifRam);
|
|
osRecvMesg(mq, (OSMesg*)NULL, OS_MESG_BLOCK);
|
|
|
|
ret = ((((__OSContRamReadFormat*)ptr)->rxsize & 0xC0) >> 4);
|
|
|
|
if (!ret) {
|
|
if (crc != ((__OSContRamReadFormat*)ptr)->datacrc) {
|
|
if ((ret = __osPfsGetStatus(mq, channel))) {
|
|
break;
|
|
}
|
|
|
|
ret = PFS_ERR_CONTRFAIL;
|
|
}
|
|
} else {
|
|
ret = PFS_ERR_NOPACK;
|
|
}
|
|
} while (ret == PFS_ERR_CONTRFAIL && retry-- >= 0);
|
|
|
|
__osSiRelAccess();
|
|
|
|
return ret;
|
|
}
|