mirror of
https://github.com/RPCSX/rpcsx.git
synced 2025-12-06 07:12:14 +01:00
279 lines
8.9 KiB
C++
279 lines
8.9 KiB
C++
#include "stdafx.h"
|
|
|
|
#ifdef _MSC_VER
|
|
#include "xinput_pad_handler.h"
|
|
|
|
namespace {
|
|
const DWORD THREAD_TIMEOUT = 1000;
|
|
const DWORD THREAD_SLEEP = 10;
|
|
const DWORD THREAD_SLEEP_INACTIVE = 100;
|
|
const DWORD MAX_GAMEPADS = 4;
|
|
const DWORD XINPUT_GAMEPAD_GUIDE = 0x0400;
|
|
const DWORD XINPUT_GAMEPAD_BUTTONS = 16;
|
|
const LPCWSTR LIBRARY_FILENAMES[] = {
|
|
L"xinput1_4.dll",
|
|
L"xinput1_3.dll",
|
|
L"xinput1_2.dll",
|
|
L"xinput9_1_0.dll"
|
|
};
|
|
|
|
inline u16 Clamp0To255(f32 input)
|
|
{
|
|
if (input > 255.f)
|
|
return 255;
|
|
else if (input < 0.f)
|
|
return 0;
|
|
else return static_cast<u16>(input);
|
|
}
|
|
|
|
inline u16 ConvertAxis(float value)
|
|
{
|
|
return static_cast<u16>((value + 1.0)*(255.0 / 2.0));
|
|
}
|
|
}
|
|
|
|
xinput_pad_handler::xinput_pad_handler() : active(false), thread(nullptr), library(nullptr), xinputGetState(nullptr), xinputEnable(nullptr), xinputSetState(nullptr)
|
|
{
|
|
}
|
|
|
|
xinput_pad_handler::~xinput_pad_handler()
|
|
{
|
|
Close();
|
|
}
|
|
|
|
void xinput_pad_handler::Init(const u32 max_connect)
|
|
{
|
|
for (auto it : LIBRARY_FILENAMES)
|
|
{
|
|
library = LoadLibrary(it);
|
|
if (library)
|
|
{
|
|
xinputEnable = reinterpret_cast<PFN_XINPUTENABLE>(GetProcAddress(library, "XInputEnable"));
|
|
xinputGetState = reinterpret_cast<PFN_XINPUTGETSTATE>(GetProcAddress(library, reinterpret_cast<LPCSTR>(100)));
|
|
if (!xinputGetState)
|
|
{
|
|
xinputGetState = reinterpret_cast<PFN_XINPUTGETSTATE>(GetProcAddress(library, "XInputGetState"));
|
|
}
|
|
|
|
xinputSetState = reinterpret_cast<PFN_XINPUTSETSTATE>(GetProcAddress(library, "XInputSetState"));
|
|
|
|
if (xinputEnable && xinputGetState && xinputSetState)
|
|
{
|
|
break;
|
|
}
|
|
|
|
FreeLibrary(library);
|
|
library = nullptr;
|
|
xinputEnable = nullptr;
|
|
xinputGetState = nullptr;
|
|
}
|
|
}
|
|
|
|
if (library)
|
|
{
|
|
std::memset(&m_info, 0, sizeof m_info);
|
|
m_info.max_connect = max_connect;
|
|
|
|
for (u32 i = 0, max = std::min(max_connect, u32(MAX_GAMEPADS)); i != max; ++i)
|
|
{
|
|
m_pads.emplace_back(
|
|
CELL_PAD_STATUS_DISCONNECTED,
|
|
CELL_PAD_SETTING_PRESS_OFF | CELL_PAD_SETTING_SENSOR_OFF,
|
|
CELL_PAD_CAPABILITY_PS3_CONFORMITY | CELL_PAD_CAPABILITY_PRESS_MODE | CELL_PAD_CAPABILITY_ACTUATOR,
|
|
CELL_PAD_DEV_TYPE_STANDARD
|
|
);
|
|
auto & pad = m_pads.back();
|
|
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL1, XINPUT_GAMEPAD_DPAD_UP, CELL_PAD_CTRL_UP);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL1, XINPUT_GAMEPAD_DPAD_DOWN, CELL_PAD_CTRL_DOWN);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL1, XINPUT_GAMEPAD_DPAD_LEFT, CELL_PAD_CTRL_LEFT);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL1, XINPUT_GAMEPAD_DPAD_RIGHT, CELL_PAD_CTRL_RIGHT);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL1, XINPUT_GAMEPAD_START, CELL_PAD_CTRL_START);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL1, XINPUT_GAMEPAD_BACK, CELL_PAD_CTRL_SELECT);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL1, XINPUT_GAMEPAD_LEFT_THUMB, CELL_PAD_CTRL_L3);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL1, XINPUT_GAMEPAD_RIGHT_THUMB, CELL_PAD_CTRL_R3);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL2, XINPUT_GAMEPAD_LEFT_SHOULDER, CELL_PAD_CTRL_L1);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL2, XINPUT_GAMEPAD_RIGHT_SHOULDER, CELL_PAD_CTRL_R1);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL2, XINPUT_GAMEPAD_GUIDE, 0x100/*CELL_PAD_CTRL_PS*/);// TODO: PS button support
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL2, 0, 0x0); // Reserved
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL2, XINPUT_GAMEPAD_A, CELL_PAD_CTRL_CROSS);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL2, XINPUT_GAMEPAD_B, CELL_PAD_CTRL_CIRCLE);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL2, XINPUT_GAMEPAD_X, CELL_PAD_CTRL_SQUARE);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL2, XINPUT_GAMEPAD_Y, CELL_PAD_CTRL_TRIANGLE);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL2, 0, CELL_PAD_CTRL_L2);
|
|
pad.m_buttons.emplace_back(CELL_PAD_BTN_OFFSET_DIGITAL2, 0, CELL_PAD_CTRL_R2);
|
|
|
|
pad.m_sticks.emplace_back(CELL_PAD_BTN_OFFSET_ANALOG_LEFT_X, 0, 0);
|
|
pad.m_sticks.emplace_back(CELL_PAD_BTN_OFFSET_ANALOG_LEFT_Y, 0, 0);
|
|
pad.m_sticks.emplace_back(CELL_PAD_BTN_OFFSET_ANALOG_RIGHT_X, 0, 0);
|
|
pad.m_sticks.emplace_back(CELL_PAD_BTN_OFFSET_ANALOG_RIGHT_Y, 0, 0);
|
|
|
|
pad.m_vibrateMotors.emplace_back(true, 0);
|
|
pad.m_vibrateMotors.emplace_back(false, 0);
|
|
}
|
|
|
|
active = true;
|
|
thread = CreateThread(NULL, 0, &xinput_pad_handler::ThreadProcProxy, this, 0, NULL);
|
|
}
|
|
}
|
|
|
|
void xinput_pad_handler::SetRumble(const u32 pad, u8 largeMotor, bool smallMotor) {
|
|
if (pad > m_pads.size())
|
|
return;
|
|
|
|
m_pads[pad].m_vibrateMotors[0].m_value = largeMotor;
|
|
m_pads[pad].m_vibrateMotors[1].m_value = smallMotor ? 255 : 0;
|
|
}
|
|
|
|
void xinput_pad_handler::Close()
|
|
{
|
|
if (library)
|
|
{
|
|
if (thread)
|
|
{
|
|
active = false;
|
|
if (WaitForSingleObject(thread, THREAD_TIMEOUT) != WAIT_OBJECT_0)
|
|
LOG_ERROR(HLE, "XInput thread could not stop within %d milliseconds", (u32)THREAD_TIMEOUT);
|
|
thread = nullptr;
|
|
}
|
|
|
|
FreeLibrary(library);
|
|
library = nullptr;
|
|
xinputGetState = nullptr;
|
|
xinputEnable = nullptr;
|
|
}
|
|
|
|
m_pads.clear();
|
|
}
|
|
|
|
std::tuple<u16, u16> xinput_pad_handler::ConvertToSquirclePoint(u16 inX, u16 inY)
|
|
{
|
|
// convert inX and Y to a (-1, 1) vector;
|
|
const f32 x = (inX - 127) / 127.f;
|
|
const f32 y = ((inY - 127) / 127.f);
|
|
|
|
// compute angle and len of given point to be used for squircle radius
|
|
const f32 angle = std::atan2(y, x);
|
|
const f32 r = std::sqrt(std::pow(x, 2.f) + std::pow(y, 2.f));
|
|
|
|
// now find len/point on the given squircle from our current angle and radius in polar coords
|
|
// https://thatsmaths.com/2016/07/14/squircles/
|
|
const f32 newLen = (1 + std::pow(std::sin(2 * angle), 2.f) / 8.f) * r;
|
|
|
|
// we now have len and angle, convert to cartisian
|
|
|
|
const int newX = Clamp0To255(((newLen * std::cos(angle)) + 1) * 127);
|
|
const int newY = Clamp0To255(((newLen * std::sin(angle)) + 1) * 127);
|
|
return std::tuple<u16, u16>(newX, newY);
|
|
}
|
|
|
|
DWORD xinput_pad_handler::ThreadProcedure()
|
|
{
|
|
// holds internal controller state change
|
|
std::array<bool, MAX_GAMEPADS> last_connection_status = {};
|
|
|
|
while (active)
|
|
{
|
|
XINPUT_STATE state;
|
|
DWORD result;
|
|
DWORD online = 0;
|
|
|
|
for (DWORD i = 0; i != m_pads.size(); ++i)
|
|
{
|
|
auto & pad = m_pads[i];
|
|
|
|
result = (*xinputGetState)(i, &state);
|
|
switch (result)
|
|
{
|
|
case ERROR_DEVICE_NOT_CONNECTED:
|
|
if (last_connection_status[i] == true)
|
|
pad.m_port_status |= CELL_PAD_STATUS_ASSIGN_CHANGES;
|
|
last_connection_status[i] = false;
|
|
pad.m_port_status &= ~CELL_PAD_STATUS_CONNECTED;
|
|
break;
|
|
|
|
case ERROR_SUCCESS:
|
|
++online;
|
|
if (last_connection_status[i] == false)
|
|
pad.m_port_status |= CELL_PAD_STATUS_ASSIGN_CHANGES;
|
|
last_connection_status[i] = true;
|
|
pad.m_port_status |= CELL_PAD_STATUS_CONNECTED;
|
|
|
|
for (DWORD j = 0; j != XINPUT_GAMEPAD_BUTTONS; ++j)
|
|
{
|
|
bool pressed = state.Gamepad.wButtons & (1 << j);
|
|
pad.m_buttons[j].m_pressed = pressed;
|
|
pad.m_buttons[j].m_value = pressed ? 255 : 0;
|
|
}
|
|
|
|
pad.m_buttons[XINPUT_GAMEPAD_BUTTONS].m_pressed = state.Gamepad.bLeftTrigger > 0;
|
|
pad.m_buttons[XINPUT_GAMEPAD_BUTTONS].m_value = state.Gamepad.bLeftTrigger;
|
|
pad.m_buttons[XINPUT_GAMEPAD_BUTTONS + 1].m_pressed = state.Gamepad.bRightTrigger > 0;
|
|
pad.m_buttons[XINPUT_GAMEPAD_BUTTONS + 1].m_value = state.Gamepad.bRightTrigger;
|
|
|
|
float LX, LY, RX, RY;
|
|
|
|
LX = state.Gamepad.sThumbLX;
|
|
LY = state.Gamepad.sThumbLY;
|
|
RX = state.Gamepad.sThumbRX;
|
|
RY = state.Gamepad.sThumbRY;
|
|
|
|
auto normalize_input = [](float& X, float& Y, float deadzone)
|
|
{
|
|
X /= 32767.0f;
|
|
Y /= 32767.0f;
|
|
deadzone /= 32767.0f;
|
|
|
|
float mag = sqrtf(X*X + Y*Y);
|
|
|
|
if (mag > deadzone)
|
|
{
|
|
float legalRange = 1.0f - deadzone;
|
|
float normalizedMag = std::min(1.0f, (mag - deadzone) / legalRange);
|
|
float scale = normalizedMag / mag;
|
|
X = X * scale;
|
|
Y = Y * scale;
|
|
}
|
|
else
|
|
{
|
|
X = 0;
|
|
Y = 0;
|
|
}
|
|
};
|
|
|
|
normalize_input(LX, LY, XINPUT_GAMEPAD_LEFT_THUMB_DEADZONE);
|
|
normalize_input(RX, RY, XINPUT_GAMEPAD_RIGHT_THUMB_DEADZONE);
|
|
|
|
pad.m_sticks[0].m_value = ConvertAxis(LX);
|
|
pad.m_sticks[1].m_value = 255 - ConvertAxis(LY);
|
|
pad.m_sticks[2].m_value = ConvertAxis(RX);
|
|
pad.m_sticks[3].m_value = 255 - ConvertAxis(RY);
|
|
|
|
std::tie(pad.m_sticks[0].m_value, pad.m_sticks[1].m_value) = ConvertToSquirclePoint(pad.m_sticks[0].m_value, pad.m_sticks[1].m_value);
|
|
std::tie(pad.m_sticks[2].m_value, pad.m_sticks[3].m_value) = ConvertToSquirclePoint(pad.m_sticks[2].m_value, pad.m_sticks[3].m_value);
|
|
|
|
XINPUT_VIBRATION vibrate;
|
|
|
|
vibrate.wLeftMotorSpeed = pad.m_vibrateMotors[0].m_value * 257;
|
|
vibrate.wRightMotorSpeed = pad.m_vibrateMotors[1].m_value * 257;
|
|
|
|
(*xinputSetState)(i, &vibrate);
|
|
|
|
break;
|
|
}
|
|
}
|
|
|
|
m_info.now_connect = online;
|
|
Sleep((online > 0) ? THREAD_SLEEP : THREAD_SLEEP_INACTIVE);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
DWORD WINAPI xinput_pad_handler::ThreadProcProxy(LPVOID parameter)
|
|
{
|
|
return reinterpret_cast<xinput_pad_handler *>(parameter)->ThreadProcedure();
|
|
}
|
|
|
|
#endif
|