ezusb: decouple some nodes from ezusb-iidx-emu

This fixes a build failure in newer gcc for popnhook. Since node-16seg has a dependency on iidxio
2022-06-23 23:54:30 -07:00
parent 523c0ad3f2
commit dc931faf86
35 changed files with 165 additions and 150 deletions
@@ -0,0 +1,120 @@
+#define LOG_MODULE "ezusb-emu-node-eeprom"
+
+#include <string.h>
+
+#include "ezusb-emu/node-eeprom.h"
+
+#include "ezusb-iidx/eeprom-cmd.h"
+
+#include "util/log.h"
+
+/* not verified, but we got calls with 3 pages only so far */
+#define EEPROM_NPAGES 3
+
+static uint8_t ezusb_iidx_emu_node_eeprom_read_page_pos;
+static uint8_t ezusb_iidx_emu_node_eeprom_mem[EZUSB_PAGESIZE * EEPROM_NPAGES];
+
+void ezusb_iidx_emu_node_eeprom_init(void)
+{
+    ezusb_iidx_emu_node_eeprom_read_page_pos = 0;
+    memset(
+        ezusb_iidx_emu_node_eeprom_mem,
+        0xFF,
+        sizeof(ezusb_iidx_emu_node_eeprom_mem));
+}
+
+uint8_t ezusb_iidx_emu_node_eeprom_process_cmd_v1(
+    uint8_t cmd_id, uint8_t cmd_data, uint8_t cmd_data2)
+{
+    switch (cmd_id) {
+        case EZUSB_IIDX_EEPROM_CMD_READ:
+            log_misc("EZUSB_EEPROM_V1_CMD_READ");
+            ezusb_iidx_emu_node_eeprom_read_page_pos = 0;
+            return EZUSB_IIDX_EEPROM_CMD_STATUS_V1_READ_OK;
+
+        case EZUSB_IIDX_EEPROM_CMD_WRITE:
+            log_misc("EZUSB_EEPROM_V1_CMD_WRITE");
+            return EZUSB_IIDX_EEPROM_CMD_STATUS_V2_WRITE_OK;
+
+        default:
+            log_warning("Unrecognised eeprom v1 command: %02x", cmd_id);
+            return EZUSB_IIDX_EEPROM_CMD_STATUS_V1_FAULT;
+    }
+}
+
+uint8_t ezusb_iidx_emu_node_eeprom_process_cmd_v2(
+    uint8_t cmd_id, uint8_t cmd_data, uint8_t cmd_data2)
+{
+    switch (cmd_id) {
+        case EZUSB_IIDX_EEPROM_CMD_READ:
+            log_misc("EZUSB_EEPROM_V2_CMD_READ");
+            ezusb_iidx_emu_node_eeprom_read_page_pos = 0;
+            return EZUSB_IIDX_EEPROM_CMD_STATUS_V2_READ_OK;
+
+        case EZUSB_IIDX_EEPROM_CMD_WRITE:
+            log_misc("EZUSB_EEPROM_V2_CMD_WRITE");
+            return EZUSB_IIDX_EEPROM_CMD_STATUS_V2_WRITE_OK;
+
+        default:
+            log_warning("Unrecognised eeprom v2 command: %02x", cmd_id);
+            return EZUSB_IIDX_EEPROM_CMD_STATUS_V2_FAULT;
+    }
+}
+
+bool ezusb_iidx_emu_node_eeprom_read_packet(
+    struct ezusb_iidx_msg_bulk_packet *pkg)
+{
+    log_misc(
+        "Reading EEPROM page 0x%02X", ezusb_iidx_emu_node_eeprom_read_page_pos);
+
+    if (ezusb_iidx_emu_node_eeprom_read_page_pos >= EEPROM_NPAGES) {
+        log_warning("Reading EEPROM ezusb_iidx_emu_node_eeprom_mem overrun");
+        return false;
+    }
+
+    /* has to be 0x22 to get accepted */
+    pkg->node = 0x22;
+    pkg->page = ezusb_iidx_emu_node_eeprom_read_page_pos;
+    memset(pkg->payload, 0, EZUSB_PAGESIZE);
+    memcpy(
+        pkg->payload,
+        ezusb_iidx_emu_node_eeprom_mem +
+            ezusb_iidx_emu_node_eeprom_read_page_pos * EZUSB_PAGESIZE,
+        EZUSB_PAGESIZE);
+
+    ezusb_iidx_emu_node_eeprom_read_page_pos++;
+    return true;
+}
+
+bool ezusb_iidx_emu_node_eeprom_write_packet(
+    const struct ezusb_iidx_msg_bulk_packet *pkg)
+{
+    log_misc("Writing EEPROM page 0x%02X", pkg->page);
+
+    if (pkg->page >= EEPROM_NPAGES) {
+        log_warning("Writing EEPROM ezusb_iidx_emu_node_eeprom_mem overrun");
+        return false;
+    }
+
+    memcpy(
+        ezusb_iidx_emu_node_eeprom_mem + pkg->page * EZUSB_PAGESIZE,
+        pkg->payload,
+        EZUSB_PAGESIZE);
+    return true;
+}
+
+/* ------------------------------------------------------------------------- */
+
+size_t ezusb_iidx_emu_node_eeprom_write_memory(
+    const uint8_t *buffer, size_t offset, size_t length)
+{
+    if (offset + length > sizeof(ezusb_iidx_emu_node_eeprom_mem)) {
+        log_warning(
+            "Writing eeprom ezusb_iidx_emu_node_eeprom_mem overrun, "
+            "truncated");
+        length = sizeof(ezusb_iidx_emu_node_eeprom_mem) - offset;
+    }
+
+    memcpy(ezusb_iidx_emu_node_eeprom_mem + offset, buffer, length);
+    return length;
+}