forked from Dniel97/segatools
173 lines
3.7 KiB
C
173 lines
3.7 KiB
C
#include <windows.h>
|
|
|
|
#ifdef __GNUC__
|
|
#include <ntdef.h>
|
|
#else
|
|
#include <winnt.h>
|
|
#endif
|
|
#include <devioctl.h>
|
|
#include <ntdddisk.h>
|
|
|
|
#include <assert.h>
|
|
|
|
#include "amex/config.h"
|
|
#include "amex/eeprom.h"
|
|
#include "amex/nvram.h"
|
|
|
|
#include "hook/iohook.h"
|
|
|
|
#include "hooklib/setupapi.h"
|
|
|
|
#include "util/dprintf.h"
|
|
#include "util/str.h"
|
|
|
|
static HRESULT eeprom_handle_irp(struct irp *irp);
|
|
static HRESULT eeprom_handle_open(struct irp *irp);
|
|
static HRESULT eeprom_handle_close(struct irp *irp);
|
|
static HRESULT eeprom_handle_ioctl(struct irp *irp);
|
|
static HRESULT eeprom_handle_read(struct irp *irp);
|
|
static HRESULT eeprom_handle_write(struct irp *irp);
|
|
|
|
static HRESULT eeprom_ioctl_get_geometry(struct irp *irp);
|
|
|
|
static HANDLE eeprom_file;
|
|
|
|
HRESULT eeprom_hook_init(const struct eeprom_config *cfg)
|
|
{
|
|
HRESULT hr;
|
|
|
|
assert(cfg != NULL);
|
|
|
|
if (!cfg->enable) {
|
|
return S_FALSE;
|
|
}
|
|
|
|
hr = nvram_open_file(&eeprom_file, cfg->path, 0x2000);
|
|
|
|
if (FAILED(hr)) {
|
|
return hr;
|
|
}
|
|
|
|
hr = iohook_push_handler(eeprom_handle_irp);
|
|
|
|
if (FAILED(hr)) {
|
|
return hr;
|
|
}
|
|
|
|
hr = setupapi_add_phantom_dev(&eeprom_guid, L"$eeprom");
|
|
|
|
if (FAILED(hr)) {
|
|
return hr;
|
|
}
|
|
|
|
return S_OK;
|
|
}
|
|
|
|
static HRESULT eeprom_handle_irp(struct irp *irp)
|
|
{
|
|
assert(irp != NULL);
|
|
|
|
if (irp->op != IRP_OP_OPEN && irp->fd != eeprom_file) {
|
|
return iohook_invoke_next(irp);
|
|
}
|
|
|
|
switch (irp->op) {
|
|
case IRP_OP_OPEN: return eeprom_handle_open(irp);
|
|
case IRP_OP_CLOSE: return eeprom_handle_close(irp);
|
|
case IRP_OP_IOCTL: return eeprom_handle_ioctl(irp);
|
|
case IRP_OP_READ: return eeprom_handle_read(irp);
|
|
case IRP_OP_WRITE: return eeprom_handle_write(irp);
|
|
default: return iohook_invoke_next(irp);
|
|
}
|
|
}
|
|
|
|
static HRESULT eeprom_handle_open(struct irp *irp)
|
|
{
|
|
if (!wstr_eq(irp->open_filename, L"$eeprom") != 0) {
|
|
return iohook_invoke_next(irp);
|
|
}
|
|
|
|
dprintf("EEPROM: Open device\n");
|
|
irp->fd = eeprom_file;
|
|
|
|
return S_OK;
|
|
}
|
|
|
|
static HRESULT eeprom_handle_close(struct irp *irp)
|
|
{
|
|
dprintf("EEPROM: Close device\n");
|
|
|
|
return S_OK;
|
|
}
|
|
|
|
static HRESULT eeprom_handle_ioctl(struct irp *irp)
|
|
{
|
|
switch (irp->ioctl) {
|
|
case IOCTL_DISK_GET_DRIVE_GEOMETRY:
|
|
return eeprom_ioctl_get_geometry(irp);
|
|
|
|
default:
|
|
dprintf("EEPROM: Unknown ioctl %x, write %i read %i\n",
|
|
irp->ioctl,
|
|
(int) irp->write.nbytes,
|
|
(int) irp->read.nbytes);
|
|
|
|
return HRESULT_FROM_WIN32(ERROR_INVALID_FUNCTION);
|
|
}
|
|
}
|
|
|
|
static HRESULT eeprom_ioctl_get_geometry(struct irp *irp)
|
|
{
|
|
DISK_GEOMETRY out;
|
|
HRESULT hr;
|
|
|
|
dprintf("EEPROM: Get geometry\n");
|
|
|
|
/* Not the real values, just bullshitting something for now */
|
|
|
|
memset(&out, 0, sizeof(out));
|
|
out.Cylinders.QuadPart = 0x800;
|
|
out.MediaType = 0;
|
|
out.TracksPerCylinder = 1;
|
|
out.SectorsPerTrack = 2;
|
|
out.BytesPerSector = 4;
|
|
|
|
hr = iobuf_write(&irp->read, &out, sizeof(out));
|
|
|
|
if (FAILED(hr)) {
|
|
dprintf("EEPROM: Get geometry failed: %08x\n", (int) hr);
|
|
}
|
|
|
|
return hr;
|
|
}
|
|
|
|
static HRESULT eeprom_handle_read(struct irp *irp)
|
|
{
|
|
if (irp->ovl == NULL) {
|
|
dprintf("EEPROM: Synchronous read..?\n");
|
|
|
|
return E_UNEXPECTED;
|
|
}
|
|
|
|
dprintf("EEPROM: Read off %x len %x\n",
|
|
(int) irp->ovl->Offset,
|
|
(int) irp->read.nbytes);
|
|
|
|
return iohook_invoke_next(irp);
|
|
}
|
|
|
|
static HRESULT eeprom_handle_write(struct irp *irp)
|
|
{
|
|
if (irp->ovl == NULL) {
|
|
dprintf("EEPROM: Synchronous write..?\n");
|
|
|
|
return E_UNEXPECTED;
|
|
}
|
|
|
|
dprintf("EEPROM: Write off %x len %x\n",
|
|
(int) irp->ovl->Offset,
|
|
(int) irp->write.nbytes);
|
|
|
|
return iohook_invoke_next(irp);
|
|
}
|