mirrors/SDL
1
0
Fork 0
mirror of https://github.com/libsdl-org/SDL.git synced 2026-02-13 07:13:35 +00:00
Code Issues Packages Projects Releases Wiki Activity
Files
bb8eee8fac287c4368b7530d2b1ef78af08c5d29
SDL/src/joystick/hidapi/SDL_hidapi_gamesir.c

1041 lines
35 KiB
C
Raw Blame History

This file contains ambiguous Unicode characters

This file contains Unicode characters that might be confused with other characters. If you think that this is intentional, you can safely ignore this warning. Use the Escape button to reveal them.

/*
Simple DirectMedia Layer
Copyright (C) 1997-2026 Sam Lantinga <slouken@libsdl.org>
This software is provided 'as-is', without any express or implied
warranty. In no event will the authors be held liable for any damages
arising from the use of this software.
Permission is granted to anyone to use this software for any purpose,
including commercial applications, and to alter it and redistribute it
freely, subject to the following restrictions:
1. The origin of this software must not be misrepresented; you must not
claim that you wrote the original software. If you use this software
in a product, an acknowledgment in the product documentation would be
appreciated but is not required.
2. Altered source versions must be plainly marked as such, and must not be
misrepresented as being the original software.
3. This notice may not be removed or altered from any source distribution.
*/
#include "SDL_internal.h"
#ifdef SDL_JOYSTICK_HIDAPI
#include "../SDL_sysjoystick.h"
#include "SDL_hidapijoystick_c.h"
#include "SDL_hidapi_rumble.h"
#ifdef SDL_JOYSTICK_HIDAPI_GAMESIR
#define GAMESIR_PACKET_HEADER_0 0xA1
#define GAMESIR_PACKET_HEADER_1_GAMEPAD 0xC8
#define BTN_A 0x01
#define BTN_B 0x02
#define BTN_C 0x04
#define BTN_X 0x08
#define BTN_Y 0x10
#define BTN_Z 0x20
#define BTN_L1 0x40
#define BTN_R1 0x80
#define BTN_L2 0x01
#define BTN_R2 0x02
#define BTN_SELECT 0x04
#define BTN_START 0x08
#define BTN_HOME 0x10
#define BTN_L3 0x20
#define BTN_R3 0x40
#define BTN_CAPTURE 0x80
#define BTN_UP 0x01
#define BTN_UP_L 0x08
#define BTN_UP_R 0x02
#define BTN_DOWN 0x05
#define BTN_DOWN_L 0x06
#define BTN_DOWN_R 0X04
#define BTN_LEFT 0x07
#define BTN_RIGHT 0x03
#define BTN_M 0x10
#define BTN_MUTE 0x20
#define BTN_L4 0x40
#define BTN_R4 0x80
#define BTN_L5 0x01
#define BTN_R5 0x02
#define BTN_L6 0x04
#define BTN_R6 0x08
#define BTN_L7 0x10
#define BTN_R7 0x20
#define BTN_L8 0x40
#define BTN_R8 0x80
#ifndef DEG2RAD
#define DEG2RAD(x) ((float)(x) * (float)(SDL_PI_F / 180.f))
#endif
#define LOAD16(A, B) (Sint16)((Uint16)(A) | (((Uint16)(B)) << 8))
typedef struct {
Uint8 cmd;
Uint8 mode;
} Gamesir_CommandMode;
typedef struct {
bool sensors_supported;
bool sensors_enabled;
Uint64 sensor_timestamp_ns;
Uint64 sensor_timestamp_step_ns;
float accelScale;
float gyroScale;
Uint8 last_state[USB_PACKET_LENGTH];
SDL_hid_device *output_handle;
} SDL_DriverGamesir_Context;
static void HIDAPI_DriverGameSir_RegisterHints(SDL_HintCallback callback, void *userdata)
{
SDL_AddHintCallback(SDL_HINT_JOYSTICK_HIDAPI_GAMESIR, callback, userdata);
}
static void HIDAPI_DriverGameSir_UnregisterHints(SDL_HintCallback callback, void *userdata)
{
SDL_RemoveHintCallback(SDL_HINT_JOYSTICK_HIDAPI_GAMESIR, callback, userdata);
}
static bool HIDAPI_DriverGameSir_IsEnabled(void)
{
return SDL_GetHintBoolean(SDL_HINT_JOYSTICK_HIDAPI_GAMESIR, SDL_GetHintBoolean(SDL_HINT_JOYSTICK_HIDAPI, SDL_HIDAPI_DEFAULT));
}
static bool HIDAPI_DriverGameSir_IsSupportedDevice(SDL_HIDAPI_Device *device, const char *name, SDL_GamepadType type, Uint16 vendor_id, Uint16 product_id, Uint16 version, int interface_number, int interface_class, int interface_subclass, int interface_protocol)
{
return SDL_IsJoystickGameSirController(vendor_id, product_id);
}
static bool SendGameSirModeSwitch(SDL_HIDAPI_Device *device)
{
Gamesir_CommandMode cmd = { 0x01 };
Uint8 buf[64];
SDL_zero(buf);
buf[0] = 0xA2;
SDL_memcpy(buf + 1, &cmd, sizeof(cmd));
SDL_hid_device *handle = NULL;
#if defined(SDL_PLATFORM_WIN32) || defined(SDL_PLATFORM_WINGDK)
SDL_DriverGamesir_Context *ctx = (SDL_DriverGamesir_Context *)device->context;
if (ctx && ctx->output_handle) {
handle = ctx->output_handle;
}
#else
handle = device->dev;
#endif
if (handle == NULL) {
SDL_SetError("Gamesir: output handle is null");
return false;
}
for (int attempt = 0; attempt < 3; ++attempt) {
int result = SDL_hid_write(handle, buf, sizeof(buf));
if (result < 0) {
return false;
}
for (int i = 0; i < 10; ++i) {
SDL_Delay(1);
Uint8 data[USB_PACKET_LENGTH] = {0};
int size = SDL_hid_read_timeout(handle, data, sizeof(data), 0);
if (size < 0) {
break;
}
if (size == 0) {
continue;
}
if (size == 64 && data[0] == 0xA1 && data[1] == 0x43 && data[2] == 0x01) {
return true;
}
}
}
SDL_Delay(10);
return true;
}
#if defined(SDL_PLATFORM_WIN32) || defined(SDL_PLATFORM_WINGDK)
#include <windows.h>
#include <setupapi.h>
#include <hidsdi.h>
#if defined(SDL_PLATFORM_WIN32) && defined(_MSC_VER)
#pragma comment(lib, "setupapi.lib")
#pragma comment(lib, "hid.lib")
#endif
static char *FindHIDInterfacePath(USHORT vid, USHORT pid, int collection_index ) {
GUID hidGuid;
HidD_GetHidGuid(&hidGuid);
HDEVINFO deviceInfoSet = SetupDiGetClassDevs(&hidGuid, NULL, NULL, DIGCF_PRESENT | DIGCF_DEVICEINTERFACE);
if (deviceInfoSet == INVALID_HANDLE_VALUE) {
return NULL;
}
SP_DEVICE_INTERFACE_DATA deviceInterfaceData;
deviceInterfaceData.cbSize = sizeof(SP_DEVICE_INTERFACE_DATA);
for (DWORD i = 0; SetupDiEnumDeviceInterfaces(deviceInfoSet, NULL, &hidGuid, i, &deviceInterfaceData); i++) {
DWORD requiredSize = 0;
SetupDiGetDeviceInterfaceDetail(deviceInfoSet, &deviceInterfaceData, NULL, 0, &requiredSize, NULL);
PSP_DEVICE_INTERFACE_DETAIL_DATA deviceDetail = (PSP_DEVICE_INTERFACE_DETAIL_DATA)SDL_malloc(requiredSize);
if (!deviceDetail) continue;
deviceDetail->cbSize = sizeof(SP_DEVICE_INTERFACE_DETAIL_DATA);
if (!SetupDiGetDeviceInterfaceDetail(deviceInfoSet, &deviceInterfaceData, deviceDetail, requiredSize, NULL, NULL)) {
SDL_free(deviceDetail);
continue;
}
HANDLE hDevice = CreateFile(deviceDetail->DevicePath,
GENERIC_READ | GENERIC_WRITE,
FILE_SHARE_READ | FILE_SHARE_WRITE,
NULL,
OPEN_EXISTING,
FILE_FLAG_OVERLAPPED,
NULL);
if (hDevice == INVALID_HANDLE_VALUE) {
SDL_free(deviceDetail);
continue;
}
HIDD_ATTRIBUTES attributes;
attributes.Size = sizeof(attributes);
if (!HidD_GetAttributes(hDevice, &attributes) ||
attributes.VendorID != vid ||
attributes.ProductID != pid) {
CloseHandle(hDevice);
SDL_free(deviceDetail);
continue;
}
PHIDP_PREPARSED_DATA preparsedData = NULL;
if (!HidD_GetPreparsedData(hDevice, &preparsedData) || !preparsedData) {
CloseHandle(hDevice);
SDL_free(deviceDetail);
continue;
}
HIDP_CAPS caps;
if (HidP_GetCaps(preparsedData, &caps) != HIDP_STATUS_SUCCESS) {
HidD_FreePreparsedData(preparsedData);
CloseHandle(hDevice);
SDL_free(deviceDetail);
continue;
}
if (caps.InputReportByteLength == 64 && caps.OutputReportByteLength == 64 ||
caps.InputReportByteLength == 37 && caps.OutputReportByteLength == 37) {
char col_str[16];
snprintf(col_str, sizeof(col_str), "col%02d", collection_index);
if (SDL_strcasestr(deviceDetail->DevicePath, col_str)) {
char *result = SDL_strdup(deviceDetail->DevicePath);
HidD_FreePreparsedData(preparsedData);
CloseHandle(hDevice);
SDL_free(deviceDetail);
SetupDiDestroyDeviceInfoList(deviceInfoSet);
return result;
}
}
HidD_FreePreparsedData(preparsedData);
CloseHandle(hDevice);
SDL_free(deviceDetail);
}
SetupDiDestroyDeviceInfoList(deviceInfoSet);
return NULL;
}
#endif
static bool HIDAPI_DriverGameSir_InitDevice(SDL_HIDAPI_Device *device)
{
Uint16 vendor_id = device->vendor_id;
Uint16 product_id = device->product_id;
SDL_hid_device *output_handle = NULL;
struct SDL_hid_device_info *devs = SDL_hid_enumerate(vendor_id, product_id);
for (struct SDL_hid_device_info *info = devs; info; info = info->next) {
if (info->interface_number == 0) {
#if defined(SDL_PLATFORM_WIN32) || defined(SDL_PLATFORM_WINGDK)
if (!output_handle) {
char *col02_path = FindHIDInterfacePath(vendor_id, product_id, 2);
if (col02_path) {
output_handle = SDL_hid_open_path(col02_path);
SDL_free(col02_path);
}
}
#else
#endif
}
if (info->interface_number == -1) {
#if defined(SDL_PLATFORM_WIN32) || defined(SDL_PLATFORM_WINGDK)
if (info->usage_page == 0x0001 && info->usage == 0x0005) {
output_handle = SDL_hid_open_path(info->path);
if (output_handle) {
SDL_Log("GameSir: Opened output interface via path pattern");
break;
}
}
#endif
}
else if (!output_handle && info->interface_number == 1) {
output_handle = SDL_hid_open_path(info->path);
}
}
SDL_hid_free_enumeration(devs);
SDL_DriverGamesir_Context *ctx = (SDL_DriverGamesir_Context *)SDL_calloc(1, sizeof(*ctx));
if (!ctx) {
SDL_hid_close(device->dev);
if (output_handle) {
SDL_hid_close(output_handle);
}
return false;
}
ctx->output_handle = output_handle;
device->context = ctx;
switch (device->product_id) {
case USB_PRODUCT_GAMESIR_GAMEPAD_G7_PRO_HID:
HIDAPI_SetDeviceName(device, "GameSir-G7 Pro (HID)");
ctx->sensors_supported = true;
SDL_Log("GameSir: Device detected - G7 Pro HID mode (PID 0x%04X)", device->product_id);
break;
case USB_PRODUCT_GAMESIR_GAMEPAD_G7_PRO_8K_HID:
HIDAPI_SetDeviceName(device, "GameSir-G7 Pro 8K (HID)");
ctx->sensors_supported = true;
SDL_Log("GameSir: Device detected - G7 Pro 8K HID mode (PID 0x%04X)", device->product_id);
break;
default:
HIDAPI_SetDeviceName(device, "GameSir Controller");
break;
}
SendGameSirModeSwitch(device);
return HIDAPI_JoystickConnected(device, NULL);
}
static int HIDAPI_DriverGameSir_GetDevicePlayerIndex(SDL_HIDAPI_Device *device, SDL_JoystickID instance_id)
{
return -1;
}
static void HIDAPI_DriverGameSir_SetDevicePlayerIndex(SDL_HIDAPI_Device *device, SDL_JoystickID instance_id, int player_index)
{
}
static bool HIDAPI_DriverGameSir_OpenJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick)
{
SDL_DriverGamesir_Context *ctx = (SDL_DriverGamesir_Context *)device->context;
SDL_AssertJoysticksLocked();
if (!ctx) {
return false;
}
SDL_zeroa(ctx->last_state);
SendGameSirModeSwitch(device);
if (device->product_id == USB_PRODUCT_GAMESIR_GAMEPAD_G7_PRO_HID) {
if (device->is_bluetooth) {
joystick->connection_state = SDL_JOYSTICK_CONNECTION_WIRELESS;
SDL_Log("GameSir: Joystick opened - Connection type: Bluetooth (wireless, HID mode)");
} else {
joystick->connection_state = SDL_JOYSTICK_CONNECTION_WIRED;
SDL_Log("GameSir: Joystick opened - Connection type: USB/2.4G (HID mode)");
}
} else if (device->product_id == USB_PRODUCT_GAMESIR_GAMEPAD_G7_PRO_8K_HID) {
if (device->is_bluetooth) {
joystick->connection_state = SDL_JOYSTICK_CONNECTION_WIRELESS;
SDL_Log("GameSir: Joystick opened - Connection type: Bluetooth (wireless, 8K HID mode)");
} else {
joystick->connection_state = SDL_JOYSTICK_CONNECTION_WIRED;
SDL_Log("GameSir: Joystick opened - Connection type: USB/2.4G (8K HID mode)");
}
} else if (device->is_bluetooth) {
joystick->connection_state = SDL_JOYSTICK_CONNECTION_WIRELESS;
SDL_Log("GameSir: Joystick opened - Connection type: Bluetooth (wireless)");
} else {
joystick->connection_state = SDL_JOYSTICK_CONNECTION_WIRED;
SDL_Log("GameSir: Joystick opened - Connection type: USB (wired)");
}
joystick->nbuttons = 35;
joystick->naxes = SDL_GAMEPAD_AXIS_COUNT;
joystick->nhats = 1;
if (ctx->sensors_supported) {
ctx->sensor_timestamp_step_ns = SDL_NS_PER_SECOND / 125;
// 加速度计缩放因子：假设范围为±2g，16位带符号值（-32768到32767）
// 32768对应2g，所以缩放因子 = 2 * SDL_STANDARD_GRAVITY / 32768.0f
ctx->accelScale = 2.0f * SDL_STANDARD_GRAVITY / 32768.0f;
// 陀螺仪缩放因子：参考PS4的实现方式
// PS4使用 (gyro_numerator / gyro_denominator) * (π / 180)
// 默认值为 (1 / 16) * (π / 180)，对应量程约为 ±2048 度/秒
// 这是游戏手柄陀螺仪的常见量程
const float gyro_numerator = 1.0f;
const float gyro_denominator = 16.0f;
ctx->gyroScale = (gyro_numerator / gyro_denominator) * (SDL_PI_F / 180.0f);
const float flSensorRate = 1000.0f;
SDL_PrivateJoystickAddSensor(joystick, SDL_SENSOR_GYRO, flSensorRate);
SDL_PrivateJoystickAddSensor(joystick, SDL_SENSOR_ACCEL, flSensorRate);
}
return true;
}
static bool HIDAPI_DriverGameSir_RumbleJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, Uint16 low_frequency_rumble, Uint16 high_frequency_rumble)
{
if (!device) {
return false;
}
SDL_DriverGamesir_Context *ctx = (SDL_DriverGamesir_Context *)device->context;
if (!ctx) {
return false;
}
Uint8 buf[64];
SDL_zero(buf);
buf[0] = 0xA2;
buf[1] = 0x03;
buf[2] = (Uint8)(low_frequency_rumble / 256);
buf[3] = (Uint8)(high_frequency_rumble / 256);
SDL_hid_device *handle = NULL;
#if defined(SDL_PLATFORM_WIN32) || defined(SDL_PLATFORM_WINGDK)
if (ctx && ctx->output_handle) {
handle = ctx->output_handle;
}
#else
handle = device->dev;
#endif
if (handle == NULL) {
SDL_SetError("Gamesir: output handle is null");
return false;
}
int result = SDL_hid_write(handle, buf, sizeof(buf));
if (result < 0) {
SDL_SetError("Gamesir: Failed to send rumble command, error: %s", SDL_GetError());
return false;
}
return true;
}
static bool HIDAPI_DriverGameSir_RumbleJoystickTriggers(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, Uint16 left_rumble, Uint16 right_rumble)
{
if (!device) {
return false;
}
SDL_DriverGamesir_Context *ctx = (SDL_DriverGamesir_Context *)device->context;
if (!ctx) {
return false;
}
Uint8 buf[64];
SDL_zero(buf);
buf[0] = 0xA2;
buf[1] = 0x03;
buf[4] = (Uint8)(left_rumble / 256);
buf[5] = (Uint8)(right_rumble / 256);
SDL_hid_device *handle = NULL;
#if defined(SDL_PLATFORM_WIN32) || defined(SDL_PLATFORM_WINGDK)
if (ctx && ctx->output_handle) {
handle = ctx->output_handle;
}
#else
handle = device->dev;
#endif
if (handle == NULL) {
SDL_SetError("Gamesir: output handle is null");
return false;
}
int result = SDL_hid_write(handle, buf, sizeof(buf));
if (result < 0) {
SDL_SetError("Gamesir: Failed to send trigger rumble command, error: %s", SDL_GetError());
return false;
}
return true;
}
static Uint32 HIDAPI_DriverGameSir_GetJoystickCapabilities(SDL_HIDAPI_Device *device, SDL_Joystick *joystick)
{
SDL_DriverGamesir_Context *ctx = (SDL_DriverGamesir_Context *)device->context;
Uint32 caps = SDL_JOYSTICK_CAP_RUMBLE | SDL_JOYSTICK_CAP_TRIGGER_RUMBLE;
if (ctx && ctx->sensors_supported) {
}
return caps;
}
static bool HIDAPI_DriverGameSir_SetJoystickLED(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, Uint8 red, Uint8 green, Uint8 blue)
{
if (!device) {
return false;
}
if (device->product_id == USB_PRODUCT_GAMESIR_GAMEPAD_G7_PRO_HID ||
device->product_id == USB_PRODUCT_GAMESIR_GAMEPAD_G7_PRO_8K_HID) {
return SDL_Unsupported();
}
SDL_DriverGamesir_Context *ctx = (SDL_DriverGamesir_Context *)device->context;
if (!ctx) {
return false;
}
Uint8 buf[64];
SDL_zero(buf);
buf[0] = 0xA2;
buf[1] = 0x04;
buf[2] = 0x01;
buf[3] = 0x01;
buf[4] = red;
buf[5] = green;
buf[6] = blue;
SDL_hid_device *handle = NULL;
#if defined(SDL_PLATFORM_WIN32) || defined(SDL_PLATFORM_WINGDK)
if (ctx && ctx->output_handle) {
handle = ctx->output_handle;
}
#else
handle = device->dev;
#endif
if (handle == NULL) {
SDL_SetError("Gamesir: output handle is null");
return false;
}
int result = SDL_hid_write(handle, buf, sizeof(buf));
if (result < 0) {
SDL_SetError("Gamesir: Failed to send LED command, error: %s", SDL_GetError());
return false;
}
return true;
}
static bool HIDAPI_DriverGameSir_SendJoystickEffect(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, const void *data, int size)
{
return SDL_Unsupported();
}
static bool HIDAPI_DriverGameSir_SetJoystickSensorsEnabled(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, bool enabled)
{
SDL_DriverGamesir_Context *ctx = (SDL_DriverGamesir_Context *)device->context;
if (ctx && ctx->sensors_supported) {
ctx->sensors_enabled = enabled;
return true;
}
return SDL_Unsupported();
}
static bool ApplyCircularDeadzone(Sint16 x, Sint16 y, Sint16 *out_x, Sint16 *out_y)
{
const Sint16 MAX_AXIS = 32767;
const float deadzone_percent = 5.0f;
const float deadzone_radius = (float)MAX_AXIS * deadzone_percent / 100.0f;
float distance = SDL_sqrtf((float)x * (float)x + (float)y * (float)y);
if (distance == 0.0f) {
*out_x = 0;
*out_y = 0;
return false;
}
if (distance < deadzone_radius) {
*out_x = 0;
*out_y = 0;
return false;
}
float scale = (distance - deadzone_radius) / (MAX_AXIS - deadzone_radius);
float normalized_x = (float)x / distance;
float normalized_y = (float)y / distance;
*out_x = (Sint16)(normalized_x * scale * MAX_AXIS);
*out_y = (Sint16)(normalized_y * scale * MAX_AXIS);
return true;
}
static void HIDAPI_DriverGameSir_HandleStatePacket(SDL_Joystick *joystick, SDL_DriverGamesir_Context *ctx, Uint8 *data, int size)
{
Sint16 axis;
Uint64 timestamp = SDL_GetTicksNS();
if (!joystick || !ctx || !data || size <= 0) {
return;
}
// 检查数据包格式：可能包含报告ID（0x43）作为第一个字节
// 实际数据包格式：43 a1 c8 [按钮数据...]
// 如果第一个字节是0x43，第二个字节是0xa1，第三个字节是0xc8，则跳过报告ID
Uint8 *packet_data = data;
int packet_size = size;
if (size >= 3 && data[0] == 0x43 && data[1] == GAMESIR_PACKET_HEADER_0 && data[2] == GAMESIR_PACKET_HEADER_1_GAMEPAD) {
// 数据包包含报告ID，跳过第一个字节
packet_data = data + 1;
packet_size = size - 1;
} else if (size >= 2 && data[0] == GAMESIR_PACKET_HEADER_0 && data[1] == GAMESIR_PACKET_HEADER_1_GAMEPAD) {
// 标准格式：没有报告ID，直接是头部字节
packet_data = data;
packet_size = size;
} else {
// 不匹配的数据包格式，直接返回
return;
}
bool is_initial_packet = (ctx->last_state[0] == 0 && ctx->last_state[1] == 0 && ctx->last_state[2] == 0 && ctx->last_state[3] == 0);
const int min_packet_size = ctx->sensors_enabled ? 29 : 17;
if (packet_size < min_packet_size) {
return;
}
if (ctx->last_state[3] != data[3]) {
Uint8 buttons = data[3];
// BTN1: A B C X Y Z L1 R1
// 使用位运算检查每个按钮是否被按下
// buttons & BTN_A 会返回 BTN_A 的值（如果按下）或 0（如果未按下）
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_SOUTH, buttons & BTN_A);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_EAST, buttons & BTN_B);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_WEST, buttons & BTN_X);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_NORTH, buttons & BTN_Y);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_LEFT_SHOULDER, buttons & BTN_L1);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_RIGHT_SHOULDER, buttons & BTN_R1);
}
if (ctx->last_state[4] != data[4]) {
Uint8 buttons = data[4];
// BTN2: L2 R2 SELECT START HOME L3 R3 CAPTURE
// 注意：L2/R2 作为数字按钮在 data[4] 中，但实际的模拟值在 data[15]/data[16] 中
// 这里只处理其他按钮，扳机轴的模拟值在后面的代码中处理
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_BACK, buttons & BTN_SELECT);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_START, buttons & BTN_START);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_GUIDE, buttons & BTN_HOME);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_LEFT_STICK, buttons & BTN_L3);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_RIGHT_STICK, buttons & BTN_R3);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_MISC1, buttons & BTN_CAPTURE);
}
if (ctx->last_state[5] != data[5]) {
Uint8 buttons = data[5];
// BTN3: UP DOWN LEFT RIGHT M MUTE L4 R4
// 处理方向键（十字键）
Uint8 hat = SDL_HAT_CENTERED;
if (buttons == BTN_UP_R) {
hat = SDL_HAT_RIGHTUP;
} else if (buttons == BTN_UP_L) {
hat = SDL_HAT_LEFTUP;
} else if (buttons == BTN_DOWN_R) {
hat = SDL_HAT_RIGHTDOWN;
} else if (buttons == BTN_DOWN_L) {
hat = SDL_HAT_LEFTDOWN;
} else if (buttons == BTN_UP) {
hat = SDL_HAT_UP;
} else if (buttons == BTN_DOWN) {
hat = SDL_HAT_DOWN;
} else if (buttons == BTN_LEFT) {
hat = SDL_HAT_LEFT;
} else if (buttons == BTN_RIGHT) {
hat = SDL_HAT_RIGHT;
} else {
hat = SDL_HAT_CENTERED;
}
SDL_SendJoystickHat(timestamp, joystick, 0, hat);
// 处理其他按钮
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_RIGHT_PADDLE1, buttons & BTN_L4);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_LEFT_PADDLE1, buttons & BTN_R4);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_MISC2, buttons & BTN_MUTE);
}
if (ctx->last_state[6] != data[6]) {
Uint8 buttons = data[6];
// BTN4: L5 R5 L6 R6 L7 R7 L8 R8
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_LEFT_PADDLE2, buttons & BTN_L5);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_RIGHT_PADDLE2, buttons & BTN_R5);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_MISC3, buttons & BTN_L6);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_MISC4, buttons & BTN_R6);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_MISC5, buttons & BTN_L7);
SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_MISC6, buttons & BTN_R7);
}
if (is_initial_packet) {
// 初始化所有摇杆轴到中心位置
SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFTX, 0);
SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFTY, 0);
SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHTX, 0);
SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHTY, 0);
} else {
// 左摇杆处理
// 左摇杆：字节 7-10 (16位值)
// 字节 7-8: X轴 (Hi/Low组合成带符号16位值，例如0x7df6)
// 字节 9-10: Y轴 (Hi/Low组合成带符号16位值)
if (size >= 11) {
// 组合字节7-8为16位值，例如：data[7]=0x7d, data[8]=0xf6 -> 0x7df6
Uint16 raw_x_unsigned = ((Uint16)data[7] << 8) | data[8];
Uint16 raw_y_unsigned = ((Uint16)data[9] << 8) | data[10];
// 将无符号16位值解释为带符号16位值
Sint16 raw_x = (Sint16)raw_x_unsigned;
Sint16 raw_y = (Sint16)raw_y_unsigned;
Sint16 left_x, left_y;
// 直接使用带符号16位值，Y轴反转（SDL约定：向上为负值）
left_x = raw_x;
left_y = -raw_y;
Uint16 last_raw_x_unsigned = ((Uint16)ctx->last_state[7] << 8) | ctx->last_state[8];
Uint16 last_raw_y_unsigned = ((Uint16)ctx->last_state[9] << 8) | ctx->last_state[10];
Sint16 last_raw_x = (Sint16)last_raw_x_unsigned;
Sint16 last_raw_y = (Sint16)last_raw_y_unsigned;
bool raw_changed = (raw_x != last_raw_x || raw_y != last_raw_y);
if (raw_changed) {
Sint16 deadzone_x, deadzone_y;
ApplyCircularDeadzone(left_x, left_y, &deadzone_x, &deadzone_y);
Sint16 last_left_x, last_left_y;
last_left_x = last_raw_x;
last_left_y = -last_raw_y; // Y轴反转
Sint16 last_deadzone_x, last_deadzone_y;
ApplyCircularDeadzone(last_left_x, last_left_y, &last_deadzone_x, &last_deadzone_y);
if (deadzone_x != last_deadzone_x || deadzone_y != last_deadzone_y) {
SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFTX, deadzone_x);
SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFTY, deadzone_y);
}
}
}
// 右摇杆处理
// 右摇杆：字节 11-14 (16位值)
// 字节 11-12: X轴 (Hi/Low组合成带符号16位值)
// 字节 13-14: Y轴 (Hi/Low组合成带符号16位值)
if (size >= 15) {
// 组合字节11-12为16位值
Uint16 raw_x_unsigned = ((Uint16)data[11] << 8) | data[12];
// 组合字节13-14为16位值
Uint16 raw_y_unsigned = ((Uint16)data[13] << 8) | data[14];
// 将无符号16位值解释为带符号16位值
Sint16 raw_x = (Sint16)raw_x_unsigned;
Sint16 raw_y = (Sint16)raw_y_unsigned;
Sint16 right_x, right_y;
// 直接使用带符号16位值，Y轴反转（SDL约定：向上为负值）
right_x = raw_x;
right_y = -raw_y;
Uint16 last_raw_x_unsigned = ((Uint16)ctx->last_state[11] << 8) | ctx->last_state[12];
Uint16 last_raw_y_unsigned = ((Uint16)ctx->last_state[13] << 8) | ctx->last_state[14];
Sint16 last_raw_x = (Sint16)last_raw_x_unsigned;
Sint16 last_raw_y = (Sint16)last_raw_y_unsigned;
bool raw_changed = (raw_x != last_raw_x || raw_y != last_raw_y);
if (raw_changed) {
Sint16 deadzone_x, deadzone_y;
ApplyCircularDeadzone(right_x, right_y, &deadzone_x, &deadzone_y);
Sint16 last_right_x, last_right_y;
last_right_x = last_raw_x;
last_right_y = -last_raw_y; // Y轴反转
Sint16 last_deadzone_x, last_deadzone_y;
ApplyCircularDeadzone(last_right_x, last_right_y, &last_deadzone_x, &last_deadzone_y);
if (deadzone_x != last_deadzone_x || deadzone_y != last_deadzone_y) {
SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHTX, deadzone_x);
SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHTY, deadzone_y);
}
}
}
// 处理扳机轴
// 协议：L2(15) - AXIS 左扳机模拟量 0-255，弹起0/按下255
// R2(16) - AXIS 右扳机模拟量 0-255，弹起0/按下255
// SDL 范围：0-32767（0=未按下，32767=完全按下）
// 线性映射：0-255 -> 0-32767
if (ctx->last_state[15] != data[15]) {
axis = (Sint16)(((int)data[15] * 255) - 32767);
SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFT_TRIGGER, axis);
}
if (ctx->last_state[16] != data[16]) {
axis = (Sint16)(((int)data[16] * 255) - 32767);
SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHT_TRIGGER, axis);
}
}
if (ctx->sensors_enabled && !is_initial_packet && size >= 29)
{
Uint64 sensor_timestamp;
float values[3];
sensor_timestamp = ctx->sensor_timestamp_ns;
ctx->sensor_timestamp_ns += ctx->sensor_timestamp_step_ns;
// 加速度计数据（字节 17-22）
// 字节 17-18: Acc X (Hi/Low组合成带符号16位值)
// 字节 19-20: Acc Y (Hi/Low组合成带符号16位值)
// 字节 21-22: Acc Z (Hi/Low组合成带符号16位值)
Uint16 acc_x_unsigned = ((Uint16)data[17] << 8) | data[18];
Uint16 acc_y_unsigned = ((Uint16)data[19] << 8) | data[20];
Uint16 acc_z_unsigned = ((Uint16)data[21] << 8) | data[22];
// 将无符号16位值转换为带符号16位值
Sint16 acc_x = (Sint16)acc_x_unsigned;
Sint16 acc_y = (Sint16)acc_y_unsigned;
Sint16 acc_z = (Sint16)acc_z_unsigned;
// 应用缩放因子并转换为浮点数
// 坐标系与PS4一致，直接使用原始值，无符号反转
values[0] = (float)acc_x * ctx->accelScale; // Acc X
values[1] = (float)acc_y * ctx->accelScale; // Acc Y
values[2] = (float)acc_z * ctx->accelScale; // Acc Z
SDL_SendJoystickSensor(timestamp, joystick, SDL_SENSOR_ACCEL, sensor_timestamp, values, 3);
// 陀螺仪数据（字节 23-28）
// 字节 23-24: Gyro X (Hi/Low组合成带符号16位值)
// 字节 25-26: Gyro Y (Hi/Low组合成带符号16位值)
// 字节 27-28: Gyro Z (Hi/Low组合成带符号16位值)
Uint16 gyro_x_unsigned = ((Uint16)data[23] << 8) | data[24];
Uint16 gyro_y_unsigned = ((Uint16)data[25] << 8) | data[26];
Uint16 gyro_z_unsigned = ((Uint16)data[27] << 8) | data[28];
// 将无符号16位值转换为带符号16位值
Sint16 gyro_x = (Sint16)gyro_x_unsigned;
Sint16 gyro_y = (Sint16)gyro_y_unsigned;
Sint16 gyro_z = (Sint16)gyro_z_unsigned;
// 应用缩放因子并转换为浮点数（弧度/秒）
// 参考PS4的实现：使用 (gyro_numerator / gyro_denominator) * (π / 180)
// 默认配置对应量程约为 ±2048 度/秒，这是游戏手柄陀螺仪的常见量程
// 坐标系与PS4一致，直接使用原始值，无符号反转
values[0] = (float)gyro_x * ctx->gyroScale; // Gyro X (Pitch)
values[1] = (float)gyro_y * ctx->gyroScale; // Gyro Y (Yaw)
values[2] = (float)gyro_z * ctx->gyroScale; // Gyro Z (Roll)
SDL_SendJoystickSensor(timestamp, joystick, SDL_SENSOR_GYRO, sensor_timestamp, values, 3);
}
if (size >= 35) {
Uint16 l_touchpad_x = ((Uint16)data[29] << 4) | ((data[30] >> 4) & 0x0F);
Uint16 l_touchpad_y = ((Uint16)(data[30] & 0x0F) << 8) | data[31];
Uint16 r_touchpad_x = ((Uint16)data[32] << 4) | ((data[33] >> 4) & 0x0F);
Uint16 r_touchpad_y = ((Uint16)(data[33] & 0x0F) << 8) | data[34];
(void)l_touchpad_x;
(void)l_touchpad_y;
(void)r_touchpad_x;
(void)r_touchpad_y;
}
SDL_memcpy(ctx->last_state, data, SDL_min(size, sizeof(ctx->last_state)));
}
static bool HIDAPI_DriverGameSir_UpdateDevice(SDL_HIDAPI_Device *device)
{
if (!device) {
return false;
}
SDL_DriverGamesir_Context *ctx = (SDL_DriverGamesir_Context *)device->context;
if (!ctx) {
return false;
}
SDL_Joystick *joystick = NULL;
Uint8 data[USB_PACKET_LENGTH];
int size;
if (device->num_joysticks > 0) {
joystick = SDL_GetJoystickFromID(device->joysticks[0]);
if (!joystick) {
return false;
}
}
SDL_hid_device *handle = NULL;
#if defined(_WIN32)
if (device->is_bluetooth) {
handle = device->dev;
} else {
if (ctx && ctx->output_handle) {
handle = ctx->output_handle;
} else {
handle = device->dev;
}
}
#else
handle = device->dev;
#endif
if (handle == NULL) {
return false;
}
while ((size = SDL_hid_read_timeout(handle, data, sizeof(data), 0)) > 0) {
if (joystick) {
// 取消注释以处理数据包
HIDAPI_DriverGameSir_HandleStatePacket(joystick, ctx, data, size);
}
}
if (size < 0) {
if (device->product_id == USB_PRODUCT_GAMESIR_GAMEPAD_G7_PRO_HID) {
if (device->is_bluetooth) {
SDL_Log("GameSir: Device disconnected - Connection type was: Bluetooth (wireless, HID mode)");
} else {
SDL_Log("GameSir: Device disconnected - Connection type was: USB/2.4G (HID mode)");
}
} else if (device->product_id == USB_PRODUCT_GAMESIR_GAMEPAD_G7_PRO_8K_HID) {
if (device->is_bluetooth) {
SDL_Log("GameSir: Device disconnected - Connection type was: Bluetooth (wireless, 8K HID mode)");
} else {
SDL_Log("GameSir: Device disconnected - Connection type was: USB/2.4G (8K HID mode)");
}
} else if (device->is_bluetooth) {
SDL_Log("GameSir: Device disconnected - Connection type was: Bluetooth (wireless)");
} else {
SDL_Log("GameSir: Device disconnected - Connection type was: USB (wired)");
}
HIDAPI_JoystickDisconnected(device, device->joysticks[0]);
}
return (size >= 0);
}
static void HIDAPI_DriverGameSir_CloseJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick)
{
}
static void HIDAPI_DriverGameSir_FreeDevice(SDL_HIDAPI_Device *device)
{
SDL_DriverGamesir_Context *ctx = (SDL_DriverGamesir_Context *)device->context;
if (ctx) {
if (ctx->output_handle) {
SDL_hid_close(ctx->output_handle);
}
SDL_free(ctx);
device->context = NULL;
}
}
SDL_HIDAPI_DeviceDriver SDL_HIDAPI_DriverGameSir = {
SDL_HINT_JOYSTICK_HIDAPI_GAMESIR,
true,
HIDAPI_DriverGameSir_RegisterHints,
HIDAPI_DriverGameSir_UnregisterHints,
HIDAPI_DriverGameSir_IsEnabled,
HIDAPI_DriverGameSir_IsSupportedDevice,
HIDAPI_DriverGameSir_InitDevice,
HIDAPI_DriverGameSir_GetDevicePlayerIndex,
HIDAPI_DriverGameSir_SetDevicePlayerIndex,
HIDAPI_DriverGameSir_UpdateDevice,
HIDAPI_DriverGameSir_OpenJoystick,
HIDAPI_DriverGameSir_RumbleJoystick,
HIDAPI_DriverGameSir_RumbleJoystickTriggers,
HIDAPI_DriverGameSir_GetJoystickCapabilities,
HIDAPI_DriverGameSir_SetJoystickLED,
HIDAPI_DriverGameSir_SendJoystickEffect,
HIDAPI_DriverGameSir_SetJoystickSensorsEnabled,
HIDAPI_DriverGameSir_CloseJoystick,
HIDAPI_DriverGameSir_FreeDevice,
};
#endif
#endif
Reference in New Issue View Git Blame Copy Permalink