diff --git a/Source/Core/Core/HW/WiimoteEmu/EmuSubroutines.cpp b/Source/Core/Core/HW/WiimoteEmu/EmuSubroutines.cpp index b6100e5234..10277873d5 100644 --- a/Source/Core/Core/HW/WiimoteEmu/EmuSubroutines.cpp +++ b/Source/Core/Core/HW/WiimoteEmu/EmuSubroutines.cpp @@ -31,668 +31,6 @@ namespace WiimoteEmu { -void Spy(Wiimote* wm_, const void* data_, size_t size_) -{ -// Enable for logging and debugging purposes. -#if 0 - // enable log - bool logCom = true; - bool logData = true; - bool logMP = false; - bool logAudio = false; - - std::string Name, TmpData; - static int c; - int size; - u16 SampleValue; - bool AudioData = false; - bool DataReport = false; - static std::queue dataRep; - static u8 dataReply[3] = {0}; - bool emu = wm_; - static Wiimote* wm = 0; - - // a container for f.e. the extension encryption key - if (!wm_ && !wm) - wm = new Wiimote(0); - else - wm = wm_; - - // ignore emulated Wiimote data - if (emu) return; - - const hid_packet* const hidp = (hid_packet*)data_; - const wm_report* const sr = (wm_report*)hidp->data; - - // use a non-pointer array because that makes read syntax shorter - u8 data[32] = {}; - memcpy(data, data_, size_); - - switch (data[1]) - { - case WM_RUMBLE: - size = 1; - if (logCom) Name.append("WM_RUMBLE"); - break; - - case WM_LEDS: - size = sizeof(wm_leds); - if (logCom) Name.append("WM_LEDS"); - break; - - case WM_REPORT_MODE: - size = sizeof(wm_report_mode); - if (logCom) Name.append("WM_REPORT_MODE"); - ERROR_LOG(CONSOLE, "WM_REPORT_MODE: 0x%02x", data[3]); - break; - - case WM_IR_PIXEL_CLOCK: - if (logCom) Name.append("WM_IR_PIXEL_CLOCK"); - break; - - case WM_SPEAKER_ENABLE: - if (logCom) Name.append("WM_SPEAKER_ENABLE"); - NOTICE_LOG(CONSOLE, "Speaker on: %d", sr->enable); - break; - - case WM_REQUEST_STATUS: - size = sizeof(wm_request_status); - if (logCom) Name.append("WM_REQUEST_STATUS"); - NOTICE_LOG(CONSOLE, "WM_REQUEST_STATUS: %s", ArrayToString(data, size+2, 0).c_str()); - break; - - case WM_WRITE_DATA: - { - if (logCom) Name.append("W 0x16"); - size = sizeof(wm_write_data); - - wm_write_data* wd = (wm_write_data*)sr->data; - u32 address = Common::swap24(wd->address); - address &= ~0x010000; - - switch (data[2] >> 0x01) - { - case WM_SPACE_EEPROM: - if (logCom) Name.append(" REG_EEPROM"); break; - case WM_SPACE_REGS1: - case WM_SPACE_REGS2: - { - const u8 region_offset = (u8)address; - void *region_ptr = nullptr; - int region_size = 0; - - switch (data[3]) - { - case 0xa2: - if (logCom) - { - Name.append(" REG_SPEAKER"); - if (data[6] == 7) - { - //INFO_LOG(CONSOLE, "Sound configuration:"); - if (data[8] == 0x00) - { - //memcpy(&SampleValue, &data[9], 2); - //NOTICE_LOG(CONSOLE, " Data format: 4-bit ADPCM (%i Hz)", 6000000 / SampleValue); - //NOTICE_LOG(CONSOLE, " Volume: %02i%%", (data[11] / 0x40) * 100); - } - else if (data[8] == 0x40) - { - //memcpy(&SampleValue, &data[9], 2); - //NOTICE_LOG(CONSOLE, " Data format: 8-bit PCM (%i Hz)", 12000000 / SampleValue); - //NOTICE_LOG(CONSOLE, " Volume: %02i%%", (data[11] / 0xff) * 100); - } - } - } - break; - case 0xa4: - if (logCom) Name.append(" REG_EXT"); - // Update the encryption mode - if (data[5] == 0xf0) - { - if (!emu) - wm->m_reg_ext.encryption = wd->data[0]; - //NOTICE_LOG(CONSOLE, "Extension encryption: %u", wm->m_reg_ext.encryption); - } - region_ptr = &wm->m_reg_ext; - break; - case 0xa6 : - if (logCom) Name.append(" REG_M+"); - // update the encryption mode - if (data[5] == 0xf0) - { - if (!emu) - wm->m_reg_motion_plus.activated = wd->data[0]; - //NOTICE_LOG(CONSOLE, "Extension enryption: %u", wm->m_reg_ext.encryption); - } - region_ptr = &wm->m_reg_motion_plus; - break; - case 0xb0: - if (logCom) Name.append(" REG_IR"); break; - } - - // save register - if (!emu && region_ptr) - memcpy((u8*)region_ptr + region_offset, wd->data, wd->size); - // save key - if (region_offset >= 0x40 && region_offset <= 0x4c) - { - if (!emu) - WiimoteGenerateKey(&wm->m_ext_key, wm->m_reg_ext.encryption_key); - INFO_LOG(CONSOLE, "Writing key: %s", ArrayToString((u8*)&wm->m_ext_key, sizeof(wm->m_ext_key), 0, 30).c_str()); - } - if (data[3] == 0xa4 || data[3] == 0xa6) - { - //DEBUG_LOG(CONSOLE, "M+: %s", ArrayToString((u8*)&wm->m_reg_motion_plus, sizeof(wm->m_reg_motion_plus), 0, 30).c_str()); - //DEBUG_LOG(CONSOLE, "M+: %s", ArrayToString((u8*)&wm->m_reg_motion_plus.ext_identifier, sizeof(wm->m_reg_motion_plus.ext_identifier), 0, 30).c_str()); - NOTICE_LOG(CONSOLE, "W[0x%02x 0x%02x|%d]: %s", data[3], region_offset, wd->size, ArrayToString(wd->data, wd->size, 0).c_str()); - } - break; - } - } - - break; - } - - case WM_READ_DATA: - { - if (logCom) Name.append("R"); - size = sizeof(wm_read_data); - - wm_read_data* rd = (wm_read_data*)sr->data; - u32 address = Common::swap24(rd->address); - u8 addressLO = address & 0xFFFF; - address &= 0xFEFFFF; - u16 size = Common::swap16(rd->size); - u8 *const block = new u8[size]; - void *region_ptr = nullptr; - - dataRep.push(((data[2]>>1)<<16) + ((data[3])<<8) + addressLO); - - switch (data[2]>>1) - { - case WM_SPACE_EEPROM: - if (logCom) Name.append(" REG_EEPROM"); - if (!emu) - memcpy(block, wm->m_eeprom + address, size); - break; - case WM_SPACE_REGS1: - case WM_SPACE_REGS2: - // ignore second byte for extension area - if (address>>16 == 0xA4) address &= 0xFF00FF; - const u8 region_offset = (u8)address; - switch (data[3]) - { - case 0xa2: - if (logCom) Name.append(" REG_SPEAKER"); - region_ptr = &wm->m_reg_speaker; - break; - case 0xa4: - if (logCom) Name.append(" REG_EXT"); - region_ptr = &wm->m_reg_motion_plus; - break; - case 0xa6: - if (logCom) Name.append(" REG_M+"); - region_ptr = &wm->m_reg_motion_plus; - break; - case 0xb0: - if (logCom) Name.append(" REG_IR"); - region_ptr = &wm->m_reg_ir; - break; - } - //if (!emu && region_ptr) - //memcpy(block, (u8*)region_ptr + region_offset, size); - //WARN_LOG(CONSOLE, "READING[0x%02x 0x%02x|%d]: %s", data[3], region_offset, size, ArrayToString(block, size, 0, 30).c_str()); - break; - } - - break; - } - - case WM_WRITE_SPEAKER_DATA: - if (logCom) Name.append("WM_SPEAKER_DATA"); - size = 21; - break; - - case WM_SPEAKER_MUTE: - if (logCom) Name.append("WM_SPEAKER"); - size = 1; - NOTICE_LOG(CONSOLE, "Speaker mute: %d", sr->enable); - break; - - case WM_IR_LOGIC: - if (logCom) Name.append("WM_IR"); - size = 1; - break; - - case WM_STATUS_REPORT: - size = sizeof(wm_status_report); - Name = "WM_STATUS_REPORT"; - //INFO_LOG(CONSOLE, "WM_STATUS_REPORT: %s", ArrayToString(data, size+2, 0).c_str()); - { - wm_status_report* pStatus = (wm_status_report*)(data + 2); - ERROR_LOG(CONSOLE, "" - "Statusreport extension: %i", - //"Speaker enabled: %i" - //"IR camera enabled: %i" - //"LED 1: %i\n" - //"LED 2: %i\n" - //"LED 3: %i\n" - //"LED 4: %i\n" - //"Battery low: %i\n" - //"Battery level: %i", - pStatus->extension - //pStatus->speaker, - //pStatus->ir, - //(pStatus->leds >> 0), - //(pStatus->leds >> 1), - //(pStatus->leds >> 2), - //(pStatus->leds >> 3), - //pStatus->battery_low, - //pStatus->battery - ); - } - break; - - case WM_READ_DATA_REPLY: - { - size = sizeof(wm_read_data_reply); - Name = "R_REPLY"; - - u8 data2[32]; - memset(data2, 0, sizeof(data2)); - memcpy(data2, data, size_); - wm_read_data_reply* const rdr = (wm_read_data_reply*)(data2 + 2); - - bool decrypted = false; - if (!dataRep.empty()) - { - dataReply[0] = (dataRep.front()>>16)&0x00FF; - dataReply[1] = (dataRep.front()>>8)&0x00FF; - dataReply[2] = dataRep.front()&0x00FF; - dataRep.pop(); - } - - switch (dataReply[0]) - { - case WM_SPACE_EEPROM: - if (logCom) - Name.append(" REG_EEPROM"); - // Wiimote calibration - if (data[4] == 0xf0 && data[5] == 0x00 && data[6] == 0x10) - { - if (data[6] == 0x10) - { - accel_cal* calib = (accel_cal*)&rdr->data[6]; - ERROR_LOG(CONSOLE, "Wiimote calibration:"); - //SERROR_LOG(CONSOLE, "%s", ArrayToString(rdr->data, rdr->size).c_str()); - ERROR_LOG(CONSOLE, "Cal_zero.x: %i", calib->zero_g.x); - ERROR_LOG(CONSOLE, "Cal_zero.y: %i", calib->zero_g.y); - ERROR_LOG(CONSOLE, "Cal_zero.z: %i", calib->zero_g.z); - ERROR_LOG(CONSOLE, "Cal_g.x: %i", calib->one_g.x); - ERROR_LOG(CONSOLE, "Cal_g.y: %i", calib->one_g.y); - ERROR_LOG(CONSOLE, "Cal_g.z: %i", calib->one_g.z); - // save - if (!emu) - memcpy(wm->m_eeprom + 0x16, rdr->data + 6, rdr->size); - } - } - break; - - case WM_SPACE_REGS1: - case WM_SPACE_REGS2: - switch (dataReply[1]) - { - case 0xa2: if (logCom) Name.append(" REG_SPEAKER"); break; - case 0xa4: if (logCom) Name.append(" REG_EXT"); break; - case 0xa6: if (logCom) Name.append(" REG_M+"); break; - case 0xb0: if (logCom) Name.append(" REG_IR"); break; - } - } - - // save key - if (!emu && rdr->address>>8 == 0x40) - { - memcpy(((u8*)&wm->m_reg_ext.encryption_key), rdr->data, rdr->size+1); - WiimoteGenerateKey(&wm->m_ext_key, wm->m_reg_ext.encryption_key); - NOTICE_LOG(CONSOLE, "Reading key: %s", ArrayToString(((u8*)&wm->m_ext_key), sizeof(wm->m_ext_key), 0, 30).c_str()); - } - - // select decryption - //if(((!wm->GetMotionPlusActive() && ((u8*)&wm->m_reg_ext)[0xf0] == 0xaa) || (wm->GetMotionPlusActive() && ((u8*)&wm->m_reg_motion_plus)[0xf0] == 0xaa)) && rdr->address>>8 < 0xf0) { - - //if(((((u8*)&wm->m_reg_ext)[0xf0] == 0xaa) || ((u8*)&wm->m_reg_motion_plus)[0xf0] == 0xaa) && rdr->address>>8 < 0xf0) { - - //if(!wm->GetMotionPlusActive() && ((u8*)&wm->m_reg_ext)[0xf0] == 0xaa && rdr->address>>8 < 0xf0) { - - //if(!wm->GetMotionPlusActive() && ((u8*)&wm->m_reg_ext)[0xf0] == 0xaa) { - - // SWARN_LOG(CONSOLE, "key %s", ArrayToString(((u8*)&wm->m_ext_key), sizeof(wm->m_ext_key), 0, 30).c_str()); - // SWARN_LOG(CONSOLE, "decrypt %s", ArrayToString(rdr->data, rdr->size+1, 0, 30).c_str()); - // WiimoteDecrypt(&wm->m_ext_key, rdr->data, dataReply[2]&0xffff, rdr->size+1); - // SWARN_LOG(CONSOLE, "decrypt %s", ArrayToString(rdr->data, rdr->size+1, 0, 30).c_str()); - // decrypted = true; - //} - - // save data - if (!emu && !rdr->error) - { - //if (dataReply[1] == 0xa4 && wm->GetMotionPlusActive()) - // memcpy(&((u8*)&wm->m_reg_motion_plus)[rdr->address>>8], rdr->data, rdr->size+1); - //if (dataReply[1] == 0xa4 && !wm->GetMotionPlusActive()) - //if (dataReply[1] == 0xa4) - // memcpy(&((u8*)&wm->m_reg_ext)[rdr->address>>8], rdr->data, rdr->size+1); - //if (!wm->GetMotionPlusActive() && wm->GetMotionPlusAttached()) - //if (dataReply[1] == 0xa6) - // memcpy(&((u8*)&wm->m_reg_motion_plus)[rdr->address>>8], rdr->data, rdr->size+1); - //INFO_LOG(CONSOLE, "Saving[0x%2x:0x%2x]: %s", dataReply[1], rdr->address>>8, ArrayToString(rdr->data, rdr->size+1).c_str()); - } - - if (!rdr->error && rdr->address>>8 >= 0xf0 && rdr->address>>8 <= 0xff) - { - //INFO_LOG(CONSOLE, "Extension ID: %s", ArrayToString(rdr->data, rdr->size+1).c_str()); - } - - // Nunchuk calibration - if (data[4] == 0xf0 && data[5] == 0x00 && (data[6] == 0x20 || data[6] == 0x30)) - { - // log - //TmpData = StringFromFormat("Read[%s] (enc): %s", (Emu ? "Emu" : "Real"), ArrayToString(data, size + 2).c_str()); - - // decrypt - //if(((u8*)&wm->m_reg_ext)[0xf0] == 0xaa) { - // WiimoteDecrypt(&wm->m_ext_key, &data[0x07], 0x00, (data[4] >> 0x04) + 1); - - //if (wm->m_extension->name == "NUNCHUK") - //{ - // INFO_LOG(CONSOLE, "\nGame got the Nunchuk calibration:\n"); - // INFO_LOG(CONSOLE, "Cal_zero.x: %i\n", data[7 + 0]); - // INFO_LOG(CONSOLE, "Cal_zero.y: %i\n", data[7 + 1]); - // INFO_LOG(CONSOLE, "Cal_zero.z: %i\n", data[7 + 2]); - // INFO_LOG(CONSOLE, "Cal_g.x: %i\n", data[7 + 4]); - // INFO_LOG(CONSOLE, "Cal_g.y: %i\n", data[7 + 5]); - // INFO_LOG(CONSOLE, "Cal_g.z: %i\n", data[7 + 6]); - // INFO_LOG(CONSOLE, "Js.Max.x: %i\n", data[7 + 8]); - // INFO_LOG(CONSOLE, "Js.Min.x: %i\n", data[7 + 9]); - // INFO_LOG(CONSOLE, "Js.Center.x: %i\n", data[7 + 10]); - // INFO_LOG(CONSOLE, "Js.Max.y: %i\n", data[7 + 11]); - // INFO_LOG(CONSOLE, "Js.Min.y: %i\n", data[7 + 12]); - // INFO_LOG(CONSOLE, "JS.Center.y: %i\n\n", data[7 + 13]); - //} - //else // g_Config.bClassicControllerConnected - //{ - // INFO_LOG(CONSOLE, "\nGame got the Classic Controller calibration:\n"); - // INFO_LOG(CONSOLE, "Lx.Max: %i\n", data[7 + 0]); - // INFO_LOG(CONSOLE, "Lx.Min: %i\n", data[7 + 1]); - // INFO_LOG(CONSOLE, "Lx.Center: %i\n", data[7 + 2]); - // INFO_LOG(CONSOLE, "Ly.Max: %i\n", data[7 + 3]); - // INFO_LOG(CONSOLE, "Ly.Min: %i\n", data[7 + 4]); - // INFO_LOG(CONSOLE, "Ly.Center: %i\n", data[7 + 5]); - // INFO_LOG(CONSOLE, "Rx.Max.x: %i\n", data[7 + 6]); - // INFO_LOG(CONSOLE, "Rx.Min.x: %i\n", data[7 + 7]); - // INFO_LOG(CONSOLE, "Rx.Center.x: %i\n", data[7 + 8]); - // INFO_LOG(CONSOLE, "Ry.Max.y: %i\n", data[7 + 9]); - // INFO_LOG(CONSOLE, "Ry.Min: %i\n", data[7 + 10]); - // INFO_LOG(CONSOLE, "Ry.Center: %i\n\n", data[7 + 11]); - // INFO_LOG(CONSOLE, "Lt.Neutral: %i\n", data[7 + 12]); - // INFO_LOG(CONSOLE, "Rt.Neutral %i\n\n", data[7 + 13]); - //} - - // save values - if (!emu) - { - // Save to registry - if (data[7 + 0] != 0xff) - { - //memcpy((u8*)&wm->m_reg_ext.calibration, &data[7], 0x10); - //memcpy((u8*)&wm->m_reg_ext.unknown3, &data[7], 0x10); - } - // Save the default values that should work with Wireless Nunchuks - else - { - //WiimoteEmu::SetDefaultExtensionRegistry(); - } - //WiimoteEmu::UpdateEeprom(); - } - // third party Nunchuk - else if (data[7] == 0xff) - { - //memcpy(wm->m_reg_ext + 0x20, WiimoteEmu::wireless_nunchuk_calibration, sizeof(WiimoteEmu::wireless_nunchuk_calibration)); - //memcpy(wm->m_reg_ext + 0x30, WiimoteEmu::wireless_nunchuk_calibration, sizeof(WiimoteEmu::wireless_nunchuk_calibration)); - } - - // print encrypted data - //INFO_LOG(CONSOLE, "WM_READ_DATA_REPLY: Extension calibration: %s", TmpData.c_str()); - } - - if (dataReply[1] == 0xa4 || dataReply[1] == 0xa6) - { - if (rdr->error == 7 || rdr->error == 8) - { - WARN_LOG(CONSOLE, "R%s[0x%02x 0x%02x]: e-%d", decrypted?"*":"", dataReply[1], rdr->address>>8, rdr->error); - } - else - { - WARN_LOG(CONSOLE, "R%s[0x%02x 0x%02x|%d]: %s", decrypted?"*":"", dataReply[1], rdr->address>>8, rdr->size+1, ArrayToString(rdr->data, rdr->size+1, 0).c_str()); - } - } - - break; - } - - case WM_ACK_DATA: - size = sizeof(wm_acknowledge); - Name = "WM_ACK_DATA"; - //INFO_LOG(CONSOLE, "ACK 0x%02x", data[4]); - break; - - case WM_REPORT_CORE: - size = sizeof(wm_report_core); - DataReport = true; - break; - case WM_REPORT_CORE_ACCEL: - size = sizeof(wm_report_core_accel); - DataReport = true; - break; - case WM_REPORT_CORE_EXT8: - size = sizeof(wm_report_core_accel_ir12); - DataReport = true; - break; - case WM_REPORT_CORE_ACCEL_IR12: - size = sizeof(wm_report_core_accel_ir12); - DataReport = true; - break; - case WM_REPORT_CORE_EXT19: - size = sizeof(wm_report_core_accel_ext16); - DataReport = true; - break; - case WM_REPORT_CORE_ACCEL_EXT16: - size = sizeof(wm_report_core_accel_ext16); - DataReport = true; - break; - case WM_REPORT_CORE_IR10_EXT9: - size = sizeof(wm_report_core_accel_ir10_ext6); - DataReport = true; - break; - case WM_REPORT_CORE_ACCEL_IR10_EXT6: - size = sizeof(wm_report_core_accel_ir10_ext6); - DataReport = true; - break; - - default: - size = 15; - NOTICE_LOG(CONSOLE, "Debugging[%s]: Unknown channel 0x%02x", (emu ? "E" : "R"), data[1]); - break; - } - - //if (DataReport && wm->GetMotionPlusActive()) - //{ - // if (data[1] == WM_REPORT_CORE_ACCEL_IR10_EXT6) - // static bool extension = false; - // if (extension != (bool)(data[17+4]&1)) - // ERROR_LOG(CONSOLE, "Datareport extension %d", data[17+4]&1); - // extension = data[17+4]&1; - //} - - if (!DataReport && logCom && size <= 30) - { - ERROR_LOG_S(CONSOLE, "Com[%s] %s: %s", (emu ? "E" : "R"), Name.c_str(), ArrayToString(data, size + 2, 0).c_str()); - } - - if (logAudio && AudioData) - { - //DEBUG_LOG(CONSOLE, "%s: %s\n", Name.c_str(), ArrayToString(data, std::min(10,size), 0, 30).c_str()); - } - - if (DataReport && (logData || logMP)) - { - // decrypt extension data - //if (data[1] == 0x37 && !wm->GetMotionPlusActive()) - //if (data[1] == 0x37) - // WiimoteDecrypt(&wm->m_ext_key, &data[17], 0x00, 0x06); - //if (data[1] == 0x35) - // WiimoteDecrypt(&wm->m_ext_key, &data[7], 0x00, 0x06); - - //if (data[1] == 0x35 || data[1] == 0x37) - //{ - // if (!g_DebugMP && mp->is_mp_data) return; - // if (!g_DebugData && !mp->is_mp_data) return; - //} - - std::string SCore = "", SAcc = "", SIR = "", SExt = "", SExtID = ""; - - wm_buttons* core = (wm_buttons*)sr->data; - accel_cal* calib = (accel_cal*)&wm->m_eeprom[0x16]; - wm_accel* accel = (wm_accel*)&data[4]; - - //SCore = StringFromFormat( - // "%d %d %d %d ", - // core->xL, - // core->yL, - // core->zL, - // core->unknown); - - SAcc = StringFromFormat( - //"%3d %3d %3d" - //" | %3d %3d %3d" - //" | %3d %3d %3d" - "| %5.2f %5.2f %5.2f" - //, calib->zero_g.x, calib->zero_g.y, calib->zero_g.z - //, (calib->zero_g.x<<2) + calib->zero_g.xL, (calib->zero_g.y<<2) + calib->zero_g.yL, (calib->zero_g.z<<2) + calib->zero_g.zL - //, calib->one_g.x, calib->one_g.y, calib->one_g.z - //, (calib->one_g.x<<2) + calib->one_g.xL, (calib->one_g.y<<2) + calib->one_g.yL, (calib->one_g.z<<2) + calib->one_g.zL - //, accel->x, accel->y, accel->z - //, (accel->x<<2) + core->xL, (accel->y<<2) + core->yL, (accel->z<<2) + core->zL - , (accel->x - calib->zero_g.x) / float(calib->one_g.x-calib->zero_g.x), (accel->y - calib->zero_g.y) / float(calib->one_g.y-calib->zero_g.y), (accel->z - calib->zero_g.z) / float(calib->one_g.z-calib->zero_g.z)); - - NOTICE_LOG(CONSOLE, "%d", size); - - if (data[1] == WM_REPORT_CORE_ACCEL_IR12) - { - wm_ir_extended *ir = (wm_ir_extended*)&data[7]; - - SIR = StringFromFormat( - "%4u %4u | %u" - , ir->x | ir->xhi << 8 - , ir->y | ir->yhi << 8 - , ir->size); - } - - if (data[1] == WM_REPORT_CORE_ACCEL_EXT16) - { - wm_nc *nc = (wm_nc*)&data[7]; - - SExt = StringFromFormat( - "%02x %02x | %02x %02x %02x | %02x" - , nc->jx, nc->jy - , nc->ax, nc->ay, nc->az - , nc->bt); - } - - if (data[1] == WM_REPORT_CORE_ACCEL_IR10_EXT6) - { - wm_ir_basic *ir = (wm_ir_basic*)&data[7]; - - SIR = StringFromFormat( - "%4u %4u %4u %4u" - , ir->x1 | ir->x1hi << 8 - , ir->y1 | ir->y1hi << 8 - , ir->x2 | ir->x2hi << 8 - , ir->y2 | ir->y1hi << 8); - - /* - wm_motionplus *mp = (wm_motionplus*)&data[17]; - wm_nc_mp *nc_mp = (wm_nc_mp *)&data[17]; - - if (mp->is_mp_data) - { - SExt = StringFromFormat("" - //"%02x %02x %02x %02x %02x %02x" - //"| %04x %04x %04x - " %5.2f %5.2f %5.2f" - " %s%s%s" - //, mp->roll1, mp->roll2 - //, mp->pitch1, mp->pitch2 - //, mp->yaw1, mp->yaw2 - //, mp->pitch2<<8 | mp->pitch1 - //, mp->roll2<<8 | mp->roll1 - //, mp->yaw2<<8 | mp->yaw1 - //, mp->pitch2<<8 | mp->pitch1 - //, mp->roll2<<8 | mp->roll1 - //, mp->yaw2<<8 | mp->yaw1 - , float((mp->pitch2<<8 | mp->pitch1) - 0x1f7f) / float(0x1fff) - , float((mp->roll2<<8 | mp->roll1) - 0x1f7f) / float(0x1fff) - , float((mp->yaw2<<8 | mp->yaw1) - 0x1f7f) / float(0x1fff) - , mp->pitch_slow?"*":" ", mp->roll_slow?"*":" ", mp->yaw_slow?"*":" "); - } - else - { - SExt = StringFromFormat( - "%02x %02x | %02x %02x | %02x %02x %02x | %02x %02x %02x", - nc_mp->bz, nc_mp->bc, - nc_mp->jx, nc_mp->jy, - nc_mp->ax+nc_mp->axL, nc_mp->ay+nc_mp->ayL, (nc_mp->az<<1)+nc_mp->azL); - } - - SExtID = StringFromFormat( - "[%s|%d|%d]" - , mp->is_mp_data ? "+" : "e" - , mp->is_mp_data ? mp->extension_connected : nc_mp->extension_connected - , wm->m_extension->active_extension); - */ - - //DEBUG_LOG_S(CONSOLE, "M+ %d Extension %d %d %s", mp->is_mp_data, mp->is_mp_data ? - // mp->extension_connected : ((wm_nc_mp*)&data[17])->extension_connected, wm->m_extension->active_extension, - // ArrayToString(((u8*)&wm->m_reg_motion_plus.ext_identifier), sizeof(wm->m_reg_motion_plus.ext_identifier), 0).c_str()); - } - - // select log data - WARN_LOG_S(CONSOLE, "Data" - "[%s]" - " | id %s" - " | %s" - " | c %s" - " | a %s" - " | ir %s" - " | ext %s" - //" | %s" - //" | %s" - //" | %s" - , (emu ? "E" : "R") - , SExtID.c_str() - , ArrayToString(data, 2, 0).c_str() - , SCore.c_str() - , SAcc.c_str() - , SIR.c_str() - , SExt.c_str() - //, ArrayToString(&data[4], 3, 0).c_str() - //, (accel->x - 0x7f) / float(0xff), (accel->y - 0x7f) / float(0xff), (accel->z - 0x7f) / float(0xff) - //, ArrayToString(&data[17], 6, 0).c_str(), - ); - } -#endif -} - void Wiimote::ReportMode(const wm_report_mode* const dr) { //INFO_LOG(WIIMOTE, "Set data report mode"); diff --git a/Source/Core/Core/HW/WiimoteEmu/WiimoteEmu.cpp b/Source/Core/Core/HW/WiimoteEmu/WiimoteEmu.cpp index bf20a1989a..5259d85bff 100644 --- a/Source/Core/Core/HW/WiimoteEmu/WiimoteEmu.cpp +++ b/Source/Core/Core/HW/WiimoteEmu/WiimoteEmu.cpp @@ -756,7 +756,6 @@ void Wiimote::Update() // send data report if (rptf_size) { - WiimoteEmu::Spy(this, data, rptf_size); Core::Callback_WiimoteInterruptChannel(m_index, m_reporting_channel, data, rptf_size); } } diff --git a/Source/Core/Core/HW/WiimoteEmu/WiimoteEmu.h b/Source/Core/Core/HW/WiimoteEmu/WiimoteEmu.h index 113ea7baad..d0494d7579 100644 --- a/Source/Core/Core/HW/WiimoteEmu/WiimoteEmu.h +++ b/Source/Core/Core/HW/WiimoteEmu/WiimoteEmu.h @@ -88,7 +88,6 @@ inline double trim(double a) class Wiimote : public ControllerEmu { friend class WiimoteReal::Wiimote; -friend void Spy(Wiimote* wm_, const void* data_, size_t size_); public: enum @@ -234,6 +233,4 @@ private: #pragma pack(pop) }; -void Spy(Wiimote* wm_, const void* data_, size_t size_); - } diff --git a/Source/Core/Core/HW/WiimoteReal/IOWin.cpp b/Source/Core/Core/HW/WiimoteReal/IOWin.cpp index e08870d9c9..96626b4e02 100644 --- a/Source/Core/Core/HW/WiimoteReal/IOWin.cpp +++ b/Source/Core/Core/HW/WiimoteReal/IOWin.cpp @@ -661,8 +661,6 @@ int _IORead(HANDLE &dev_handle, OVERLAPPED &hid_overlap_read, u8* buf, int index } } - WiimoteEmu::Spy(nullptr, buf, bytes + 1); - return bytes + 1; } @@ -683,8 +681,6 @@ int Wiimote::IORead(u8* buf) int _IOWrite(HANDLE &dev_handle, OVERLAPPED &hid_overlap_write, enum win_bt_stack_t &stack, const u8* buf, size_t len, DWORD* written) { - WiimoteEmu::Spy(nullptr, buf, len); - switch (stack) { case MSBT_STACK_UNKNOWN: