mirror of https://github.com/AxioDL/metaforce.git
Working GBALink
This commit is contained in:
Jack Andersen
parent
9109151bf9
commit
64b93b4792
129
gbalink/main.cpp
129
gbalink/main.cpp
|
|
@ -303,7 +303,7 @@ CGBASupport* CGBASupport::SharedInstance;
|
|||
static net::Socket DataServer = {false};
|
||||
static net::Socket DataSocket = {false};
|
||||
static net::Socket ClockServer = {false};
|
||||
static net::Socket ClockSocket = {true};
|
||||
static net::Socket ClockSocket = {false};
|
||||
static u8 Cmd = 0;
|
||||
static u64 LastGCTick = 0;
|
||||
static u64 TimeCmdSent = 0;
|
||||
|
|
@ -317,11 +317,16 @@ static u64 GetGCTicks()
|
|||
return mach_absolute_time() * MachToDolphinNum / MachToDolphinDenom;
|
||||
}
|
||||
|
||||
static constexpr u64 GetGCTicksPerSec()
|
||||
{
|
||||
return 486000000ull;
|
||||
}
|
||||
|
||||
static void WaitGCTicks(u64 ticks)
|
||||
{
|
||||
struct timeval tv = {};
|
||||
tv.tv_sec = ticks / 486000000;
|
||||
tv.tv_usec = (ticks % 486000000) * 1000000 / 486000000;
|
||||
tv.tv_sec = ticks / GetGCTicksPerSec();
|
||||
tv.tv_usec = (ticks % GetGCTicksPerSec()) * 1000000 / GetGCTicksPerSec();
|
||||
select(0, NULL, NULL, NULL, &tv);
|
||||
}
|
||||
|
||||
|
|
@ -364,7 +369,7 @@ static u64 GetTransferTime(u8 cmd)
|
|||
break;
|
||||
}
|
||||
}
|
||||
return bytes * 486000000ull / BYTES_PER_SECOND;
|
||||
return bytes * GetGCTicksPerSec() / BYTES_PER_SECOND;
|
||||
}
|
||||
|
||||
static void ClockSync()
|
||||
|
|
@ -376,13 +381,13 @@ static void ClockSync()
|
|||
if (!LastGCTick)
|
||||
{
|
||||
LastGCTick = GetGCTicks();
|
||||
TickDelta = 486000000ull / 60;
|
||||
TickDelta = GetGCTicksPerSec() / 60;
|
||||
}
|
||||
else
|
||||
TickDelta = GetGCTicks() - LastGCTick;
|
||||
|
||||
/* Scale GameCube clock into GBA clock */
|
||||
TickDelta = u32(u64(TickDelta) * 16777216 / 486000000);
|
||||
TickDelta = u32(u64(TickDelta) * 16777216 / GetGCTicksPerSec());
|
||||
LastGCTick = GetGCTicks();
|
||||
TickDelta = hecl::SBig(TickDelta);
|
||||
u8* deltaStr = reinterpret_cast<u8*>(&TickDelta);
|
||||
|
|
@ -395,7 +400,6 @@ static void Send(const u8* buffer)
|
|||
{
|
||||
Cmd = buffer[0];
|
||||
|
||||
//DataSocket.setBlocking(true);
|
||||
ssize_t status;
|
||||
if (Cmd == CMD_WRITE)
|
||||
status = DataSocket.send(buffer, 5);
|
||||
|
|
@ -477,15 +481,6 @@ static u64 TimeSent = 0;
|
|||
|
||||
static size_t RunBuffer(u8* buffer, u64& remTicks)
|
||||
{
|
||||
/*
|
||||
if (TimeSent)
|
||||
{
|
||||
s64 waitDelta = GetGCTicks() - TimeSent;
|
||||
if (GetTransferTime(Cmd) > waitDelta)
|
||||
return 0;
|
||||
}
|
||||
*/
|
||||
|
||||
if (!WaitingForResp)
|
||||
{
|
||||
DataReceivedBytes = 0;
|
||||
|
|
@ -629,20 +624,11 @@ static s32 GBAWrite(s32 chan, u8* src, u8* status)
|
|||
return GBA_READY;
|
||||
}
|
||||
|
||||
static const u8 KawasedoLUT[] =
|
||||
{
|
||||
0x18, 0xFC, 0xC0, 0x80, 0x7F, 0x40, 0x3F, 0x01, 0x00, 0x2F,
|
||||
0x2F, 0x20, 0x43, 0x6F, 0x64, 0x65, 0x64, 0x20, 0x62, 0x79,
|
||||
0x20, 0x4B, 0x61, 0x77, 0x61, 0x73, 0x65, 0x64, 0x6F, 0x00,
|
||||
0x00, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0xAC, 0xC4,
|
||||
0xF8, 0x08, 0x10, 0xBF, 0x18, 0x00, 0x00, 0x00
|
||||
};
|
||||
|
||||
/** Self-contained class for solving Kawasedo's GBA BootROM challenge.
|
||||
* GBA will boot client_pad.bin code on completion. */
|
||||
class CKawasedoChallenge
|
||||
{
|
||||
/** DSP-hosted HMAC function
|
||||
/** DSP-hosted public-key unwrap and initial message crypt
|
||||
* Reference: https://github.com/dolphin-emu/dolphin/blob/master/Source/Core/Core/HW/DSPHLE/UCodes/GBA.cpp */
|
||||
struct DSPSecParms
|
||||
{
|
||||
|
|
@ -656,10 +642,10 @@ class CKawasedoChallenge
|
|||
ShortAndLong x4_pColor; /* Palette of Nintendo logo */
|
||||
ShortAndLong x8_pSpeed; /* Speed of logo pulsing */
|
||||
u32 xc_progLen; /* Length of program to boot */
|
||||
//u32* x10_resultsDest; /* Written to resK1 and resK2 instead */
|
||||
//u32* x10_resultsDest; /* Written to x20_publicKey and x24_initMessage instead */
|
||||
|
||||
u32 x20_resK1; /* Transformed key */
|
||||
u32 x24_resHMAC; /* Message authentication code */
|
||||
u32 x20_publicKey; /* Transformed public key */
|
||||
u32 x24_initMessage; /* Message authentication code */
|
||||
|
||||
void ProcessGBACrypto()
|
||||
{
|
||||
|
|
@ -706,8 +692,8 @@ class CKawasedoChallenge
|
|||
}
|
||||
|
||||
// Send the result back to mram
|
||||
x20_resK1 = (x20 << 16) | x21;
|
||||
x24_resHMAC = (x22 << 16) | x23;
|
||||
x20_publicKey = (x20 << 16) | x21;
|
||||
x24_initMessage = (x22 << 16) | x23;
|
||||
|
||||
printf("key: %08x, len: %08x, unk1: %08x, unk2: %08x 20: %04x, 21: %04x, 22: %04x, 23: %04x\n",
|
||||
x0_gbaK1.l, xc_progLen,
|
||||
|
|
@ -732,7 +718,7 @@ class CKawasedoChallenge
|
|||
u32 x38_crc;
|
||||
u32 x3c_checkStore[7];
|
||||
s32 x58_currentKey;
|
||||
s32 x5c_HMAC;
|
||||
s32 x5c_initMessage;
|
||||
s32 x60_gameId;
|
||||
u32 x64_totalBytes;
|
||||
|
||||
|
|
@ -789,7 +775,6 @@ class CKawasedoChallenge
|
|||
void GBAX02()
|
||||
{
|
||||
xf8_dspHmac.x0_gbaK1.l = reinterpret_cast<u32&>(x18_readBuf);
|
||||
xf8_dspHmac.x0_gbaK1.l = hecl::SBig(0xd3aa85a2);
|
||||
xf8_dspHmac.x4_pColor.l = x0_pColor;
|
||||
xf8_dspHmac.x8_pSpeed.l = x4_pSpeed;
|
||||
xf8_dspHmac.xc_progLen = xc_progLen;
|
||||
|
|
@ -798,9 +783,8 @@ class CKawasedoChallenge
|
|||
|
||||
bool GBAX01()
|
||||
{
|
||||
x58_currentKey = xf8_dspHmac.x20_resK1;
|
||||
x58_currentKey = 0xd3aa85a2;
|
||||
x5c_HMAC = xf8_dspHmac.x24_resHMAC;
|
||||
x58_currentKey = xf8_dspHmac.x20_publicKey;
|
||||
x5c_initMessage = xf8_dspHmac.x24_initMessage;
|
||||
|
||||
x20_byteInWindow = ROUND_UP_8(xc_progLen);
|
||||
if (x20_byteInWindow < 512)
|
||||
|
|
@ -809,7 +793,7 @@ class CKawasedoChallenge
|
|||
x20_byteInWindow -= 512;
|
||||
x20_byteInWindow /= 8;
|
||||
|
||||
reinterpret_cast<u32&>(x1c_writeBuf) = x5c_HMAC;
|
||||
reinterpret_cast<u32&>(x1c_writeBuf) = x5c_initMessage;
|
||||
|
||||
x38_crc = 0x15a0;
|
||||
x34_bytesSent = 0;
|
||||
|
|
@ -879,18 +863,18 @@ class CKawasedoChallenge
|
|||
|
||||
if (x34_bytesSent >= 0xc0)
|
||||
{
|
||||
u32 checksum2 = cryptWindow;
|
||||
u32 tmpSecret = x38_crc;
|
||||
u32 shiftWindow = cryptWindow;
|
||||
u32 shiftCrc = x38_crc;
|
||||
for (int i=0 ; i<32 ; ++i)
|
||||
{
|
||||
if ((checksum2 ^ tmpSecret) & 0x1)
|
||||
tmpSecret = (tmpSecret >> 1) ^ 0xa1c1;
|
||||
if ((shiftWindow ^ shiftCrc) & 0x1)
|
||||
shiftCrc = (shiftCrc >> 1) ^ 0xa1c1;
|
||||
else
|
||||
tmpSecret >>= 1;
|
||||
shiftCrc >>= 1;
|
||||
|
||||
checksum2 >>= 1;
|
||||
shiftWindow >>= 1;
|
||||
}
|
||||
x38_crc = tmpSecret;
|
||||
x38_crc = shiftCrc;
|
||||
}
|
||||
|
||||
if (x34_bytesSent == 0x1f8)
|
||||
|
|
@ -913,7 +897,7 @@ class CKawasedoChallenge
|
|||
x58_currentKey = 0x6177614b * x58_currentKey + 1;
|
||||
|
||||
cryptWindow ^= x58_currentKey;
|
||||
cryptWindow ^= -((0x20 << 20) + x34_bytesSent);
|
||||
cryptWindow ^= -(0x2000000 + x34_bytesSent);
|
||||
cryptWindow ^= 0x20796220;
|
||||
}
|
||||
|
||||
|
|
@ -980,7 +964,7 @@ class CKawasedoChallenge
|
|||
return false;
|
||||
}
|
||||
|
||||
if (*x10_statusPtr == GBA_JSTAT_SEND)
|
||||
if (*x10_statusPtr != GBA_JSTAT_SEND)
|
||||
{
|
||||
if (GBAGetStatus(m_chan, x10_statusPtr) != GBA_READY)
|
||||
{
|
||||
|
|
@ -1103,14 +1087,12 @@ static s32 GBAJoyBootAsync(s32 chan, s32 paletteColor, s32 paletteSpeed,
|
|||
return GBA_READY;
|
||||
}
|
||||
|
||||
static u32 calculateJBusChecksum(const u8* data, size_t len)
|
||||
static u8 calculateJBusChecksum(const u8* data, size_t len)
|
||||
{
|
||||
const u8* ptr = data;
|
||||
u32 sum = -1;
|
||||
for (int i = len ; i > 0; --i)
|
||||
for (int i = 0 ; i < len; ++i)
|
||||
{
|
||||
u8 ch = *ptr;
|
||||
ptr++;
|
||||
u8 ch = *data++;
|
||||
sum ^= ch;
|
||||
for (int j = 0; j < 8; ++j)
|
||||
{
|
||||
|
|
@ -1123,7 +1105,6 @@ static u32 calculateJBusChecksum(const u8* data, size_t len)
|
|||
sum >>= 1;
|
||||
}
|
||||
}
|
||||
|
||||
return sum;
|
||||
}
|
||||
|
||||
|
|
@ -1182,7 +1163,7 @@ bool CGBASupport::PollResponse()
|
|||
return false;
|
||||
|
||||
u64 profStart = GetGCTicks();
|
||||
const u64 timeToSpin = 486000000ull / 8000;
|
||||
const u64 timeToSpin = GetGCTicksPerSec() / 8000;
|
||||
for (;;)
|
||||
{
|
||||
u64 curTime = GetGCTicks();
|
||||
|
|
@ -1204,11 +1185,10 @@ bool CGBASupport::PollResponse()
|
|||
if (GBARead(x40_siChan, bytes, &status) != GBA_READY)
|
||||
return false;
|
||||
|
||||
u32 swapped = hecl::SBig(reinterpret_cast<u32&>(bytes));
|
||||
if (bytes[0] != calculateJBusChecksum(reinterpret_cast<u8*>(&swapped), 3))
|
||||
if (bytes[3] != calculateJBusChecksum(bytes, 3))
|
||||
return false;
|
||||
|
||||
x44_fusionLinked = (bytes[2] & 0x2) != 0;
|
||||
x44_fusionLinked = (bytes[2] & 0x2) == 0;
|
||||
if (x44_fusionLinked && (bytes[2] & 0x1) != 0)
|
||||
x45_fusionBeat = true;
|
||||
|
||||
|
|
@ -1257,12 +1237,6 @@ void CGBASupport::Update(float dt)
|
|||
x34_phase = EPhase::Complete;
|
||||
break;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Synchronous mode */
|
||||
x34_phase = EPhase::Failed;
|
||||
break;
|
||||
}
|
||||
x38_timeout = std::max(0.f, x38_timeout - dt);
|
||||
if (x38_timeout == 0.f)
|
||||
x34_phase = EPhase::Failed;
|
||||
|
|
@ -1305,7 +1279,7 @@ int main(int argc, char** argv)
|
|||
{
|
||||
mach_timebase_info_data_t timebase;
|
||||
mach_timebase_info(&timebase);
|
||||
MachToDolphinNum = 486000000ull * timebase.numer;
|
||||
MachToDolphinNum = GetGCTicksPerSec() * timebase.numer;
|
||||
MachToDolphinDenom = 1000000000ull * timebase.denom;
|
||||
|
||||
CGBASupport gba("client_pad.bin");
|
||||
|
|
@ -1315,21 +1289,24 @@ int main(int argc, char** argv)
|
|||
|
||||
printf("Waiting 5 sec\n");
|
||||
s64 waitedTicks = 0;
|
||||
while (waitedTicks < 486000000ll * 5)
|
||||
while (waitedTicks < GetGCTicksPerSec() * 5)
|
||||
{
|
||||
s64 start = GetGCTicks();
|
||||
u8 status;
|
||||
GBAGetStatus(1, &status);
|
||||
s64 end = GetGCTicks();
|
||||
s64 passedTicks = end - start;
|
||||
s64 waitTicks = 486000000ll / 1 - passedTicks;
|
||||
if (waitTicks > 0)
|
||||
{
|
||||
WaitGCTicks(waitTicks);
|
||||
waitedTicks += 486000000ll / 1;
|
||||
}
|
||||
else
|
||||
waitedTicks += passedTicks;
|
||||
waitedTicks += end - start;
|
||||
|
||||
WaitGCTicks(GetGCTicksPerSec() * 0.684);
|
||||
waitedTicks += GetGCTicksPerSec() * 0.684;
|
||||
|
||||
start = GetGCTicks();
|
||||
GBAGetStatus(1, &status);
|
||||
end = GetGCTicks();
|
||||
waitedTicks += end - start;
|
||||
|
||||
WaitGCTicks(GetGCTicksPerSec() * 0.066);
|
||||
waitedTicks += GetGCTicksPerSec() * 0.066;
|
||||
}
|
||||
|
||||
printf("Connecting\n");
|
||||
|
|
@ -1337,14 +1314,16 @@ int main(int argc, char** argv)
|
|||
{
|
||||
s64 frameStart = GetGCTicks();
|
||||
gba.Update(1.f / 60.f);
|
||||
fflush(stdout);
|
||||
s64 frameEnd = GetGCTicks();
|
||||
s64 passedTicks = frameEnd - frameStart;
|
||||
s64 waitTicks = 486000000ll / 60 - passedTicks;
|
||||
s64 waitTicks = GetGCTicksPerSec() / 60 - passedTicks;
|
||||
if (waitTicks > 0)
|
||||
WaitGCTicks(waitTicks);
|
||||
}
|
||||
|
||||
u8 status;
|
||||
GBAGetStatus(1, &status);
|
||||
|
||||
CGBASupport::EPhase finalPhase = gba.GetPhase();
|
||||
printf("%s Linked: %d Beat: %d\n",
|
||||
finalPhase == CGBASupport::EPhase::Complete ? "Complete" : "Failed",
|
||||
|
|
|
|||
Loading…
Reference in New Issue