summaryrefslogtreecommitdiff
path: root/src/libultra_code_O2/osPfsIsPlug.c
diff options
context:
space:
mode:
authorRandom <28494085+Random06457@users.noreply.github.com>2020-10-03 17:22:44 +0200
committerGitHub <noreply@github.com>2020-10-03 11:22:44 -0400
commit174af7384d1cfcbf15da02d9069bf02bdc433c20 (patch)
treee4fb18346f71047c123ec4d34a80ae7e4d8ab9ea /src/libultra_code_O2/osPfsIsPlug.c
parent6136ee6debd570a63fc695a6f4664553303f2324 (diff)
libultra cleanup (#215)
* cleanup libultra * fixes - use quotes instead of <> for includes - add macros for zelda specific thread priorities - fix Makefile - properly format the remaining pfs structs * fix button macros + add CHECK_BTN_ANY/CHECK_BTN_ALL * remove ULTRA_ABS * fix includes * update z_player.c/z_lib.c + run format.sh * merge upstream/master * fix include in En_Goroiwa * fix includes
Diffstat (limited to 'src/libultra_code_O2/osPfsIsPlug.c')
-rw-r--r--src/libultra_code_O2/osPfsIsPlug.c93
1 files changed, 93 insertions, 0 deletions
diff --git a/src/libultra_code_O2/osPfsIsPlug.c b/src/libultra_code_O2/osPfsIsPlug.c
new file mode 100644
index 000000000..329610ac5
--- /dev/null
+++ b/src/libultra_code_O2/osPfsIsPlug.c
@@ -0,0 +1,93 @@
+#include "ultra64.h"
+#include "global.h"
+
+s32 osPfsIsPlug(OSMesgQueue* mq, u8* pattern) {
+ s32 ret = 0;
+ OSMesg msg;
+ u8 bitpattern;
+ OSContStatus contData[MAXCONTROLLERS];
+ s32 channel;
+ u8 bits = 0;
+ s32 crcErrorCount = 3;
+
+ __osSiGetAccess();
+
+ do {
+ __osPfsRequestData(CONT_CMD_REQUEST_STATUS);
+
+ ret = __osSiRawStartDma(OS_WRITE, &pifMempakBuf);
+ osRecvMesg(mq, &msg, OS_MESG_BLOCK);
+
+ ret = __osSiRawStartDma(OS_READ, &pifMempakBuf);
+ osRecvMesg(mq, &msg, OS_MESG_BLOCK);
+
+ __osPfsGetInitData(&bitpattern, &contData[0]);
+
+ for (channel = 0; channel < __osMaxControllers; channel++) {
+ if ((contData[channel].status & CONT_ADDR_CRC_ER) == 0) {
+ crcErrorCount--;
+ break;
+ }
+ }
+ if (channel == __osMaxControllers) {
+ crcErrorCount = 0;
+ }
+ } while (crcErrorCount > 0);
+
+ for (channel = 0; channel < __osMaxControllers; channel++) {
+ if ((contData[channel].errno == 0) && ((contData[channel].status & CONT_CARD_ON) != 0)) {
+ bits |= (1 << channel);
+ }
+ }
+ __osSiRelAccess();
+ *pattern = bits;
+ return ret;
+}
+
+void __osPfsRequestData(u8 poll) {
+ u8* bufPtr = &pifMempakBuf;
+ __OSContRequestHeader req;
+ s32 i;
+
+ __osContLastPoll = poll;
+
+ pifMempakBuf.status = 1;
+
+ req.align = 0xFF;
+ req.txsize = 1;
+ req.rxsize = 3;
+ req.poll = poll;
+ req.typeh = 0xFF;
+ req.typel = 0xFF;
+ req.status = 0xFF;
+ req.align1 = 0xFF;
+
+ for (i = 0; i < __osMaxControllers; i++) {
+ *((__OSContRequestHeader*)bufPtr) = req;
+ bufPtr += sizeof(req);
+ }
+ *((u8*)bufPtr) = CONT_CMD_END;
+}
+
+void __osPfsGetInitData(u8* pattern, OSContStatus* contData) {
+ u8* bufptr;
+ __OSContRequestHeader req;
+ s32 i;
+ u8 bits = 0;
+
+ bufptr = &pifMempakBuf;
+
+ for (i = 0; i < __osMaxControllers; i++, bufptr += sizeof(req), contData++) {
+ req = *((__OSContRequestHeader*)bufptr);
+ contData->errno = ((req.rxsize & 0xC0) >> 4);
+
+ if (contData->errno) {
+ continue;
+ }
+
+ contData->type = ((req.typel << 8) | req.typeh);
+ contData->status = req.status;
+ bits |= (1 << i);
+ }
+ *pattern = bits;
+}