| /* |
| Simple DirectMedia Layer |
| Copyright (C) 1997-2020 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_hints.h" |
| #include "SDL_events.h" |
| #include "SDL_joystick.h" |
| #include "SDL_gamecontroller.h" |
| #include "../SDL_sysjoystick.h" |
| #include "SDL_hidapijoystick_c.h" |
| |
| |
| #ifdef SDL_JOYSTICK_HIDAPI_PS5 |
| |
| typedef struct |
| { |
| Uint8 ucLeftJoystickX; |
| Uint8 ucLeftJoystickY; |
| Uint8 ucRightJoystickX; |
| Uint8 ucRightJoystickY; |
| Uint8 rgucButtonsHatAndCounter[ 3 ]; |
| Uint8 ucTriggerLeft; |
| Uint8 ucTriggerRight; |
| } PS5SimpleStatePacket_t; |
| |
| typedef struct |
| { |
| Uint8 ucLeftJoystickX; |
| Uint8 ucLeftJoystickY; |
| Uint8 ucRightJoystickX; |
| Uint8 ucRightJoystickY; |
| Uint8 ucTriggerLeft; |
| Uint8 ucTriggerRight; |
| Uint8 ucCounter; |
| Uint8 rgucButtonsAndHat[ 3 ]; |
| Uint8 rgucUnknown[ 53 ]; |
| } PS5StatePacket_t; |
| |
| typedef struct { |
| union |
| { |
| PS5SimpleStatePacket_t simple; |
| PS5StatePacket_t state; |
| } last_state; |
| } SDL_DriverPS5_Context; |
| |
| |
| /* Define this if you want to log all packets from the controller */ |
| /*#define DEBUG_PS5_PROTOCOL*/ |
| |
| static SDL_bool |
| HIDAPI_DriverPS5_IsSupportedDevice(const char *name, SDL_GameControllerType type, Uint16 vendor_id, Uint16 product_id, Uint16 version, int interface_number, int interface_class, int interface_subclass, int interface_protocol) |
| { |
| return (type == SDL_CONTROLLER_TYPE_PS5); |
| } |
| |
| static const char * |
| HIDAPI_DriverPS5_GetDeviceName(Uint16 vendor_id, Uint16 product_id) |
| { |
| if (vendor_id == USB_VENDOR_SONY) { |
| return "PS5 Controller"; |
| } |
| return NULL; |
| } |
| |
| static SDL_bool |
| HIDAPI_DriverPS5_InitDevice(SDL_HIDAPI_Device *device) |
| { |
| return HIDAPI_JoystickConnected(device, NULL, SDL_FALSE); |
| } |
| |
| static int |
| HIDAPI_DriverPS5_GetDevicePlayerIndex(SDL_HIDAPI_Device *device, SDL_JoystickID instance_id) |
| { |
| return -1; |
| } |
| |
| static void |
| HIDAPI_DriverPS5_SetDevicePlayerIndex(SDL_HIDAPI_Device *device, SDL_JoystickID instance_id, int player_index) |
| { |
| } |
| |
| static SDL_bool |
| HIDAPI_DriverPS5_OpenJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick) |
| { |
| SDL_DriverPS5_Context *ctx; |
| |
| ctx = (SDL_DriverPS5_Context *)SDL_calloc(1, sizeof(*ctx)); |
| if (!ctx) { |
| SDL_OutOfMemory(); |
| return SDL_FALSE; |
| } |
| |
| device->dev = hid_open_path(device->path, 0); |
| if (!device->dev) { |
| SDL_free(ctx); |
| SDL_SetError("Couldn't open %s", device->path); |
| return SDL_FALSE; |
| } |
| device->context = ctx; |
| |
| /* Initialize the joystick capabilities */ |
| joystick->nbuttons = 16; |
| joystick->naxes = SDL_CONTROLLER_AXIS_MAX; |
| |
| return SDL_TRUE; |
| } |
| |
| static int |
| HIDAPI_DriverPS5_RumbleJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, Uint16 low_frequency_rumble, Uint16 high_frequency_rumble) |
| { |
| return SDL_Unsupported(); |
| } |
| |
| static int |
| HIDAPI_DriverPS5_RumbleJoystickTriggers(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, Uint16 left_rumble, Uint16 right_rumble) |
| { |
| return SDL_Unsupported(); |
| } |
| |
| static SDL_bool |
| HIDAPI_DriverPS5_HasJoystickLED(SDL_HIDAPI_Device *device, SDL_Joystick *joystick) |
| { |
| return SDL_FALSE; |
| } |
| |
| static int |
| HIDAPI_DriverPS5_SetJoystickLED(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, Uint8 red, Uint8 green, Uint8 blue) |
| { |
| return SDL_Unsupported(); |
| } |
| |
| static void |
| HIDAPI_DriverPS5_HandleSimpleStatePacket(SDL_Joystick *joystick, hid_device *dev, SDL_DriverPS5_Context *ctx, PS5SimpleStatePacket_t *packet) |
| { |
| Sint16 axis; |
| |
| if (ctx->last_state.simple.rgucButtonsHatAndCounter[0] != packet->rgucButtonsHatAndCounter[0]) { |
| { |
| Uint8 data = (packet->rgucButtonsHatAndCounter[0] >> 4); |
| |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_X, (data & 0x01) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_A, (data & 0x02) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_B, (data & 0x04) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_Y, (data & 0x08) ? SDL_PRESSED : SDL_RELEASED); |
| } |
| { |
| Uint8 data = (packet->rgucButtonsHatAndCounter[0] & 0x0F); |
| SDL_bool dpad_up = SDL_FALSE; |
| SDL_bool dpad_down = SDL_FALSE; |
| SDL_bool dpad_left = SDL_FALSE; |
| SDL_bool dpad_right = SDL_FALSE; |
| |
| switch (data) { |
| case 0: |
| dpad_up = SDL_TRUE; |
| break; |
| case 1: |
| dpad_up = SDL_TRUE; |
| dpad_right = SDL_TRUE; |
| break; |
| case 2: |
| dpad_right = SDL_TRUE; |
| break; |
| case 3: |
| dpad_right = SDL_TRUE; |
| dpad_down = SDL_TRUE; |
| break; |
| case 4: |
| dpad_down = SDL_TRUE; |
| break; |
| case 5: |
| dpad_left = SDL_TRUE; |
| dpad_down = SDL_TRUE; |
| break; |
| case 6: |
| dpad_left = SDL_TRUE; |
| break; |
| case 7: |
| dpad_up = SDL_TRUE; |
| dpad_left = SDL_TRUE; |
| break; |
| default: |
| break; |
| } |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_DPAD_DOWN, dpad_down); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_DPAD_UP, dpad_up); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_DPAD_RIGHT, dpad_right); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_DPAD_LEFT, dpad_left); |
| } |
| } |
| |
| if (ctx->last_state.simple.rgucButtonsHatAndCounter[1] != packet->rgucButtonsHatAndCounter[1]) { |
| Uint8 data = packet->rgucButtonsHatAndCounter[1]; |
| |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_LEFTSHOULDER, (data & 0x01) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_RIGHTSHOULDER, (data & 0x02) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_BACK, (data & 0x10) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_START, (data & 0x20) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_LEFTSTICK, (data & 0x40) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_RIGHTSTICK, (data & 0x80) ? SDL_PRESSED : SDL_RELEASED); |
| } |
| |
| if (ctx->last_state.simple.rgucButtonsHatAndCounter[2] != packet->rgucButtonsHatAndCounter[2]) { |
| Uint8 data = (packet->rgucButtonsHatAndCounter[2] & 0x03); |
| |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_GUIDE, (data & 0x01) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, 15, (data & 0x02) ? SDL_PRESSED : SDL_RELEASED); |
| } |
| |
| axis = ((int)packet->ucTriggerLeft * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_TRIGGERLEFT, axis); |
| axis = ((int)packet->ucTriggerRight * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_TRIGGERRIGHT, axis); |
| axis = ((int)packet->ucLeftJoystickX * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_LEFTX, axis); |
| axis = ((int)packet->ucLeftJoystickY * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_LEFTY, axis); |
| axis = ((int)packet->ucRightJoystickX * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_RIGHTX, axis); |
| axis = ((int)packet->ucRightJoystickY * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_RIGHTY, axis); |
| |
| SDL_memcpy(&ctx->last_state.simple, packet, sizeof(ctx->last_state.simple)); |
| } |
| |
| static void |
| HIDAPI_DriverPS5_HandleStatePacket(SDL_Joystick *joystick, hid_device *dev, SDL_DriverPS5_Context *ctx, PS5StatePacket_t *packet) |
| { |
| Sint16 axis; |
| |
| if (ctx->last_state.state.rgucButtonsAndHat[0] != packet->rgucButtonsAndHat[0]) { |
| { |
| Uint8 data = (packet->rgucButtonsAndHat[0] >> 4); |
| |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_X, (data & 0x01) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_A, (data & 0x02) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_B, (data & 0x04) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_Y, (data & 0x08) ? SDL_PRESSED : SDL_RELEASED); |
| } |
| { |
| Uint8 data = (packet->rgucButtonsAndHat[0] & 0x0F); |
| SDL_bool dpad_up = SDL_FALSE; |
| SDL_bool dpad_down = SDL_FALSE; |
| SDL_bool dpad_left = SDL_FALSE; |
| SDL_bool dpad_right = SDL_FALSE; |
| |
| switch (data) { |
| case 0: |
| dpad_up = SDL_TRUE; |
| break; |
| case 1: |
| dpad_up = SDL_TRUE; |
| dpad_right = SDL_TRUE; |
| break; |
| case 2: |
| dpad_right = SDL_TRUE; |
| break; |
| case 3: |
| dpad_right = SDL_TRUE; |
| dpad_down = SDL_TRUE; |
| break; |
| case 4: |
| dpad_down = SDL_TRUE; |
| break; |
| case 5: |
| dpad_left = SDL_TRUE; |
| dpad_down = SDL_TRUE; |
| break; |
| case 6: |
| dpad_left = SDL_TRUE; |
| break; |
| case 7: |
| dpad_up = SDL_TRUE; |
| dpad_left = SDL_TRUE; |
| break; |
| default: |
| break; |
| } |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_DPAD_DOWN, dpad_down); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_DPAD_UP, dpad_up); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_DPAD_RIGHT, dpad_right); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_DPAD_LEFT, dpad_left); |
| } |
| } |
| |
| if (ctx->last_state.state.rgucButtonsAndHat[1] != packet->rgucButtonsAndHat[1]) { |
| Uint8 data = packet->rgucButtonsAndHat[1]; |
| |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_LEFTSHOULDER, (data & 0x01) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_RIGHTSHOULDER, (data & 0x02) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_BACK, (data & 0x10) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_START, (data & 0x20) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_LEFTSTICK, (data & 0x40) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_RIGHTSTICK, (data & 0x80) ? SDL_PRESSED : SDL_RELEASED); |
| } |
| |
| if (ctx->last_state.state.rgucButtonsAndHat[2] != packet->rgucButtonsAndHat[2]) { |
| Uint8 data = (packet->rgucButtonsAndHat[2] & 0x03); |
| |
| SDL_PrivateJoystickButton(joystick, SDL_CONTROLLER_BUTTON_GUIDE, (data & 0x01) ? SDL_PRESSED : SDL_RELEASED); |
| SDL_PrivateJoystickButton(joystick, 15, (data & 0x02) ? SDL_PRESSED : SDL_RELEASED); |
| } |
| |
| axis = ((int)packet->ucTriggerLeft * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_TRIGGERLEFT, axis); |
| axis = ((int)packet->ucTriggerRight * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_TRIGGERRIGHT, axis); |
| axis = ((int)packet->ucLeftJoystickX * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_LEFTX, axis); |
| axis = ((int)packet->ucLeftJoystickY * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_LEFTY, axis); |
| axis = ((int)packet->ucRightJoystickX * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_RIGHTX, axis); |
| axis = ((int)packet->ucRightJoystickY * 257) - 32768; |
| SDL_PrivateJoystickAxis(joystick, SDL_CONTROLLER_AXIS_RIGHTY, axis); |
| |
| SDL_memcpy(&ctx->last_state.state, packet, sizeof(ctx->last_state.state)); |
| } |
| |
| static SDL_bool |
| HIDAPI_DriverPS5_UpdateDevice(SDL_HIDAPI_Device *device) |
| { |
| SDL_DriverPS5_Context *ctx = (SDL_DriverPS5_Context *)device->context; |
| SDL_Joystick *joystick = NULL; |
| Uint8 data[USB_PACKET_LENGTH]; |
| int size; |
| |
| if (device->num_joysticks > 0) { |
| joystick = SDL_JoystickFromInstanceID(device->joysticks[0]); |
| } |
| if (!joystick) { |
| return SDL_FALSE; |
| } |
| |
| while ((size = hid_read_timeout(device->dev, data, sizeof(data), 0)) > 0) { |
| #ifdef DEBUG_PS5_PROTOCOL |
| HIDAPI_DumpPacket("PS5 packet: size = %d", data, size); |
| #endif |
| switch (data[0]) { |
| case 0x01: |
| if (size == 10) { |
| HIDAPI_DriverPS5_HandleSimpleStatePacket(joystick, device->dev, ctx, (PS5SimpleStatePacket_t *)&data[1]); |
| } else { |
| HIDAPI_DriverPS5_HandleStatePacket(joystick, device->dev, ctx, (PS5StatePacket_t *)&data[1]); |
| } |
| break; |
| default: |
| #ifdef DEBUG_JOYSTICK |
| SDL_Log("Unknown PS5 packet: 0x%.2x\n", data[0]); |
| #endif |
| break; |
| } |
| } |
| |
| if (size < 0) { |
| /* Read error, device is disconnected */ |
| HIDAPI_JoystickDisconnected(device, joystick->instance_id, SDL_FALSE); |
| } |
| return (size >= 0); |
| } |
| |
| static void |
| HIDAPI_DriverPS5_CloseJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick) |
| { |
| hid_close(device->dev); |
| device->dev = NULL; |
| |
| SDL_free(device->context); |
| device->context = NULL; |
| } |
| |
| static void |
| HIDAPI_DriverPS5_FreeDevice(SDL_HIDAPI_Device *device) |
| { |
| } |
| |
| SDL_HIDAPI_DeviceDriver SDL_HIDAPI_DriverPS5 = |
| { |
| SDL_HINT_JOYSTICK_HIDAPI_PS5, |
| SDL_TRUE, |
| HIDAPI_DriverPS5_IsSupportedDevice, |
| HIDAPI_DriverPS5_GetDeviceName, |
| HIDAPI_DriverPS5_InitDevice, |
| HIDAPI_DriverPS5_GetDevicePlayerIndex, |
| HIDAPI_DriverPS5_SetDevicePlayerIndex, |
| HIDAPI_DriverPS5_UpdateDevice, |
| HIDAPI_DriverPS5_OpenJoystick, |
| HIDAPI_DriverPS5_RumbleJoystick, |
| HIDAPI_DriverPS5_RumbleJoystickTriggers, |
| HIDAPI_DriverPS5_HasJoystickLED, |
| HIDAPI_DriverPS5_SetJoystickLED, |
| HIDAPI_DriverPS5_CloseJoystick, |
| HIDAPI_DriverPS5_FreeDevice, |
| NULL |
| }; |
| |
| #endif /* SDL_JOYSTICK_HIDAPI_PS5 */ |
| |
| #endif /* SDL_JOYSTICK_HIDAPI */ |
| |
| /* vi: set ts=4 sw=4 expandtab: */ |
