nu/jvs.c: Add emulated JVS controller

nu/guid.c

@@ -4,4 +4,5 @@
 #include "nu/ds.h"
 #include "nu/eeprom.h"
 #include "nu/gpio.h"
+#include "nu/jvs.h"
 #include "nu/sram.h"

nu/jvs.c

@@ -0,0 +1,171 @@
+#include <windows.h>
+#include <ntstatus.h>
+
+#include <assert.h>
+#include <stddef.h>
+
+#include "hook/iobuf.h"
+#include "hook/iohook.h"
+
+#include "jvs/jvs-bus.h"
+
+#include "nu/jvs.h"
+
+#include "util/dprintf.h"
+#include "util/dump.h"
+#include "util/setupapi.h"
+
+enum {
+    JVS_IOCTL_HELLO     = 0x80006004,
+    JVS_IOCTL_SENSE     = 0x8000600C,
+    JVS_IOCTL_TRANSACT  = 0x8000E008,
+};
+
+static HRESULT jvs_handle_irp(struct irp *irp);
+static HRESULT jvs_handle_open(struct irp *irp);
+static HRESULT jvs_handle_close(struct irp *irp);
+static HRESULT jvs_handle_ioctl(struct irp *irp);
+
+static HRESULT jvs_ioctl_hello(struct irp *irp);
+static HRESULT jvs_ioctl_sense(struct irp *irp);
+static HRESULT jvs_ioctl_transact(struct irp *irp);
+
+static HANDLE jvs_fd;
+static struct jvs_node *jvs_root;
+
+void jvs_hook_init(void)
+{
+    jvs_fd = iohook_open_dummy_fd();
+    iohook_push_handler(jvs_handle_irp);
+    setupapi_add_phantom_dev(&jvs_guid, L"$jvs");
+}
+
+void jvs_attach(struct jvs_node *root)
+{
+    jvs_root = root;
+}
+
+static HRESULT jvs_handle_irp(struct irp *irp)
+{
+    assert(irp != NULL);
+
+    if (irp->op != IRP_OP_OPEN && irp->fd != jvs_fd) {
+        return iohook_invoke_next(irp);
+    }
+
+    switch (irp->op) {
+    case IRP_OP_OPEN:   return jvs_handle_open(irp);
+    case IRP_OP_CLOSE:  return jvs_handle_close(irp);
+    case IRP_OP_IOCTL:  return jvs_handle_ioctl(irp);
+    default:            return HRESULT_FROM_WIN32(ERROR_INVALID_FUNCTION);
+    }
+}
+
+static HRESULT jvs_handle_open(struct irp *irp)
+{
+    if (wcscmp(irp->open_filename, L"$jvs") != 0) {
+        return iohook_invoke_next(irp);
+    }
+
+    dprintf("JVS Controller: Open device\n");
+    irp->fd = jvs_fd;
+
+    return S_OK;
+}
+
+static HRESULT jvs_handle_close(struct irp *irp)
+{
+    dprintf("JVS Controller: Close device\n");
+
+    return S_OK;
+}
+
+static HRESULT jvs_handle_ioctl(struct irp *irp)
+{
+    switch (irp->ioctl) {
+    case JVS_IOCTL_HELLO:
+        return jvs_ioctl_hello(irp);
+
+    case JVS_IOCTL_SENSE:
+        return jvs_ioctl_sense(irp);
+
+    case JVS_IOCTL_TRANSACT:
+        return jvs_ioctl_transact(irp);
+
+    default:
+        dprintf("JVS Controller: Unknown ioctl %#x\n", irp->ioctl);
+
+        return HRESULT_FROM_WIN32(ERROR_INVALID_FUNCTION);
+    }
+}
+
+static HRESULT jvs_ioctl_hello(struct irp *irp)
+{
+    HRESULT hr;
+
+    // uuh fucked if i know
+
+    dprintf("JVS Controller: Port startup (?)\n");
+
+         iobuf_write_8(&irp->read, 0);
+    hr = iobuf_write_8(&irp->read, 0);
+
+    return hr;
+}
+
+static HRESULT jvs_ioctl_sense(struct irp *irp)
+{
+    uint8_t code;
+    bool sense;
+
+    if (jvs_root != NULL) {
+        sense = jvs_root->sense(jvs_root);
+
+        if (sense) {
+            dprintf("JVS Controller: Sense line 2.5 V (address unassigned)\n");
+            code = 3;
+        } else {
+            dprintf("JVS Controller: Sense line 0.0 V (address assigned)\n");
+            code = 2;
+        }
+    } else {
+        dprintf("JVS Controller: Sense line 5.0 V (no downstream PCB)\n");
+        code = 1;
+    }
+
+    return iobuf_write_8(&irp->read, code);
+}
+
+static HRESULT jvs_ioctl_transact(struct irp *irp)
+{
+#if 0
+    dprintf("\nJVS Controller: Outbound frame:\n");
+    dump_const_iobuf(&irp->write);
+#endif
+
+    jvs_bus_transact(jvs_root, irp->write.bytes, irp->write.nbytes, &irp->read);
+
+#if 0
+    dprintf("JVS Controller: Inbound frame:\n");
+    dump_iobuf(&irp->read);
+    dprintf("\n");
+#endif
+
+    if (irp->read.pos == 0) {
+        /* The un-acked JVS reset command must return ERROR_NO_DATA_DETECTED,
+           and this error must always be returned asynchronously. And since
+           async I/O comes from the NT kernel, we have to return that win32
+           error as the equivalent NTSTATUS. */
+
+        if (irp->ovl == NULL || irp->ovl->hEvent == NULL) {
+            return HRESULT_FROM_WIN32(ERROR_NO_DATA_DETECTED);
+        }
+
+        irp->ovl->Internal = STATUS_NO_DATA_DETECTED;
+        SetEvent(irp->ovl->hEvent);
+
+        return HRESULT_FROM_WIN32(ERROR_IO_PENDING);
+    } else {
+        return S_OK;
+    }
+}

nu/jvs.h

@@ -0,0 +1,15 @@
+#pragma once
+
+#include <windows.h>
+
+#include "jvs/jvs-bus.h"
+
+DEFINE_GUID(
+        jvs_guid,
+        0xDB6BBB45,
+        0xCC96,
+        0x4288,
+        0xAA, 0x00, 0x6C, 0x00, 0xD7, 0x67, 0xBD, 0xBF);
+
+void jvs_hook_init(void);
+void jvs_attach(struct jvs_node *root);

nu/meson.build

@@ -15,6 +15,8 @@ nu_lib = static_library(
         'gpio.c',
         'gpio.h',
         'guid.c',
+        'jvs.c',
+        'jvs.h',
         'hwmon.c',
         'hwmon.h',
         'nusec.c',