mirror of https://github.com/AxioDL/jbus.git
785 lines
21 KiB
C++
785 lines
21 KiB
C++
#include "jbus/Endpoint.hpp"
|
|
|
|
#include <algorithm>
|
|
|
|
#define LOG_TRANSFER 0
|
|
|
|
#if LOG_TRANSFER
|
|
#include <cstdio>
|
|
#endif
|
|
|
|
namespace jbus {
|
|
|
|
#define ROUND_UP_8(val) (((val) + 7) & ~7)
|
|
|
|
void Endpoint::KawasedoChallenge::DSPSecParms::ProcessGBACrypto() {
|
|
/* Unwrap key from challenge using 'sedo' magic number (to encrypt JoyBoot program) */
|
|
x20_key = x0_gbaChallenge ^ 0x6f646573;
|
|
|
|
/* Pack palette parameters */
|
|
u16 paletteSpeedCoded;
|
|
s16 logoSpeed = static_cast<s8>(x8_logoSpeed);
|
|
if (logoSpeed < 0)
|
|
paletteSpeedCoded = ((-logoSpeed + 2) * 2) | (x4_logoPalette << 4);
|
|
else if (logoSpeed == 0)
|
|
paletteSpeedCoded = (x4_logoPalette * 2) | 0x70;
|
|
else /* logo_speed > 0 */
|
|
paletteSpeedCoded = ((logoSpeed - 1) * 2) | (x4_logoPalette << 4);
|
|
|
|
/* JoyBoot ROMs start with a padded header; this is the length beyond that header */
|
|
s32 lengthNoHeader = ROUND_UP_8(xc_progLength) - 0x200;
|
|
|
|
/* The JoyBus protocol transmits in 4-byte packets while flipping a state flag;
|
|
* so the GBA BIOS counts the program length in 8-byte packet-pairs */
|
|
u16 packetPairCount = (lengthNoHeader < 0) ? 0 : lengthNoHeader / 8;
|
|
paletteSpeedCoded |= (packetPairCount & 0x4000) >> 14;
|
|
|
|
/* Pack together encoded transmission parameters */
|
|
u32 t1 = (((packetPairCount << 16) | 0x3f80) & 0x3f80ffff) * 2;
|
|
t1 += (static_cast<s16>(static_cast<s8>(t1 >> 8)) & packetPairCount) << 16;
|
|
u32 t2 = ((paletteSpeedCoded & 0xff) << 16) + (t1 & 0xff0000) + ((t1 >> 8) & 0xffff00);
|
|
u32 t3 = paletteSpeedCoded << 16 | ((t2 << 8) & 0xff000000) | (t1 >> 16) | 0x80808080;
|
|
|
|
/* Wrap with 'Kawa' or 'sedo' (Kawasedo is the author of the BIOS cipher) */
|
|
x24_authInitCode = t3 ^ ((t3 & 0x200) != 0 ? 0x6f646573 : 0x6177614b);
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_0Reset(ThreadLocalEndpoint& endpoint, EJoyReturn status) {
|
|
if (status != GBA_READY ||
|
|
(status = endpoint.GBAResetAsync(x10_statusPtr, bindThis(&KawasedoChallenge::_1GetStatus))) != GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_1GetStatus(ThreadLocalEndpoint& endpoint, EJoyReturn status) {
|
|
if (status == GBA_READY)
|
|
if (*x10_statusPtr != GBA_JSTAT_SEND)
|
|
status = GBA_JOYBOOT_UNKNOWN_STATE;
|
|
|
|
if (status != GBA_READY || (status = endpoint.GBAGetStatusAsync(
|
|
x10_statusPtr, bindThis(&KawasedoChallenge::_2ReadChallenge))) != GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_2ReadChallenge(ThreadLocalEndpoint& endpoint, EJoyReturn status) {
|
|
if (status == GBA_READY)
|
|
if (*x10_statusPtr != (GBA_JSTAT_PSF0 | GBA_JSTAT_SEND))
|
|
status = GBA_JOYBOOT_UNKNOWN_STATE;
|
|
|
|
if (status != GBA_READY || (status = endpoint.GBAReadAsync(x18_readBuf, x10_statusPtr,
|
|
bindThis(&KawasedoChallenge::_3DSPCrypto))) != GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_3DSPCrypto(ThreadLocalEndpoint& endpoint, EJoyReturn status) {
|
|
if (status != GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
} else {
|
|
_DSPCryptoInit();
|
|
_DSPCryptoDone(endpoint);
|
|
}
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_DSPCryptoInit() {
|
|
xf8_dspHmac.x0_gbaChallenge = reinterpret_cast<u32&>(x18_readBuf);
|
|
xf8_dspHmac.x4_logoPalette = x0_pColor;
|
|
xf8_dspHmac.x8_logoSpeed = x4_pSpeed;
|
|
xf8_dspHmac.xc_progLength = xc_progLen;
|
|
xf8_dspHmac.ProcessGBACrypto();
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_DSPCryptoDone(ThreadLocalEndpoint& endpoint) {
|
|
x58_currentKey = xf8_dspHmac.x20_key;
|
|
x5c_initMessage = xf8_dspHmac.x24_authInitCode;
|
|
|
|
x20_byteInWindow = ROUND_UP_8(xc_progLen);
|
|
if (x20_byteInWindow < 512)
|
|
x20_byteInWindow = 512;
|
|
x64_totalBytes = x20_byteInWindow;
|
|
x20_byteInWindow -= 512;
|
|
x20_byteInWindow /= 8;
|
|
|
|
reinterpret_cast<u32&>(x1c_writeBuf) = x5c_initMessage;
|
|
|
|
x38_crc = 0x15a0;
|
|
x34_bytesSent = 0;
|
|
|
|
x28_ticksAfterXf = GetGCTicks();
|
|
x30_justStarted = 1;
|
|
|
|
EJoyReturn status;
|
|
if ((status = endpoint.GBAWriteAsync(x1c_writeBuf, x10_statusPtr, bindThis(&KawasedoChallenge::_4TransmitProgram))) !=
|
|
GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_4TransmitProgram(ThreadLocalEndpoint& endpoint, EJoyReturn status) {
|
|
if (status != GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
return;
|
|
}
|
|
|
|
#if LOG_TRANSFER
|
|
printf("PROG [%d/%d]\n", x34_bytesSent, x64_totalBytes);
|
|
#endif
|
|
if (x30_justStarted) {
|
|
x30_justStarted = 0;
|
|
} else {
|
|
if (!(*x10_statusPtr & GBA_JSTAT_PSF1) || (*x10_statusPtr & GBA_JSTAT_PSF0) >> 4 != (x34_bytesSent & 4) >> 2) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, GBA_JOYBOOT_UNKNOWN_STATE);
|
|
x14_callback = {};
|
|
}
|
|
return;
|
|
}
|
|
x34_bytesSent += 4;
|
|
}
|
|
|
|
if (x34_bytesSent <= x64_totalBytes) {
|
|
u32 cryptWindow;
|
|
if (x34_bytesSent != x64_totalBytes) {
|
|
x20_byteInWindow = 0;
|
|
cryptWindow = 0;
|
|
while (x20_byteInWindow < 4) {
|
|
if (xc_progLen) {
|
|
cryptWindow |= *x8_progPtr++ << (x20_byteInWindow * 8);
|
|
--xc_progLen;
|
|
}
|
|
++x20_byteInWindow;
|
|
}
|
|
|
|
if (x34_bytesSent == 0xac) {
|
|
x60_gameId = cryptWindow;
|
|
} else if (x34_bytesSent == 0xc4) {
|
|
cryptWindow = endpoint.getChan() << 0x8;
|
|
}
|
|
|
|
if (x34_bytesSent >= 0xc0) {
|
|
u32 shiftWindow = cryptWindow;
|
|
u32 shiftCrc = x38_crc;
|
|
for (int i = 0; i < 32; ++i) {
|
|
if ((shiftWindow ^ shiftCrc) & 0x1)
|
|
shiftCrc = (shiftCrc >> 1) ^ 0xa1c1;
|
|
else
|
|
shiftCrc >>= 1;
|
|
|
|
shiftWindow >>= 1;
|
|
}
|
|
x38_crc = shiftCrc;
|
|
}
|
|
|
|
if (x34_bytesSent == 0x1f8) {
|
|
x3c_checkStore[0] = cryptWindow;
|
|
} else if (x34_bytesSent == 0x1fc) {
|
|
x20_byteInWindow = 1;
|
|
x3c_checkStore[x20_byteInWindow] = cryptWindow;
|
|
}
|
|
} else {
|
|
cryptWindow = x38_crc | x34_bytesSent << 16;
|
|
}
|
|
|
|
if (x34_bytesSent > 0xbf) {
|
|
x58_currentKey = 0x6177614b * x58_currentKey + 1;
|
|
|
|
cryptWindow ^= x58_currentKey;
|
|
cryptWindow ^= -(0x2000000 + x34_bytesSent);
|
|
cryptWindow ^= 0x20796220;
|
|
}
|
|
|
|
x1c_writeBuf[0] = cryptWindow >> 0;
|
|
x1c_writeBuf[1] = cryptWindow >> 8;
|
|
x1c_writeBuf[2] = cryptWindow >> 16;
|
|
x1c_writeBuf[3] = cryptWindow >> 24;
|
|
|
|
if (x34_bytesSent == 0x1f8)
|
|
x3c_checkStore[2] = cryptWindow;
|
|
|
|
if (x20_byteInWindow < 4) {
|
|
x3c_checkStore[2 + x20_byteInWindow] = cryptWindow;
|
|
x3c_checkStore[5 - x20_byteInWindow] =
|
|
x3c_checkStore[1 + x20_byteInWindow] * x3c_checkStore[4 - x20_byteInWindow];
|
|
x3c_checkStore[4 + x20_byteInWindow] =
|
|
x3c_checkStore[1 + x20_byteInWindow] * x3c_checkStore[1 - x20_byteInWindow];
|
|
x3c_checkStore[7 - x20_byteInWindow] =
|
|
x3c_checkStore[-1 + x20_byteInWindow] * x3c_checkStore[4 - x20_byteInWindow];
|
|
}
|
|
|
|
if ((status = endpoint.GBAWriteAsync(x1c_writeBuf, x10_statusPtr,
|
|
bindThis(&KawasedoChallenge::_4TransmitProgram))) != GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
} else // x34_bytesWritten > x64_totalBytes
|
|
{
|
|
if ((status = endpoint.GBAReadAsync(x18_readBuf, x10_statusPtr, bindThis(&KawasedoChallenge::_5StartBootPoll))) !=
|
|
GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_5StartBootPoll(ThreadLocalEndpoint& endpoint, EJoyReturn status) {
|
|
if (status != GBA_READY ||
|
|
(status = endpoint.GBAGetStatusAsync(x10_statusPtr, bindThis(&KawasedoChallenge::_6BootPoll))) != GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_6BootPoll(ThreadLocalEndpoint& endpoint, EJoyReturn status) {
|
|
if (status == GBA_READY)
|
|
if (*x10_statusPtr & (GBA_JSTAT_FLAGS_MASK | GBA_JSTAT_RECV))
|
|
status = GBA_JOYBOOT_UNKNOWN_STATE;
|
|
|
|
if (status != GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
return;
|
|
}
|
|
|
|
if (*x10_statusPtr != GBA_JSTAT_SEND) {
|
|
if ((status = endpoint.GBAGetStatusAsync(x10_statusPtr, bindThis(&KawasedoChallenge::_6BootPoll))) != GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
return;
|
|
}
|
|
|
|
if ((status = endpoint.GBAReadAsync(x18_readBuf, x10_statusPtr, bindThis(&KawasedoChallenge::_7BootAcknowledge))) !=
|
|
GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_7BootAcknowledge(ThreadLocalEndpoint& endpoint, EJoyReturn status) {
|
|
if (status != GBA_READY || (status = endpoint.GBAWriteAsync(x18_readBuf, x10_statusPtr,
|
|
bindThis(&KawasedoChallenge::_8BootDone))) != GBA_READY) {
|
|
x28_ticksAfterXf = 0;
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
}
|
|
|
|
void Endpoint::KawasedoChallenge::_8BootDone(ThreadLocalEndpoint& endpoint, EJoyReturn status) {
|
|
if (status == GBA_READY)
|
|
*x10_statusPtr = 0;
|
|
|
|
x28_ticksAfterXf = 0;
|
|
|
|
if (x14_callback) {
|
|
x14_callback(endpoint, status);
|
|
x14_callback = {};
|
|
}
|
|
}
|
|
|
|
Endpoint::KawasedoChallenge::KawasedoChallenge(s32 paletteColor, s32 paletteSpeed, const u8* programp, s32 length,
|
|
u8* status, FGBACallback&& callback)
|
|
: x0_pColor(paletteColor)
|
|
, x4_pSpeed(paletteSpeed)
|
|
, x8_progPtr(programp)
|
|
, xc_progLen(length)
|
|
, x10_statusPtr(status)
|
|
, x14_callback(std::move(callback))
|
|
, x34_bytesSent(0)
|
|
, m_initialized(true) {}
|
|
|
|
void Endpoint::KawasedoChallenge::start(Endpoint& endpoint) {
|
|
if (endpoint.GBAGetStatusAsync(x10_statusPtr, bindThis(&KawasedoChallenge::_0Reset)) != GBA_READY) {
|
|
x14_callback = {};
|
|
m_started = false;
|
|
}
|
|
}
|
|
|
|
void Endpoint::clockSync() {
|
|
if (!m_clockSocket) {
|
|
m_running = false;
|
|
return;
|
|
}
|
|
|
|
u32 TickDelta = 0;
|
|
if (!m_lastGCTick) {
|
|
m_lastGCTick = GetGCTicks();
|
|
TickDelta = GetGCTicksPerSec() / 60;
|
|
} else
|
|
TickDelta = GetGCTicks() - m_lastGCTick;
|
|
|
|
/* Scale GameCube clock into GBA clock */
|
|
TickDelta = u32(u64(TickDelta) * 16777216 / GetGCTicksPerSec());
|
|
m_lastGCTick = GetGCTicks();
|
|
TickDelta = SBig(TickDelta);
|
|
if (m_clockSocket.send(&TickDelta, 4) == net::Socket::EResult::Error)
|
|
m_running = false;
|
|
}
|
|
|
|
void Endpoint::send(Buffer buffer) {
|
|
m_lastCmd = buffer[0];
|
|
|
|
net::Socket::EResult result;
|
|
size_t sentBytes;
|
|
if (m_lastCmd == CMD_WRITE) {
|
|
result = m_dataSocket.send(buffer.data(), buffer.size(), sentBytes);
|
|
} else {
|
|
result = m_dataSocket.send(buffer.data(), 1, sentBytes);
|
|
}
|
|
|
|
if (m_lastCmd != CMD_STATUS) {
|
|
m_booted = true;
|
|
}
|
|
|
|
if (result != net::Socket::EResult::OK) {
|
|
m_running = false;
|
|
}
|
|
#if LOG_TRANSFER
|
|
else {
|
|
printf("Send %02x [> %02x%02x%02x%02x] (%lu)\n", buffer[0], buffer[1], buffer[2], buffer[3], buffer[4], sentBytes);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
size_t Endpoint::receive(Buffer& buffer) {
|
|
if (!m_dataSocket) {
|
|
m_running = false;
|
|
return buffer.size();
|
|
}
|
|
|
|
size_t recvBytes = 0;
|
|
const net::Socket::EResult result = m_dataSocket.recv(buffer.data(), buffer.size(), recvBytes);
|
|
if (result == net::Socket::EResult::Error) {
|
|
m_running = false;
|
|
return buffer.size();
|
|
}
|
|
|
|
if (recvBytes > buffer.size()) {
|
|
recvBytes = buffer.size();
|
|
}
|
|
|
|
#if LOG_TRANSFER
|
|
if (recvBytes > 0) {
|
|
if (m_lastCmd == CMD_STATUS || m_lastCmd == CMD_RESET) {
|
|
printf("Stat/Reset [< %02x%02x%02x%02x%02x] (%lu)\n", buffer[0], buffer[1], buffer[2], buffer[3], buffer[4],
|
|
recvBytes);
|
|
} else {
|
|
printf("Receive [< %02x%02x%02x%02x%02x] (%lu)\n", buffer[0], buffer[1], buffer[2], buffer[3], buffer[4],
|
|
recvBytes);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
return recvBytes;
|
|
}
|
|
|
|
size_t Endpoint::runBuffer(Buffer& buffer, std::unique_lock<std::mutex>& lk) {
|
|
Buffer tmpBuffer = buffer;
|
|
|
|
lk.unlock();
|
|
clockSync();
|
|
send(tmpBuffer);
|
|
const size_t receivedBytes = receive(tmpBuffer);
|
|
lk.lock();
|
|
|
|
buffer = tmpBuffer;
|
|
return receivedBytes;
|
|
}
|
|
|
|
bool Endpoint::idleGetStatus(std::unique_lock<std::mutex>& lk) {
|
|
Buffer buffer{u8(CMD_STATUS), 0, 0, 0, 0};
|
|
return runBuffer(buffer, lk) != 0;
|
|
}
|
|
|
|
void Endpoint::transferProc() {
|
|
#if LOG_TRANSFER
|
|
printf("Starting JoyBus transfer thread for channel %d\n", m_chan);
|
|
#endif
|
|
|
|
/* This lock is relinquished on I/O cycles or when waiting for next request */
|
|
std::unique_lock<std::mutex> lk(m_syncLock);
|
|
while (m_running) {
|
|
if (m_cmdIssued) {
|
|
/* Synchronous command write/read cycle */
|
|
runBuffer(m_buffer, lk);
|
|
m_cmdIssued = false;
|
|
|
|
EJoyReturn xferStatus = m_running ? GBA_READY : GBA_NOT_READY;
|
|
|
|
/* Handle message response */
|
|
switch (m_lastCmd) {
|
|
case CMD_RESET:
|
|
case CMD_STATUS:
|
|
if (m_statusPtr)
|
|
*m_statusPtr = m_buffer[2];
|
|
break;
|
|
case CMD_WRITE:
|
|
if (m_statusPtr)
|
|
*m_statusPtr = m_buffer[0];
|
|
break;
|
|
case CMD_READ:
|
|
if (m_statusPtr != nullptr) {
|
|
*m_statusPtr = m_buffer[4];
|
|
}
|
|
if (m_readDstPtr != nullptr) {
|
|
std::copy(m_buffer.cbegin(), m_buffer.cbegin() + 4, m_readDstPtr);
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
m_statusPtr = nullptr;
|
|
m_readDstPtr = nullptr;
|
|
if (m_callback) {
|
|
FGBACallback cb = std::move(m_callback);
|
|
m_callback = {};
|
|
ThreadLocalEndpoint ep(*this);
|
|
cb(ep, xferStatus);
|
|
}
|
|
} else if (!m_booted) {
|
|
/* Poll bus with status messages when inactive */
|
|
if (idleGetStatus(lk)) {
|
|
lk.unlock();
|
|
WaitGCTicks(GetGCTicksPerSec() * 4 / 60);
|
|
lk.lock();
|
|
}
|
|
} else {
|
|
/* Wait for next user request */
|
|
m_issueCv.wait(lk);
|
|
}
|
|
}
|
|
|
|
m_syncCv.notify_all();
|
|
m_dataSocket.close();
|
|
m_clockSocket.close();
|
|
|
|
#if LOG_TRANSFER
|
|
printf("Stopping JoyBus transfer thread for channel %d\n", m_chan);
|
|
#endif
|
|
}
|
|
|
|
void Endpoint::transferWakeup(ThreadLocalEndpoint& endpoint, u8 status) { m_syncCv.notify_all(); }
|
|
|
|
void Endpoint::stop() {
|
|
m_running = false;
|
|
m_issueCv.notify_one();
|
|
if (m_transferThread.joinable())
|
|
m_transferThread.join();
|
|
}
|
|
|
|
EJoyReturn Endpoint::GBAGetProcessStatus(u8& percentOut) {
|
|
if (!m_running)
|
|
return GBA_NOT_READY;
|
|
|
|
std::unique_lock<std::mutex> lk(m_syncLock);
|
|
if (m_joyBoot) {
|
|
percentOut = m_joyBoot.percentComplete();
|
|
if (!m_joyBoot.isDone())
|
|
return GBA_BUSY;
|
|
}
|
|
|
|
if (m_cmdIssued)
|
|
return GBA_BUSY;
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn Endpoint::GBAGetStatusAsync(u8* status, FGBACallback&& callback) {
|
|
if (!m_running)
|
|
return GBA_NOT_READY;
|
|
|
|
std::unique_lock<std::mutex> lk(m_syncLock);
|
|
if (m_cmdIssued)
|
|
return GBA_NOT_READY;
|
|
|
|
m_cmdIssued = true;
|
|
m_statusPtr = status;
|
|
m_buffer[0] = CMD_STATUS;
|
|
m_callback = std::move(callback);
|
|
|
|
m_issueCv.notify_one();
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn Endpoint::GBAGetStatus(u8* status) {
|
|
if (!m_running)
|
|
return GBA_NOT_READY;
|
|
|
|
std::unique_lock<std::mutex> lk(m_syncLock);
|
|
if (m_cmdIssued)
|
|
return GBA_NOT_READY;
|
|
|
|
m_cmdIssued = true;
|
|
m_statusPtr = status;
|
|
m_buffer[0] = CMD_STATUS;
|
|
m_callback = bindSync();
|
|
|
|
m_issueCv.notify_one();
|
|
m_syncCv.wait(lk);
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn Endpoint::GBAResetAsync(u8* status, FGBACallback&& callback) {
|
|
if (!m_running)
|
|
return GBA_NOT_READY;
|
|
|
|
std::unique_lock<std::mutex> lk(m_syncLock);
|
|
if (m_cmdIssued)
|
|
return GBA_NOT_READY;
|
|
|
|
m_cmdIssued = true;
|
|
m_statusPtr = status;
|
|
m_buffer[0] = CMD_RESET;
|
|
m_callback = std::move(callback);
|
|
|
|
m_issueCv.notify_one();
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn Endpoint::GBAReset(u8* status) {
|
|
if (!m_running)
|
|
return GBA_NOT_READY;
|
|
|
|
std::unique_lock<std::mutex> lk(m_syncLock);
|
|
if (m_cmdIssued)
|
|
return GBA_NOT_READY;
|
|
|
|
m_cmdIssued = true;
|
|
m_statusPtr = status;
|
|
m_buffer[0] = CMD_RESET;
|
|
m_callback = bindSync();
|
|
|
|
m_issueCv.notify_one();
|
|
m_syncCv.wait(lk);
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn Endpoint::GBAReadAsync(ReadWriteBuffer& dst, u8* status, FGBACallback&& callback) {
|
|
if (!m_running) {
|
|
return GBA_NOT_READY;
|
|
}
|
|
|
|
std::unique_lock<std::mutex> lk(m_syncLock);
|
|
if (m_cmdIssued) {
|
|
return GBA_NOT_READY;
|
|
}
|
|
|
|
m_cmdIssued = true;
|
|
m_statusPtr = status;
|
|
m_readDstPtr = dst.data();
|
|
m_buffer[0] = CMD_READ;
|
|
m_callback = std::move(callback);
|
|
|
|
m_issueCv.notify_one();
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn Endpoint::GBARead(ReadWriteBuffer& dst, u8* status) {
|
|
if (!m_running) {
|
|
return GBA_NOT_READY;
|
|
}
|
|
|
|
std::unique_lock<std::mutex> lk(m_syncLock);
|
|
if (m_cmdIssued) {
|
|
return GBA_NOT_READY;
|
|
}
|
|
|
|
m_cmdIssued = true;
|
|
m_statusPtr = status;
|
|
m_readDstPtr = dst.data();
|
|
m_buffer[0] = CMD_READ;
|
|
m_callback = bindSync();
|
|
|
|
m_issueCv.notify_one();
|
|
m_syncCv.wait(lk);
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn Endpoint::GBAWriteAsync(ReadWriteBuffer src, u8* status, FGBACallback&& callback) {
|
|
if (!m_running) {
|
|
return GBA_NOT_READY;
|
|
}
|
|
|
|
std::unique_lock<std::mutex> lk(m_syncLock);
|
|
if (m_cmdIssued) {
|
|
return GBA_NOT_READY;
|
|
}
|
|
|
|
m_cmdIssued = true;
|
|
m_statusPtr = status;
|
|
m_buffer[0] = CMD_WRITE;
|
|
for (size_t i = 0; i < src.size(); ++i) {
|
|
m_buffer[i + 1] = src[i];
|
|
}
|
|
m_callback = std::move(callback);
|
|
|
|
m_issueCv.notify_one();
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn Endpoint::GBAWrite(ReadWriteBuffer src, u8* status) {
|
|
if (!m_running) {
|
|
return GBA_NOT_READY;
|
|
}
|
|
|
|
std::unique_lock<std::mutex> lk(m_syncLock);
|
|
if (m_cmdIssued) {
|
|
return GBA_NOT_READY;
|
|
}
|
|
|
|
m_cmdIssued = true;
|
|
m_statusPtr = status;
|
|
m_buffer[0] = CMD_WRITE;
|
|
for (size_t i = 0; i < src.size(); ++i) {
|
|
m_buffer[i + 1] = src[i];
|
|
}
|
|
m_callback = bindSync();
|
|
|
|
m_issueCv.notify_one();
|
|
m_syncCv.wait(lk);
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn Endpoint::GBAJoyBootAsync(s32 paletteColor, s32 paletteSpeed, const u8* programp, s32 length, u8* status,
|
|
FGBACallback&& callback) {
|
|
if (!m_running)
|
|
return GBA_NOT_READY;
|
|
|
|
if (m_chan > 3)
|
|
return GBA_JOYBOOT_ERR_INVALID;
|
|
|
|
if (!length || length >= 0x40000)
|
|
return GBA_JOYBOOT_ERR_INVALID;
|
|
|
|
if (paletteSpeed < -4 || paletteSpeed > 4)
|
|
return GBA_JOYBOOT_ERR_INVALID;
|
|
|
|
if (paletteColor < 0 || paletteColor > 6)
|
|
return GBA_JOYBOOT_ERR_INVALID;
|
|
|
|
if (programp[0xac] * programp[0xac] * programp[0xac] * programp[0xac] == 0)
|
|
return GBA_JOYBOOT_ERR_INVALID;
|
|
|
|
m_joyBoot = KawasedoChallenge(paletteColor, paletteSpeed, programp, length, status, std::move(callback));
|
|
m_joyBoot.start(*this);
|
|
if (!m_joyBoot.started())
|
|
return GBA_NOT_READY;
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
Endpoint::Endpoint(u8 chan, net::Socket&& data, net::Socket&& clock)
|
|
: m_dataSocket(std::move(data)), m_clockSocket(std::move(clock)), m_chan(chan) {
|
|
m_transferThread = std::thread(std::bind(&Endpoint::transferProc, this));
|
|
}
|
|
|
|
Endpoint::~Endpoint() { stop(); }
|
|
|
|
EJoyReturn ThreadLocalEndpoint::GBAGetStatusAsync(u8* status, FGBACallback&& callback) {
|
|
if (!m_ep.m_running || m_ep.m_cmdIssued)
|
|
return GBA_NOT_READY;
|
|
|
|
m_ep.m_cmdIssued = true;
|
|
m_ep.m_statusPtr = status;
|
|
m_ep.m_buffer[0] = Endpoint::CMD_STATUS;
|
|
m_ep.m_callback = std::move(callback);
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn ThreadLocalEndpoint::GBAResetAsync(u8* status, FGBACallback&& callback) {
|
|
if (!m_ep.m_running || m_ep.m_cmdIssued)
|
|
return GBA_NOT_READY;
|
|
|
|
m_ep.m_cmdIssued = true;
|
|
m_ep.m_statusPtr = status;
|
|
m_ep.m_buffer[0] = Endpoint::CMD_RESET;
|
|
m_ep.m_callback = std::move(callback);
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn ThreadLocalEndpoint::GBAReadAsync(ReadWriteBuffer& dst, u8* status, FGBACallback&& callback) {
|
|
if (!m_ep.m_running || m_ep.m_cmdIssued)
|
|
return GBA_NOT_READY;
|
|
|
|
m_ep.m_cmdIssued = true;
|
|
m_ep.m_statusPtr = status;
|
|
m_ep.m_readDstPtr = dst.data();
|
|
m_ep.m_buffer[0] = Endpoint::CMD_READ;
|
|
m_ep.m_callback = std::move(callback);
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
EJoyReturn ThreadLocalEndpoint::GBAWriteAsync(ReadWriteBuffer src, u8* status, FGBACallback&& callback) {
|
|
if (!m_ep.m_running || m_ep.m_cmdIssued)
|
|
return GBA_NOT_READY;
|
|
|
|
m_ep.m_cmdIssued = true;
|
|
m_ep.m_statusPtr = status;
|
|
m_ep.m_buffer[0] = Endpoint::CMD_WRITE;
|
|
for (size_t i = 0; i < src.size(); ++i) {
|
|
m_ep.m_buffer[i + 1] = src[i];
|
|
}
|
|
m_ep.m_callback = std::move(callback);
|
|
|
|
return GBA_READY;
|
|
}
|
|
|
|
} // namespace jbus
|