/* Copyright 2016-2023 melonDS team This file is part of melonDS. melonDS is free software: you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation, either version 3 of the License, or (at your option) any later version. melonDS is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with melonDS. If not, see http://www.gnu.org/licenses/. */ #include #include #include "DSi.h" #include "DSi_NWifi.h" #include "SPI.h" #include "WifiAP.h" #include "Platform.h" using Platform::Log; using Platform::LogLevel; const u8 CIS0[256] = { 0x01, 0x03, 0xD9, 0x01, 0xFF, 0x20, 0x04, 0x71, 0x02, 0x00, 0x02, 0x21, 0x02, 0x0C, 0x00, 0x22, 0x04, 0x00, 0x00, 0x08, 0x32, 0x1A, 0x05, 0x01, 0x01, 0x00, 0x02, 0x07, 0x1B, 0x08, 0xC1, 0x41, 0x30, 0x30, 0xFF, 0xFF, 0x32, 0x00, 0x14, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; const u8 CIS1[256] = { 0x20, 0x04, 0x71, 0x02, 0x00, 0x02, 0x21, 0x02, 0x0C, 0x00, 0x22, 0x2A, 0x01, 0x01, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00, 0xFF, 0x80, 0x00, 0x00, 0x00, 0x00, 0x01, 0x0A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x01, 0x00, 0x01, 0x00, 0x01, 0x80, 0x01, 0x06, 0x81, 0x01, 0x07, 0x82, 0x01, 0xDF, 0xFF, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; DSi_NWifi::DSi_NWifi(DSi_SDHost* host) : DSi_SDDevice(host), Mailbox { // HACK // the mailboxes are supposed to be 0x80 bytes // however, as we do things instantly, emulating this is meaningless // and only adds complication DynamicFIFO(0x600), DynamicFIFO(0x600), DynamicFIFO(0x600), DynamicFIFO(0x600), DynamicFIFO(0x600), DynamicFIFO(0x600), DynamicFIFO(0x600), DynamicFIFO(0x600), // mailbox 8: extra mailbox acting as a bigger RX buffer DynamicFIFO(0x8000) } { NDS::RegisterEventFunc(NDS::Event_DSi_NWifi, 0, MemberEventFunc(DSi_NWifi, MSTimer)); // this seems to control whether the firmware upload is done EEPROMReady = 0; } DSi_NWifi::~DSi_NWifi() { NDS::CancelEvent(NDS::Event_DSi_NWifi); NDS::UnregisterEventFunc(NDS::Event_DSi_NWifi, 0); } void DSi_NWifi::Reset() { TransferCmd = 0xFFFFFFFF; RemSize = 0; F0_IRQEnable = 0; F0_IRQStatus = 0; F1_IRQEnable = 0; F1_IRQEnable_CPU = 0; F1_IRQEnable_Error = 0; F1_IRQEnable_Counter = 0; F1_IRQStatus = 0; F1_IRQStatus_CPU = 0; F1_IRQStatus_Error = 0; F1_IRQStatus_Counter = 0; WindowData = 0; WindowReadAddr = 0; WindowWriteAddr = 0; for (int i = 0; i < 9; i++) Mailbox[i].Clear(); const Firmware* fw = NDS::SPI->GetFirmware(); MacAddress mac = fw->GetHeader().MacAddr; Log(LogLevel::Info, "NWifi MAC: %02X:%02X:%02X:%02X:%02X:%02X\n", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]); Firmware::WifiBoard type = fw->GetHeader().WifiBoard; switch (type) { case Firmware::WifiBoard::W015: // AR6002 ROMID = 0x20000188; ChipID = 0x02000001; HostIntAddr = 0x00500400; break; case Firmware::WifiBoard::W024: // AR6013 ROMID = 0x23000024; ChipID = 0x0D000000; HostIntAddr = 0x00520000; break; case Firmware::WifiBoard::W028: // AR6014 (3DS) ROMID = 0x2300006F; ChipID = 0x0D000001; HostIntAddr = 0x00520000; Log(LogLevel::Info, "NWifi: hardware is 3DS type, unchecked\n"); break; default: Log(LogLevel::Warn, "NWifi: unknown hardware type 0x%x, assuming AR6002\n", static_cast(type)); ROMID = 0x20000188; ChipID = 0x02000001; HostIntAddr = 0x00500400; break; } memset(EEPROM, 0, 0x400); *(u32*)&EEPROM[0x000] = 0x300; *(u16*)&EEPROM[0x008] = 0x8348; // TODO: determine properly (country code) memcpy(&EEPROM[0x00A], mac.data(), mac.size()); *(u32*)&EEPROM[0x010] = 0x60000000; memset(&EEPROM[0x03C], 0xFF, 0x70); memset(&EEPROM[0x140], 0xFF, 0x8); u16 chk = 0xFFFF; for (int i = 0; i < 0x300; i+=2) chk ^= *(u16*)&EEPROM[i]; *(u16*)&EEPROM[0x004] = chk; // TODO: SDIO reset shouldn't reset this // this is reset by the internal reset register, and that also resets EEPROM init BootPhase = 0; ErrorMask = 0; ScanTimer = 0; BeaconTimer = 0x10A2220ULL; ConnectionStatus = 0; NDS::CancelEvent(NDS::Event_DSi_NWifi); } void DSi_NWifi::DoSavestate(Savestate* file) { file->Section("NWFi"); for (int i = 0; i < 9; i++) Mailbox[i].DoSavestate(file); file->Var8(&F0_IRQEnable); file->Var8(&F0_IRQStatus); file->Var8(&F1_IRQEnable); file->Var8(&F1_IRQEnable_CPU); file->Var8(&F1_IRQEnable_Error); file->Var8(&F1_IRQEnable_Counter); file->Var8(&F1_IRQStatus); file->Var8(&F1_IRQStatus_CPU); file->Var8(&F1_IRQStatus_Error); file->Var8(&F1_IRQStatus_Counter); file->Var32(&WindowData); file->Var32(&WindowReadAddr); file->Var32(&WindowWriteAddr); file->Var32(&ROMID); file->Var32(&ChipID); file->Var32(&HostIntAddr); file->VarArray(EEPROM, 0x400); file->Var32(&EEPROMReady); file->Var32(&BootPhase); file->Var32(&ErrorMask); file->Var32(&ScanTimer); file->Var64(&BeaconTimer); file->Var32(&ConnectionStatus); } // CHECKME // can IRQ status bits be set when the corresponding IRQs are disabled in the enable register? // otherwise, does disabling them clear the status register? void DSi_NWifi::UpdateIRQ() { F0_IRQStatus = 0; IRQ = false; if (F1_IRQStatus & F1_IRQEnable) F0_IRQStatus |= (1<<1); if (F0_IRQEnable & (1<<0)) { if (F0_IRQStatus & F0_IRQEnable) IRQ = true; } Host->SetCardIRQ(); } void DSi_NWifi::UpdateIRQ_F1() { F1_IRQStatus = 0; if (!Mailbox[4].IsEmpty()) F1_IRQStatus |= (1<<0); if (!Mailbox[5].IsEmpty()) F1_IRQStatus |= (1<<1); if (!Mailbox[6].IsEmpty()) F1_IRQStatus |= (1<<2); if (!Mailbox[7].IsEmpty()) F1_IRQStatus |= (1<<3); if (F1_IRQStatus_Counter & F1_IRQEnable_Counter) F1_IRQStatus |= (1<<4); if (F1_IRQStatus_CPU & F1_IRQEnable_CPU) F1_IRQStatus |= (1<<6); if (F1_IRQStatus_Error & F1_IRQEnable_Error) F1_IRQStatus |= (1<<7); UpdateIRQ(); } void DSi_NWifi::SetIRQ_F1_Counter(u32 n) { F1_IRQStatus_Counter |= (1<= 0x01000 && addr < 0x01100) { return CIS0[addr & 0xFF]; } if (addr >= 0x01100 && addr < 0x01200) { return CIS1[addr & 0xFF]; } Log(LogLevel::Debug, "NWIFI: unknown func0 read %05X\n", addr); return 0; } void DSi_NWifi::F0_Write(u32 addr, u8 val) { switch (addr) { case 0x00004: F0_IRQEnable = val; UpdateIRQ(); return; } Log(LogLevel::Debug, "NWIFI: unknown func0 write %05X %02X\n", addr, val); } u8 DSi_NWifi::F1_Read(u32 addr) { if (addr < 0x100) { u8 ret = Mailbox[4].Read(); if (addr == 0xFF) DrainRXBuffer(); UpdateIRQ_F1(); return ret; } else if (addr < 0x200) { u8 ret = Mailbox[5].Read(); UpdateIRQ_F1(); return ret; } else if (addr < 0x300) { u8 ret = Mailbox[6].Read(); UpdateIRQ_F1(); return ret; } else if (addr < 0x400) { u8 ret = Mailbox[7].Read(); UpdateIRQ_F1(); return ret; } else if (addr < 0x800) { switch (addr) { case 0x00400: return F1_IRQStatus; case 0x00401: return F1_IRQStatus_CPU; case 0x00402: return F1_IRQStatus_Error; case 0x00403: return F1_IRQStatus_Counter; case 0x00405: { u8 ret = 0; if (Mailbox[4].Level() >= 4) ret |= (1<<0); if (Mailbox[5].Level() >= 4) ret |= (1<<1); if (Mailbox[6].Level() >= 4) ret |= (1<<2); if (Mailbox[7].Level() >= 4) ret |= (1<<3); return ret; } case 0x00408: return Mailbox[4].Peek(0); case 0x00409: return Mailbox[4].Peek(1); case 0x0040A: return Mailbox[4].Peek(2); case 0x0040B: return Mailbox[4].Peek(3); case 0x00418: return F1_IRQEnable; case 0x00419: return F1_IRQEnable_CPU; case 0x0041A: return F1_IRQEnable_Error; case 0x0041B: return F1_IRQEnable_Counter; // GROSS FUCKING HACK case 0x00440: ClearIRQ_F1_Counter(0); return 0; case 0x00450: return 1; // HAX!! case 0x00474: return WindowData & 0xFF; case 0x00475: return (WindowData >> 8) & 0xFF; case 0x00476: return (WindowData >> 16) & 0xFF; case 0x00477: return WindowData >> 24; } } else if (addr < 0x1000) { u8 ret = Mailbox[4].Read(); if (addr == 0xFFF) DrainRXBuffer(); UpdateIRQ_F1(); return ret; } else if (addr < 0x1800) { u8 ret = Mailbox[5].Read(); UpdateIRQ_F1(); return ret; } else if (addr < 0x2000) { u8 ret = Mailbox[6].Read(); UpdateIRQ_F1(); return ret; } else if (addr < 0x2800) { u8 ret = Mailbox[7].Read(); UpdateIRQ_F1(); return ret; } else { u8 ret = Mailbox[4].Read(); if (addr == 0x3FFF) DrainRXBuffer(); UpdateIRQ_F1(); return ret; } //printf("NWIFI: unknown func1 read %05X\n", addr); return 0; } void DSi_NWifi::F1_Write(u32 addr, u8 val) { if (addr < 0x100) { if (Mailbox[0].IsFull()) Log(LogLevel::Debug, "!!! NWIFI: MBOX0 FULL\n"); Mailbox[0].Write(val); if (addr == 0xFF) HandleCommand(); UpdateIRQ_F1(); return; } else if (addr < 0x200) { if (Mailbox[1].IsFull()) Log(LogLevel::Debug, "!!! NWIFI: MBOX1 FULL\n"); Mailbox[1].Write(val); UpdateIRQ_F1(); return; } else if (addr < 0x300) { if (Mailbox[2].IsFull()) Log(LogLevel::Debug, "!!! NWIFI: MBOX2 FULL\n"); Mailbox[2].Write(val); UpdateIRQ_F1(); return; } else if (addr < 0x400) { if (Mailbox[3].IsFull()) Log(LogLevel::Debug, "!!! NWIFI: MBOX3 FULL\n"); Mailbox[3].Write(val); UpdateIRQ_F1(); return; } else if (addr < 0x800) { switch (addr) { case 0x00418: F1_IRQEnable = val; UpdateIRQ_F1(); return; case 0x00419: F1_IRQEnable_CPU = val; UpdateIRQ_F1(); return; case 0x0041A: F1_IRQEnable_Error = val; UpdateIRQ_F1(); return; case 0x0041B: F1_IRQEnable_Counter = val; UpdateIRQ_F1(); return; // GROSS FUCKING HACK case 0x00440: ClearIRQ_F1_Counter(0); return; case 0x00474: WindowData = (WindowData & 0xFFFFFF00) | val; return; case 0x00475: WindowData = (WindowData & 0xFFFF00FF) | (val << 8); return; case 0x00476: WindowData = (WindowData & 0xFF00FFFF) | (val << 16); return; case 0x00477: WindowData = (WindowData & 0x00FFFFFF) | (val << 24); return; case 0x00478: WindowWriteAddr = (WindowWriteAddr & 0xFFFFFF00) | val; WindowWrite(WindowWriteAddr, WindowData); return; case 0x00479: WindowWriteAddr = (WindowWriteAddr & 0xFFFF00FF) | (val << 8); return; case 0x0047A: WindowWriteAddr = (WindowWriteAddr & 0xFF00FFFF) | (val << 16); return; case 0x0047B: WindowWriteAddr = (WindowWriteAddr & 0x00FFFFFF) | (val << 24); return; case 0x0047C: WindowReadAddr = (WindowReadAddr & 0xFFFFFF00) | val; WindowData = WindowRead(WindowReadAddr); return; case 0x0047D: WindowReadAddr = (WindowReadAddr & 0xFFFF00FF) | (val << 8); return; case 0x0047E: WindowReadAddr = (WindowReadAddr & 0xFF00FFFF) | (val << 16); return; case 0x0047F: WindowReadAddr = (WindowReadAddr & 0x00FFFFFF) | (val << 24); return; } } else if (addr < 0x1000) { if (Mailbox[0].IsFull()) Log(LogLevel::Debug, "!!! NWIFI: MBOX0 FULL\n"); Mailbox[0].Write(val); if (addr == 0xFFF) HandleCommand(); UpdateIRQ_F1(); return; } else if (addr < 0x1800) { if (Mailbox[1].IsFull()) Log(LogLevel::Debug, "!!! NWIFI: MBOX1 FULL\n"); Mailbox[1].Write(val); UpdateIRQ_F1(); return; } else if (addr < 0x2000) { if (Mailbox[2].IsFull()) Log(LogLevel::Debug, "!!! NWIFI: MBOX2 FULL\n"); Mailbox[2].Write(val); UpdateIRQ_F1(); return; } else if (addr < 0x2800) { if (Mailbox[3].IsFull()) Log(LogLevel::Debug, "!!! NWIFI: MBOX3 FULL\n"); Mailbox[3].Write(val); UpdateIRQ_F1(); return; } else { if (Mailbox[0].IsFull()) Log(LogLevel::Debug, "!!! NWIFI: MBOX0 FULL\n"); Mailbox[0].Write(val); if (addr == 0x3FFF) HandleCommand(); // CHECKME UpdateIRQ_F1(); return; } Log(LogLevel::Debug, "NWIFI: unknown func1 write %05X %02X\n", addr, val); } u8 DSi_NWifi::SDIO_Read(u32 func, u32 addr) { switch (func) { case 0: return F0_Read(addr); case 1: return F1_Read(addr); } Log(LogLevel::Debug, "NWIFI: unknown SDIO read %d %05X\n", func, addr); return 0; } void DSi_NWifi::SDIO_Write(u32 func, u32 addr, u8 val) { switch (func) { case 0: return F0_Write(addr, val); case 1: return F1_Write(addr, val); } Log(LogLevel::Debug, "NWIFI: unknown SDIO write %d %05X %02X\n", func, addr, val); } void DSi_NWifi::SendCMD(u8 cmd, u32 param) { switch (cmd) { case 12: // stop command // CHECKME: does the SDIO controller actually send those?? // DSi firmware sets it to send them return; case 52: // IO_RW_DIRECT { u32 func = (param >> 28) & 0x7; u32 addr = (param >> 9) & 0x1FFFF; if (param & (1<<31)) { // write u8 val = param & 0xFF; SDIO_Write(func, addr, val); if (param & (1<<27)) val = SDIO_Read(func, addr); // checkme Host->SendResponse(val | 0x1000, true); } else { // read u8 val = SDIO_Read(func, addr); Host->SendResponse(val | 0x1000, true); } } return; case 53: // IO_RW_EXTENDED { u32 addr = (param >> 9) & 0x1FFFF; TransferCmd = param; TransferAddr = addr; if (param & (1<<27)) { RemSize = (param & 0x1FF) << 9; // checkme } else { RemSize = (param & 0x1FF); if (!RemSize) RemSize = 0x200; } if (param & (1<<31)) { // write WriteBlock(); Host->SendResponse(0x1000, true); } else { // read ReadBlock(); Host->SendResponse(0x1000, true); } } return; } Log(LogLevel::Warn, "NWIFI: unknown CMD %d %08X\n", cmd, param); } void DSi_NWifi::SendACMD(u8 cmd, u32 param) { Log(LogLevel::Warn, "NWIFI: unknown ACMD %d %08X\n", cmd, param); } void DSi_NWifi::ContinueTransfer() { if (TransferCmd & (1<<31)) WriteBlock(); else ReadBlock(); } void DSi_NWifi::ReadBlock() { u32 func = (TransferCmd >> 28) & 0x7; u32 len = (TransferCmd & (1<<27)) ? 0x200 : RemSize; len = Host->GetTransferrableLen(len); u8 data[0x200]; for (u32 i = 0; i < len; i++) { data[i] = SDIO_Read(func, TransferAddr); if (TransferCmd & (1<<26)) { TransferAddr++; TransferAddr &= 0x1FFFF; // checkme } } len = Host->DataRX(data, len); if (RemSize > 0) { RemSize -= len; if (RemSize == 0) { // TODO? } } } void DSi_NWifi::WriteBlock() { u32 func = (TransferCmd >> 28) & 0x7; u32 len = (TransferCmd & (1<<27)) ? 0x200 : RemSize; len = Host->GetTransferrableLen(len); u8 data[0x200]; if ((len = Host->DataTX(data, len))) { for (u32 i = 0; i < len; i++) { SDIO_Write(func, TransferAddr, data[i]); if (TransferCmd & (1<<26)) { TransferAddr++; TransferAddr &= 0x1FFFF; // checkme } } if (RemSize > 0) { RemSize -= len; if (RemSize == 0) { // TODO? } } } } void DSi_NWifi::HandleCommand() { switch (BootPhase) { case 0: return BMI_Command(); case 1: return HTC_Command(); case 2: return WMI_Command(); } } void DSi_NWifi::BMI_Command() { u32 cmd = MB_Read32(0); switch (cmd) { case 0x01: // BMI_DONE { Log(LogLevel::Debug, "BMI_DONE\n"); EEPROMReady = 1; // GROSS FUCKING HACK u8 ready_msg[6] = {0x0A, 0x00, 0x08, 0x06, 0x16, 0x00}; SendWMIEvent(0, 0x0001, ready_msg, 6); BootPhase = 1; } return; case 0x03: // BMI_WRITE_MEMORY { u32 addr = MB_Read32(0); u32 len = MB_Read32(0); Log(LogLevel::Debug, "BMI mem write %08X %08X\n", addr, len); for (u32 i = 0; i < len; i++) { u8 val = Mailbox[0].Read(); // TODO: do something with it!! } } return; case 0x04: // BMI_EXECUTE { u32 entry = MB_Read32(0); u32 arg = MB_Read32(0); Log(LogLevel::Debug, "BMI_EXECUTE %08X %08X\n", entry, arg); } return; case 0x06: // BMI_READ_SOC_REGISTER { u32 addr = MB_Read32(0); u32 val = WindowRead(addr); MB_Write32(4, val); } return; case 0x07: // BMI_WRITE_SOC_REGISTER { u32 addr = MB_Read32(0); u32 val = MB_Read32(0); WindowWrite(addr, val); } return; case 0x08: // BMI_GET_TARGET_ID MB_Write32(4, 0xFFFFFFFF); MB_Write32(4, 0x0000000C); MB_Write32(4, ROMID); MB_Write32(4, 0x00000002); return; case 0x0D: // BMI_LZ_STREAM_START { u32 addr = MB_Read32(0); Log(LogLevel::Debug, "BMI_LZ_STREAM_START %08X\n", addr); } return; case 0x0E: // BMI_LZ_DATA { u32 len = MB_Read32(0); Log(LogLevel::Debug, "BMI LZ write %08X\n", len); //FILE* f = fopen("debug/wififirm.bin", "ab"); for (u32 i = 0; i < len; i++) { u8 val = Mailbox[0].Read(); // TODO: do something with it!! //fwrite(&val, 1, 1, f); } //fclose(f); } return; default: Log(LogLevel::Warn, "unknown BMI command %08X\n", cmd); return; } } void DSi_NWifi::HTC_Command() { u16 h0 = MB_Read16(0); u16 len = MB_Read16(0); u16 h2 = MB_Read16(0); u16 cmd = MB_Read16(0); switch (cmd) { case 0x0002: // service connect { u16 svc_id = MB_Read16(0); u16 conn_flags = MB_Read16(0); Log(LogLevel::Debug, "service connect %04X %04X %04X\n", svc_id, conn_flags, MB_Read16(0)); u8 svc_resp[8]; // responses from hardware: // 0003 0100 00 01 0602 00 00 // 0003 0101 00 02 0600 00 00 // 0003 0102 00 03 0600 00 00 // 0003 0103 00 04 0600 00 00 // 0003 0104 00 05 0600 00 00 *(u16*)&svc_resp[0] = svc_id; svc_resp[2] = 0; svc_resp[3] = (svc_id & 0xFF) + 1; *(u16*)&svc_resp[4] = (svc_id==0x0100) ? 0x0602 : 0x0600; // max message size *(u16*)&svc_resp[6] = 0x0000; SendWMIEvent(0, 0x0003, svc_resp, 8); } break; case 0x0004: // setup complete { u8 ready_evt[12]; memcpy(&ready_evt[0], &EEPROM[0xA], 6); // MAC address ready_evt[6] = 0x02; ready_evt[7] = 0; *(u32*)&ready_evt[8] = 0x2300006C; SendWMIEvent(1, 0x1001, ready_evt, 12); u8 regdomain_evt[4]; *(u32*)®domain_evt[0] = 0x80000000 | (*(u16*)&EEPROM[0x008] & 0x0FFF); SendWMIEvent(1, 0x1006, regdomain_evt, 4); BootPhase = 2; NDS::ScheduleEvent(NDS::Event_DSi_NWifi, false, 33611, 0, 0); } break; default: Log(LogLevel::Warn, "unknown HTC command %04X\n", cmd); for (int i = 0; i < len; i++) { printf("%02X ", Mailbox[0].Read()); if ((i&0xF)==0xF) printf("\n"); } printf("\n"); break; } MB_Drain(0); } void DSi_NWifi::WMI_Command() { u16 h0 = MB_Read16(0); u16 len = MB_Read16(0); u16 h2 = MB_Read16(0); u8 ep = h0 & 0xFF; if (ep > 0x01) // data endpoints { WMI_SendPacket(len); } else { u16 cmd = MB_Read16(0); switch (cmd) { case 0x0001: // connect to network { WMI_ConnectToNetwork(); } break; case 0x0003: // disconnect { if (ConnectionStatus != 1) Log(LogLevel::Warn, "WMI: ?? trying to disconnect while not connected\n"); Log(LogLevel::Debug, "WMI: disconnect\n"); ConnectionStatus = 0; u8 reply[11]; *(u16*)&reply[0] = 3; // checkme memcpy(&reply[2], WifiAP::APMac, 6); reply[8] = 3; // disconnect reason (via cmd) reply[9] = 0; // assoc-response length (none here) reply[10] = 0; // we need atleast one byte here, even if there is no assoc-response SendWMIEvent(1, 0x1003, reply, 11); } break; case 0x0004: // synchronize { Mailbox[0].Read(); // TODO?? } break; case 0x0005: // create priority stream { // TODO??? // there's a lot of crap in there. } break; case 0x0007: // start scan { u32 forcefg = MB_Read32(0); u32 legacy = MB_Read32(0); u32 scantime = MB_Read32(0); u32 forceinterval = MB_Read32(0); u8 scantype = Mailbox[0].Read(); u8 nchannels = Mailbox[0].Read(); Log(LogLevel::Debug, "WMI: start scan, forceFG=%d, legacy=%d, scanTime=%d, interval=%d, scanType=%d, chan=%d\n", forcefg, legacy, scantime, forceinterval, scantype, nchannels); if (ScanTimer > 0) { Log(LogLevel::Debug, "!! CHECKME: START SCAN BUT WAS ALREADY SCANNING (%d)\n", ScanTimer); } // checkme ScanTimer = scantime*5; } break; case 0x0008: // set scan params { // TODO: do something with the params!! } break; case 0x0009: // set BSS filter { // TODO: do something with the params!! u8 bssfilter = Mailbox[0].Read(); Mailbox[0].Read(); Mailbox[0].Read(); Mailbox[0].Read(); u32 iemask = MB_Read32(0); Log(LogLevel::Debug, "WMI: set BSS filter, filter=%02X, iemask=%08X\n", bssfilter, iemask); } break; case 0x000A: // set probed BSSID { u8 id = Mailbox[0].Read(); u8 flags = Mailbox[0].Read(); u8 len = Mailbox[0].Read(); char ssid[33] = {0}; for (int i = 0; i < len && i < 32; i++) ssid[i] = Mailbox[0].Read(); // TODO: store it somewhere Log(LogLevel::Debug, "WMI: set probed SSID: id=%d, flags=%02X, len=%d, SSID=%s\n", id, flags, len, ssid); } break; case 0x000D: // set disconnect timeout { Mailbox[0].Read(); // TODO?? } break; case 0x000E: // get channel list { int nchan = 11; // TODO: customize?? u8 reply[2 + (nchan*2) + 2]; reply[0] = 0; reply[1] = nchan; for (int i = 0; i < nchan; i++) *(u16*)&reply[2 + (i*2)] = 2412 + (i*5); *(u16*)&reply[2 + (nchan*2)] = 0; SendWMIEvent(1, 0x000E, reply, 4+(nchan*2)); } break; case 0x0011: // set channel params { Mailbox[0].Read(); u8 scan = Mailbox[0].Read(); u8 phymode = Mailbox[0].Read(); u8 len = Mailbox[0].Read(); u16 channels[32]; for (int i = 0; i < len && i < 32; i++) channels[i] = MB_Read16(0); // TODO: store it somewhere Log(LogLevel::Debug, "WMI: set channel params: scan=%d, phymode=%d, len=%d, channels=", scan, phymode, len); for (int i = 0; i < len && i < 32; i++) printf("%d,", channels[i]); printf("\n"); } break; case 0x0012: // set power mode { Mailbox[0].Read(); // TODO?? } break; case 0x0017: // dummy? Mailbox[0].Read(); break; case 0x0022: // set error bitmask { ErrorMask = MB_Read32(0); } break; case 0x002E: // extension shit { u32 extcmd = MB_Read32(0); switch (extcmd) { case 0x2008: // 'heartbeat'?? { u32 cookie = MB_Read32(0); u32 source = MB_Read32(0); u8 reply[12]; *(u32*)&reply[0] = 0x3007; *(u32*)&reply[4] = cookie; *(u32*)&reply[8] = source; SendWMIEvent(1, 0x1010, reply, 12); } break; default: Log(LogLevel::Warn, "WMI: unknown ext cmd 002E:%04X\n", extcmd); break; } } break; case 0x003D: // set keepalive interval { Mailbox[0].Read(); // TODO?? } break; case 0x0041: // 'WMI_SET_WSC_STATUS_CMD' { Mailbox[0].Read(); // TODO?? } break; case 0x0047: // cmd47 -- timer shenanigans?? { // } break; case 0x0048: // not supported by DSi?? { MB_Read32(0); MB_Read32(0); Mailbox[0].Read(); Mailbox[0].Read(); } break; case 0x0049: // 'host exit notify' { // } break; case 0xF000: // set bitrate { // TODO! Mailbox[0].Read(); Mailbox[0].Read(); Mailbox[0].Read(); } break; default: Log(LogLevel::Warn, "unknown WMI command %04X (header: %04X:%04X:%04X)\n", cmd, h0, len, h2); for (int i = 0; i < len-2; i++) { printf("%02X ", Mailbox[0].Read()); if ((i&0xF)==0xF) printf("\n"); } printf("\n"); break; } } if (h0 & (1<<8)) SendWMIAck(ep); MB_Drain(0); } void DSi_NWifi::WMI_ConnectToNetwork() { u8 type = Mailbox[0].Read(); u8 auth11 = Mailbox[0].Read(); u8 auth = Mailbox[0].Read(); u8 pCryptoType = Mailbox[0].Read(); u8 pCryptoLen = Mailbox[0].Read(); u8 gCryptoType = Mailbox[0].Read(); u8 gCryptoLen = Mailbox[0].Read(); u8 ssidLen = Mailbox[0].Read(); char ssid[33] = {0}; for (int i = 0; i < 32; i++) ssid[i] = Mailbox[0].Read(); if (ssidLen <= 32) ssid[ssidLen] = '\0'; u16 channel = MB_Read16(0); u8 bssid[6]; *(u32*)&bssid[0] = MB_Read32(0); *(u16*)&bssid[4] = MB_Read16(0); u32 flags = MB_Read32(0); if ((type != 0x01) || (auth11 != 0x01) || (auth != 0x01) || (pCryptoType != 0x01) || (gCryptoType != 0x01) || (memcmp(bssid, WifiAP::APMac, 6))) { Log(LogLevel::Error, "WMI_Connect: bad parameters\n"); // TODO: send disconnect?? return; } Log(LogLevel::Debug, "WMI: connecting to network %s\n", ssid); u8 reply[20]; // hope this is right! *(u16*)&reply[0] = 2437; // channel memcpy(&reply[2], WifiAP::APMac, 6); // BSSID *(u16*)&reply[8] = 128; // listen interval *(u16*)&reply[10] = 128; // beacon interval *(u32*)&reply[12] = 0x01; // network type reply[16] = 0x16; // beaconIeLen ??? reply[17] = 0x2F; // assocReqLen reply[18] = 0x16; // assocRespLen reply[19] = 0; // ????? SendWMIEvent(1, 0x1002, reply, 20); ConnectionStatus = 1; } void DSi_NWifi::WMI_SendPacket(u16 len) { if (ConnectionStatus != 1) { Log(LogLevel::Warn, "WMI: !! trying to send shit while not connected\n"); // TODO: report error?? return; } // header??? // packets with bit1=1 are something special (sync??) // otherwise, ???? // header is 001C on ARP frames, 0000 otherwise u16 hdr = MB_Read16(0); hdr = ((hdr & 0xFF00) >> 8) | ((hdr & 0x00FF) << 8); u16 type = hdr & 0x0003; if (type == 2) // data sync { Log(LogLevel::Debug, "WMI: data sync\n"); /*Mailbox[8].Write(2); // eid Mailbox[8].Write(0x00); // flags MB_Write16(8, 2); // data length Mailbox[8].Write(0); // Mailbox[8].Write(0); // MB_Write16(8, 0x0200); // DrainRXBuffer();*/ return; } if (type) { Log(LogLevel::Debug, "WMI: special frame %04X len=%d\n", hdr, len); for (int i = 0; i < len-2; i++) { printf("%02X ", Mailbox[0].Read()); if ((i&0xF)==0xF) printf("\n"); } printf("\n"); return; } Log(LogLevel::Debug, "WMI: send packet, hdr=%04X, len=%d\n", hdr, len); u8 dstmac[6]; u8 srcmac[6]; u16 plen; *(u32*)&dstmac[0] = MB_Read32(0); *(u16*)&dstmac[4] = MB_Read16(0); *(u32*)&srcmac[0] = MB_Read32(0); *(u16*)&srcmac[4] = MB_Read16(0); plen = MB_Read16(0); plen = ((plen & 0xFF00) >> 8) | ((plen & 0x00FF) << 8); if (plen > len-16) { Log(LogLevel::Error, "WMI: bad packet length %d > %d\n", plen, len-16); return; } u32 h0 = MB_Read32(0); u16 h1 = MB_Read16(0); if (h0 != 0x0003AAAA || h1 != 0x0000) { Log(LogLevel::Error, "WMI: bad LLC/SLIP header\n"); return; } u16 ethertype = MB_Read16(0); int lan_len = (plen - 8) + 14; memcpy(&LANBuffer[0], dstmac, 6); // destination MAC memcpy(&LANBuffer[6], srcmac, 6); // source MAC *(u16*)&LANBuffer[12] = ethertype; // type for (int i = 0; i < lan_len-14; i++) { LANBuffer[14+i] = Mailbox[0].Read(); } /*for (int i = 0; i < lan_len; i++) { printf("%02X ", LANBuffer[i]); if ((i&0xF)==0xF) printf("\n"); } printf("\n");*/ Platform::LAN_SendPacket(LANBuffer, lan_len); } void DSi_NWifi::SendWMIEvent(u8 ep, u16 id, u8* data, u32 len) { if (!Mailbox[8].CanFit(6+len+2+8)) { Log(LogLevel::Error, "NWifi: !! not enough space in RX buffer for WMI event %04X\n", id); return; } Mailbox[8].Write(ep); // eid Mailbox[8].Write(0x02); // flags (trailer) MB_Write16(8, len+2+8); // data length (plus event ID and trailer) Mailbox[8].Write(8); // trailer length Mailbox[8].Write(0); // MB_Write16(8, id); // event ID for (u32 i = 0; i < len; i++) { Mailbox[8].Write(data[i]); } // trailer Mailbox[8].Write(0x02); Mailbox[8].Write(0x06); Mailbox[8].Write(0x00); Mailbox[8].Write(0x00); Mailbox[8].Write(0x00); Mailbox[8].Write(0x00); Mailbox[8].Write(0x00); Mailbox[8].Write(0x00); DrainRXBuffer(); } void DSi_NWifi::SendWMIAck(u8 ep) { if (!Mailbox[8].CanFit(6+12)) { Log(LogLevel::Error, "NWifi: !! not enough space in RX buffer for WMI ack (ep #%d)\n", ep); return; } Mailbox[8].Write(0); // eid Mailbox[8].Write(0x02); // flags (trailer) MB_Write16(8, 0xC); // data length (plus trailer) Mailbox[8].Write(0xC); // trailer length Mailbox[8].Write(0); // // credit report Mailbox[8].Write(0x01); Mailbox[8].Write(0x02); Mailbox[8].Write(ep); Mailbox[8].Write(0x01); // lookahead Mailbox[8].Write(0x02); Mailbox[8].Write(0x06); Mailbox[8].Write(0x00); Mailbox[8].Write(0x00); Mailbox[8].Write(0x00); Mailbox[8].Write(0x00); Mailbox[8].Write(0x00); Mailbox[8].Write(0x00); DrainRXBuffer(); } void DSi_NWifi::SendWMIBSSInfo(u8 type, u8* data, u32 len) { if (!Mailbox[8].CanFit(6+len+2+16)) { Log(LogLevel::Error, "NWifi: !! not enough space in RX buffer for WMI BSSINFO event\n"); return; } // TODO: check when version>=2 frame type is used? // I observed the version<2 variant on my DSi Mailbox[8].Write(1); // eid Mailbox[8].Write(0x00); // flags MB_Write16(8, len+2+16); // data length (plus event ID and trailer) Mailbox[8].Write(0xFF); // trailer length Mailbox[8].Write(0xFF); // MB_Write16(8, 0x1004); // event ID MB_Write16(8, 2437); // channel (6) (checkme!) Mailbox[8].Write(type); Mailbox[8].Write(0x1B); // 'snr' MB_Write16(8, 0xFFBC); // RSSI MB_Write32(8, *(u32*)&WifiAP::APMac[0]); MB_Write16(8, *(u16*)&WifiAP::APMac[4]); MB_Write32(8, 0); // ieMask for (u32 i = 0; i < len; i++) { Mailbox[8].Write(data[i]); } DrainRXBuffer(); } void DSi_NWifi::CheckRX() { if (!Mailbox[8].CanFit(2048)) return; int rxlen = Platform::LAN_RecvPacket(LANBuffer); if (rxlen > 0) { //printf("WMI packet recv %04X %04X %04X\n", *(u16*)&LANBuffer[0], *(u16*)&LANBuffer[2], *(u16*)&LANBuffer[4]); // check destination MAC if (*(u32*)&LANBuffer[0] != 0xFFFFFFFF || *(u16*)&LANBuffer[4] != 0xFFFF) { if (memcmp(&LANBuffer[0], &EEPROM[0x00A], 6)) return; } // check source MAC, in case we get a packet we just sent out if (!memcmp(&LANBuffer[6], &EEPROM[0x00A], 6)) return; // packet is good Log(LogLevel::Debug, "WMI: receive packet %04X, len=%d\n", *(u16*)&LANBuffer[12], rxlen); /*for (int i = 0; i < rxlen; i++) { printf("%02X ", LANBuffer[i]); if ((i&0xF)==0xF) printf("\n"); } printf("\n");*/ int datalen = rxlen - 14; // length of packet body u16 hdr = 0x0000; //if (*(u16*)&LANBuffer[12] == 0x0608) // HAX!!! // hdr = 0x1C00; hdr = 0x80; // TODO: not hardcode the endpoint ID!! u8 ep = 2; Mailbox[8].Write(ep); Mailbox[8].Write(0x00); MB_Write16(8, 16 + 8 + datalen); Mailbox[8].Write(0); Mailbox[8].Write(0); MB_Write16(8, hdr); MB_Write32(8, *(u32*)&LANBuffer[0]); MB_Write16(8, *(u16*)&LANBuffer[4]); MB_Write32(8, *(u32*)&LANBuffer[6]); MB_Write16(8, *(u16*)&LANBuffer[10]); u16 plen = datalen + 8; plen = ((plen & 0xFF00) >> 8) | ((plen & 0x00FF) << 8); MB_Write16(8, plen); MB_Write16(8, 0xAAAA); MB_Write16(8, 0x0003); MB_Write16(8, 0x0000); MB_Write16(8, *(u16*)&LANBuffer[12]); for (int i = 0; i < datalen; i++) Mailbox[8].Write(LANBuffer[14+i]); DrainRXBuffer(); } } u32 DSi_NWifi::WindowRead(u32 addr) { Log(LogLevel::Debug, "NWifi: window read %08X\n", addr); if ((addr & 0xFFFF00) == HostIntAddr) { // RAM host interest area // TODO: different base based on hardware version switch (addr & 0xFF) { case 0x54: // base address of EEPROM data // TODO find what the actual address is! return 0x1FFC00; case 0x58: return EEPROMReady; } return 0; } // hax if ((addr & 0x1FFC00) == 0x1FFC00) { return *(u32*)&EEPROM[addr & 0x3FF]; } switch (addr) { case 0x40EC: // chip ID return ChipID; // SOC_RESET_CAUSE case 0x40C0: return 2; } return 0; } void DSi_NWifi::WindowWrite(u32 addr, u32 val) { Log(LogLevel::Debug, "NWifi: window write %08X %08X\n", addr, val); } void DSi_NWifi::DrainRXBuffer() { while (Mailbox[8].Level() >= 6) { u16 len = Mailbox[8].Peek(2) | (Mailbox[8].Peek(3) << 8); u32 totallen = len + 6; u32 required = (totallen + 0x7F) & ~0x7F; if (!Mailbox[4].CanFit(required)) break; u32 i = 0; for (; i < totallen; i++) Mailbox[4].Write(Mailbox[8].Read()); for (; i < required; i++) Mailbox[4].Write(0); } UpdateIRQ_F1(); } void DSi_NWifi::MSTimer(u32 param) { BeaconTimer++; if (ScanTimer > 0) { ScanTimer--; // send a beacon if (!(BeaconTimer & 0x7F)) { u8 beacon[] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // timestamp 0x80, 0x00, // beacon interval 0x21, 0x00, // capability, 0x01, 0x08, 0x82, 0x84, 0x8B, 0x96, 0x0C, 0x12, 0x18, 0x24, // rates 0x03, 0x01, 0x06, // channel 0x05, 0x04, 0x00, 0x00, 0x00, 0x00, // TIM 0x00, 0x07, 'm', 'e', 'l', 'o', 'n', 'A', 'P', // SSID }; SendWMIBSSInfo(0x01, beacon, sizeof(beacon)); Log(LogLevel::Debug, "send beacon\n"); } if (ScanTimer == 0) { u32 status = 0; SendWMIEvent(1, 0x100A, (u8*)&status, 4); } } if (ConnectionStatus == 1) { //if (Mailbox[4].IsEmpty()) CheckRX(); } NDS::ScheduleEvent(NDS::Event_DSi_NWifi, true, 33611, 0, 0); }