| 1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099 |
- /*
- 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"
- #include "SDL_hidapi_flydigi.h"
- #ifdef SDL_JOYSTICK_HIDAPI_FLYDIGI
- // Define this if you want to log all packets from the controller
- #if 0
- #define DEBUG_FLYDIGI_PROTOCOL
- #endif
- #ifndef DEG2RAD
- #define DEG2RAD(x) ((float)(x) * (float)(SDL_PI_F / 180.f))
- #endif
- enum
- {
- SDL_GAMEPAD_BUTTON_FLYDIGI_M1 = 11,
- SDL_GAMEPAD_BUTTON_FLYDIGI_M2,
- SDL_GAMEPAD_BUTTON_FLYDIGI_M3,
- SDL_GAMEPAD_BUTTON_FLYDIGI_M4,
- SDL_GAMEPAD_NUM_BASE_FLYDIGI_BUTTONS
- };
- /* Rate of IMU Sensor Packets over wireless dongle observed in testcontroller at 1000hz */
- #define SENSOR_INTERVAL_VADER4_PRO_DONGLE_RATE_HZ 1000
- #define SENSOR_INTERVAL_VADER4_PRO_DONGLE_NS (SDL_NS_PER_SECOND / SENSOR_INTERVAL_VADER4_PRO_DONGLE_RATE_HZ)
- /* Rate of IMU Sensor Packets over wired connection observed in testcontroller at 500hz */
- #define SENSOR_INTERVAL_VADER4_PRO_WIRED_RATE_HZ 500
- #define SENSOR_INTERVAL_VADER4_PRO_WIRED_NS (SDL_NS_PER_SECOND / SENSOR_INTERVAL_VADER4_PRO_WIRED_RATE_HZ)
- /* Rate of IMU Sensor Packets over wired connection observed in testcontroller at 500hz */
- #define SENSOR_INTERVAL_VADER5_PRO_RATE_HZ 500
- #define SENSOR_INTERVAL_VADER5_PRO_NS (SDL_NS_PER_SECOND / SENSOR_INTERVAL_VADER5_PRO_RATE_HZ)
- /* Rate of IMU Sensor Packets over wireless dongle observed in testcontroller at 295hz */
- #define SENSOR_INTERVAL_APEX5_DONGLE_RATE_HZ 295
- #define SENSOR_INTERVAL_APEX5_DONGLE_NS (SDL_NS_PER_SECOND / SENSOR_INTERVAL_APEX5_DONGLE_RATE_HZ)
- /* Rate of IMU Sensor Packets over wired connection observed in testcontroller at 970hz */
- #define SENSOR_INTERVAL_APEX5_WIRED_RATE_HZ 970
- #define SENSOR_INTERVAL_APEX5_WIRED_NS (SDL_NS_PER_SECOND / SENSOR_INTERVAL_APEX5_WIRED_RATE_HZ)
- #define FLYDIGI_ACQUIRE_CONTROLLER_HEARTBEAT_TIME 1000 * 30
- #define FLYDIGI_V1_CMD_REPORT_ID 0x05
- #define FLYDIGI_V1_HAPTIC_COMMAND 0x0F
- #define FLYDIGI_V1_GET_INFO_COMMAND 0xEC
- #define FLYDIGI_V2_CMD_REPORT_ID 0x03
- #define FLYDIGI_V2_MAGIC1 0x5A
- #define FLYDIGI_V2_MAGIC2 0xA5
- #define FLYDIGI_V2_GET_INFO_COMMAND 0x01
- #define FLYDIGI_V2_GET_STATUS_COMMAND 0x10
- #define FLYDIGI_V2_SET_STATUS_COMMAND 0x11
- #define FLYDIGI_V2_HAPTIC_COMMAND 0x12
- #define FLYDIGI_V2_ACQUIRE_CONTROLLER_COMMAND 0x1C
- #define FLYDIGI_V2_INPUT_REPORT 0xEF
- typedef struct
- {
- SDL_HIDAPI_Device *device;
- Uint8 deviceID;
- bool available;
- bool has_cz;
- bool has_lmrm;
- bool has_circle;
- bool wireless;
- bool sensors_supported;
- bool sensors_enabled;
- Uint16 firmware_version;
- Uint64 sensor_timestamp_ns; // Simulate onboard clock. Advance by known time step. Nanoseconds.
- Uint64 sensor_timestamp_step_ns; // Based on observed rate of receipt of IMU sensor packets.
- float accelScale;
- float gyroScale;
- Uint64 next_heartbeat;
- Uint64 last_packet;
- Uint8 last_state[USB_PACKET_LENGTH];
- } SDL_DriverFlydigi_Context;
- static void HIDAPI_DriverFlydigi_RegisterHints(SDL_HintCallback callback, void *userdata)
- {
- SDL_AddHintCallback(SDL_HINT_JOYSTICK_HIDAPI_FLYDIGI, callback, userdata);
- }
- static void HIDAPI_DriverFlydigi_UnregisterHints(SDL_HintCallback callback, void *userdata)
- {
- SDL_RemoveHintCallback(SDL_HINT_JOYSTICK_HIDAPI_FLYDIGI, callback, userdata);
- }
- static bool HIDAPI_DriverFlydigi_IsEnabled(void)
- {
- return SDL_GetHintBoolean(SDL_HINT_JOYSTICK_HIDAPI_FLYDIGI, SDL_GetHintBoolean(SDL_HINT_JOYSTICK_HIDAPI, SDL_HIDAPI_DEFAULT));
- }
- static bool HIDAPI_DriverFlydigi_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)
- {
- if (SDL_IsJoystickFlydigiController(vendor_id, product_id)) {
- if (vendor_id == USB_VENDOR_FLYDIGI_V1) {
- if (interface_number == 2) {
- // Early controllers have their custom protocol on interface 2
- return true;
- }
- } else {
- // Newer controllers have their custom protocol on interface 1 or 2, but
- // only expose one HID interface, so we'll accept any interface we see.
- return true;
- }
- }
- return false;
- }
- static void HIDAPI_DriverFlydigi_UpdateDeviceIdentity(SDL_HIDAPI_Device *device)
- {
- SDL_DriverFlydigi_Context *ctx = (SDL_DriverFlydigi_Context *)device->context;
- Uint8 controller_type = SDL_FLYDIGI_UNKNOWN;
- switch (ctx->deviceID) {
- case 19:
- controller_type = SDL_FLYDIGI_APEX2;
- break;
- case 24:
- case 26:
- case 29:
- controller_type = SDL_FLYDIGI_APEX3;
- break;
- case 84:
- controller_type = SDL_FLYDIGI_APEX4;
- break;
- case 20:
- case 21:
- case 23:
- controller_type = SDL_FLYDIGI_VADER2;
- break;
- case 22:
- controller_type = SDL_FLYDIGI_VADER2_PRO;
- break;
- case 28:
- controller_type = SDL_FLYDIGI_VADER3;
- break;
- case 80:
- case 81:
- controller_type = SDL_FLYDIGI_VADER3_PRO;
- break;
- case 85:
- case 91:
- case 105:
- controller_type = SDL_FLYDIGI_VADER4_PRO;
- break;
- case 128:
- case 129:
- controller_type = SDL_FLYDIGI_APEX5;
- break;
- case 130:
- controller_type = SDL_FLYDIGI_VADER5_PRO;
- break;
- case 133:
- case 134:
- controller_type = SDL_FLYDIGI_APEX5;
- break;
- case 149: //Apex6
- case 150: //Apex6 Pro
- case 152: //Apex 6 Pro Phantom Blade Zero
- controller_type = SDL_FLYDIGI_APEX6;
- break;
- default:
- // Try to guess from the name of the controller
- if (SDL_strcasestr(device->name, "VADER") != NULL) {
- if (SDL_strstr(device->name, "VADER2") != NULL) {
- controller_type = SDL_FLYDIGI_VADER2;
- } else if (SDL_strstr(device->name, "VADER3") != NULL) {
- controller_type = SDL_FLYDIGI_VADER3;
- } else if (SDL_strstr(device->name, "VADER4") != NULL) {
- controller_type = SDL_FLYDIGI_VADER4_PRO;
- } else if (SDL_strstr(device->name, "Vader 5") != NULL) {
- controller_type = SDL_FLYDIGI_VADER5_PRO;
- }
- } else if (SDL_strstr(device->name, "APEX") != NULL) {
- if (SDL_strstr(device->name, "APEX2") != NULL) {
- controller_type = SDL_FLYDIGI_APEX2;
- } else if (SDL_strstr(device->name, "APEX3") != NULL) {
- controller_type = SDL_FLYDIGI_APEX3;
- } else if (SDL_strstr(device->name, "APEX4") != NULL) {
- controller_type = SDL_FLYDIGI_APEX4;
- } else if (SDL_strstr(device->name, "APEX5") != NULL) {
- controller_type = SDL_FLYDIGI_APEX5;
- } else if (SDL_strstr(device->name, "APEX6") != NULL) {
- controller_type = SDL_FLYDIGI_APEX6;
- }
- }
- break;
- }
- device->guid.data[15] = controller_type;
- // This is the previous sensor default of 125hz.
- // Override this in the switch statement below based on observed sensor packet rate.
- ctx->sensor_timestamp_step_ns = SDL_NS_PER_SECOND / 125;
- switch (controller_type) {
- case SDL_FLYDIGI_APEX2:
- HIDAPI_SetDeviceName(device, "Flydigi Apex 2");
- break;
- case SDL_FLYDIGI_APEX3:
- HIDAPI_SetDeviceName(device, "Flydigi Apex 3");
- break;
- case SDL_FLYDIGI_APEX4:
- // The Apex 4 controller has sensors, but they're only reported when gyro mouse is enabled
- HIDAPI_SetDeviceName(device, "Flydigi Apex 4");
- break;
- case SDL_FLYDIGI_APEX5:
- HIDAPI_SetDeviceName(device, "Flydigi Apex 5");
- ctx->has_lmrm = true;
- ctx->sensors_supported = true;
- ctx->accelScale = SDL_STANDARD_GRAVITY / 4096.0f;
- ctx->gyroScale = DEG2RAD(2000.0f);
- ctx->sensor_timestamp_step_ns = ctx->wireless ? SENSOR_INTERVAL_APEX5_DONGLE_NS : SENSOR_INTERVAL_APEX5_WIRED_NS;
- break;
- case SDL_FLYDIGI_APEX6:
- HIDAPI_SetDeviceName(device, "Flydigi Apex 6");
- ctx->has_lmrm = true;
- ctx->sensors_supported = true;
- ctx->accelScale = SDL_STANDARD_GRAVITY / 4096.0f;
- ctx->gyroScale = DEG2RAD(2000.0f);
- ctx->sensor_timestamp_step_ns = ctx->wireless ? SENSOR_INTERVAL_APEX5_DONGLE_NS : SENSOR_INTERVAL_APEX5_WIRED_NS;
- break;
- case SDL_FLYDIGI_VADER2:
- // The Vader 2 controller has sensors, but they're only reported when gyro mouse is enabled
- HIDAPI_SetDeviceName(device, "Flydigi Vader 2");
- ctx->has_cz = true;
- break;
- case SDL_FLYDIGI_VADER2_PRO:
- HIDAPI_SetDeviceName(device, "Flydigi Vader 2 Pro");
- ctx->has_cz = true;
- break;
- case SDL_FLYDIGI_VADER3:
- HIDAPI_SetDeviceName(device, "Flydigi Vader 3");
- ctx->has_cz = true;
- break;
- case SDL_FLYDIGI_VADER3_PRO:
- HIDAPI_SetDeviceName(device, "Flydigi Vader 3 Pro");
- ctx->has_cz = true;
- ctx->sensors_supported = true;
- ctx->accelScale = SDL_STANDARD_GRAVITY / 256.0f;
- ctx->sensor_timestamp_step_ns = ctx->wireless ? SENSOR_INTERVAL_VADER4_PRO_DONGLE_NS : SENSOR_INTERVAL_VADER4_PRO_WIRED_NS;
- break;
- case SDL_FLYDIGI_VADER4_PRO:
- HIDAPI_SetDeviceName(device, "Flydigi Vader 4 Pro");
- ctx->has_cz = true;
- ctx->sensors_supported = true;
- ctx->accelScale = SDL_STANDARD_GRAVITY / 256.0f;
- ctx->sensor_timestamp_step_ns = ctx->wireless ? SENSOR_INTERVAL_VADER4_PRO_DONGLE_NS : SENSOR_INTERVAL_VADER4_PRO_WIRED_NS;
- break;
- case SDL_FLYDIGI_VADER5_PRO:
- HIDAPI_SetDeviceName(device, "Flydigi Vader 5 Pro");
- ctx->has_cz = true;
- ctx->has_lmrm = true;
- ctx->has_circle = true;
- ctx->sensors_supported = true;
- ctx->accelScale = SDL_STANDARD_GRAVITY / 4096.0f;
- ctx->gyroScale = DEG2RAD(2000.0f);
- ctx->sensor_timestamp_step_ns = SENSOR_INTERVAL_VADER5_PRO_NS;
- break;
- default:
- SDL_LogDebug(SDL_LOG_CATEGORY_INPUT, "Unknown FlyDigi controller with ID %d, name '%s'", ctx->deviceID, device->name);
- break;
- }
- }
- static void HIDAPI_DriverFlydigi_SetAvailable(SDL_HIDAPI_Device *device, bool available)
- {
- SDL_DriverFlydigi_Context *ctx = (SDL_DriverFlydigi_Context *)device->context;
- if (available == ctx->available) {
- return;
- }
- if (available) {
- if (device->num_joysticks == 0) {
- HIDAPI_JoystickConnected(device, NULL);
- }
- } else {
- if (device->num_joysticks > 0) {
- HIDAPI_JoystickDisconnected(device, device->joysticks[0]);
- }
- }
- ctx->available = available;
- }
- static int HIDAPI_DriverFlydigi_WritePacket(SDL_HIDAPI_Device *device, const Uint8 *data, size_t size)
- {
- // We know that at the very least the Vader 5 now uses unnumbered reports for commands instead of FLYDIGI_V2_CMD_REPORT_ID.
- // If other Flydigi things prove to do the same, we can tweak this check to be more general.
- bool bUsesUnnumberedReports = (device->vendor_id == USB_VENDOR_FLYDIGI_V2 && (device->product_id == USB_PRODUCT_FLYDIGI_V2_VADER || device->product_id == USB_PRODUCT_FLYDIGI_V2_APEX6));
- if (bUsesUnnumberedReports && data[0] == FLYDIGI_V2_CMD_REPORT_ID) {
- // Zero out the report byte.
- Uint8 output[USB_PACKET_LENGTH];
- SDL_memcpy(output, data, SDL_min(size, USB_PACKET_LENGTH));
- output[0] = 0;
- return SDL_hid_write(device->dev, output, SDL_min(size, USB_PACKET_LENGTH));
- }
- return SDL_hid_write(device->dev, data, size);
- }
- static bool HIDAPI_DriverFlydigi_InitControllerV1(SDL_HIDAPI_Device *device)
- {
- SDL_DriverFlydigi_Context *ctx = (SDL_DriverFlydigi_Context *)device->context;
- // Detecting the Vader 2 can take over 1000 read retries, so be generous here
- for (int attempt = 0; ctx->deviceID == 0 && attempt < 30; ++attempt) {
- const Uint8 request[] = { FLYDIGI_V1_CMD_REPORT_ID, FLYDIGI_V1_GET_INFO_COMMAND, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
- // This write will occasionally return -1, so ignore failure here and try again
- (void)HIDAPI_DriverFlydigi_WritePacket(device, request, sizeof(request));
- // Read the reply
- for (int i = 0; i < 100; ++i) {
- SDL_Delay(1);
- Uint8 data[USB_PACKET_LENGTH];
- int size = SDL_hid_read_timeout(device->dev, data, sizeof(data), 0);
- if (size < 0) {
- break;
- }
- if (size == 0) {
- continue;
- }
- #ifdef DEBUG_FLYDIGI_PROTOCOL
- HIDAPI_DumpPacket("Flydigi packet: size = %d", data, size);
- #endif
- if (size == 32 && data[15] == 236) {
- ctx->deviceID = data[3];
- ctx->firmware_version = LOAD16(data[9], data[10]);
- char serial[9];
- (void)SDL_snprintf(serial, sizeof(serial), "%.2x%.2x%.2x%.2x", data[5], data[6], data[7], data[8]);
- HIDAPI_SetDeviceSerial(device, serial);
- // The Vader 2 with firmware 6.0.4.9 doesn't report the connection state
- if (ctx->firmware_version >= 0x6400) {
- switch (data[13]) {
- case 0:
- // Wireless connection
- ctx->wireless = true;
- break;
- case 1:
- // Wired connection
- ctx->wireless = false;
- break;
- default:
- break;
- }
- }
- // Done!
- break;
- }
- }
- }
- HIDAPI_DriverFlydigi_UpdateDeviceIdentity(device);
- HIDAPI_DriverFlydigi_SetAvailable(device, true);
- return true;
- }
- static bool GetReply(SDL_HIDAPI_Device* device, Uint8 command, Uint8* data, size_t length)
- {
- for (int i = 0; i < 100; ++i) {
- SDL_Delay(1);
- int size = SDL_hid_read_timeout(device->dev, data, length, 0);
- if (size < 0) {
- break;
- }
- if (size == 0) {
- continue;
- }
- #ifdef DEBUG_FLYDIGI_PROTOCOL
- HIDAPI_DumpPacket("Flydigi packet: size = %d", data, size);
- #endif
- if (size == 32) {
- if (data[1] == FLYDIGI_V2_MAGIC1 && data[2] == FLYDIGI_V2_MAGIC2) {
- // Skip the report ID
- SDL_memmove(&data[0], &data[1], size - 1);
- data[size - 1] = 0;
- }
- if (data[0] == FLYDIGI_V2_MAGIC1 && data[1] == FLYDIGI_V2_MAGIC2 && data[2] == command) {
- return true;
- }
- }
- }
- return false;
- }
- static bool SDL_HIDAPI_Flydigi_SendInfoRequest(SDL_HIDAPI_Device *device)
- {
- const Uint8 cmd[] = {
- FLYDIGI_V2_CMD_REPORT_ID,
- FLYDIGI_V2_MAGIC1,
- FLYDIGI_V2_MAGIC2,
- FLYDIGI_V2_GET_INFO_COMMAND,
- 2,
- 0
- };
- if (HIDAPI_DriverFlydigi_WritePacket(device, cmd, sizeof(cmd)) < 0) {
- return SDL_SetError("Couldn't query controller info");
- }
- return true;
- }
- static void HIDAPI_DriverFlydigi_HandleInfoResponse(SDL_Joystick *joystick, SDL_DriverFlydigi_Context *ctx, Uint8 *data, int size)
- {
- SDL_PowerState state;
- int percent;
- Uint8 status = (data[11] >> 4) & 0x0F;
- Uint8 level = (data[11] & 0x0F);
- switch (status) {
- case 0:
- state = SDL_POWERSTATE_ON_BATTERY;
- if (ctx->device->guid.data[15] == SDL_FLYDIGI_APEX6) {
- percent = level * 10;
- } else {
- percent = level * 20;
- }
- break;
- case 1:
- state = SDL_POWERSTATE_CHARGING;
- if (ctx->device->guid.data[15] == SDL_FLYDIGI_APEX6) {
- percent = level * 10;
- } else {
- percent = level * 20;
- }
- break;
- case 2:
- state = SDL_POWERSTATE_CHARGED;
- percent = 100;
- break;
- default:
- state = SDL_POWERSTATE_UNKNOWN;
- percent = 0;
- break;
- }
- SDL_SendJoystickPowerInfo(joystick, state, percent);
- }
- static bool SDL_HIDAPI_Flydigi_SendStatusRequest(SDL_HIDAPI_Device *device)
- {
- const Uint8 cmd[] = {
- FLYDIGI_V2_CMD_REPORT_ID,
- FLYDIGI_V2_MAGIC1,
- FLYDIGI_V2_MAGIC2,
- FLYDIGI_V2_GET_STATUS_COMMAND
- };
- if (HIDAPI_DriverFlydigi_WritePacket(device, cmd, sizeof(cmd)) < 0) {
- return SDL_SetError("Couldn't query controller status");
- }
- return true;
- }
- static void HIDAPI_DriverFlydigi_HandleStatusResponse(SDL_HIDAPI_Device *device, Uint8 *data, int size)
- {
- if (data[9] == 1) {
- HIDAPI_DriverFlydigi_SetAvailable(device, true);
- } else {
- // Click "Allow third-party apps to take over mappings" in the FlyDigi Space Station app
- HIDAPI_DriverFlydigi_SetAvailable(device, false);
- }
- }
- static bool SDL_HIDAPI_Flydigi_SendAcquireRequest(SDL_HIDAPI_Device *device, bool acquire)
- {
- const Uint8 cmd[32] = {
- FLYDIGI_V2_CMD_REPORT_ID,
- FLYDIGI_V2_MAGIC1,
- FLYDIGI_V2_MAGIC2,
- FLYDIGI_V2_ACQUIRE_CONTROLLER_COMMAND,
- 23,
- acquire ? 1 : 0,
- 'S', 'D', 'L', 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
- };
- if (HIDAPI_DriverFlydigi_WritePacket(device, cmd, sizeof(cmd)) < 0) {
- return SDL_SetError("Couldn't send acquire command");
- }
- return true;
- }
- static void HIDAPI_DriverFlydigi_HandleAcquireResponse(SDL_HIDAPI_Device *device, Uint8 *data, int size)
- {
- if (data[5] != 1 && data[6] == 0) {
- // Controller acquiring failed or has been disabled
- HIDAPI_DriverFlydigi_SetAvailable(device, false);
- }
- }
- static bool HIDAPI_DriverFlydigi_InitControllerV2(SDL_HIDAPI_Device *device)
- {
- SDL_DriverFlydigi_Context *ctx = (SDL_DriverFlydigi_Context *)device->context;
- Uint8 data[USB_PACKET_LENGTH];
- if (!SDL_HIDAPI_Flydigi_SendInfoRequest(device)) {
- return false;
- }
- if (!GetReply(device, FLYDIGI_V2_GET_INFO_COMMAND, data, sizeof(data))) {
- return SDL_SetError("Couldn't get controller info");
- }
- // Check the firmware version
- Uint16 min_firmware_version;
- ctx->firmware_version = LOAD16(data[16], data[15]);
- switch (device->product_id) {
- case USB_PRODUCT_FLYDIGI_V2_APEX:
- // Minimum supported firmware version, Apex 5
- min_firmware_version = 0x7031;
- break;
- case USB_PRODUCT_FLYDIGI_V2_VADER:
- // Minimum supported firmware version, Vader 5 Pro
- min_firmware_version = 0x7141;
- break;
- default:
- // Unknown product, presumably this version is okay?
- min_firmware_version = 0;
- break;
- }
- if (ctx->firmware_version < min_firmware_version) {
- return SDL_SetError("Unsupported firmware version");
- }
- switch (data[6]) {
- case 1:
- // Wired connection
- ctx->wireless = false;
- break;
- case 2:
- // Wireless connection
- ctx->wireless = true;
- break;
- default:
- break;
- }
- ctx->deviceID = data[5];
- HIDAPI_DriverFlydigi_UpdateDeviceIdentity(device);
- // See whether we can acquire the controller
- SDL_HIDAPI_Flydigi_SendStatusRequest(device);
- return true;
- }
- static bool HIDAPI_DriverFlydigi_InitDevice(SDL_HIDAPI_Device *device)
- {
- SDL_DriverFlydigi_Context *ctx = (SDL_DriverFlydigi_Context *)SDL_calloc(1, sizeof(*ctx));
- if (!ctx) {
- return false;
- }
- ctx->device = device;
- device->context = ctx;
- if (device->vendor_id == USB_VENDOR_FLYDIGI_V1) {
- return HIDAPI_DriverFlydigi_InitControllerV1(device);
- } else {
- return HIDAPI_DriverFlydigi_InitControllerV2(device);
- }
- }
- static int HIDAPI_DriverFlydigi_GetDevicePlayerIndex(SDL_HIDAPI_Device *device, SDL_JoystickID instance_id)
- {
- return -1;
- }
- static void HIDAPI_DriverFlydigi_SetDevicePlayerIndex(SDL_HIDAPI_Device *device, SDL_JoystickID instance_id, int player_index)
- {
- }
- static bool HIDAPI_DriverFlydigi_OpenJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick)
- {
- SDL_DriverFlydigi_Context *ctx = (SDL_DriverFlydigi_Context *)device->context;
- SDL_AssertJoysticksLocked();
- SDL_zeroa(ctx->last_state);
- // Initialize the joystick capabilities
- joystick->nbuttons = SDL_GAMEPAD_NUM_BASE_FLYDIGI_BUTTONS;
- if (ctx->has_cz) {
- joystick->nbuttons += 2;
- }
- if (ctx->has_lmrm) {
- joystick->nbuttons += 2;
- }
- if (ctx->has_circle) {
- joystick->nbuttons += 1;
- }
- joystick->naxes = SDL_GAMEPAD_AXIS_COUNT;
- joystick->nhats = 1;
- if (ctx->wireless) {
- joystick->connection_state = SDL_JOYSTICK_CONNECTION_WIRELESS;
- }
- if (ctx->sensors_supported) {
- const float flSensorRate = ctx->wireless ? (float)SENSOR_INTERVAL_VADER4_PRO_DONGLE_RATE_HZ : (float)SENSOR_INTERVAL_VADER4_PRO_WIRED_RATE_HZ;
- SDL_PrivateJoystickAddSensor(joystick, SDL_SENSOR_GYRO, flSensorRate);
- SDL_PrivateJoystickAddSensor(joystick, SDL_SENSOR_ACCEL, flSensorRate);
- }
- return true;
- }
- static bool HIDAPI_DriverFlydigi_RumbleJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, Uint16 low_frequency_rumble, Uint16 high_frequency_rumble)
- {
- if (device->vendor_id == USB_VENDOR_FLYDIGI_V1) {
- Uint8 rumble_packet[] = { FLYDIGI_V1_CMD_REPORT_ID, FLYDIGI_V1_HAPTIC_COMMAND, 0x00, 0x00 };
- rumble_packet[2] = low_frequency_rumble >> 8;
- rumble_packet[3] = high_frequency_rumble >> 8;
- if (SDL_HIDAPI_SendRumble(device, rumble_packet, sizeof(rumble_packet)) != sizeof(rumble_packet)) {
- return SDL_SetError("Couldn't send rumble packet");
- }
- } else {
- Uint8 rumble_packet[] = { FLYDIGI_V2_CMD_REPORT_ID, FLYDIGI_V2_MAGIC1, FLYDIGI_V2_MAGIC2, FLYDIGI_V2_HAPTIC_COMMAND, 6, 0, 0, 0, 0, 0 };
- rumble_packet[5] = low_frequency_rumble >> 8;
- rumble_packet[6] = high_frequency_rumble >> 8;
- if (SDL_HIDAPI_SendRumble(device, rumble_packet, sizeof(rumble_packet)) != sizeof(rumble_packet)) {
- return SDL_SetError("Couldn't send rumble packet");
- }
- }
- return true;
- }
- static bool HIDAPI_DriverFlydigi_RumbleJoystickTriggers(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, Uint16 left_rumble, Uint16 right_rumble)
- {
- return SDL_Unsupported();
- }
- static Uint32 HIDAPI_DriverFlydigi_GetJoystickCapabilities(SDL_HIDAPI_Device *device, SDL_Joystick *joystick)
- {
- return SDL_JOYSTICK_CAP_RUMBLE;
- }
- static bool HIDAPI_DriverFlydigi_SetJoystickLED(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, Uint8 red, Uint8 green, Uint8 blue)
- {
- return SDL_Unsupported();
- }
- static bool HIDAPI_DriverFlydigi_SendJoystickEffect(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, const void *data, int size)
- {
- return SDL_Unsupported();
- }
- static bool HIDAPI_DriverFlydigi_SetJoystickSensorsEnabled(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, bool enabled)
- {
- SDL_DriverFlydigi_Context *ctx = (SDL_DriverFlydigi_Context *)device->context;
- if (ctx->sensors_supported) {
- ctx->sensors_enabled = enabled;
- return true;
- }
- return SDL_Unsupported();
- }
- static void HIDAPI_DriverFlydigi_HandleStatePacketV1(SDL_Joystick *joystick, SDL_DriverFlydigi_Context *ctx, Uint8 *data, int size)
- {
- Sint16 axis;
- Uint64 timestamp = SDL_GetTicksNS();
- Uint8 extra_button_index = SDL_GAMEPAD_NUM_BASE_FLYDIGI_BUTTONS;
- if (ctx->last_state[9] != data[9]) {
- Uint8 hat;
- switch (data[9] & 0x0F) {
- case 0x01u:
- hat = SDL_HAT_UP;
- break;
- case 0x02u | 0x01u:
- hat = SDL_HAT_RIGHTUP;
- break;
- case 0x02u:
- hat = SDL_HAT_RIGHT;
- break;
- case 0x02u | 0x04u:
- hat = SDL_HAT_RIGHTDOWN;
- break;
- case 0x04u:
- hat = SDL_HAT_DOWN;
- break;
- case 0x08u | 0x04u:
- hat = SDL_HAT_LEFTDOWN;
- break;
- case 0x08u:
- hat = SDL_HAT_LEFT;
- break;
- case 0x08u | 0x01u:
- hat = SDL_HAT_LEFTUP;
- break;
- default:
- hat = SDL_HAT_CENTERED;
- break;
- }
- SDL_SendJoystickHat(timestamp, joystick, 0, hat);
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_SOUTH, ((data[9] & 0x10) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_EAST, ((data[9] & 0x20) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_BACK, ((data[9] & 0x40) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_WEST, ((data[9] & 0x80) != 0));
- }
- if (ctx->last_state[10] != data[10]) {
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_NORTH, ((data[10] & 0x01) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_START, ((data[10] & 0x02) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_LEFT_SHOULDER, ((data[10] & 0x04) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_RIGHT_SHOULDER, ((data[10] & 0x08) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_LEFT_STICK, ((data[10] & 0x40) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_RIGHT_STICK, ((data[10] & 0x80) != 0));
- }
- if (ctx->last_state[7] != data[7]) {
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_FLYDIGI_M1, ((data[7] & 0x04) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_FLYDIGI_M2, ((data[7] & 0x08) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_FLYDIGI_M3, ((data[7] & 0x10) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_FLYDIGI_M4, ((data[7] & 0x20) != 0));
- if (ctx->has_cz) {
- SDL_SendJoystickButton(timestamp, joystick, extra_button_index++, ((data[7] & 0x01) != 0));
- SDL_SendJoystickButton(timestamp, joystick, extra_button_index++, ((data[7] & 0x02) != 0));
- }
- }
- if (ctx->last_state[8] != data[8]) {
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_GUIDE, ((data[8] & 0x08) != 0));
- // The '+' button is used to toggle gyro mouse mode, so don't pass that to the application
- // SDL_SendJoystickButton(timestamp, joystick, extra_button_index++, ((data[8] & 0x01) != 0));
- // The '-' button is only available on the Vader 2, for simplicity let's ignore that
- // SDL_SendJoystickButton(timestamp, joystick, extra_button_index++, ((data[8] & 0x10) != 0));
- }
- #define READ_STICK_AXIS(offset) \
- (data[offset] == 0x7f ? 0 : (Sint16)HIDAPI_RemapVal((float)((int)data[offset] - 0x7f), -0x7f, 0xff - 0x7f, SDL_MIN_SINT16, SDL_MAX_SINT16))
- {
- axis = READ_STICK_AXIS(17);
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFTX, axis);
- axis = READ_STICK_AXIS(19);
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFTY, axis);
- axis = READ_STICK_AXIS(21);
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHTX, axis);
- axis = READ_STICK_AXIS(22);
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHTY, axis);
- }
- #undef READ_STICK_AXIS
- #define READ_TRIGGER_AXIS(offset) \
- (Sint16)(((int)data[offset] * 257) - 32768)
- {
- axis = READ_TRIGGER_AXIS(23);
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFT_TRIGGER, axis);
- axis = READ_TRIGGER_AXIS(24);
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHT_TRIGGER, axis);
- }
- #undef READ_TRIGGER_AXIS
- if (ctx->sensors_enabled) {
- Uint64 sensor_timestamp;
- float values[3];
- // Advance the imu sensor time stamp based on the observed rate of receipt of packets in the testcontroller app.
- // This varies between Product ID and connection type.
- sensor_timestamp = ctx->sensor_timestamp_ns;
- ctx->sensor_timestamp_ns += ctx->sensor_timestamp_step_ns;
- // Pitch and yaw scales may be receiving extra filtering for the sake of bespoke direct mouse output.
- // As result, roll has a different scaling factor than pitch and yaw.
- // These values were estimated using the testcontroller tool in lieux of hard data sheet references.
- const float flPitchAndYawScale = DEG2RAD(72000.0f);
- const float flRollScale = DEG2RAD(1200.0f);
- values[0] = HIDAPI_RemapVal(-1.0f * LOAD16(data[26], data[27]), INT16_MIN, INT16_MAX, -flPitchAndYawScale, flPitchAndYawScale);
- values[1] = HIDAPI_RemapVal(-1.0f * LOAD16(data[18], data[20]), INT16_MIN, INT16_MAX, -flPitchAndYawScale, flPitchAndYawScale);
- values[2] = HIDAPI_RemapVal(-1.0f * LOAD16(data[29], data[30]), INT16_MIN, INT16_MAX, -flRollScale, flRollScale);
- SDL_SendJoystickSensor(timestamp, joystick, SDL_SENSOR_GYRO, sensor_timestamp, values, 3);
- const float flAccelScale = ctx->accelScale;
- values[0] = -LOAD16(data[11], data[12]) * flAccelScale; // Acceleration along pitch axis
- values[1] = LOAD16(data[15], data[16]) * flAccelScale; // Acceleration along yaw axis
- values[2] = LOAD16(data[13], data[14]) * flAccelScale; // Acceleration along roll axis
- SDL_SendJoystickSensor(timestamp, joystick, SDL_SENSOR_ACCEL, sensor_timestamp, values, 3);
- }
- SDL_memcpy(ctx->last_state, data, SDL_min(size, sizeof(ctx->last_state)));
- }
- static void HIDAPI_DriverFlydigi_HandlePacketV1(SDL_Joystick *joystick, SDL_DriverFlydigi_Context *ctx, Uint8 *data, int size)
- {
- if (data[0] != 0x04 || data[1] != 0xFE) {
- // We don't know how to handle this report, ignore it
- return;
- }
- if (joystick) {
- HIDAPI_DriverFlydigi_HandleStatePacketV1(joystick, ctx, data, size);
- }
- }
- static void HIDAPI_DriverFlydigi_HandleStatePacketV2(SDL_Joystick *joystick, SDL_DriverFlydigi_Context *ctx, Uint8 *data, int size)
- {
- Sint16 axis;
- Uint64 timestamp = SDL_GetTicksNS();
- Uint8 extra_button_index = SDL_GAMEPAD_NUM_BASE_FLYDIGI_BUTTONS;
- if (ctx->last_state[11] != data[11]) {
- Uint8 hat;
- switch (data[11] & 0x0F) {
- case 0x01u:
- hat = SDL_HAT_UP;
- break;
- case 0x02u | 0x01u:
- hat = SDL_HAT_RIGHTUP;
- break;
- case 0x02u:
- hat = SDL_HAT_RIGHT;
- break;
- case 0x02u | 0x04u:
- hat = SDL_HAT_RIGHTDOWN;
- break;
- case 0x04u:
- hat = SDL_HAT_DOWN;
- break;
- case 0x08u | 0x04u:
- hat = SDL_HAT_LEFTDOWN;
- break;
- case 0x08u:
- hat = SDL_HAT_LEFT;
- break;
- case 0x08u | 0x01u:
- hat = SDL_HAT_LEFTUP;
- break;
- default:
- hat = SDL_HAT_CENTERED;
- break;
- }
- SDL_SendJoystickHat(timestamp, joystick, 0, hat);
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_SOUTH, ((data[11] & 0x10) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_EAST, ((data[11] & 0x20) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_BACK, ((data[11] & 0x40) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_WEST, ((data[11] & 0x80) != 0));
- }
- if (ctx->last_state[12] != data[12]) {
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_NORTH, ((data[12] & 0x01) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_START, ((data[12] & 0x02) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_LEFT_SHOULDER, ((data[12] & 0x04) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_RIGHT_SHOULDER, ((data[12] & 0x08) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_LEFT_STICK, ((data[12] & 0x40) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_RIGHT_STICK, ((data[12] & 0x80) != 0));
- }
- if (ctx->last_state[13] != data[13]) {
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_FLYDIGI_M1, ((data[13] & 0x04) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_FLYDIGI_M2, ((data[13] & 0x08) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_FLYDIGI_M3, ((data[13] & 0x10) != 0));
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_FLYDIGI_M4, ((data[13] & 0x20) != 0));
- if (ctx->has_cz) {
- SDL_SendJoystickButton(timestamp, joystick, extra_button_index++, ((data[13] & 0x01) != 0));
- SDL_SendJoystickButton(timestamp, joystick, extra_button_index++, ((data[13] & 0x02) != 0));
- }
- if (ctx->has_lmrm) {
- SDL_SendJoystickButton(timestamp, joystick, extra_button_index++, ((data[13] & 0x40) != 0));
- SDL_SendJoystickButton(timestamp, joystick, extra_button_index++, ((data[13] & 0x80) != 0));
- }
- } else {
- if (ctx->has_cz) {
- extra_button_index += 2;
- }
- if (ctx->has_lmrm) {
- extra_button_index += 2;
- }
- }
- if (ctx->last_state[14] != data[14]) {
- SDL_SendJoystickButton(timestamp, joystick, SDL_GAMEPAD_BUTTON_GUIDE, ((data[14] & 0x08) != 0));
- if (ctx->has_circle) {
- SDL_SendJoystickButton(timestamp, joystick, extra_button_index++, ((data[14] & 0x01) != 0));
- }
- }
- axis = LOAD16(data[3], data[4]);
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFTX, axis);
- axis = -LOAD16(data[5], data[6]);
- if (axis <= -32768) {
- axis = 32767;
- }
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFTY, axis);
- axis = LOAD16(data[7], data[8]);
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHTX, axis);
- axis = -LOAD16(data[9], data[10]);
- if (axis <= -32768) {
- axis = 32767;
- }
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHTY, axis);
- #define READ_TRIGGER_AXIS(offset) \
- (Sint16)(((int)data[offset] * 257) - 32768)
- {
- axis = READ_TRIGGER_AXIS(15);
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_LEFT_TRIGGER, axis);
- axis = READ_TRIGGER_AXIS(16);
- SDL_SendJoystickAxis(timestamp, joystick, SDL_GAMEPAD_AXIS_RIGHT_TRIGGER, axis);
- }
- #undef READ_TRIGGER_AXIS
- if (ctx->sensors_enabled) {
- Uint64 sensor_timestamp;
- float values[3];
- // Advance the imu sensor time stamp based on the observed rate of receipt of packets in the testcontroller app.
- // This varies between Product ID and connection type.
- sensor_timestamp = ctx->sensor_timestamp_ns;
- ctx->sensor_timestamp_ns += ctx->sensor_timestamp_step_ns;
- const float flGyroScale = ctx->gyroScale;
- values[0] = HIDAPI_RemapVal((float)LOAD16(data[17], data[18]), INT16_MIN, INT16_MAX, -flGyroScale, flGyroScale);
- values[1] = HIDAPI_RemapVal((float)LOAD16(data[21], data[22]), INT16_MIN, INT16_MAX, -flGyroScale, flGyroScale);
- values[2] = HIDAPI_RemapVal(-(float)LOAD16(data[19], data[20]), INT16_MIN, INT16_MAX, -flGyroScale, flGyroScale);
- SDL_SendJoystickSensor(timestamp, joystick, SDL_SENSOR_GYRO, sensor_timestamp, values, 3);
- const float flAccelScale = ctx->accelScale;
- values[0] = LOAD16(data[23], data[24]) * flAccelScale; // Acceleration along pitch axis
- values[1] = LOAD16(data[27], data[28]) * flAccelScale; // Acceleration along yaw axis
- values[2] = -LOAD16(data[25], data[26]) * flAccelScale; // Acceleration along roll axis
- SDL_SendJoystickSensor(timestamp, joystick, SDL_SENSOR_ACCEL, sensor_timestamp, values, 3);
- }
- SDL_memcpy(ctx->last_state, data, SDL_min(size, sizeof(ctx->last_state)));
- }
- static void HIDAPI_DriverFlydigi_HandleStatusUpdate(SDL_HIDAPI_Device *device, Uint8 *data, int size)
- {
- // The status changed, see if we can acquire the controller now
- SDL_HIDAPI_Flydigi_SendStatusRequest(device);
- }
- static void HIDAPI_DriverFlydigi_HandlePacketV2(SDL_Joystick *joystick, SDL_DriverFlydigi_Context *ctx, Uint8 *data, int size)
- {
- if (size > 0 && data[0] != 0x5A) {
- // If first byte is not 0x5A, it must be REPORT_ID, we need to remove it.
- ++data;
- --size;
- }
- if (size < 31 || data[0] != FLYDIGI_V2_MAGIC1 || data[1] != FLYDIGI_V2_MAGIC2) {
- // We don't know how to handle this report, ignore it
- return;
- }
- switch (data[2]) {
- case FLYDIGI_V2_GET_INFO_COMMAND:
- if (joystick) {
- HIDAPI_DriverFlydigi_HandleInfoResponse(joystick, ctx, data, size);
- }
- break;
- case FLYDIGI_V2_SET_STATUS_COMMAND:
- HIDAPI_DriverFlydigi_HandleStatusUpdate(ctx->device, data, size);
- break;
- case FLYDIGI_V2_GET_STATUS_COMMAND:
- HIDAPI_DriverFlydigi_HandleStatusResponse(ctx->device, data, size);
- break;
- case FLYDIGI_V2_ACQUIRE_CONTROLLER_COMMAND:
- HIDAPI_DriverFlydigi_HandleAcquireResponse(ctx->device, data, size);
- break;
- case FLYDIGI_V2_INPUT_REPORT:
- if (joystick) {
- HIDAPI_DriverFlydigi_HandleStatePacketV2(joystick, ctx, data, size);
- }
- break;
- default:
- // We don't recognize this command, ignore it
- break;
- }
- }
- static bool HIDAPI_DriverFlydigi_UpdateDevice(SDL_HIDAPI_Device *device)
- {
- SDL_DriverFlydigi_Context *ctx = (SDL_DriverFlydigi_Context *)device->context;
- SDL_Joystick *joystick = NULL;
- Uint8 data[USB_PACKET_LENGTH];
- int size = 0;
- Uint64 now = SDL_GetTicks();
- if (device->num_joysticks > 0) {
- joystick = SDL_GetJoystickFromID(device->joysticks[0]);
- }
- if (device->vendor_id == USB_VENDOR_FLYDIGI_V2 && joystick) {
- if (!ctx->next_heartbeat || now >= ctx->next_heartbeat) {
- SDL_HIDAPI_Flydigi_SendAcquireRequest(device, true);
- SDL_HIDAPI_Flydigi_SendInfoRequest(device);
- ctx->next_heartbeat = now + FLYDIGI_ACQUIRE_CONTROLLER_HEARTBEAT_TIME;
- }
- }
- while ((size = SDL_hid_read_timeout(device->dev, data, sizeof(data), 0)) > 0) {
- #ifdef DEBUG_FLYDIGI_PROTOCOL
- HIDAPI_DumpPacket("Flydigi packet: size = %d", data, size);
- #endif
- ctx->last_packet = now;
- if (device->vendor_id == USB_VENDOR_FLYDIGI_V1) {
- HIDAPI_DriverFlydigi_HandlePacketV1(joystick, ctx, data, size);
- } else {
- HIDAPI_DriverFlydigi_HandlePacketV2(joystick, ctx, data, size);
- }
- }
- if (device->vendor_id == USB_VENDOR_FLYDIGI_V2) {
- // If we haven't gotten a packet in a while, check to make sure we can still acquire it
- const int INPUT_TIMEOUT_MS = 100;
- if (now >= (ctx->last_packet + INPUT_TIMEOUT_MS)) {
- ctx->next_heartbeat = now;
- }
- }
- if (size < 0 && device->num_joysticks > 0) {
- // Read error, device is disconnected
- HIDAPI_JoystickDisconnected(device, device->joysticks[0]);
- }
- return (size >= 0);
- }
- static void HIDAPI_DriverFlydigi_CloseJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick)
- {
- // Don't unacquire the controller, someone else might be using it too.
- // The controller will automatically unacquire itself after a little while
- //SDL_HIDAPI_Flydigi_SendAcquireRequest(device, false);
- }
- static void HIDAPI_DriverFlydigi_FreeDevice(SDL_HIDAPI_Device *device)
- {
- }
- SDL_HIDAPI_DeviceDriver SDL_HIDAPI_DriverFlydigi = {
- SDL_HINT_JOYSTICK_HIDAPI_FLYDIGI,
- true,
- HIDAPI_DriverFlydigi_RegisterHints,
- HIDAPI_DriverFlydigi_UnregisterHints,
- HIDAPI_DriverFlydigi_IsEnabled,
- HIDAPI_DriverFlydigi_IsSupportedDevice,
- HIDAPI_DriverFlydigi_InitDevice,
- HIDAPI_DriverFlydigi_GetDevicePlayerIndex,
- HIDAPI_DriverFlydigi_SetDevicePlayerIndex,
- HIDAPI_DriverFlydigi_UpdateDevice,
- HIDAPI_DriverFlydigi_OpenJoystick,
- HIDAPI_DriverFlydigi_RumbleJoystick,
- HIDAPI_DriverFlydigi_RumbleJoystickTriggers,
- HIDAPI_DriverFlydigi_GetJoystickCapabilities,
- HIDAPI_DriverFlydigi_SetJoystickLED,
- HIDAPI_DriverFlydigi_SendJoystickEffect,
- HIDAPI_DriverFlydigi_SetJoystickSensorsEnabled,
- HIDAPI_DriverFlydigi_CloseJoystick,
- HIDAPI_DriverFlydigi_FreeDevice,
- };
- #endif // SDL_JOYSTICK_HIDAPI_FLYDIGI
- #endif // SDL_JOYSTICK_HIDAPI
|