mirror of
https://github.com/zeldaret/mm.git
synced 2026-08-18 21:18:17 -04:00
Anghelo Carvajal
4fa13e4132
* Delete unused headers * Move PR and io to ultra64 * move headers to ultra64 * more cleanups * more reorganizing * i think that should be all * format * ifdef guards cleanup * Add IO_READ and IO_WRITE macros for future use * warnings * review Co-authored-by: Tharo <17233964+Thar0@users.noreply.github.com> * warnings again * warn * ifdef guards * fix merge * fix merge * fix merge * bss * padutils.h * bss * bss * bss * fix merge * bss * bss * bss * fix merge * fixes * fixes * bss * bss * fix merge * fix * fix * fix includepaths * fix paths * bss * fix * ultra64/ -> PR/ * header guards * fix ehader guards * fix * fix++ * format * bss is borken * prevent 2 * :despair: * bss * rename assert to dbg_hungup * fix * a * fix * bss * fix * bss * bss --------- Co-authored-by: Tharo <17233964+Thar0@users.noreply.github.com>
75 lines
2.2 KiB
C
75 lines
2.2 KiB
C
/**
|
|
* File: voicecontread36.c
|
|
*/
|
|
|
|
#include "PR/controller_voice.h"
|
|
#include "PR/controller.h"
|
|
#include "functions.h"
|
|
#include "variables.h"
|
|
|
|
#define READ36FORMAT(ptr) ((__OSVoiceRead36Format*)(ptr))
|
|
|
|
s32 __osVoiceContRead36(OSMesgQueue* mq, s32 channel, u16 address, u8 dst[36]) {
|
|
s32 errorCode;
|
|
u8 status;
|
|
u8* ptr;
|
|
s32 retryCount = 2;
|
|
s32 i;
|
|
|
|
__osSiGetAccess();
|
|
|
|
do {
|
|
ptr = (u8*)&__osPfsPifRam.ramarray;
|
|
|
|
if ((__osContLastPoll != CONT_CMD_READ36_VOICE) || (channel != __osPfsLastChannel)) {
|
|
__osContLastPoll = CONT_CMD_READ36_VOICE;
|
|
__osPfsLastChannel = channel;
|
|
|
|
for (i = 0; i < channel; i++, *ptr++ = 0) {}
|
|
|
|
__osPfsPifRam.status = CONT_CMD_EXE;
|
|
|
|
READ36FORMAT(ptr)->dummy = CONT_CMD_NOP;
|
|
READ36FORMAT(ptr)->txsize = CONT_CMD_READ36_VOICE_TX;
|
|
READ36FORMAT(ptr)->rxsize = CONT_CMD_READ36_VOICE_RX;
|
|
READ36FORMAT(ptr)->cmd = CONT_CMD_READ36_VOICE;
|
|
READ36FORMAT(ptr)->datacrc = 0xFF;
|
|
|
|
ptr[sizeof(__OSVoiceRead36Format)] = CONT_CMD_END;
|
|
} else {
|
|
ptr += channel;
|
|
}
|
|
|
|
READ36FORMAT(ptr)->addrh = address >> 3;
|
|
READ36FORMAT(ptr)->addrl = (address << 5) | __osContAddressCrc(address);
|
|
|
|
__osSiRawStartDma(OS_WRITE, &__osPfsPifRam);
|
|
osRecvMesg(mq, NULL, OS_MESG_BLOCK);
|
|
__osSiRawStartDma(OS_READ, &__osPfsPifRam);
|
|
osRecvMesg(mq, NULL, OS_MESG_BLOCK);
|
|
|
|
errorCode = CHNL_ERR(*READ36FORMAT(ptr));
|
|
|
|
if (errorCode == 0) {
|
|
if (__osVoiceContDataCrc(READ36FORMAT(ptr)->data, ARRAY_COUNT(READ36FORMAT(ptr)->data)) !=
|
|
READ36FORMAT(ptr)->datacrc) {
|
|
errorCode = __osVoiceGetStatus(mq, channel, &status);
|
|
if (errorCode != 0) {
|
|
break;
|
|
}
|
|
|
|
errorCode = CONT_ERR_CONTRFAIL;
|
|
} else {
|
|
bcopy(READ36FORMAT(ptr)->data, dst, ARRAY_COUNT(READ36FORMAT(ptr)->data));
|
|
}
|
|
} else {
|
|
errorCode = CONT_ERR_NO_CONTROLLER;
|
|
}
|
|
|
|
} while ((errorCode == CONT_ERR_CONTRFAIL) && (retryCount-- >= 0));
|
|
|
|
__osSiRelAccess();
|
|
|
|
return errorCode;
|
|
}
|