segatools/idzio/xi.c

213 lines
5.9 KiB
C
Raw Normal View History

2019-05-04 00:36:23 +00:00
#include <windows.h>
#include <xinput.h>
#include <math.h>
2019-05-04 22:47:34 +00:00
#include <assert.h>
2019-05-04 00:36:23 +00:00
#include <stdbool.h>
#include <stdint.h>
2019-05-04 22:47:34 +00:00
#include "idzio/backend.h"
#include "idzio/config.h"
2019-05-04 00:36:23 +00:00
#include "idzio/idzio.h"
#include "idzio/shifter.h"
2019-05-04 22:47:34 +00:00
#include "idzio/xi.h"
2019-05-04 00:36:23 +00:00
2019-05-04 22:47:34 +00:00
#include "util/dprintf.h"
2019-05-04 00:36:23 +00:00
2019-05-04 22:47:34 +00:00
static void idz_xi_jvs_read_buttons(uint8_t *gamebtn_out);
static void idz_xi_jvs_read_shifter(uint8_t *gear);
static void idz_xi_jvs_read_analogs(struct idz_io_analog_state *out);
static HRESULT idz_xi_config_apply(const struct idz_xi_config *cfg);
2019-05-04 22:47:34 +00:00
static const struct idz_io_backend idz_xi_backend = {
.jvs_read_buttons = idz_xi_jvs_read_buttons,
.jvs_read_shifter = idz_xi_jvs_read_shifter,
.jvs_read_analogs = idz_xi_jvs_read_analogs,
};
static bool idz_xi_single_stick_steering;
static bool idz_xi_linear_steering;
2023-08-29 00:22:05 +00:00
static uint16_t idz_xi_left_stick_deadzone;
static uint16_t idz_xi_right_stick_deadzone;
const uint16_t max_stick_value = 32767;
/* Apply steering wheel restriction. Real cabs only report about 76% of
the output value when the wheel is turned to either of its maximum positions. */
const uint16_t max_wheel_value = 24831;
HRESULT idz_xi_init(const struct idz_xi_config *cfg, const struct idz_io_backend **backend)
2019-05-04 00:36:23 +00:00
{
HRESULT hr;
assert(cfg != NULL);
2019-05-04 22:47:34 +00:00
assert(backend != NULL);
hr = idz_xi_config_apply(cfg);
if (FAILED(hr)) {
return hr;
}
dprintf("XInput: Using XInput controller\n");
2019-05-04 22:47:34 +00:00
*backend = &idz_xi_backend;
2019-05-04 00:36:23 +00:00
return S_OK;
}
2023-08-29 00:22:05 +00:00
static HRESULT idz_xi_config_apply(const struct idz_xi_config *cfg) {
/* Deadzones check */
if (cfg->left_stick_deadzone > 32767 || cfg->left_stick_deadzone < 0) {
dprintf("XInput: Left stick deadzone is too large or negative\n");
return E_INVALIDARG;
}
if (cfg->right_stick_deadzone > 32767 || cfg->right_stick_deadzone < 0) {
dprintf("XInput: Right stick deadzone is too large or negative\n");
return E_INVALIDARG;
}
dprintf("XInput: --- Begin configuration ---\n");
dprintf("XInput: Single Stick Steering : %i\n", cfg->single_stick_steering);
dprintf("XInput: Linear Steering . . . : %i\n", cfg->linear_steering);
2023-08-29 00:22:05 +00:00
dprintf("XInput: Left Deadzone . . . . : %i\n", cfg->left_stick_deadzone);
dprintf("XInput: Right Deadzone . . . : %i\n", cfg->right_stick_deadzone);
dprintf("XInput: --- End configuration ---\n");
idz_xi_single_stick_steering = cfg->single_stick_steering;
idz_xi_linear_steering = cfg->linear_steering;
2023-08-29 00:22:05 +00:00
idz_xi_left_stick_deadzone = cfg->left_stick_deadzone;
idz_xi_right_stick_deadzone = cfg->right_stick_deadzone;
return S_OK;
}
2019-05-04 22:47:34 +00:00
static void idz_xi_jvs_read_buttons(uint8_t *gamebtn_out)
2019-05-04 00:36:23 +00:00
{
uint8_t gamebtn;
XINPUT_STATE xi;
WORD xb;
2019-05-04 22:47:34 +00:00
assert(gamebtn_out != NULL);
2019-05-04 00:36:23 +00:00
2019-05-04 22:47:34 +00:00
gamebtn = 0;
2019-05-04 00:36:23 +00:00
memset(&xi, 0, sizeof(xi));
XInputGetState(0, &xi);
xb = xi.Gamepad.wButtons;
if (xb & XINPUT_GAMEPAD_DPAD_UP) {
gamebtn |= IDZ_IO_GAMEBTN_UP;
}
if (xb & XINPUT_GAMEPAD_DPAD_DOWN) {
gamebtn |= IDZ_IO_GAMEBTN_DOWN;
}
if (xb & XINPUT_GAMEPAD_DPAD_LEFT) {
gamebtn |= IDZ_IO_GAMEBTN_LEFT;
}
if (xb & XINPUT_GAMEPAD_DPAD_RIGHT) {
gamebtn |= IDZ_IO_GAMEBTN_RIGHT;
}
if (xb & (XINPUT_GAMEPAD_START | XINPUT_GAMEPAD_A)) {
2019-05-04 00:36:23 +00:00
gamebtn |= IDZ_IO_GAMEBTN_START;
}
if (xb & (XINPUT_GAMEPAD_BACK | XINPUT_GAMEPAD_B)) {
2019-05-04 00:36:23 +00:00
gamebtn |= IDZ_IO_GAMEBTN_VIEW_CHANGE;
}
*gamebtn_out = gamebtn;
}
2019-05-04 22:47:34 +00:00
static void idz_xi_jvs_read_shifter(uint8_t *gear)
2019-05-04 00:36:23 +00:00
{
bool shift_dn;
bool shift_up;
2019-05-04 00:36:23 +00:00
XINPUT_STATE xi;
WORD xb;
2019-05-04 22:47:34 +00:00
assert(gear != NULL);
2019-05-04 00:36:23 +00:00
memset(&xi, 0, sizeof(xi));
XInputGetState(0, &xi);
xb = xi.Gamepad.wButtons;
if (xb & XINPUT_GAMEPAD_START) {
/* Reset to Neutral when start is pressed */
idz_shifter_reset();
2019-05-04 00:36:23 +00:00
}
shift_dn = xb & (XINPUT_GAMEPAD_Y | XINPUT_GAMEPAD_LEFT_SHOULDER);
shift_up = xb & (XINPUT_GAMEPAD_X | XINPUT_GAMEPAD_RIGHT_SHOULDER);
2019-05-04 00:36:23 +00:00
idz_shifter_update(shift_dn, shift_up);
2019-05-04 00:36:23 +00:00
*gear = idz_shifter_current_gear();
2019-05-04 00:36:23 +00:00
}
static int16_t calculate_norm_steering(int16_t axis, uint16_t deadzone, bool linear_steering) {
// determine how far the controller is pushed
float magnitude = sqrt(axis*axis);
// determine the direction the controller is pushed
float norm_axis = axis / magnitude;
float norm_magnitude = 0.0;
// check if the controller is outside a circular dead zone
if (magnitude > deadzone)
{
// clip the magnitude at its expected maximum value
if (magnitude > max_stick_value) magnitude = max_stick_value;
// adjust magnitude relative to the end of the dead zone
magnitude -= deadzone;
// optionally normalize the magnitude with respect to its expected range
// giving a magnitude value of 0.0 to 1.0
norm_magnitude = magnitude / (max_stick_value - deadzone);
} else // if the controller is in the deadzone zero out the magnitude
{
magnitude = 0.0;
norm_magnitude = 0.0;
}
// apply non-linear transform to the axis
if (!linear_steering) {
return norm_axis * pow(norm_magnitude, 3.0) * max_wheel_value;
}
return norm_axis * norm_magnitude * max_wheel_value;
}
2019-05-04 22:47:34 +00:00
static void idz_xi_jvs_read_analogs(struct idz_io_analog_state *out)
2019-05-04 00:36:23 +00:00
{
XINPUT_STATE xi;
int left;
int right;
2019-05-04 22:47:34 +00:00
assert(out != NULL);
2019-05-04 00:36:23 +00:00
memset(&xi, 0, sizeof(xi));
XInputGetState(0, &xi);
left = xi.Gamepad.sThumbLX;
right = xi.Gamepad.sThumbRX;
// normalize the steering axis
left = calculate_norm_steering(left, idz_xi_left_stick_deadzone, idz_xi_linear_steering);
right = calculate_norm_steering(right, idz_xi_right_stick_deadzone, idz_xi_linear_steering);
2019-05-04 00:36:23 +00:00
if(idz_xi_single_stick_steering) {
out->wheel = left;
} else {
out->wheel = (left + right) / 2;
}
2019-05-04 00:36:23 +00:00
out->accel = xi.Gamepad.bRightTrigger << 8;
out->brake = xi.Gamepad.bLeftTrigger << 8;
}