mirror of
https://github.com/Lorenzooone/cc3dsfs.git
synced 2026-04-26 00:13:40 -05:00
Add Partner CTR init
This commit is contained in:
Lorenzooone
parent
ae42aea0a5
commit
fa305f3b98
|
|
@ -22,6 +22,7 @@ int GetNumCyPartnerCTRDeviceDesc(void);
|
|||
const cypart_device_usb_device* GetCyPartnerCTRDeviceDesc(int index);
|
||||
const cy_device_usb_device* get_cy_usb_info(const cypart_device_usb_device* usb_device_desc);
|
||||
std::string read_serial_ctr_capture(cy_device_device_handlers* handlers, const cypart_device_usb_device* device);
|
||||
int capture_init(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, std::string &serial);
|
||||
int capture_start(cy_device_device_handlers* handlers, const cypart_device_usb_device* device);
|
||||
int StartCaptureDma(cy_device_device_handlers* handlers, const cypart_device_usb_device* device);
|
||||
int capture_end(cy_device_device_handlers* handlers, const cypart_device_usb_device* device);
|
||||
|
|
|
|||
|
|
@ -100,7 +100,306 @@ std::string read_serial_ctr_capture(cy_device_device_handlers* handlers, const c
|
|||
return std::to_string(serial_part_1) + "-" + read_string(buffer_in + 5, 3);
|
||||
}
|
||||
|
||||
static int send_partner_ctr_packet(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, const uint8_t* data, size_t size_data, int &transferred) {
|
||||
cypress_pipe_reset_ctrl_bulk_out(handlers, get_cy_usb_info(device));
|
||||
return cypress_ctrl_bulk_out_transfer(handlers, get_cy_usb_info(device), data, size_data, &transferred);
|
||||
}
|
||||
|
||||
static int recv_partner_ctr_packet(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint8_t* data, size_t size_data, int &transferred) {
|
||||
cypress_pipe_reset_ctrl_bulk_in(handlers, get_cy_usb_info(device));
|
||||
return cypress_ctrl_bulk_in_transfer(handlers, get_cy_usb_info(device), data, size_data, &transferred);
|
||||
}
|
||||
|
||||
// Name is tentative, based on pattern observed in wireshark packets...
|
||||
static int write_to_address_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t address, const uint8_t* data, size_t data_size, uint8_t data_size_byte) {
|
||||
int transferred = 0;
|
||||
const size_t out_data_size = 6 + data_size;
|
||||
uint8_t buffer_out[out_data_size];
|
||||
|
||||
buffer_out[0] = 0x43;
|
||||
buffer_out[1] = data_size_byte;
|
||||
write_le32(buffer_out + 2, address);
|
||||
memcpy(buffer_out + 6, data, data_size);
|
||||
|
||||
int ret = send_partner_ctr_packet(handlers, device, buffer_out, out_data_size, transferred);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
if(transferred < ((int)out_data_size))
|
||||
return -1;
|
||||
return ret;
|
||||
}
|
||||
|
||||
// No packet seems to be sent with this pattern?! Would need to be checked
|
||||
// to be sure...
|
||||
static int write_u8_to_address_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t address, uint8_t value) {
|
||||
return write_to_address_partner_ctr(handlers, device, address, &value, sizeof(value), 1);
|
||||
}
|
||||
|
||||
static int write_u16_to_address_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t address, uint16_t value) {
|
||||
uint8_t buffer[sizeof(value)];
|
||||
write_le16(buffer, value);
|
||||
return write_to_address_partner_ctr(handlers, device, address, buffer, sizeof(value), 0);
|
||||
}
|
||||
|
||||
static int write_u32_to_address_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t address, uint32_t value) {
|
||||
uint8_t buffer[sizeof(value)];
|
||||
write_le32(buffer, value);
|
||||
return write_to_address_partner_ctr(handlers, device, address, buffer, sizeof(value), 2);
|
||||
}
|
||||
|
||||
// No packet seems to be sent with this pattern?! Based on read packets...
|
||||
static int write_u64_plus_to_address_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t address, const uint8_t* data, size_t data_size) {
|
||||
return write_to_address_partner_ctr(handlers, device, address, data, data_size, ((data_size >> 3) << 4) | 2);
|
||||
}
|
||||
|
||||
// Name is tentative, based on pattern observed in wireshark packets...
|
||||
static int read_from_address_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t address, uint8_t* data, size_t data_size, uint8_t data_size_byte) {
|
||||
int transferred = 0;
|
||||
const size_t out_data_size = 6;
|
||||
uint8_t buffer_out[out_data_size];
|
||||
|
||||
buffer_out[0] = 0x42;
|
||||
buffer_out[1] = data_size_byte;
|
||||
write_le32(buffer_out + 2, address);
|
||||
|
||||
int ret = send_partner_ctr_packet(handlers, device, buffer_out, out_data_size, transferred);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
if(transferred < ((int)out_data_size))
|
||||
return -1;
|
||||
|
||||
ret = recv_partner_ctr_packet(handlers, device, data, data_size, transferred);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
if(transferred < ((int)data_size))
|
||||
return -1;
|
||||
return ret;
|
||||
}
|
||||
|
||||
// No packet seems to be read with this pattern?! Would need to be checked
|
||||
// to be sure...
|
||||
static int read_u8_from_address_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t address, uint8_t &value) {
|
||||
return read_from_address_partner_ctr(handlers, device, address, &value, sizeof(value), 1);
|
||||
}
|
||||
|
||||
static int read_u16_from_address_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t address, uint16_t &value) {
|
||||
uint8_t buffer[sizeof(value)];
|
||||
int ret = read_from_address_partner_ctr(handlers, device, address, buffer, sizeof(value), 0);
|
||||
value = read_le16(buffer);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int read_u32_from_address_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t address, uint32_t &value) {
|
||||
uint8_t buffer[sizeof(value)];
|
||||
int ret = read_from_address_partner_ctr(handlers, device, address, buffer, sizeof(value), 2);
|
||||
value = read_le32(buffer);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int read_u64_plus_from_address_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t address, uint8_t* data, size_t data_size) {
|
||||
return read_from_address_partner_ctr(handlers, device, address, data, data_size, ((data_size >> 3) << 4) | 2);
|
||||
}
|
||||
|
||||
static int read_partner_ctr_status(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint32_t &status) {
|
||||
return read_u32_from_address_partner_ctr(handlers, device, 0xF0000000, status);
|
||||
}
|
||||
|
||||
// Name is tentative, especially for this one...
|
||||
static int read_fw_info_partner_ctr(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint8_t info_kind, uint32_t &value) {
|
||||
int transferred = 0;
|
||||
uint8_t buffer_out[4] = {0x20, 0x01, 0x00, 0x00};
|
||||
uint8_t buffer_in[4];
|
||||
|
||||
buffer_out[3] = info_kind;
|
||||
|
||||
int ret = send_partner_ctr_packet(handlers, device, buffer_out, 4, transferred);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
if(transferred < 4)
|
||||
return -1;
|
||||
|
||||
ret = recv_partner_ctr_packet(handlers, device, buffer_in, 4, transferred);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
if(transferred < 4)
|
||||
return -1;
|
||||
value = read_le32(buffer_in);
|
||||
return ret;
|
||||
}
|
||||
|
||||
// Seems to be some state, maybe...? Influenced by the writes, which seem to
|
||||
// select stuff...?
|
||||
static int capture_start_unknown_read_0x1002(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint16_t base_value, uint16_t second_value, uint16_t &unk16) {
|
||||
int ret = 0;
|
||||
|
||||
ret = write_u16_to_address_partner_ctr(handlers, device, 0xF8001002, base_value);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
ret = read_u16_from_address_partner_ctr(handlers, device, 0xF8001001, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
ret = write_u16_to_address_partner_ctr(handlers, device, 0xF8001002, second_value);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
ret = read_u16_from_address_partner_ctr(handlers, device, 0xF8001001, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
ret = read_u16_from_address_partner_ctr(handlers, device, 0xF8001003, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
// Resets position...?
|
||||
ret = write_u16_to_address_partner_ctr(handlers, device, 0xF8001000, 0x001D);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int capture_start_unknown_write_0x1000(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint16_t out_value_xd) {
|
||||
int ret = 0;
|
||||
uint16_t base_out_val = 0x001D | (out_value_xd & 0xFF00);
|
||||
|
||||
ret = write_u16_to_address_partner_ctr(handlers, device, 0xF8001000, base_out_val);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
ret = write_u16_to_address_partner_ctr(handlers, device, 0xF8001000, out_value_xd);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int capture_start_unknown_write_and_read_0x1000_0x1002(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint16_t out_value_xd, uint16_t base_value, uint16_t second_value, uint16_t &unk16) {
|
||||
int ret = 0;
|
||||
|
||||
ret = capture_start_unknown_write_0x1000(handlers, device, out_value_xd);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_unknown_read_0x1002(handlers, device, base_value, second_value, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int capture_start_first_unknown_write_and_read_0x1000_0x1002(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, uint16_t out_value_xd, uint16_t &unk16) {
|
||||
int ret = 0;
|
||||
|
||||
ret = capture_start_unknown_write_and_read_0x1000_0x1002(handlers, device, out_value_xd, 0x0000, 0x0000, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_unknown_write_and_read_0x1000_0x1002(handlers, device, out_value_xd, 0x000F, 0x0000, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
// Various unknown reads and writes from registers...
|
||||
int capture_init(cy_device_device_handlers* handlers, const cypart_device_usb_device* device, std::string &serial) {
|
||||
int ret = 0;
|
||||
uint32_t status = 0;
|
||||
uint32_t unk32 = 0;
|
||||
uint16_t unk16 = 0;
|
||||
|
||||
// Stop capture, if one already ongoing...
|
||||
ret = write_u32_to_address_partner_ctr(handlers, device, 0xF0000010, 0x80000000);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
serial = read_serial_ctr_capture(handlers, device);
|
||||
|
||||
ret = read_fw_info_partner_ctr(handlers, device, 0, unk32);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
// Do processing based on this...?
|
||||
ret = read_fw_info_partner_ctr(handlers, device, 0x0F, unk32);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
// Do processing based on this...?
|
||||
|
||||
ret = capture_start_first_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x005D, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_first_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x003D, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = write_u32_to_address_partner_ctr(handlers, device, 0xF000000C, 0xFFFFFFFF);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = read_fw_info_partner_ctr(handlers, device, 0, unk32);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
// Do processing based on this...?
|
||||
ret = read_fw_info_partner_ctr(handlers, device, 0x0F, unk32);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_first_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x005D, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_first_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x003D, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x005D, 0x0018, 0x000F, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x005D, 0x0019, 0x0000, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
// Is this FF5D due to uninitialized data, or...?
|
||||
ret = capture_start_unknown_write_and_read_0x1000_0x1002(handlers, device, 0xFF5D, 0xFF18, 0x0004, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x005D, 0x0019, 0x0000, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = write_u32_to_address_partner_ctr(handlers, device, 0xF000000C, 0x00001000);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x005D, 0x0028, 0x0000, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = read_partner_ctr_status(handlers, device, status);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
// Is this 015D due to uninitialized data, or...?
|
||||
ret = capture_start_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x015D, 0x012A, 0x0000, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = read_u32_from_address_partner_ctr(handlers, device, 0xF8002010, unk32);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x005D, 0x0018, 0x0004, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = capture_start_unknown_write_and_read_0x1000_0x1002(handlers, device, 0x005D, 0x001A, 0x0064, unk16);
|
||||
if(ret < 0)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int capture_start(cy_device_device_handlers* handlers, const cypart_device_usb_device* device) {
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user