Leahnaya/pokefirered
1
0
Fork 0
mirror of https://github.com/pret/pokefirered.git synced 2026-05-09 12:35:23 -05:00
Code Issues Actions Packages Projects Releases Wiki Activity
7d704a1ce6
pokefirered/src/link.c
cawtds b9251aca11 smol -> smolTM where applicable
2026-03-07 11:55:56 +01:00

1832 lines
46 KiB
C
Raw Blame History

#include "global.h"
#include "io_reg.h"
#include "gpu_regs.h"
#include "malloc.h"
#include "string_util.h"
#include "battle.h"
#include "decompress.h"
#include "event_data.h"
#include "graphics.h"
#include "help_system.h"
#include "item_menu.h"
#include "librfu.h"
#include "link.h"
#include "link_rfu.h"
#include "m4a.h"
#include "menu.h"
#include "overworld.h"
#include "palette.h"
#include "quest_log.h"
#include "random.h"
#include "reload_save.h"
#include "save.h"
#include "scanline_effect.h"
#include "sound.h"
#include "strings.h"
#include "task.h"
#include "trade.h"
#include "constants/battle.h"
#include "constants/songs.h"
struct BlockTransfer
{
u16 pos;
u16 size;
const u8 *src;
bool8 active;
u8 multiplayerId;
};
struct LinkTestBGInfo
{
u32 screenBaseBlock;
u32 paletteNum;
u32 baseChar;
u32 unused;
};
#define SIO_MULTI_CNT ((struct SioMultiCnt *)REG_ADDR_SIOCNT)
static struct BlockTransfer sBlockSend;
ALIGNED(8) static struct BlockTransfer sBlockRecv[MAX_LINK_PLAYERS];
static u32 sBlockSendDelayCounter;
static u32 sDummy1; // Never read
static u32 sPlayerDataExchangeStatus;
static u8 sNumVBlanksWithoutSerialIntr;
static bool8 sSendBufferEmpty;
static u16 sSendNonzeroCheck;
static u16 sRecvNonzeroCheck;
static u8 sChecksumAvailable;
static u8 sHandshakePlayerCount;
COMMON_DATA u16 gLinkPartnersHeldKeys[6];
COMMON_DATA u32 gLinkDebugSeed;
COMMON_DATA struct LinkPlayerBlock gLocalLinkPlayerBlock;
COMMON_DATA bool8 gLinkErrorOccurred;
COMMON_DATA u32 gLinkDebugFlags;
COMMON_DATA u32 gLinkFiller1;
COMMON_DATA bool8 gRemoteLinkPlayersNotReceived[MAX_LINK_PLAYERS];
COMMON_DATA u8 gBlockReceivedStatus[MAX_LINK_PLAYERS];
COMMON_DATA u32 gLinkFiller2;
COMMON_DATA u16 gLinkHeldKeys;
COMMON_DATA u16 ALIGNED(4) gRecvCmds[MAX_RFU_PLAYERS][CMD_LENGTH] = {0};
COMMON_DATA u32 gLinkStatus;
COMMON_DATA bool8 gLinkDummy1; // Never read
COMMON_DATA bool8 gLinkDummy2; // Never read
COMMON_DATA bool8 gReadyToExitStandby[MAX_LINK_PLAYERS];
COMMON_DATA bool8 gReadyToCloseLink[MAX_LINK_PLAYERS];
COMMON_DATA u16 gReadyCloseLinkType;
COMMON_DATA u8 gSuppressLinkErrorMessage;
COMMON_DATA u8 gWirelessCommType;
COMMON_DATA u8 gSavedLinkPlayerCount;
COMMON_DATA u16 gSendCmd[CMD_LENGTH];
COMMON_DATA u8 gSavedMultiplayerId;
COMMON_DATA bool8 gReceivedRemoteLinkPlayers;
COMMON_DATA struct LinkTestBGInfo gLinkTestBGInfo;
COMMON_DATA void (*gLinkCallback)(void);
COMMON_DATA u8 gShouldAdvanceLinkState;
COMMON_DATA u16 gLinkTestBlockChecksums[MAX_LINK_PLAYERS];
COMMON_DATA u8 gBlockRequestType;
COMMON_DATA u32 gLinkFiller3; // file
COMMON_DATA u32 gLinkFiller4; // boundary
COMMON_DATA u32 gLinkFiller5; // here?
COMMON_DATA u8 gLastSendQueueCount;
COMMON_DATA struct Link gLink;
COMMON_DATA u8 gLastRecvQueueCount;
COMMON_DATA u16 gLinkSavedIme;
EWRAM_DATA u32 gBerryBlenderKeySendAttempts = 0;
EWRAM_DATA u16 gBlockRecvBuffer[MAX_RFU_PLAYERS][BLOCK_BUFFER_SIZE / 2] = {};
EWRAM_DATA u8 gBlockSendBuffer[BLOCK_BUFFER_SIZE] = {};
static EWRAM_DATA bool8 sLinkOpen = FALSE;
EWRAM_DATA u16 gLinkType = 0;
static EWRAM_DATA u16 sTimeOutCounter = 0;
EWRAM_DATA struct LinkPlayer gLocalLinkPlayer = {};
EWRAM_DATA struct LinkPlayer gLinkPlayers[MAX_RFU_PLAYERS] = {};
EWRAM_DATA struct LinkPlayer gSavedLinkPlayers[MAX_RFU_PLAYERS] = {};
EWRAM_DATA struct {
u32 status;
u8 lastRecvQueueCount;
u8 lastSendQueueCount;
bool8 disconnected;
} sLinkErrorBuffer = {};
static EWRAM_DATA u16 sReadyCloseLinkAttempts = 0; // never read
static EWRAM_DATA void *sLinkErrorBgTilemapBuffer = NULL;
static void InitLocalLinkPlayer(void);
static void VBlankCB_LinkError(void);
static void ProcessRecvCmds(u8 id);
static void LinkCB_SendHeldKeys(void);
static void ResetBlockSend(void);
static bool32 InitBlockSend(const void *src, size_t size);
static void LinkCB_BlockSendBegin(void);
static void LinkCB_BlockSend(void);
static void LinkCB_BlockSendEnd(void);
static void SetBerryBlenderLinkCallback(void);
static void SetBlockReceivedFlag(u8 id);
static void LinkCB_RequestPlayerDataExchange(void);
static void LinkCB_ReadyCloseLink(void);
static void LinkCB_WaitCloseLink(void);
static void LinkCB_Standby(void);
static void LinkCB_StandbyForAll(void);
static void CheckErrorStatus(void);
static void CB2_PrintErrorMessage(void);
static void SetWirelessCommType0_Internal(void);
static void DisableSerial(void);
static void EnableSerial(void);
static void CheckMasterOrSlave(void);
static void InitTimer(void);
static void EnqueueSendCmd(u16 *sendCmd);
static void DequeueRecvCmds(u16 (*recvCmds)[CMD_LENGTH]);
static void StartTransfer(void);
static bool8 DoHandshake(void);
static void DoRecv(void);
static void DoSend(void);
static void StopTimer(void);
static void SendRecvDone(void);
static const u16 sWirelessLinkDisplayPal[] = INCBIN_U16("graphics/link/wireless_display.gbapal");
static const u16 sWirelessLinkDisplayGfx[] = INCBIN_U16("graphics/link/wireless_display.4bpp.smol");
static const u16 sWirelessLinkDisplayTilemap[] = INCBIN_U16("graphics/link/wireless_display.bin.smolTM");
static const u16 sLinkTestFontPal[] = INCBIN_U16("graphics/link/test_font.gbapal");
static const u16 sLinkTestFontGfx[] = INCBIN_U16("graphics/link/test_font.4bpp");
static const struct BlockRequest sBlockRequests[] = {
[BLOCK_REQ_SIZE_NONE] = { gBlockSendBuffer, 200 },
[BLOCK_REQ_SIZE_200] = { gBlockSendBuffer, 200 },
[BLOCK_REQ_SIZE_100] = { gBlockSendBuffer, 100 },
[BLOCK_REQ_SIZE_220] = { gBlockSendBuffer, 220 },
[BLOCK_REQ_SIZE_40] = { gBlockSendBuffer, 40 }
};
static const char sASCIIGameFreakInc[] = "GameFreak inc.";
static const char sASCIITestPrint[] = "TEST PRINT\nP0\nP1\nP2\nP3";
static const struct BgTemplate sLinkErrorBgTemplates[] = {
{
.bg = 0,
.charBaseIndex = 2,
.mapBaseIndex = 31,
.priority = 0
}, {
.bg = 1,
.charBaseIndex = 0,
.mapBaseIndex = 8,
.priority = 1
}
};
static const struct WindowTemplate sLinkErrorWindowTemplates[] = {
{
.bg = 0,
.tilemapLeft = 0,
.tilemapTop = 0,
.width = 30,
.height = 5,
.paletteNum = 15,
.baseBlock = 0x002
}, {
.bg = 0,
.tilemapLeft = 0,
.tilemapTop = 6,
.width = 30,
.height = 7,
.paletteNum = 15,
.baseBlock = 0x098
}, {
.bg = 0,
.tilemapLeft = 0,
.tilemapTop = 13,
.width = 30,
.height = 7,
.paletteNum = 15,
.baseBlock = 0x16A
}, DUMMY_WIN_TEMPLATE
};
static const u8 sLinkErrorTextColor[] = { 0x00, 0x01, 0x02 };
bool8 IsWirelessAdapterConnected(void)
{
if (QL_IS_PLAYBACK_STATE)
return FALSE;
SetWirelessCommType1();
InitRFUAPI();
RfuSetIgnoreError(TRUE);
if (rfu_LMAN_REQBN_softReset_and_checkID() == RFU_ID)
{
rfu_REQ_stopMode();
rfu_waitREQComplete();
return TRUE;
}
SetWirelessCommType0_Internal();
CloseLink();
RestoreSerialTimer3IntrHandlers();
return FALSE;
}
void Task_DestroySelf(u8 taskId)
{
DestroyTask(taskId);
}
void InitLinkTestBG(u8 paletteNum, u8 bgNum, u8 screenBaseBlock, u8 charBaseBlock, u16 baseChar)
{
LoadPalette(sLinkTestFontPal, BG_PLTT_ID(paletteNum), PLTT_SIZE_4BPP);
DmaCopy16(3, sLinkTestFontGfx, (u16 *)BG_CHAR_ADDR(charBaseBlock) + (16 * baseChar), sizeof sLinkTestFontGfx);
gLinkTestBGInfo.screenBaseBlock = screenBaseBlock;
gLinkTestBGInfo.paletteNum = paletteNum;
gLinkTestBGInfo.baseChar = baseChar;
switch (bgNum)
{
case 1:
SetGpuReg(REG_OFFSET_BG1CNT, BGCNT_SCREENBASE(screenBaseBlock) | BGCNT_PRIORITY(1) | BGCNT_CHARBASE(charBaseBlock));
break;
case 2:
SetGpuReg(REG_OFFSET_BG2CNT, BGCNT_SCREENBASE(screenBaseBlock) | BGCNT_PRIORITY(1) | BGCNT_CHARBASE(charBaseBlock));
break;
case 3:
SetGpuReg(REG_OFFSET_BG3CNT, BGCNT_SCREENBASE(screenBaseBlock) | BGCNT_PRIORITY(1) | BGCNT_CHARBASE(charBaseBlock));
break;
}
SetGpuReg(REG_OFFSET_BG0HOFS + bgNum * 4, 0);
SetGpuReg(REG_OFFSET_BG0VOFS + bgNum * 4, 0);
}
void SetLocalLinkPlayerId(u8 playerId)
{
gLocalLinkPlayer.id = playerId;
}
static void InitLocalLinkPlayer(void)
{
gLocalLinkPlayer.trainerId = gSaveBlock2Ptr->playerTrainerId[0] | (gSaveBlock2Ptr->playerTrainerId[1] << 8) | (gSaveBlock2Ptr->playerTrainerId[2] << 16) | (gSaveBlock2Ptr->playerTrainerId[3] << 24);
StringCopy(gLocalLinkPlayer.name, gSaveBlock2Ptr->playerName);
gLocalLinkPlayer.gender = gSaveBlock2Ptr->playerGender;
gLocalLinkPlayer.linkType = gLinkType;
gLocalLinkPlayer.language = gGameLanguage;
gLocalLinkPlayer.version = gGameVersion + 0x4000;
gLocalLinkPlayer.lp_field_2 = 0x8000;
gLocalLinkPlayer.progressFlags = IsNationalPokedexEnabled();
if (FlagGet(FLAG_SYS_CAN_LINK_WITH_RS))
{
gLocalLinkPlayer.progressFlags |= 0x10;
}
}
static void VBlankCB_LinkError(void)
{
LoadOam();
ProcessSpriteCopyRequests();
TransferPlttBuffer();
}
void InitLink(void)
{
int i;
for (i = 0; i < CMD_LENGTH; i++)
gSendCmd[i] = LINKCMD_NONE;
sLinkOpen = TRUE;
EnableSerial();
}
void Task_TriggerHandshake(u8 taskId)
{
if (++gTasks[taskId].data[0] == 5)
{
gShouldAdvanceLinkState = 1;
DestroyTask(taskId);
}
}
void OpenLink(void)
{
int i;
if (!gWirelessCommType)
{
ResetSerial();
InitLink();
gLinkCallback = LinkCB_RequestPlayerDataExchange;
gLinkVSyncDisabled = FALSE;
gLinkErrorOccurred = FALSE;
gSuppressLinkErrorMessage = FALSE;
ResetBlockReceivedFlags();
ResetBlockSend();
sDummy1 = FALSE;
gLinkDummy2 = FALSE;
gLinkDummy1 = FALSE;
gReadyCloseLinkType = 0;
CreateTask(Task_TriggerHandshake, 2);
}
else
{
InitRFUAPI();
}
gReceivedRemoteLinkPlayers = FALSE;
for (i = 0; i < MAX_LINK_PLAYERS; i++)
{
gRemoteLinkPlayersNotReceived[i] = TRUE;
gReadyToCloseLink[i] = FALSE;
gReadyToExitStandby[i] = FALSE;
}
}
void CloseLink(void)
{
gReceivedRemoteLinkPlayers = FALSE;
if (gWirelessCommType)
LinkRfu_Shutdown();
sLinkOpen = FALSE;
DisableSerial();
}
u16 LinkMain2(const u16 *heldKeys)
{
u8 i;
if (!sLinkOpen)
return 0;
for (i = 0; i < CMD_LENGTH; i++)
gSendCmd[i] = 0;
gLinkHeldKeys = *heldKeys;
if (gLinkStatus & LINK_STAT_CONN_ESTABLISHED)
{
ProcessRecvCmds(SIO_MULTI_CNT->id);
if (gLinkCallback != NULL)
gLinkCallback();
CheckErrorStatus();
}
return gLinkStatus;
}
static void HandleReceiveRemoteLinkPlayer(u8 who)
{
int i;
int count;
count = 0;
gRemoteLinkPlayersNotReceived[who] = FALSE;
for (i = 0; i < GetLinkPlayerCount_2(); i++)
count += gRemoteLinkPlayersNotReceived[i];
if (count == 0 && !gReceivedRemoteLinkPlayers)
gReceivedRemoteLinkPlayers = TRUE;
}
static void ProcessRecvCmds(u8 unused)
{
u16 i;
for (i = 0; i < MAX_LINK_PLAYERS; i++)
{
gLinkPartnersHeldKeys[i] = 0;
if (gRecvCmds[i][0] == 0)
continue;
switch (gRecvCmds[i][0])
{
case LINKCMD_SEND_LINK_TYPE:
{
struct LinkPlayerBlock * block;
InitLocalLinkPlayer();
block = &gLocalLinkPlayerBlock;
block->linkPlayer = gLocalLinkPlayer;
memcpy(block->magic1, sASCIIGameFreakInc, sizeof(block->magic1) - 1);
memcpy(block->magic2, sASCIIGameFreakInc, sizeof(block->magic2) - 1);
InitBlockSend(block, sizeof(*block));
break;
}
case LINKCMD_BLENDER_SEND_KEYS:
gLinkPartnersHeldKeys[i] = gRecvCmds[i][1];
break;
case LINKCMD_DUMMY_1:
gLinkDummy2 = TRUE;
break;
case LINKCMD_DUMMY_2:
gLinkDummy2 = TRUE;
break;
case LINKCMD_INIT_BLOCK:
{
struct BlockTransfer * blockRecv;
blockRecv = &sBlockRecv[i];
blockRecv->pos = 0;
blockRecv->size = gRecvCmds[i][1];
blockRecv->multiplayerId = gRecvCmds[i][2];
break;
}
case LINKCMD_CONT_BLOCK:
{
if (sBlockRecv[i].size > BLOCK_BUFFER_SIZE)
{
// Too large block was sent.
}
else
{
u32 j;
for (j = 0; j < CMD_LENGTH - 1; j++)
gBlockRecvBuffer[i][(sBlockRecv[i].pos / 2) + j] = gRecvCmds[i][j + 1];
}
sBlockRecv[i].pos += (CMD_LENGTH - 1) * 2;
if (sBlockRecv[i].pos >= sBlockRecv[i].size)
{
if (gRemoteLinkPlayersNotReceived[i] == TRUE)
{
struct LinkPlayerBlock * block;
struct LinkPlayer * linkPlayer;
block = (struct LinkPlayerBlock *)&gBlockRecvBuffer[i];
linkPlayer = &gLinkPlayers[i];
*linkPlayer = block->linkPlayer;
if ((linkPlayer->version & 0xFF) == VERSION_RUBY || (linkPlayer->version & 0xFF) == VERSION_SAPPHIRE)
{
linkPlayer->progressFlagsCopy = 0;
linkPlayer->neverRead = 0;
linkPlayer->progressFlags = 0;
}
ConvertLinkPlayerName(linkPlayer);
if (strcmp(block->magic1, sASCIIGameFreakInc) != 0
|| strcmp(block->magic2, sASCIIGameFreakInc) != 0)
SetMainCallback2(CB2_LinkError);
else
HandleReceiveRemoteLinkPlayer(i);
}
else
{
SetBlockReceivedFlag(i);
}
}
}
break;
case LINKCMD_READY_CLOSE_LINK:
gReadyToCloseLink[i] = TRUE;
break;
case LINKCMD_READY_EXIT_STANDBY:
gReadyToExitStandby[i] = TRUE;
break;
case LINKCMD_BLENDER_NO_PBLOCK_SPACE:
SetBerryBlenderLinkCallback();
break;
case LINKCMD_SEND_BLOCK_REQ:
SendBlock(0, sBlockRequests[gRecvCmds[i][1]].address, sBlockRequests[gRecvCmds[i][1]].size);
break;
case LINKCMD_SEND_HELD_KEYS:
gLinkPartnersHeldKeys[i] = gRecvCmds[i][1];
break;
}
}
}
void BuildSendCmd(u16 command)
{
switch (command)
{
case LINKCMD_SEND_LINK_TYPE:
gSendCmd[0] = LINKCMD_SEND_LINK_TYPE;
gSendCmd[1] = gLinkType;
break;
case LINKCMD_READY_EXIT_STANDBY:
gSendCmd[0] = LINKCMD_READY_EXIT_STANDBY;
break;
case LINKCMD_BLENDER_SEND_KEYS:
gSendCmd[0] = LINKCMD_BLENDER_SEND_KEYS;
gSendCmd[1] = gMain.heldKeys;
break;
case LINKCMD_DUMMY_1:
gSendCmd[0] = LINKCMD_DUMMY_1;
break;
case LINKCMD_SEND_EMPTY:
gSendCmd[0] = LINKCMD_SEND_EMPTY;
gSendCmd[1] = 0;
break;
case LINKCMD_SEND_0xEE:
{
u8 i;
gSendCmd[0] = LINKCMD_SEND_0xEE;
for (i = 0; i < 5; i++)
gSendCmd[i + 1] = 0xEE;
break;
}
case LINKCMD_INIT_BLOCK:
gSendCmd[0] = LINKCMD_INIT_BLOCK;
gSendCmd[1] = sBlockSend.size;
gSendCmd[2] = sBlockSend.multiplayerId + 0x80;
break;
case LINKCMD_BLENDER_NO_PBLOCK_SPACE:
gSendCmd[0] = LINKCMD_BLENDER_NO_PBLOCK_SPACE;
break;
case LINKCMD_SEND_ITEM:
gSendCmd[0] = LINKCMD_SEND_ITEM;
gSendCmd[1] = gSpecialVar_ItemId;
break;
case LINKCMD_SEND_BLOCK_REQ:
gSendCmd[0] = LINKCMD_SEND_BLOCK_REQ;
gSendCmd[1] = gBlockRequestType;
break;
case LINKCMD_READY_CLOSE_LINK:
gSendCmd[0] = LINKCMD_READY_CLOSE_LINK;
gSendCmd[1] = gReadyCloseLinkType;
break;
case LINKCMD_DUMMY_2:
gSendCmd[0] = LINKCMD_DUMMY_2;
break;
case LINKCMD_SEND_HELD_KEYS:
if (gHeldKeyCodeToSend == 0 || gLinkTransferringData)
{
break;
}
gSendCmd[0] = LINKCMD_SEND_HELD_KEYS;
gSendCmd[1] = gHeldKeyCodeToSend;
break;
}
}
void StartSendingKeysToLink(void)
{
if (gWirelessCommType)
StartSendingKeysToRfu();
gLinkCallback = LinkCB_SendHeldKeys;
}
bool32 IsSendingKeysToLink(void)
{
if (gWirelessCommType)
return IsSendingKeysToRfu();
if (gLinkCallback == LinkCB_SendHeldKeys)
return TRUE;
return FALSE;
}
static void LinkCB_SendHeldKeys(void)
{
if (gReceivedRemoteLinkPlayers == TRUE)
BuildSendCmd(LINKCMD_SEND_HELD_KEYS);
}
void ClearLinkCallback(void)
{
gLinkCallback = NULL;
}
void ClearLinkCallback_2(void)
{
if (gWirelessCommType)
ClearLinkRfuCallback();
else
gLinkCallback = NULL;
}
u8 GetLinkPlayerCount(void)
{
if (gWirelessCommType)
return Rfu_GetLinkPlayerCount();
return EXTRACT_PLAYER_COUNT(gLinkStatus);
}
void OpenLinkTimed(void)
{
sPlayerDataExchangeStatus = EXCHANGE_NOT_STARTED;
sTimeOutCounter = 0;
OpenLink();
}
u8 GetLinkPlayerDataExchangeStatusTimed(int minPlayers, int maxPlayers)
{
int i;
int count;
u32 index;
u8 numPlayers;
count = 0;
if (gReceivedRemoteLinkPlayers == TRUE)
{
numPlayers = GetLinkPlayerCount_2();
if (minPlayers > numPlayers || numPlayers > maxPlayers)
{
sPlayerDataExchangeStatus = EXCHANGE_WRONG_NUM_PLAYERS;
return sPlayerDataExchangeStatus;
}
else
{
if (GetLinkPlayerCount() == 0)
{
gLinkErrorOccurred = TRUE;
CloseLink();
}
for (i = 0, index = 0; i < GetLinkPlayerCount(); index++, i++)
{
if (gLinkPlayers[index].linkType == gLinkPlayers[0].linkType)
count++;
}
if (count == GetLinkPlayerCount())
{
if (gLinkPlayers[0].linkType == LINKTYPE_TRADE_SETUP)
{
switch (GetGameProgressForLinkTrade())
{
case TRADE_BOTH_PLAYERS_READY:
sPlayerDataExchangeStatus = EXCHANGE_COMPLETE;
break;
case TRADE_PLAYER_NOT_READY:
sPlayerDataExchangeStatus = EXCHANGE_PLAYER_NOT_READY;
break;
case TRADE_PARTNER_NOT_READY:
sPlayerDataExchangeStatus = EXCHANGE_PARTNER_NOT_READY;
break;
}
}
else
{
sPlayerDataExchangeStatus = EXCHANGE_COMPLETE;
}
}
else
{
sPlayerDataExchangeStatus = EXCHANGE_DIFF_SELECTIONS;
}
}
}
else if (++sTimeOutCounter > 600)
{
sPlayerDataExchangeStatus = EXCHANGE_TIMED_OUT;
}
return sPlayerDataExchangeStatus;
}
bool8 IsLinkPlayerDataExchangeComplete(void)
{
u8 i;
u8 count;
bool8 retval;
count = 0;
for (i = 0; i < GetLinkPlayerCount(); i++)
{
if (gLinkPlayers[i].linkType == gLinkPlayers[0].linkType)
count++;
}
if (count == GetLinkPlayerCount())
{
retval = TRUE;
sPlayerDataExchangeStatus = EXCHANGE_COMPLETE;
}
else
{
retval = FALSE;
sPlayerDataExchangeStatus = EXCHANGE_DIFF_SELECTIONS;
}
return retval;
}
u32 GetLinkPlayerTrainerId(u8 who)
{
return gLinkPlayers[who].trainerId;
}
void ResetLinkPlayers(void)
{
int i;
for (i = 0; i <= MAX_LINK_PLAYERS; i++)
gLinkPlayers[i] = (struct LinkPlayer){};
}
static void ResetBlockSend(void)
{
sBlockSend.active = FALSE;
sBlockSend.pos = 0;
sBlockSend.size = 0;
sBlockSend.src = NULL;
}
static bool32 InitBlockSend(const void *src, size_t size)
{
if (sBlockSend.active)
return FALSE;
sBlockSend.multiplayerId = GetMultiplayerId();
sBlockSend.active = TRUE;
sBlockSend.size = size;
sBlockSend.pos = 0;
if (size > BLOCK_BUFFER_SIZE)
{
sBlockSend.src = src;
}
else
{
if (src != gBlockSendBuffer)
memcpy(gBlockSendBuffer, src, size);
sBlockSend.src = gBlockSendBuffer;
}
BuildSendCmd(LINKCMD_INIT_BLOCK);
gLinkCallback = LinkCB_BlockSendBegin;
sBlockSendDelayCounter = 0;
return TRUE;
}
static void LinkCB_BlockSendBegin(void)
{
if (++sBlockSendDelayCounter > 2)
gLinkCallback = LinkCB_BlockSend;
}
static void LinkCB_BlockSend(void)
{
int i;
const u8 *src;
src = sBlockSend.src;
gSendCmd[0] = LINKCMD_CONT_BLOCK;
for (i = 0; i < CMD_LENGTH - 1; i++)
gSendCmd[i + 1] = (src[sBlockSend.pos + i * 2 + 1] << 8) | src[sBlockSend.pos + i * 2];
sBlockSend.pos += 14;
if (sBlockSend.size <= sBlockSend.pos)
{
sBlockSend.active = FALSE;
gLinkCallback = LinkCB_BlockSendEnd;
}
}
static void LinkCB_BlockSendEnd(void)
{
gLinkCallback = NULL;
}
static void LinkCB_BerryBlenderSendHeldKeys(void)
{
GetMultiplayerId();
BuildSendCmd(LINKCMD_BLENDER_SEND_KEYS);
gBerryBlenderKeySendAttempts++;
}
static void SetBerryBlenderLinkCallback(void)
{
gBerryBlenderKeySendAttempts = 0;
gLinkCallback = LinkCB_BerryBlenderSendHeldKeys;
}
u8 GetMultiplayerId(void)
{
if (gWirelessCommType == 1)
return Rfu_GetMultiplayerId();
return SIO_MULTI_CNT->id;
}
u8 BitmaskAllOtherLinkPlayers(void)
{
u8 mpId;
mpId = GetMultiplayerId();
return ((1 << MAX_LINK_PLAYERS) - 1) ^ (1 << mpId);
}
bool8 SendBlock(u8 unused, const void *src, u16 size)
{
if (gWirelessCommType == 1)
return Rfu_InitBlockSend(src, size);
return InitBlockSend(src, size);
}
bool8 SendBlockRequest(u8 blockRequestType)
{
if (gWirelessCommType == 1)
return Rfu_SendBlockRequest(blockRequestType);
if (gLinkCallback == NULL)
{
gBlockRequestType = blockRequestType;
BuildSendCmd(LINKCMD_SEND_BLOCK_REQ);
return TRUE;
}
return FALSE;
}
bool8 IsLinkTaskFinished(void)
{
if (gWirelessCommType == 1)
return IsLinkRfuTaskFinished();
return gLinkCallback == NULL;
}
u8 GetBlockReceivedStatus(void)
{
if (gWirelessCommType == 1)
return Rfu_GetBlockReceivedStatus();
return (gBlockReceivedStatus[3] << 3) | (gBlockReceivedStatus[2] << 2) | (gBlockReceivedStatus[1] << 1) | (gBlockReceivedStatus[0] << 0);
}
static void SetBlockReceivedFlag(u8 who)
{
if (gWirelessCommType == 1)
Rfu_SetBlockReceivedFlag(who);
else
gBlockReceivedStatus[who] = TRUE;
}
void ResetBlockReceivedFlags(void)
{
int i;
if (gWirelessCommType == 1)
{
for (i = 0; i < MAX_RFU_PLAYERS; i++)
Rfu_ResetBlockReceivedFlag(i);
}
else
{
for (i = 0; i < MAX_LINK_PLAYERS; i++)
gBlockReceivedStatus[i] = FALSE;
}
}
void ResetBlockReceivedFlag(u8 who)
{
if (gWirelessCommType == 1)
Rfu_ResetBlockReceivedFlag(who);
else if (gBlockReceivedStatus[who])
gBlockReceivedStatus[who] = FALSE;
}
void CheckShouldAdvanceLinkState(void)
{
if ((gLinkStatus & LINK_STAT_MASTER) && EXTRACT_PLAYER_COUNT(gLinkStatus) > 1)
gShouldAdvanceLinkState = 1;
}
static void LinkCB_RequestPlayerDataExchange(void)
{
if (gLinkStatus & LINK_STAT_MASTER)
BuildSendCmd(LINKCMD_SEND_LINK_TYPE);
gLinkCallback = NULL;
}
u8 GetSavedLinkPlayerCountAsBitFlags(void)
{
int i;
u8 flags;
flags = 0;
for (i = 0; i < gSavedLinkPlayerCount; i++)
flags |= (1 << i);
return flags;
}
u8 GetLinkPlayerCountAsBitFlags(void)
{
int i;
u8 flags;
flags = 0;
for (i = 0; i < GetLinkPlayerCount(); i++)
flags |= (1 << i);
return flags;
}
void SaveLinkPlayers(u8 numPlayers)
{
int i;
gSavedLinkPlayerCount = numPlayers;
gSavedMultiplayerId = GetMultiplayerId();
for (i = 0; i < MAX_RFU_PLAYERS; i++)
gSavedLinkPlayers[i] = gLinkPlayers[i];
}
// The number of players when trading began. This is frequently compared against the
// current number of connected players to check if anyone dropped out.
u8 GetSavedPlayerCount(void)
{
return gSavedLinkPlayerCount;
}
void CheckLinkPlayersMatchSaved(void)
{
u8 i;
for (i = 0; i < gSavedLinkPlayerCount; i++)
{
if (gSavedLinkPlayers[i].trainerId != gLinkPlayers[i].trainerId
|| StringCompare(gSavedLinkPlayers[i].name, gLinkPlayers[i].name) != 0)
{
gLinkErrorOccurred = TRUE;
CloseLink();
SetMainCallback2(CB2_LinkError);
}
}
}
void ResetLinkPlayerCount(void)
{
gSavedLinkPlayerCount = 0;
gSavedMultiplayerId = 0;
}
u8 GetLinkPlayerCount_2(void)
{
return EXTRACT_PLAYER_COUNT(gLinkStatus);
}
bool8 IsLinkMaster(void)
{
if (gWirelessCommType)
return Rfu_IsMaster();
return EXTRACT_MASTER(gLinkStatus);
}
void SetCloseLinkCallbackAndType(u16 type)
{
if (gWirelessCommType == 1)
{
Rfu_SetCloseLinkCallback();
}
else
{
if (gLinkCallback == NULL)
{
gLinkCallback = LinkCB_ReadyCloseLink;
gLinkDummy1 = FALSE;
gReadyCloseLinkType = type;
}
}
}
void SetCloseLinkCallback(void)
{
if (gWirelessCommType == 1)
{
Rfu_SetCloseLinkCallback();
}
else
{
if (gLinkCallback != NULL)
{
sReadyCloseLinkAttempts++;
}
else
{
gLinkCallback = LinkCB_ReadyCloseLink;
gLinkDummy1 = FALSE;
gReadyCloseLinkType = 0;
}
}
}
static void LinkCB_ReadyCloseLink(void)
{
if (gLastRecvQueueCount == 0)
{
BuildSendCmd(LINKCMD_READY_CLOSE_LINK);
gLinkCallback = LinkCB_WaitCloseLink;
}
}
static void LinkCB_WaitCloseLink(void)
{
int i;
unsigned count;
// Wait for all players to be ready
u8 linkPlayerCount = GetLinkPlayerCount();
count = 0;
for (i = 0; i < linkPlayerCount; i++)
{
if (gReadyToCloseLink[i])
count++;
}
if (count == linkPlayerCount)
{
// All ready, close link
gBattleTypeFlags &= ~(BATTLE_TYPE_LINK_IN_BATTLE | 0xFFFF0000);
gLinkVSyncDisabled = TRUE;
CloseLink();
gLinkCallback = NULL;
gLinkDummy1 = TRUE;
}
}
void SetLinkStandbyCallback(void)
{
if (gWirelessCommType == 1)
{
Rfu_SetLinkStandbyCallback();
}
else
{
if (gLinkCallback == NULL)
gLinkCallback = LinkCB_Standby;
gLinkDummy1 = FALSE;
}
}
static void LinkCB_Standby(void)
{
if (gLastRecvQueueCount == 0)
{
BuildSendCmd(LINKCMD_READY_EXIT_STANDBY);
gLinkCallback = LinkCB_StandbyForAll;
}
}
static void LinkCB_StandbyForAll(void)
{
u8 i;
u8 linkPlayerCount = GetLinkPlayerCount();
for (i = 0; i < linkPlayerCount; i++)
{
if (!gReadyToExitStandby[i])
break;
}
// If true, all players ready to exit standby
if (i == linkPlayerCount)
{
for (i = 0; i < MAX_LINK_PLAYERS; i++)
gReadyToExitStandby[i] = FALSE;
gLinkCallback = NULL;
}
}
static void CheckErrorStatus(void)
{
// Check if a link error has occurred
if (sLinkOpen && EXTRACT_LINK_ERRORS(gLinkStatus))
{
// Link error has occurred, handle message details if
// necessary, then stop the link.
if (!gSuppressLinkErrorMessage)
{
sLinkErrorBuffer.status = gLinkStatus;
sLinkErrorBuffer.lastRecvQueueCount = gLastRecvQueueCount;
sLinkErrorBuffer.lastSendQueueCount = gLastSendQueueCount;
SetMainCallback2(CB2_LinkError);
}
gLinkErrorOccurred = TRUE;
CloseLink();
}
}
void SetLinkErrorFromRfu(u32 status, u8 lastSendQueueCount, u8 lastRecvQueueCount, u8 isConnectionError)
{
sLinkErrorBuffer.status = status;
sLinkErrorBuffer.lastSendQueueCount = lastSendQueueCount;
sLinkErrorBuffer.lastRecvQueueCount = lastRecvQueueCount;
sLinkErrorBuffer.disconnected = isConnectionError;
}
void CB2_LinkError(void)
{
u8 *tilemapBuffer;
SetGpuReg(REG_OFFSET_DISPCNT, 0);
m4aMPlayStop(&gMPlayInfo_SE1);
m4aMPlayStop(&gMPlayInfo_SE2);
m4aMPlayStop(&gMPlayInfo_SE3);
InitHeap(gHeap, HEAP_SIZE);
ResetSpriteData();
FreeAllSpritePalettes();
ResetPaletteFadeControl();
SetBackdropFromColor(RGB_BLACK);
ResetTasks();
ScanlineEffect_Stop();
if (gWirelessCommType)
{
if (!sLinkErrorBuffer.disconnected)
gWirelessCommType = 3;
ResetLinkRfuGFLayer();
}
SetVBlankCallback(VBlankCB_LinkError);
ResetBgsAndClearDma3BusyFlags(FALSE);
InitBgsFromTemplates(0, sLinkErrorBgTemplates, ARRAY_COUNT(sLinkErrorBgTemplates));
sLinkErrorBgTilemapBuffer = tilemapBuffer = malloc(BG_SCREEN_SIZE);
SetBgTilemapBuffer(1, tilemapBuffer);
if (InitWindows(sLinkErrorWindowTemplates))
{
DeactivateAllTextPrinters();
ResetTempTileDataBuffers();
SetGpuReg(REG_OFFSET_BLDALPHA, 0);
SetGpuReg(REG_OFFSET_BG0HOFS, 0);
SetGpuReg(REG_OFFSET_BG0VOFS, 0);
SetGpuReg(REG_OFFSET_BG1HOFS, 0);
SetGpuReg(REG_OFFSET_BG1VOFS, 0);
ClearGpuRegBits(REG_OFFSET_DISPCNT, DISPCNT_WIN0_ON | DISPCNT_WIN1_ON | DISPCNT_OBJWIN_ON);
LoadPalette(gStandardMenuPalette, BG_PLTT_ID(15), PLTT_SIZE_4BPP);
gSoftResetDisabled = FALSE;
CreateTask(Task_DestroySelf, 0);
StopMapMusic();
gMain.callback1 = NULL;
RunTasks();
AnimateSprites();
BuildOamBuffer();
UpdatePaletteFade();
SetMainCallback2(CB2_PrintErrorMessage);
}
}
static void ErrorMsg_MoveCloserToPartner(void)
{
DecompressAndLoadBgGfxUsingHeap(1, sWirelessLinkDisplayGfx, FALSE, 0, 0);
CopyToBgTilemapBuffer(1, sWirelessLinkDisplayTilemap, 0, 0);
CopyBgTilemapBufferToVram(1);
LoadPalette(sWirelessLinkDisplayPal, BG_PLTT_ID(0), PLTT_SIZE_4BPP);
FillWindowPixelBuffer(0, PIXEL_FILL(0));
FillWindowPixelBuffer(2, PIXEL_FILL(0));
AddTextPrinterParameterized3(0, FONT_NORMAL_COPY_2, 2, 5, sLinkErrorTextColor, 0, gText_CommErrorEllipsis);
AddTextPrinterParameterized3(2, FONT_NORMAL_COPY_2, 2, 2, sLinkErrorTextColor, 0, gText_MoveCloserToLinkPartner);
PutWindowTilemap(0);
PutWindowTilemap(2);
CopyWindowToVram(0, COPYWIN_NONE); // Does nothing
CopyWindowToVram(2, COPYWIN_FULL);
ShowBg(0);
ShowBg(1);
}
static void ErrorMsg_CheckConnections(void)
{
FillWindowPixelBuffer(1, PIXEL_FILL(0));
FillWindowPixelBuffer(2, PIXEL_FILL(0));
AddTextPrinterParameterized3(1, FONT_NORMAL_COPY_2, 2, 0, sLinkErrorTextColor, 0, gText_CommErrorCheckConnections);
PutWindowTilemap(1);
PutWindowTilemap(2);
CopyWindowToVram(1, COPYWIN_NONE); // Does nothing
CopyWindowToVram(2, COPYWIN_FULL);
ShowBg(0);
}
static void CB2_PrintErrorMessage(void)
{
switch (gMain.state)
{
case 0:
// Below is only true for the RFU, so the other error
// type is inferred to be from a wired connection
if (sLinkErrorBuffer.disconnected)
ErrorMsg_MoveCloserToPartner();
else
ErrorMsg_CheckConnections();
break;
case 30:
PlaySE(SE_BOO);
break;
case 60:
PlaySE(SE_BOO);
break;
case 90:
PlaySE(SE_BOO);
break;
case 130:
if (gWirelessCommType == 2)
AddTextPrinterParameterized3(0, FONT_NORMAL_COPY_2, 2, 20, sLinkErrorTextColor, 0, gText_ABtnTitleScreen);
else if (gWirelessCommType == 1)
AddTextPrinterParameterized3(0, FONT_NORMAL_COPY_2, 2, 20, sLinkErrorTextColor, 0, gText_ABtnRegistrationCounter);
break;
}
if (gMain.state == 160)
{
if (gWirelessCommType == 1)
{
if (JOY_NEW(A_BUTTON))
{
HelpSystem_Enable();
PlaySE(SE_PIN);
gWirelessCommType = 0;
sLinkErrorBuffer.disconnected = 0;
ReloadSave();
}
}
else if (gWirelessCommType == 2)
{
if (JOY_NEW(A_BUTTON))
{
HelpSystem_Enable();
rfu_REQ_stopMode();
rfu_waitREQComplete();
DoSoftReset();
}
}
}
if (gMain.state != 160)
gMain.state++;
}
bool8 GetSioMultiSI(void)
{
return (REG_SIOCNT & SIO_MULTI_SI) != 0;
}
bool8 IsLinkConnectionEstablished(void)
{
return EXTRACT_CONN_ESTABLISHED(gLinkStatus);
}
void SetSuppressLinkErrorMessage(bool8 flag)
{
gSuppressLinkErrorMessage = flag;
}
bool8 HasLinkErrorOccurred(void)
{
return gLinkErrorOccurred;
}
void LocalLinkPlayerToBlock(void)
{
struct LinkPlayerBlock * block;
InitLocalLinkPlayer();
block = &gLocalLinkPlayerBlock;
block->linkPlayer = gLocalLinkPlayer;
memcpy(block->magic1, sASCIIGameFreakInc, sizeof(block->magic1) - 1);
memcpy(block->magic2, sASCIIGameFreakInc, sizeof(block->magic2) - 1);
memcpy(gBlockSendBuffer, block, sizeof(*block));
}
void LinkPlayerFromBlock(u32 who)
{
u8 who_ = who;
struct LinkPlayerBlock *block;
struct LinkPlayer *player;
block = (struct LinkPlayerBlock *)gBlockRecvBuffer[who_];
player = &gLinkPlayers[who_];
*player = block->linkPlayer;
ConvertLinkPlayerName(player);
if (strcmp(block->magic1, sASCIIGameFreakInc) != 0
|| strcmp(block->magic2, sASCIIGameFreakInc) != 0)
{
SetMainCallback2(CB2_LinkError);
}
}
// When this function returns TRUE the callbacks are skipped
bool8 HandleLinkConnection(void)
{
bool32 main1Failed;
bool32 main2Failed;
if (gWirelessCommType == 0)
{
gLinkStatus = LinkMain1(&gShouldAdvanceLinkState, gSendCmd, gRecvCmds);
LinkMain2(&gMain.heldKeys);
if ((gLinkStatus & LINK_STAT_RECEIVED_NOTHING) && IsSendingKeysOverCable() == TRUE)
return TRUE;
}
else
{
main1Failed = RfuMain1(); // Always returns FALSE
main2Failed = RfuMain2();
if (IsSendingKeysOverCable() == TRUE)
{
// This will never be reached.
// IsSendingKeysOverCable is always FALSE for wireless communication
if (main1Failed == TRUE || IsRfuRecvQueueEmpty() || main2Failed)
return TRUE;
}
}
return FALSE;
}
void SetWirelessCommType1(void)
{
if (!gReceivedRemoteLinkPlayers)
gWirelessCommType = 1;
}
static void SetWirelessCommType0_Internal(void)
{
if (!gReceivedRemoteLinkPlayers)
gWirelessCommType = 0;
}
// Unused
void SetWirelessCommType0(void)
{
if (!gReceivedRemoteLinkPlayers)
gWirelessCommType = 0;
}
u32 GetLinkRecvQueueLength(void)
{
if (gWirelessCommType != 0)
return GetRfuRecvQueueLength();
return gLink.recvQueue.count;
}
bool32 IsLinkRecvQueueAtOverworldMax(void)
{
if (GetLinkRecvQueueLength() >= OVERWORLD_RECV_QUEUE_MAX)
return TRUE;
return FALSE;
}
void ConvertLinkPlayerName(struct LinkPlayer * player)
{
player->progressFlagsCopy = player->progressFlags; // ? Perhaps relocating for a longer name field
ConvertInternationalString(player->name, player->language);
}
// File break?
static void DisableSerial(void)
{
DisableInterrupts(INTR_FLAG_TIMER3 | INTR_FLAG_SERIAL);
REG_SIOCNT = SIO_MULTI_MODE;
REG_TM3CNT_H = 0;
REG_IF = INTR_FLAG_TIMER3 | INTR_FLAG_SERIAL;
REG_SIOMLT_SEND = 0;
REG_SIOMLT_RECV = 0;
CpuFill32(0, &gLink, sizeof(gLink));
}
static void EnableSerial(void)
{
DisableInterrupts(INTR_FLAG_TIMER3 | INTR_FLAG_SERIAL);
REG_RCNT = 0;
REG_SIOCNT = SIO_MULTI_MODE;
REG_SIOCNT |= SIO_115200_BPS | SIO_INTR_ENABLE;
EnableInterrupts(INTR_FLAG_SERIAL);
REG_SIOMLT_SEND = 0;
CpuFill32(0, &gLink, sizeof(gLink));
sNumVBlanksWithoutSerialIntr = 0;
sSendNonzeroCheck = 0;
sRecvNonzeroCheck = 0;
sChecksumAvailable = 0;
sHandshakePlayerCount = 0;
gLastSendQueueCount = 0;
gLastRecvQueueCount = 0;
}
void ResetSerial(void)
{
EnableSerial();
DisableSerial();
}
u32 LinkMain1(u8 *shouldAdvanceLinkState, u16 *sendCmd, u16 (*recvCmds)[CMD_LENGTH])
{
u32 retVal;
u32 retVal2;
switch (gLink.state)
{
case LINK_STATE_START0:
DisableSerial();
gLink.state = LINK_STATE_START1;
break;
case LINK_STATE_START1:
if (*shouldAdvanceLinkState == 1)
{
EnableSerial();
gLink.state = LINK_STATE_HANDSHAKE;
}
break;
case LINK_STATE_HANDSHAKE:
switch (*shouldAdvanceLinkState)
{
default:
CheckMasterOrSlave();
break;
case 1:
if (gLink.isMaster == LINK_MASTER && gLink.playerCount > 1)
gLink.handshakeAsMaster = TRUE;
break;
case 2:
gLink.state = LINK_STATE_START0;
REG_SIOMLT_SEND = 0;
break;
}
break;
case LINK_STATE_INIT_TIMER:
InitTimer();
gLink.state = LINK_STATE_CONN_ESTABLISHED;
// fallthrough
case LINK_STATE_CONN_ESTABLISHED:
EnqueueSendCmd(sendCmd);
DequeueRecvCmds(recvCmds);
break;
}
*shouldAdvanceLinkState = 0;
retVal = gLink.localId;
retVal |= (gLink.playerCount << LINK_STAT_PLAYER_COUNT_SHIFT);
if (gLink.isMaster == LINK_MASTER)
{
retVal |= LINK_STAT_MASTER;
}
{
u32 receivedNothing = gLink.receivedNothing << LINK_STAT_RECEIVED_NOTHING_SHIFT;
u32 link_field_F = gLink.link_field_F << LINK_STAT_UNK_FLAG_9_SHIFT;
u32 hardwareError = gLink.hardwareError << LINK_STAT_ERROR_HARDWARE_SHIFT;
u32 badChecksum = gLink.badChecksum << LINK_STAT_ERROR_CHECKSUM_SHIFT;
u32 queueFull = gLink.queueFull << LINK_STAT_ERROR_QUEUE_FULL_SHIFT;
u32 val;
if (gLink.state == LINK_STATE_CONN_ESTABLISHED)
{
val = LINK_STAT_CONN_ESTABLISHED;
val |= receivedNothing;
val |= retVal;
val |= link_field_F;
val |= hardwareError;
val |= badChecksum;
val |= queueFull;
}
else
{
val = retVal;
val |= receivedNothing;
val |= link_field_F;
val |= hardwareError;
val |= badChecksum;
val |= queueFull;
}
retVal = val;
}
if (gLink.lag == LAG_MASTER)
retVal |= LINK_STAT_ERROR_LAG_MASTER;
if (gLink.localId >= MAX_LINK_PLAYERS)
retVal |= LINK_STAT_ERROR_INVALID_ID;
retVal2 = retVal;
if (gLink.lag == LAG_SLAVE)
retVal2 |= LINK_STAT_ERROR_LAG_SLAVE;
return retVal2;
}
static void CheckMasterOrSlave(void)
{
u32 terminals;
terminals = *(vu32 *)REG_ADDR_SIOCNT & (SIO_MULTI_SD | SIO_MULTI_SI);
if (terminals == SIO_MULTI_SD && gLink.localId == 0)
gLink.isMaster = LINK_MASTER;
else
gLink.isMaster = LINK_SLAVE;
}
static void InitTimer(void)
{
if (gLink.isMaster)
{
REG_TM3CNT_L = -197;
REG_TM3CNT_H = TIMER_64CLK | TIMER_INTR_ENABLE;
EnableInterrupts(INTR_FLAG_TIMER3);
}
}
static void EnqueueSendCmd(u16 *sendCmd)
{
u8 i;
u8 offset;
gLinkSavedIme = REG_IME;
REG_IME = 0;
if (gLink.sendQueue.count < QUEUE_CAPACITY)
{
offset = gLink.sendQueue.pos + gLink.sendQueue.count;
if (offset >= QUEUE_CAPACITY)
offset -= QUEUE_CAPACITY;
for (i = 0; i < CMD_LENGTH; i++)
{
sSendNonzeroCheck |= *sendCmd;
gLink.sendQueue.data[i][offset] = *sendCmd;
*sendCmd = 0;
sendCmd++;
}
}
else
{
gLink.queueFull = QUEUE_FULL_SEND;
}
if (sSendNonzeroCheck)
{
gLink.sendQueue.count++;
sSendNonzeroCheck = 0;
}
REG_IME = gLinkSavedIme;
gLastSendQueueCount = gLink.sendQueue.count;
}
static void DequeueRecvCmds(u16 (*recvCmds)[CMD_LENGTH])
{
u8 i;
u8 j;
gLinkSavedIme = REG_IME;
REG_IME = 0;
if (gLink.recvQueue.count == 0)
{
for (i = 0; i < gLink.playerCount; i++)
{
for (j = 0; j < CMD_LENGTH; j++)
recvCmds[i][j] = 0;
}
gLink.receivedNothing = TRUE;
}
else
{
for (i = 0; i < gLink.playerCount; i++)
{
for (j = 0; j < CMD_LENGTH; j++)
recvCmds[i][j] = gLink.recvQueue.data[i][j][gLink.recvQueue.pos];
}
gLink.recvQueue.count--;
gLink.recvQueue.pos++;
if (gLink.recvQueue.pos >= QUEUE_CAPACITY)
gLink.recvQueue.pos = 0;
gLink.receivedNothing = FALSE;
}
REG_IME = gLinkSavedIme;
}
void LinkVSync(void)
{
if (gLink.isMaster)
{
switch (gLink.state)
{
case LINK_STATE_CONN_ESTABLISHED:
if (gLink.serialIntrCounter < 9)
{
if (gLink.hardwareError != TRUE)
gLink.lag = LAG_MASTER;
else
StartTransfer();
}
else if (gLink.lag != LAG_MASTER)
{
gLink.serialIntrCounter = 0;
StartTransfer();
}
break;
case LINK_STATE_HANDSHAKE:
StartTransfer();
break;
}
}
else if (gLink.state == LINK_STATE_CONN_ESTABLISHED || gLink.state == LINK_STATE_HANDSHAKE)
{
if (++sNumVBlanksWithoutSerialIntr > 10)
{
if (gLink.state == LINK_STATE_CONN_ESTABLISHED)
gLink.lag = LAG_SLAVE;
if (gLink.state == LINK_STATE_HANDSHAKE)
{
gLink.playerCount = 0;
gLink.link_field_F = FALSE;
}
}
}
}
void Timer3Intr(void)
{
StopTimer();
StartTransfer();
}
void SerialCB(void)
{
gLink.localId = SIO_MULTI_CNT->id;
switch (gLink.state)
{
case LINK_STATE_CONN_ESTABLISHED:
gLink.hardwareError = SIO_MULTI_CNT->error;
DoRecv();
DoSend();
SendRecvDone();
break;
case LINK_STATE_HANDSHAKE:
if (DoHandshake())
{
if (gLink.isMaster)
{
gLink.state = LINK_STATE_INIT_TIMER;
gLink.serialIntrCounter = 8;
}
else
{
gLink.state = LINK_STATE_CONN_ESTABLISHED;
}
}
break;
}
gLink.serialIntrCounter++;
sNumVBlanksWithoutSerialIntr = 0;
if (gLink.serialIntrCounter == 8)
gLastRecvQueueCount = gLink.recvQueue.count;
}
static void StartTransfer(void)
{
REG_SIOCNT |= SIO_START;
}
static bool8 DoHandshake(void)
{
u8 i;
u8 playerCount;
u16 minRecv;
playerCount = 0;
minRecv = 0xFFFF;
if (gLink.handshakeAsMaster == TRUE)
REG_SIOMLT_SEND = MASTER_HANDSHAKE;
else
REG_SIOMLT_SEND = SLAVE_HANDSHAKE;
*(u64 *)gLink.tempRecvBuffer = REG_SIOMLT_RECV;
REG_SIOMLT_RECV = 0;
gLink.handshakeAsMaster = FALSE;
for (i = 0; i < 4; i++)
{
if ((gLink.tempRecvBuffer[i] & ~0x3) == SLAVE_HANDSHAKE || gLink.tempRecvBuffer[i] == MASTER_HANDSHAKE)
{
playerCount++;
if (minRecv > gLink.tempRecvBuffer[i] && gLink.tempRecvBuffer[i] != 0)
minRecv = gLink.tempRecvBuffer[i];
}
else
{
if (gLink.tempRecvBuffer[i] != 0xFFFF)
playerCount = 0;
break;
}
}
gLink.playerCount = playerCount;
if (gLink.playerCount > 1 && gLink.playerCount == sHandshakePlayerCount && gLink.tempRecvBuffer[0] == MASTER_HANDSHAKE)
return TRUE;
if (gLink.playerCount > 1)
gLink.link_field_F = (minRecv & 3) + 1;
else
gLink.link_field_F = 0;
sHandshakePlayerCount = gLink.playerCount;
return FALSE;
}
static void DoRecv(void)
{
u16 recv[4];
u8 i;
u8 index;
*(u64 *)recv = REG_SIOMLT_RECV;
if (gLink.sendCmdIndex == 0)
{
for (i = 0; i < gLink.playerCount; i++)
{
if (gLink.checksum != recv[i] && sChecksumAvailable)
gLink.badChecksum = TRUE;
}
gLink.checksum = 0;
sChecksumAvailable = TRUE;
}
else
{
index = gLink.recvQueue.pos + gLink.recvQueue.count;
if (index >= QUEUE_CAPACITY)
index -= QUEUE_CAPACITY;
if (gLink.recvQueue.count < QUEUE_CAPACITY)
{
for (i = 0; i < gLink.playerCount; i++)
{
gLink.checksum += recv[i];
sRecvNonzeroCheck |= recv[i];
gLink.recvQueue.data[i][gLink.recvCmdIndex][index] = recv[i];
}
}
else
{
gLink.queueFull = QUEUE_FULL_RECV;
}
gLink.recvCmdIndex++;
if (gLink.recvCmdIndex == CMD_LENGTH && sRecvNonzeroCheck)
{
gLink.recvQueue.count++;
sRecvNonzeroCheck = 0;
}
}
}
static void DoSend(void)
{
if (gLink.sendCmdIndex == CMD_LENGTH)
{
REG_SIOMLT_SEND = gLink.checksum;
if (!sSendBufferEmpty)
{
gLink.sendQueue.count--;
gLink.sendQueue.pos++;
if (gLink.sendQueue.pos >= QUEUE_CAPACITY)
gLink.sendQueue.pos = 0;
}
else
{
sSendBufferEmpty = FALSE;
}
}
else
{
if (!sSendBufferEmpty && gLink.sendQueue.count == 0)
sSendBufferEmpty = TRUE;
if (sSendBufferEmpty)
REG_SIOMLT_SEND = 0;
else
REG_SIOMLT_SEND = gLink.sendQueue.data[gLink.sendCmdIndex][gLink.sendQueue.pos];
gLink.sendCmdIndex++;
}
}
static void StopTimer(void)
{
if (gLink.isMaster)
{
REG_TM3CNT_H &= ~TIMER_ENABLE;
REG_TM3CNT_L = -197;
}
}
static void SendRecvDone(void)
{
if (gLink.recvCmdIndex == CMD_LENGTH)
{
gLink.sendCmdIndex = 0;
gLink.recvCmdIndex = 0;
}
else if (gLink.isMaster)
{
REG_TM3CNT_H |= TIMER_ENABLE;
}
}
void ResetSendBuffer(void)
{
u8 i;
u8 j;
gLink.sendQueue.count = 0;
gLink.sendQueue.pos = 0;
for (i = 0; i < CMD_LENGTH; i++)
{
for (j = 0; j < QUEUE_CAPACITY; j++)
gLink.sendQueue.data[i][j] = LINKCMD_NONE;
}
}
void ResetRecvBuffer(void)
{
u8 i;
u8 j;
u8 k;
gLink.recvQueue.count = 0;
gLink.recvQueue.pos = 0;
for (i = 0; i < MAX_LINK_PLAYERS; i++)
{
for (j = 0; j < CMD_LENGTH; j++)
{
for (k = 0; k < QUEUE_CAPACITY; k++)
gLink.recvQueue.data[i][j][k] = LINKCMD_NONE;
}
}
}
Reference in New Issue View Git Blame Copy Permalink