mirror of https://github.com/encounter/SDL.git
416 lines
15 KiB
C
416 lines
15 KiB
C
/*
|
|
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 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_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: */
|