usb: change api so that every packet sent is crc32c, update python usb api, add automated tests for usb.

This commit is contained in:
ITotalJustice
2025-08-31 06:12:02 +01:00
parent b6b1af5959
commit 22e965521a
13 changed files with 469 additions and 71 deletions

View File

@@ -2,9 +2,11 @@ import struct
import usb.core
import usb.util
import time
import crc32c
# magic number (SPH0) for the script and switch.
MAGIC = 0x53504830
PACKET_SIZE = 24
# commands
CMD_QUIT = 0
@@ -19,14 +21,85 @@ RESULT_ERROR = 1
FLAG_NONE = 0
FLAG_STREAM = 1 << 0
# disabled, see usbds.cpp usbDsEndpoint_SetZlt
ENABLE_ZLT = 0
class UsbPacket:
STRUCT_FORMAT = "<6I" # 6 unsigned 32-bit ints, little-endian
def __init__(self, magic=MAGIC, arg2=0, arg3=0, arg4=0, arg5=0, crc32c_val=0):
self.magic = magic
self.arg2 = arg2
self.arg3 = arg3
self.arg4 = arg4
self.arg5 = arg5
self.crc32c = crc32c_val
def pack(self):
self.generate_crc32c()
return struct.pack(self.STRUCT_FORMAT, self.magic, self.arg2, self.arg3, self.arg4, self.arg5, self.crc32c)
@classmethod
def unpack(cls, data):
fields = struct.unpack(cls.STRUCT_FORMAT, data)
return cls(*fields)
def calculate_crc32c(self):
data = struct.pack("<5I", self.magic, self.arg2, self.arg3, self.arg4, self.arg5)
return crc32c.crc32c(data)
def generate_crc32c(self):
self.crc32c = self.calculate_crc32c()
def verify(self):
if self.crc32c != self.calculate_crc32c():
raise ValueError("CRC32C mismatch")
if self.magic != MAGIC:
raise ValueError("Bad magic")
return True
class SendPacket(UsbPacket):
@classmethod
def build(cls, cmd, arg3=0, arg4=0):
packet = cls(MAGIC, cmd, arg3, arg4)
packet.generate_crc32c()
return packet
def get_cmd(self):
return self.arg2
class ResultPacket(UsbPacket):
@classmethod
def build(cls, result, arg3=0, arg4=0):
packet = cls(MAGIC, result, arg3, arg4)
packet.generate_crc32c()
return packet
def verify(self):
super().verify()
if self.arg2 != RESULT_OK:
raise ValueError("Result not OK")
return True
class SendDataPacket(UsbPacket):
@classmethod
def build(cls, offset, size, crc32c_val):
arg2 = (offset >> 32) & 0xFFFFFFFF
arg3 = offset & 0xFFFFFFFF
packet = cls(MAGIC, arg2, arg3, size, crc32c_val)
packet.generate_crc32c()
return packet
def get_offset(self):
return (self.arg2 << 32) | self.arg3
def get_size(self):
return self.arg4
def get_crc32c(self):
return self.arg5
class Usb:
def __init__(self):
self.__out_ep = None
self.__in_ep = None
self.__packet_size = 0
def wait_for_connect(self) -> None:
print("waiting for switch")
@@ -61,29 +134,23 @@ class Usb:
print("iManufacturer: {} iProduct: {} iSerialNumber: {}".format(dev.manufacturer, dev.product, dev.serial_number))
print("bcdUSB: {} bMaxPacketSize0: {}".format(hex(dev.bcdUSB), dev.bMaxPacketSize0))
self.__packet_size = 1 << dev.bMaxPacketSize0
def read(self, size: int, timeout: int = 0) -> bytes:
if (ENABLE_ZLT and size and (size % self.__packet_size) == 0):
size += 1
return self.__in_ep.read(size, timeout)
def write(self, buf: bytes, timeout: int = 0) -> int:
return self.__out_ep.write(data=buf, timeout=timeout)
def get_send_header(self) -> tuple[int, int, int]:
header = self.read(16)
[magic, arg2, arg3, arg4] = struct.unpack('<IIII', header)
if magic != MAGIC:
raise Exception("Unexpected magic {}".format(magic))
return arg2, arg3, arg4
packet = SendPacket.unpack(self.read(PACKET_SIZE))
packet.verify()
return packet.get_cmd(), packet.arg3, packet.arg4
def get_send_data_header(self) -> tuple[int, int, int]:
header = self.read(16)
return struct.unpack('<QII', header)
packet = SendDataPacket.unpack(self.read(PACKET_SIZE))
packet.verify()
return packet.get_offset(), packet.get_size(), packet.get_crc32c()
def send_result(self, result: int, arg3: int = 0, arg4: int = 0) -> None:
send_data = struct.pack('<IIII', MAGIC, result, arg3, arg4)
send_data = ResultPacket.build(result, arg3, arg4).pack()
self.write(send_data)