#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
#if 0#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
};
#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)
#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)
#define SENSOR_INTERVAL_VADER5_PRO_RATE_HZ 500
#define SENSOR_INTERVAL_VADER5_PRO_NS (SDL_NS_PER_SECOND / SENSOR_INTERVAL_VADER5_PRO_RATE_HZ)
#define SENSOR_INTERVAL_APEX5_DONGLE_RATE_HZ 295
#define SENSOR_INTERVAL_APEX5_DONGLE_NS (SDL_NS_PER_SECOND / SENSOR_INTERVAL_APEX5_DONGLE_RATE_HZ)
#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; Uint64 sensor_timestamp_step_ns; 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) {
return true;
}
} else {
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;
default:
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;
}
}
break;
}
device->guid.data[15] = controller_type;
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:
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_VADER2:
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 bool HIDAPI_DriverFlydigi_InitControllerV1(SDL_HIDAPI_Device *device)
{
SDL_DriverFlydigi_Context *ctx = (SDL_DriverFlydigi_Context *)device->context;
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 };
(void)SDL_hid_write(device->dev, request, sizeof(request));
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);
if (ctx->firmware_version >= 0x6400) {
switch (data[13]) {
case 0:
ctx->wireless = true;
break;
case 1:
ctx->wireless = false;
break;
default:
break;
}
}
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) {
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 (SDL_hid_write(device->dev, 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;
percent = level * 20;
break;
case 1:
state = SDL_POWERSTATE_CHARGING;
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 (SDL_hid_write(device->dev, 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 {
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 (SDL_hid_write(device->dev, 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) {
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");
}
Uint16 min_firmware_version;
ctx->firmware_version = LOAD16(data[16], data[15]);
switch (device->product_id) {
case USB_PRODUCT_FLYDIGI_V2_APEX:
min_firmware_version = 0x7031;
break;
case USB_PRODUCT_FLYDIGI_V2_VADER:
min_firmware_version = 0x7141;
break;
default:
min_firmware_version = 0;
break;
}
if (ctx->firmware_version < min_firmware_version) {
return SDL_SetError("Unsupported firmware version");
}
switch (data[6]) {
case 1:
ctx->wireless = false;
break;
case 2:
ctx->wireless = true;
break;
default:
break;
}
ctx->deviceID = data[5];
HIDAPI_DriverFlydigi_UpdateDeviceIdentity(device);
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);
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));
}
#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];
sensor_timestamp = ctx->sensor_timestamp_ns;
ctx->sensor_timestamp_ns += ctx->sensor_timestamp_step_ns;
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; values[1] = LOAD16(data[15], data[16]) * flAccelScale; values[2] = LOAD16(data[13], data[14]) * flAccelScale; 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) {
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];
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; values[1] = LOAD16(data[27], data[28]) * flAccelScale; values[2] = -LOAD16(data[25], data[26]) * flAccelScale; 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)
{
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) {
++data;
--size;
}
if (size < 31 || data[0] != FLYDIGI_V2_MAGIC1 || data[1] != FLYDIGI_V2_MAGIC2) {
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:
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) {
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) {
HIDAPI_JoystickDisconnected(device, device->joysticks[0]);
}
return (size >= 0);
}
static void HIDAPI_DriverFlydigi_CloseJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick)
{
}
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
#endif