forked from Hay1tsme/segatools
chusan: added chusanhook, led board fix, config added
credits go to @domeori https://dev.s-ul.net/domeori/segatools/-/tree/mr-imports
This commit is contained in:
@ -43,6 +43,35 @@ void slider_config_load(struct slider_config *cfg, const wchar_t *filename)
|
||||
cfg->enable = GetPrivateProfileIntW(L"slider", L"enable", 1, filename);
|
||||
}
|
||||
|
||||
void led1509306_config_load(struct led1509306_config *cfg, const wchar_t *filename)
|
||||
{
|
||||
assert(cfg != NULL);
|
||||
assert(filename != NULL);
|
||||
|
||||
wchar_t tmpstr[16];
|
||||
|
||||
memset(cfg->board_number, ' ', sizeof(cfg->board_number));
|
||||
memset(cfg->chip_number, ' ', sizeof(cfg->chip_number));
|
||||
|
||||
cfg->enable = GetPrivateProfileIntW(L"ledstrip", L"enable", 1, filename);
|
||||
cfg->fw_ver = GetPrivateProfileIntW(L"ledstrip", L"fw_ver", 0x90, filename);
|
||||
cfg->fw_sum = GetPrivateProfileIntW(L"ledstrip", L"fw_sum", 0xadf7, filename);
|
||||
|
||||
GetPrivateProfileStringW(L"ledstrip", L"board_number", L"15093-06", tmpstr, _countof(tmpstr), filename);
|
||||
size_t n = wcstombs(cfg->board_number, tmpstr, sizeof(cfg->board_number));
|
||||
for (int i = n; i < sizeof(cfg->board_number); i++)
|
||||
{
|
||||
cfg->board_number[i] = ' ';
|
||||
}
|
||||
|
||||
GetPrivateProfileStringW(L"ledstrip", L"chip_number", L"6710 ", tmpstr, _countof(tmpstr), filename);
|
||||
n = wcstombs(cfg->chip_number, tmpstr, sizeof(cfg->chip_number));
|
||||
for (int i = n; i < sizeof(cfg->chip_number); i++)
|
||||
{
|
||||
cfg->chip_number[i] = ' ';
|
||||
}
|
||||
}
|
||||
|
||||
void chuni_hook_config_load(
|
||||
struct chuni_hook_config *cfg,
|
||||
const wchar_t *filename)
|
||||
@ -58,4 +87,5 @@ void chuni_hook_config_load(
|
||||
gfx_config_load(&cfg->gfx, filename);
|
||||
chuni_dll_config_load(&cfg->dll, filename);
|
||||
slider_config_load(&cfg->slider, filename);
|
||||
led1509306_config_load(&cfg->led1509306, filename);
|
||||
}
|
||||
|
@ -9,6 +9,7 @@
|
||||
|
||||
#include "chunihook/chuni-dll.h"
|
||||
#include "chunihook/slider.h"
|
||||
#include "chunihook/led1509306.h"
|
||||
|
||||
#include "gfxhook/gfx.h"
|
||||
|
||||
@ -21,6 +22,7 @@ struct chuni_hook_config {
|
||||
struct gfx_config gfx;
|
||||
struct chuni_dll_config dll;
|
||||
struct slider_config slider;
|
||||
struct led1509306_config led1509306;
|
||||
};
|
||||
|
||||
void chuni_dll_config_load(
|
||||
|
@ -9,6 +9,7 @@
|
||||
#include "chunihook/config.h"
|
||||
#include "chunihook/jvs.h"
|
||||
#include "chunihook/slider.h"
|
||||
#include "chunihook/led1509306.h"
|
||||
|
||||
#include "chuniio/chuniio.h"
|
||||
|
||||
@ -96,6 +97,12 @@ static DWORD CALLBACK chuni_pre_startup(void)
|
||||
goto fail;
|
||||
}
|
||||
|
||||
hr = led1509306_hook_init(&chuni_hook_cfg.led1509306);
|
||||
|
||||
if (FAILED(hr)) {
|
||||
goto fail;
|
||||
}
|
||||
|
||||
hr = sg_reader_hook_init(&chuni_hook_cfg.aime, 12, chuni_hook_mod);
|
||||
|
||||
if (FAILED(hr)) {
|
||||
|
@ -101,13 +101,13 @@ static void chunithm_jvs_read_switches(void *ctx, struct io3_switch_state *out)
|
||||
out->p1 = 0x0000;
|
||||
out->p2 = 0x0000;
|
||||
|
||||
if (opbtn & 0x01) {
|
||||
if (opbtn & CHUNI_IO_OPBTN_TEST) {
|
||||
out->system = 0x80;
|
||||
} else {
|
||||
out->system = 0x00;
|
||||
}
|
||||
|
||||
if (opbtn & 0x02) {
|
||||
if (opbtn & CHUNI_IO_OPBTN_SERVICE) {
|
||||
out->p1 |= 0x4000;
|
||||
}
|
||||
|
||||
|
377
chunihook/led1509306.c
Normal file
377
chunihook/led1509306.c
Normal file
@ -0,0 +1,377 @@
|
||||
#include <windows.h>
|
||||
|
||||
#include <assert.h>
|
||||
#include <process.h>
|
||||
#include <stdbool.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
|
||||
#include "board/led1509306-cmd.h"
|
||||
#include "board/led1509306-frame.h"
|
||||
|
||||
#include "chunihook/led1509306.h"
|
||||
|
||||
#include "hook/iobuf.h"
|
||||
#include "hook/iohook.h"
|
||||
|
||||
#include "hooklib/uart.h"
|
||||
|
||||
#include "util/dprintf.h"
|
||||
#include "util/dump.h"
|
||||
|
||||
static HRESULT led1509306_handle_irp(struct irp *irp);
|
||||
static HRESULT led1509306_handle_irp_locked(int board, struct irp *irp);
|
||||
|
||||
static HRESULT led1509306_req_dispatch(int board, const struct led1509306_req_any *req);
|
||||
static HRESULT led1509306_req_reset(int board, const struct led1509306_req_any *req);
|
||||
static HRESULT led1509306_req_get_board_info(int board);
|
||||
static HRESULT led1509306_req_get_fw_sum(int board);
|
||||
static HRESULT led1509306_req_get_protocol_ver(int board);
|
||||
static HRESULT led1509306_req_get_board_status(int board);
|
||||
static HRESULT led1509306_req_set_led(int board, const struct led1509306_req_any *req);
|
||||
static HRESULT led1509306_req_set_disable_response(int board, const struct led1509306_req_any *req);
|
||||
static HRESULT led1509306_req_set_timeout(int board, const struct led1509306_req_any *req);
|
||||
|
||||
static char led1509306_board_num[8];
|
||||
static char led1509306_chip_num[5];
|
||||
static uint8_t led1509306_fw_ver;
|
||||
static uint16_t led1509306_fw_sum;
|
||||
static uint8_t led1509306_board_adr = 2;
|
||||
static uint8_t led1509306_host_adr = 1;
|
||||
|
||||
#define led1509306_nboards 2
|
||||
|
||||
typedef struct {
|
||||
CRITICAL_SECTION lock;
|
||||
struct uart boarduart;
|
||||
uint8_t written_bytes[520];
|
||||
uint8_t readable_bytes[520];
|
||||
bool enable_response;
|
||||
} _led1509306_per_board_vars;
|
||||
|
||||
_led1509306_per_board_vars led1509306_per_board_vars[led1509306_nboards];
|
||||
|
||||
HRESULT led1509306_hook_init(const struct led1509306_config *cfg)
|
||||
{
|
||||
assert(cfg != NULL);
|
||||
|
||||
if (!cfg->enable) {
|
||||
return S_FALSE;
|
||||
}
|
||||
|
||||
memcpy(led1509306_board_num, cfg->board_number, sizeof(led1509306_board_num));
|
||||
memcpy(led1509306_chip_num, cfg->chip_number, sizeof(led1509306_chip_num));
|
||||
led1509306_fw_ver = cfg->fw_ver;
|
||||
led1509306_fw_sum = cfg->fw_sum;
|
||||
|
||||
for (int i = 0; i < led1509306_nboards; i++)
|
||||
{
|
||||
_led1509306_per_board_vars *v = &led1509306_per_board_vars[i];
|
||||
|
||||
InitializeCriticalSection(&v->lock);
|
||||
|
||||
uart_init(&v->boarduart, 10 + i);
|
||||
v->boarduart.written.bytes = v->written_bytes;
|
||||
v->boarduart.written.nbytes = sizeof(v->written_bytes);
|
||||
v->boarduart.readable.bytes = v->readable_bytes;
|
||||
v->boarduart.readable.nbytes = sizeof(v->readable_bytes);
|
||||
|
||||
v->enable_response = true;
|
||||
}
|
||||
|
||||
return iohook_push_handler(led1509306_handle_irp);
|
||||
}
|
||||
|
||||
static HRESULT led1509306_handle_irp(struct irp *irp)
|
||||
{
|
||||
HRESULT hr;
|
||||
|
||||
assert(irp != NULL);
|
||||
|
||||
for (int i = 0; i < led1509306_nboards; i++)
|
||||
{
|
||||
_led1509306_per_board_vars *v = &led1509306_per_board_vars[i];
|
||||
struct uart *boarduart = &v->boarduart;
|
||||
|
||||
if (uart_match_irp(boarduart, irp))
|
||||
{
|
||||
CRITICAL_SECTION lock = v->lock;
|
||||
|
||||
EnterCriticalSection(&lock);
|
||||
hr = led1509306_handle_irp_locked(i, irp);
|
||||
LeaveCriticalSection(&lock);
|
||||
|
||||
return hr;
|
||||
}
|
||||
}
|
||||
|
||||
return iohook_invoke_next(irp);
|
||||
}
|
||||
|
||||
static HRESULT led1509306_handle_irp_locked(int board, struct irp *irp)
|
||||
{
|
||||
struct led1509306_req_any req;
|
||||
struct iobuf req_iobuf;
|
||||
HRESULT hr;
|
||||
|
||||
struct uart *boarduart = &led1509306_per_board_vars[board].boarduart;
|
||||
|
||||
hr = uart_handle_irp(boarduart, irp);
|
||||
|
||||
if (FAILED(hr) || irp->op != IRP_OP_WRITE) {
|
||||
return hr;
|
||||
}
|
||||
|
||||
for (;;) {
|
||||
#if 0
|
||||
dprintf("TX Buffer:\n");
|
||||
dump_iobuf(&boarduart->written);
|
||||
#endif
|
||||
|
||||
req_iobuf.bytes = (byte*)&req;
|
||||
req_iobuf.nbytes = sizeof(req.hdr) + sizeof(req.cmd) + sizeof(req.payload);
|
||||
req_iobuf.pos = 0;
|
||||
|
||||
hr = led1509306_frame_decode(&req_iobuf, &boarduart->written);
|
||||
|
||||
if (hr != S_OK) {
|
||||
if (FAILED(hr)) {
|
||||
dprintf("Chunithm LED Strip: Deframe error: %x\n", (int) hr);
|
||||
}
|
||||
|
||||
return hr;
|
||||
}
|
||||
|
||||
#if 0
|
||||
dprintf("Deframe Buffer:\n");
|
||||
dump_iobuf(&req_iobuf);
|
||||
#endif
|
||||
|
||||
hr = led1509306_req_dispatch(board, &req);
|
||||
|
||||
if (FAILED(hr)) {
|
||||
dprintf("Chunithm LED Strip: Processing error: %x\n", (int) hr);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static HRESULT led1509306_req_dispatch(int board, const struct led1509306_req_any *req)
|
||||
{
|
||||
switch (req->cmd) {
|
||||
case LED_15093_06_CMD_RESET:
|
||||
return led1509306_req_reset(board, req);
|
||||
|
||||
case LED_15093_06_CMD_BOARD_INFO:
|
||||
return led1509306_req_get_board_info(board);
|
||||
|
||||
case LED_15093_06_CMD_FW_SUM:
|
||||
return led1509306_req_get_fw_sum(board);
|
||||
|
||||
case LED_15093_06_CMD_PROTOCOL_VER:
|
||||
return led1509306_req_get_protocol_ver(board);
|
||||
|
||||
case LED_15093_06_CMD_BOARD_STATUS:
|
||||
return led1509306_req_get_board_status(board);
|
||||
|
||||
case LED_15093_06_CMD_SET_LED:
|
||||
return led1509306_req_set_led(board, req);
|
||||
|
||||
case LED_15093_06_CMD_SET_DISABLE_RESPONSE:
|
||||
return led1509306_req_set_disable_response(board, req);
|
||||
|
||||
case LED_15093_06_CMD_SET_TIMEOUT:
|
||||
return led1509306_req_set_timeout(board, req);
|
||||
|
||||
default:
|
||||
dprintf("Chunithm LED Strip: Unhandled command %02x\n", req->cmd);
|
||||
|
||||
return S_OK;
|
||||
}
|
||||
}
|
||||
|
||||
static HRESULT led1509306_req_reset(int board, const struct led1509306_req_any *req)
|
||||
{
|
||||
dprintf("Chunithm LED Strip: Reset (board %u, type %02x)\n", board, req->payload[0]);
|
||||
|
||||
if (req->payload[0] != 0xd9)
|
||||
dprintf("Chunithm LED Strip: Warning -- Unknown reset type %02x\n", req->payload[0]);
|
||||
|
||||
led1509306_per_board_vars[board].enable_response = true;
|
||||
|
||||
struct led1509306_resp_any resp;
|
||||
|
||||
memset(&resp, 0, sizeof(resp));
|
||||
resp.hdr.sync = LED_15093_06_FRAME_SYNC;
|
||||
resp.hdr.dest_adr = led1509306_host_adr;
|
||||
resp.hdr.src_adr = led1509306_board_adr;
|
||||
resp.hdr.nbytes = 3;
|
||||
|
||||
resp.status = 1;
|
||||
resp.cmd = LED_15093_06_CMD_RESET;
|
||||
resp.report = 1;
|
||||
|
||||
return led1509306_frame_encode(&led1509306_per_board_vars[board].boarduart.readable, &resp, sizeof(resp.hdr) + resp.hdr.nbytes);
|
||||
}
|
||||
|
||||
static HRESULT led1509306_req_get_board_info(int board)
|
||||
{
|
||||
dprintf("Chunithm LED Strip: Get board info (board %u)\n", board);
|
||||
|
||||
struct led1509306_resp_board_info resp;
|
||||
|
||||
memset(&resp, 0, sizeof(resp));
|
||||
resp.hdr.sync = LED_15093_06_FRAME_SYNC;
|
||||
resp.hdr.dest_adr = led1509306_host_adr;
|
||||
resp.hdr.src_adr = led1509306_board_adr;
|
||||
resp.hdr.nbytes = sizeof(resp.data) + 3;
|
||||
|
||||
resp.status = 1;
|
||||
resp.cmd = LED_15093_06_CMD_BOARD_INFO;
|
||||
resp.report = 1;
|
||||
|
||||
memcpy(resp.data.board_num, led1509306_board_num, sizeof(resp.data.board_num));
|
||||
resp.data._0a = 0x0a;
|
||||
memcpy(resp.data.chip_num, led1509306_chip_num, sizeof(resp.data.chip_num));
|
||||
resp.data._ff = 0xff;
|
||||
resp.data.fw_ver = led1509306_fw_ver;
|
||||
|
||||
return led1509306_frame_encode(&led1509306_per_board_vars[board].boarduart.readable, &resp, sizeof(resp.hdr) + resp.hdr.nbytes);
|
||||
}
|
||||
|
||||
static HRESULT led1509306_req_get_fw_sum(int board)
|
||||
{
|
||||
dprintf("Chunithm LED Strip: Get firmware checksum (board %u)\n", board);
|
||||
|
||||
struct led1509306_resp_any resp;
|
||||
|
||||
memset(&resp, 0, sizeof(resp));
|
||||
resp.hdr.sync = LED_15093_06_FRAME_SYNC;
|
||||
resp.hdr.dest_adr = led1509306_host_adr;
|
||||
resp.hdr.src_adr = led1509306_board_adr;
|
||||
resp.hdr.nbytes = 2 + 3;
|
||||
|
||||
resp.status = 1;
|
||||
resp.cmd = LED_15093_06_CMD_FW_SUM;
|
||||
resp.report = 1;
|
||||
|
||||
resp.data[0] = (led1509306_fw_sum >> 8) & 0xff;
|
||||
resp.data[1] = led1509306_fw_sum & 0xff;
|
||||
|
||||
return led1509306_frame_encode(&led1509306_per_board_vars[board].boarduart.readable, &resp, sizeof(resp.hdr) + resp.hdr.nbytes);
|
||||
}
|
||||
|
||||
static HRESULT led1509306_req_get_protocol_ver(int board)
|
||||
{
|
||||
dprintf("Chunithm LED Strip: Get protocol version (board %u)\n", board);
|
||||
|
||||
struct led1509306_resp_any resp;
|
||||
|
||||
memset(&resp, 0, sizeof(resp));
|
||||
resp.hdr.sync = LED_15093_06_FRAME_SYNC;
|
||||
resp.hdr.dest_adr = led1509306_host_adr;
|
||||
resp.hdr.src_adr = led1509306_board_adr;
|
||||
resp.hdr.nbytes = 3 + 3;
|
||||
|
||||
resp.status = 1;
|
||||
resp.cmd = LED_15093_06_CMD_PROTOCOL_VER;
|
||||
resp.report = 1;
|
||||
|
||||
resp.data[0] = 1;
|
||||
resp.data[1] = 1;
|
||||
resp.data[2] = 4;
|
||||
|
||||
return led1509306_frame_encode(&led1509306_per_board_vars[board].boarduart.readable, &resp, sizeof(resp.hdr) + resp.hdr.nbytes);
|
||||
}
|
||||
|
||||
static HRESULT led1509306_req_get_board_status(int board)
|
||||
{
|
||||
dprintf("Chunithm LED Strip: Get board status (board %u)\n", board);
|
||||
|
||||
struct led1509306_resp_any resp;
|
||||
|
||||
memset(&resp, 0, sizeof(resp));
|
||||
resp.hdr.sync = LED_15093_06_FRAME_SYNC;
|
||||
resp.hdr.dest_adr = led1509306_host_adr;
|
||||
resp.hdr.src_adr = led1509306_board_adr;
|
||||
resp.hdr.nbytes = 4 + 3;
|
||||
|
||||
resp.status = 1;
|
||||
resp.cmd = LED_15093_06_CMD_BOARD_STATUS;
|
||||
resp.report = 1;
|
||||
|
||||
resp.data[0] = 0;
|
||||
resp.data[1] = 0;
|
||||
resp.data[2] = 0;
|
||||
resp.data[3] = 0;
|
||||
|
||||
return led1509306_frame_encode(&led1509306_per_board_vars[board].boarduart.readable, &resp, sizeof(resp.hdr) + resp.hdr.nbytes);
|
||||
}
|
||||
|
||||
static HRESULT led1509306_req_set_led(int board, const struct led1509306_req_any *req)
|
||||
{
|
||||
// dprintf("Chunithm LED Strip: Set LED (board %u)\n", board);
|
||||
|
||||
if (!led1509306_per_board_vars[board].enable_response)
|
||||
return S_OK;
|
||||
|
||||
struct led1509306_resp_any resp;
|
||||
|
||||
memset(&resp, 0, sizeof(resp));
|
||||
resp.hdr.sync = LED_15093_06_FRAME_SYNC;
|
||||
resp.hdr.dest_adr = led1509306_host_adr;
|
||||
resp.hdr.src_adr = led1509306_board_adr;
|
||||
resp.hdr.nbytes = 3;
|
||||
|
||||
resp.status = 1;
|
||||
resp.cmd = LED_15093_06_CMD_SET_LED;
|
||||
resp.report = 1;
|
||||
|
||||
return led1509306_frame_encode(&led1509306_per_board_vars[board].boarduart.readable, &resp, sizeof(resp.hdr) + resp.hdr.nbytes);
|
||||
}
|
||||
|
||||
static HRESULT led1509306_req_set_disable_response(int board, const struct led1509306_req_any *req)
|
||||
{
|
||||
dprintf("Chunithm LED Strip: Disable LED responses (board %u)\n", board);
|
||||
|
||||
led1509306_per_board_vars[board].enable_response = !req->payload[0];
|
||||
|
||||
struct led1509306_resp_any resp;
|
||||
|
||||
memset(&resp, 0, sizeof(resp));
|
||||
resp.hdr.sync = LED_15093_06_FRAME_SYNC;
|
||||
resp.hdr.dest_adr = led1509306_host_adr;
|
||||
resp.hdr.src_adr = led1509306_board_adr;
|
||||
resp.hdr.nbytes = 1 + 3;
|
||||
|
||||
resp.status = 1;
|
||||
resp.cmd = LED_15093_06_CMD_SET_DISABLE_RESPONSE;
|
||||
resp.report = 1;
|
||||
|
||||
resp.data[0] = req->payload[0];
|
||||
|
||||
return led1509306_frame_encode(&led1509306_per_board_vars[board].boarduart.readable, &resp, sizeof(resp.hdr) + resp.hdr.nbytes);
|
||||
}
|
||||
|
||||
static HRESULT led1509306_req_set_timeout(int board, const struct led1509306_req_any *req)
|
||||
{
|
||||
dprintf("Chunithm LED Strip: Set timeout (board %u)\n", board);
|
||||
|
||||
// not actually implemented, but respond correctly anyway
|
||||
|
||||
struct led1509306_resp_any resp;
|
||||
|
||||
memset(&resp, 0, sizeof(resp));
|
||||
resp.hdr.sync = LED_15093_06_FRAME_SYNC;
|
||||
resp.hdr.dest_adr = led1509306_host_adr;
|
||||
resp.hdr.src_adr = led1509306_board_adr;
|
||||
resp.hdr.nbytes = 2 + 3;
|
||||
|
||||
resp.status = 1;
|
||||
resp.cmd = LED_15093_06_CMD_SET_TIMEOUT;
|
||||
resp.report = 1;
|
||||
|
||||
resp.data[0] = req->payload[0];
|
||||
resp.data[1] = req->payload[1];
|
||||
|
||||
return led1509306_frame_encode(&led1509306_per_board_vars[board].boarduart.readable, &resp, sizeof(resp.hdr) + resp.hdr.nbytes);
|
||||
}
|
16
chunihook/led1509306.h
Normal file
16
chunihook/led1509306.h
Normal file
@ -0,0 +1,16 @@
|
||||
#pragma once
|
||||
|
||||
#include <windows.h>
|
||||
|
||||
#include <stdbool.h>
|
||||
|
||||
struct led1509306_config {
|
||||
bool enable;
|
||||
bool cvt_port;
|
||||
char board_number[8];
|
||||
char chip_number[5];
|
||||
uint8_t fw_ver;
|
||||
uint16_t fw_sum;
|
||||
};
|
||||
|
||||
HRESULT led1509306_hook_init(const struct led1509306_config *cfg);
|
@ -30,5 +30,7 @@ shared_library(
|
||||
'jvs.h',
|
||||
'slider.c',
|
||||
'slider.h',
|
||||
'led1509306.c',
|
||||
'led1509306.h',
|
||||
],
|
||||
)
|
||||
|
Reference in New Issue
Block a user