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

• Show log

  Commit

• Hash : 4c9628a0
  Author :
  Date : 2019-12-30T17:56:56
  

  Fixed GameCube controller axis and trigger ranges and X and B button being swapped

Download

• src/joystick/hidapi/SDL_hidapi_gamecube.c

• /*
    Simple DirectMedia Layer
    Copyright (C) 1997-2019 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_log.h"
  #include "SDL_events.h"
  #include "SDL_timer.h"
  #include "SDL_haptic.h"
  #include "SDL_joystick.h"
  #include "SDL_gamecontroller.h"
  #include "../SDL_sysjoystick.h"
  #include "SDL_hidapijoystick_c.h"
  
  
  #ifdef SDL_JOYSTICK_HIDAPI_GAMECUBE
  
  #define MAX_CONTROLLERS 4
  
  typedef struct {
      SDL_JoystickID joysticks[MAX_CONTROLLERS];
      Uint8 wireless[MAX_CONTROLLERS];
      Uint8 min_axis[MAX_CONTROLLERS*SDL_CONTROLLER_AXIS_MAX];
      Uint8 max_axis[MAX_CONTROLLERS*SDL_CONTROLLER_AXIS_MAX];
      Uint8 rumbleAllowed[MAX_CONTROLLERS];
      Uint8 rumble[1+MAX_CONTROLLERS];
      Uint32 rumbleExpiration[MAX_CONTROLLERS];
      /* Without this variable, hid_write starts to lag a TON */
      SDL_bool rumbleUpdate;
  } SDL_DriverGameCube_Context;
  
  static SDL_bool
  HIDAPI_DriverGameCube_IsSupportedDevice(Uint16 vendor_id, Uint16 product_id, Uint16 version, int interface_number, const char *name)
  {
      if (vendor_id == 0x057e && product_id == 0x0337) {
          /* Nintendo Co., Ltd.  Wii U GameCube Controller Adapter */
          return SDL_TRUE;
      }
      return SDL_FALSE;
  }
  
  static const char *
  HIDAPI_DriverGameCube_GetDeviceName(Uint16 vendor_id, Uint16 product_id)
  {
      return "Nintendo GameCube Controller";
  }
  
  static void
  ResetAxisRange(SDL_DriverGameCube_Context *ctx, int joystick_index)
  {
      SDL_memset(&ctx->min_axis[joystick_index*SDL_CONTROLLER_AXIS_MAX], 128-88, SDL_CONTROLLER_AXIS_MAX);
      SDL_memset(&ctx->max_axis[joystick_index*SDL_CONTROLLER_AXIS_MAX], 128+88, SDL_CONTROLLER_AXIS_MAX);
  
      /* Trigger axes may have a higher resting value */
      ctx->min_axis[joystick_index*SDL_CONTROLLER_AXIS_MAX+SDL_CONTROLLER_AXIS_TRIGGERLEFT] = 40;
      ctx->min_axis[joystick_index*SDL_CONTROLLER_AXIS_MAX+SDL_CONTROLLER_AXIS_TRIGGERRIGHT] = 40;
  }
  
  static float fsel(float fComparand, float fValGE, float fLT)
  {
      return fComparand >= 0 ? fValGE : fLT;
  }
  
  static float RemapVal(float val, float A, float B, float C, float D)
  {
      if (A == B) {
          return fsel(val - B , D , C);
      }
      if (val < A) {
          val = A;
      }
      if (val > B) {
          val = B;
      }
      return C + (D - C) * (val - A) / (B - A);
  }
  
  static SDL_bool
  HIDAPI_DriverGameCube_InitDevice(SDL_HIDAPI_Device *device)
  {
      SDL_DriverGameCube_Context *ctx;
      Uint8 packet[37];
      Uint8 *curSlot;
      Uint8 i;
      int size;
      Uint8 initMagic = 0x13;
      Uint8 rumbleMagic = 0x11;
  
      ctx = (SDL_DriverGameCube_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;
  
      ctx->joysticks[0] = -1;
      ctx->joysticks[1] = -1;
      ctx->joysticks[2] = -1;
      ctx->joysticks[3] = -1;
      ctx->rumble[0] = rumbleMagic;
  
      /* This is all that's needed to initialize the device. Really! */
      if (hid_write(device->dev, &initMagic, sizeof(initMagic)) != sizeof(initMagic)) {
          SDL_SetError("Couldn't initialize WUP-028");
          goto error;
      }
  
      /* Wait for the adapter to initialize */
      SDL_Delay(10);
  
      /* Add all the applicable joysticks */
      while ((size = hid_read_timeout(device->dev, packet, sizeof(packet), 0)) > 0) {
          if (size < 37 || packet[0] != 0x21) {
              continue; /* Nothing to do yet...? */
          }
  
          /* Go through all 4 slots */
          curSlot = packet + 1;
          for (i = 0; i < MAX_CONTROLLERS; i += 1, curSlot += 9) {
              ctx->wireless[i] = (curSlot[0] & 0x20) != 0;
  
              /* Only allow rumble if the adapter's second USB cable is connected */
              ctx->rumbleAllowed[i] = (curSlot[0] & 0x04) != 0 && !ctx->wireless[i];
  
              if (curSlot[0] & 0x30) { /* 0x10 - Wired, 0x20 - Wireless */
                  if (ctx->joysticks[i] == -1) {
                      ResetAxisRange(ctx, i);
                      HIDAPI_JoystickConnected(device, &ctx->joysticks[i]);
                  }
              } else {
                  if (ctx->joysticks[i] != -1) {
                      HIDAPI_JoystickDisconnected(device, ctx->joysticks[i]);
                      ctx->joysticks[i] = -1;
                  }
                  continue;
              }
          }
      }
  
      return SDL_TRUE;
  
  error:
      if (device->dev) {
          hid_close(device->dev);
          device->dev = NULL;
      }
      if (device->context) {
          SDL_free(device->context);
          device->context = NULL;
      }
      return SDL_FALSE;
  }
  
  static int
  HIDAPI_DriverGameCube_GetDevicePlayerIndex(SDL_HIDAPI_Device *device, SDL_JoystickID instance_id)
  {
      SDL_DriverGameCube_Context *ctx = (SDL_DriverGameCube_Context *)device->context;
      Uint8 i;
  
      for (i = 0; i < 4; ++i) {
          if (instance_id == ctx->joysticks[i]) {
              return i;
          }
      }
      return -1;
  }
  
  static void
  HIDAPI_DriverGameCube_SetDevicePlayerIndex(SDL_HIDAPI_Device *device, SDL_JoystickID instance_id, int player_index)
  {
  }
  
  static SDL_bool
  HIDAPI_DriverGameCube_UpdateDevice(SDL_HIDAPI_Device *device)
  {
      SDL_DriverGameCube_Context *ctx = (SDL_DriverGameCube_Context *)device->context;
      SDL_Joystick *joystick;
      Uint8 packet[37];
      Uint8 *curSlot;
      Uint8 i;
      Sint16 axis_value;
      int size;
  
      /* Read input packet */
      while ((size = hid_read_timeout(device->dev, packet, sizeof(packet), 0)) > 0) {
          if (size < 37 || packet[0] != 0x21) {
              continue; /* Nothing to do right now...? */
          }
  
          /* Go through all 4 slots */
          curSlot = packet + 1;
          for (i = 0; i < MAX_CONTROLLERS; i += 1, curSlot += 9) {
              ctx->wireless[i] = (curSlot[0] & 0x20) != 0;
  
              /* Only allow rumble if the adapter's second USB cable is connected */
              ctx->rumbleAllowed[i] = (curSlot[0] & 0x04) != 0 && !ctx->wireless[i];
  
              if (curSlot[0] & 0x30) { /* 0x10 - Wired, 0x20 - Wireless */
                  if (ctx->joysticks[i] == -1) {
                      ResetAxisRange(ctx, i);
                      HIDAPI_JoystickConnected(device, &ctx->joysticks[i]);
                  }
                  joystick = SDL_JoystickFromInstanceID(ctx->joysticks[i]);
  
                  /* Hasn't been opened yet, skip */
                  if (joystick == NULL) {
                      continue;
                  }
              } else {
                  if (ctx->joysticks[i] != -1) {
                      HIDAPI_JoystickDisconnected(device, ctx->joysticks[i]);
                      ctx->joysticks[i] = -1;
                  }
                  continue;
              }
  
              #define READ_BUTTON(off, flag, button) \
                  SDL_PrivateJoystickButton( \
                      joystick, \
                      button, \
                      (curSlot[off] & flag) ? SDL_PRESSED : SDL_RELEASED \
                  );
              READ_BUTTON(1, 0x01, 0) /* A */
              READ_BUTTON(1, 0x04, 1) /* B */
              READ_BUTTON(1, 0x02, 2) /* X */
              READ_BUTTON(1, 0x08, 3) /* Y */
              READ_BUTTON(1, 0x10, 4) /* DPAD_LEFT */
              READ_BUTTON(1, 0x20, 5) /* DPAD_RIGHT */
              READ_BUTTON(1, 0x40, 6) /* DPAD_DOWN */
              READ_BUTTON(1, 0x80, 7) /* DPAD_UP */
              READ_BUTTON(2, 0x01, 8) /* START */
              READ_BUTTON(2, 0x02, 9) /* RIGHTSHOULDER */
              /* These two buttons are for the bottoms of the analog triggers.
               * More than likely, you're going to want to read the axes instead!
               * -flibit
               */
              READ_BUTTON(2, 0x04, 10) /* TRIGGERRIGHT */
              READ_BUTTON(2, 0x08, 11) /* TRIGGERLEFT */
              #undef READ_BUTTON
  
              #define READ_AXIS(off, axis) \
                  if (axis < SDL_CONTROLLER_AXIS_TRIGGERLEFT) \
                  if (curSlot[off] < ctx->min_axis[i*SDL_CONTROLLER_AXIS_MAX+axis]) ctx->min_axis[i*SDL_CONTROLLER_AXIS_MAX+axis] = curSlot[off]; \
                  if (curSlot[off] > ctx->max_axis[i*SDL_CONTROLLER_AXIS_MAX+axis]) ctx->max_axis[i*SDL_CONTROLLER_AXIS_MAX+axis] = curSlot[off]; \
                  axis_value = (Sint16)(RemapVal(curSlot[off], ctx->min_axis[i*SDL_CONTROLLER_AXIS_MAX+axis], ctx->max_axis[i*SDL_CONTROLLER_AXIS_MAX+axis], SDL_MIN_SINT16, SDL_MAX_SINT16)); \
                  SDL_PrivateJoystickAxis( \
                      joystick, \
                      axis, axis_value \
                  );
              READ_AXIS(3, SDL_CONTROLLER_AXIS_LEFTX)
              READ_AXIS(4, SDL_CONTROLLER_AXIS_LEFTY)
              READ_AXIS(5, SDL_CONTROLLER_AXIS_RIGHTX)
              READ_AXIS(6, SDL_CONTROLLER_AXIS_RIGHTY)
              READ_AXIS(7, SDL_CONTROLLER_AXIS_TRIGGERLEFT)
              READ_AXIS(8, SDL_CONTROLLER_AXIS_TRIGGERRIGHT)
              #undef READ_AXIS
          }
      }
  
      /* Write rumble packet */
      for (i = 0; i < MAX_CONTROLLERS; i += 1) {
          if (ctx->rumbleExpiration[i] || (ctx->rumble[1 + i] && !ctx->rumbleAllowed[i])) {
              Uint32 now = SDL_GetTicks();
              if (SDL_TICKS_PASSED(now, ctx->rumbleExpiration[i]) || !ctx->rumbleAllowed[i]) {
                  ctx->rumble[1 + i] = 0;
                  ctx->rumbleExpiration[i] = 0;
                  ctx->rumbleUpdate = SDL_TRUE;
              }
          }
      }
      if (ctx->rumbleUpdate) {
          hid_write(device->dev, ctx->rumble, sizeof(ctx->rumble));
          ctx->rumbleUpdate = SDL_FALSE;
      }
  
      /* If we got here, nothing bad happened! */
      return SDL_TRUE;
  }
  
  static SDL_bool
  HIDAPI_DriverGameCube_OpenJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick)
  {
      SDL_DriverGameCube_Context *ctx = (SDL_DriverGameCube_Context *)device->context;
      Uint8 i;
      for (i = 0; i < MAX_CONTROLLERS; i += 1) {
          if (joystick->instance_id == ctx->joysticks[i]) {
              joystick->nbuttons = 12;
              joystick->naxes = SDL_CONTROLLER_AXIS_MAX;
              joystick->epowerlevel = ctx->wireless[i] ? SDL_JOYSTICK_POWER_UNKNOWN : SDL_JOYSTICK_POWER_WIRED;
              return SDL_TRUE;
          }
      }
      return SDL_FALSE; /* Should never get here! */
  }
  
  static int
  HIDAPI_DriverGameCube_RumbleJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick, Uint16 low_frequency_rumble, Uint16 high_frequency_rumble, Uint32 duration_ms)
  {
      SDL_DriverGameCube_Context *ctx = (SDL_DriverGameCube_Context *)device->context;
      Uint8 i, val;
      for (i = 0; i < MAX_CONTROLLERS; i += 1) {
          if (joystick->instance_id == ctx->joysticks[i]) {
              if (ctx->wireless[i]) {
                  return SDL_SetError("Ninteno GameCube WaveBird controllers do not support rumble");
              }
              if (!ctx->rumbleAllowed[i]) {
                  return SDL_SetError("Second USB cable for WUP-028 not connected");
              }
              val = (low_frequency_rumble > 0 || high_frequency_rumble > 0);
              if (val != ctx->rumble[i + 1]) {
                  ctx->rumble[i + 1] = val;
                  ctx->rumbleUpdate = SDL_TRUE;
              }
              if (val && duration_ms) {
                  ctx->rumbleExpiration[i] = SDL_GetTicks() + SDL_min(duration_ms, SDL_MAX_RUMBLE_DURATION_MS);
                  if (!ctx->rumbleExpiration[i]) {
                      ctx->rumbleExpiration[i] = 1;
                  }
              } else {
                  ctx->rumbleExpiration[i] = 0;
              }
              return 0;
          }
      }
  
      /* Should never get here! */
      SDL_SetError("Couldn't find joystick");
      return -1;
  }
  
  static void
  HIDAPI_DriverGameCube_CloseJoystick(SDL_HIDAPI_Device *device, SDL_Joystick *joystick)
  {
      SDL_DriverGameCube_Context *ctx = (SDL_DriverGameCube_Context *)device->context;
      Uint8 i;
  
      /* Stop rumble activity */
      for (i = 0; i < MAX_CONTROLLERS; i += 1) {
          if (joystick->instance_id == ctx->joysticks[i]) {
              if (!ctx->wireless[i] && ctx->rumbleAllowed[i] && ctx->rumble[1 + i] != 0) {
                  ctx->rumble[1 + i] = 0;
                  ctx->rumbleExpiration[i] = 0;
                  hid_write(device->dev, ctx->rumble, sizeof(ctx->rumble));
              }
              break;
          }
      }
  }
  
  static void
  HIDAPI_DriverGameCube_FreeDevice(SDL_HIDAPI_Device *device)
  {
      hid_close(device->dev);
      device->dev = NULL;
  
      SDL_free(device->context);
      device->context = NULL;
  }
  
  SDL_HIDAPI_DeviceDriver SDL_HIDAPI_DriverGameCube =
  {
      SDL_HINT_JOYSTICK_HIDAPI_GAMECUBE,
      SDL_TRUE,
      HIDAPI_DriverGameCube_IsSupportedDevice,
      HIDAPI_DriverGameCube_GetDeviceName,
      HIDAPI_DriverGameCube_InitDevice,
      HIDAPI_DriverGameCube_GetDevicePlayerIndex,
      HIDAPI_DriverGameCube_SetDevicePlayerIndex,
      HIDAPI_DriverGameCube_UpdateDevice,
      HIDAPI_DriverGameCube_OpenJoystick,
      HIDAPI_DriverGameCube_RumbleJoystick,
      HIDAPI_DriverGameCube_CloseJoystick,
      HIDAPI_DriverGameCube_FreeDevice
  };
  
  #endif /* SDL_JOYSTICK_HIDAPI_GAMECUBE */
  
  #endif /* SDL_JOYSTICK_HIDAPI */
  
  /* vi: set ts=4 sw=4 expandtab: */
  

Download