nu/jvs.c: Add emulated JVS controller

This commit is contained in:
Tau 2018-11-08 14:20:48 -05:00
parent e2f554f5bb
commit 0929beae11
4 changed files with 189 additions and 0 deletions

View File

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

171
nu/jvs.c Normal file
View File

@ -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;
}
}

15
nu/jvs.h Normal file
View File

@ -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);

View File

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