kc3-lang/SDL/src/joystick/hidapi/SDL_hidapi_ps5.c

• Show log

  Commit

• Hash : 3a3aaac2
  Author :
  Date : 2020-11-06T11:30:52
  

  Added 4 auxiliary buttons to the game controller API Xbox Elite controllers use AUX1-AUX4 to represent the paddle buttons when using the HIDAPI driver PS4 and PS5 controllers use AUX1 to represent the touchpad button Nintendo Switch Pro controllers use AUX1 to represent the capture button

Download

• src/joystick/hidapi/SDL_hidapi_ps5.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: */
  

Download