companion/src/simulation/joystick.cpp

   1 #include "joystick.h"
   2
   3 Joystick::Joystick(QObject *parent, int joystickEventTimeout, bool doAutoRepeat, int repeatDelay)
   4   : QObject(parent)
   5 {
   6   if ( SDL_WasInit(SDL_INIT_JOYSTICK) ) {
   7     int i;
   8     for (i = 0; i < SDL_NumJoysticks(); i++)
   9       joystickNames.append(SDL_JoystickName(i));
  10     connect(&joystickTimer, SIGNAL(timeout()), this, SLOT(processEvents()));
  11   } else {
  12     fprintf(stderr, "ERROR: couldn't initialize SDL joystick support\n");
  13   }
  14
  15   joystick = NULL;
  16   numAxes = numButtons = numHats = numTrackballs = 0;
  17   autoRepeat = doAutoRepeat;
  18   autoRepeatDelay = repeatDelay;
  19   eventTimeout = joystickEventTimeout;
  20 }
  21
  22 Joystick::~Joystick()
  23 {
  24   if ( isOpen() )
  25     close();
  26 }
  27
  28 bool Joystick::open(int stick)
  29 {
  30   if ( isOpen() )
  31     close();
  32
  33   joystick = SDL_JoystickOpen(stick);
  34   if ( joystick ) {
  35     numAxes = SDL_JoystickNumAxes(joystick);
  36     numButtons = SDL_JoystickNumButtons(joystick);
  37     numHats = SDL_JoystickNumHats(joystick);
  38     numTrackballs = SDL_JoystickNumBalls(joystick);
  39     joystickTimer.start(eventTimeout);
  40     return TRUE;
  41   } else {
  42     fprintf(stderr, "ERROR: couldn't open SDL joystick #%d", stick);
  43     return FALSE;
  44   }
  45 }
  46
  47 void Joystick::close()
  48 {
  49   joystickTimer.stop();
  50   if ( joystick )
  51     SDL_JoystickClose(joystick);
  52   joystick = NULL;
  53   numAxes = numButtons = numHats = numTrackballs = 0;
  54 }
  55
  56 void Joystick::processEvents()
  57 {
  58   if ( !isOpen() )
  59     return;
  60
  61   SDL_JoystickUpdate();
  62
  63   int i;
  64   for (i = 0; i < numAxes; i++) {
  65     Sint16 moved = SDL_JoystickGetAxis(joystick, i);
  66     if ( abs(moved) >= deadzones[i] ) {
  67       if ( (moved != axes[i]) ) {
  68         int deltaMoved = abs(axes[i] - moved);
  69         if ( deltaMoved >= sensitivities[i] )
  70           emit axisValueChanged(i, moved);
  71         axes[i] = moved;
  72         axisRepeatTimers[i].restart();
  73       } else if (autoRepeat && moved != 0) {
  74         if ( axisRepeatTimers[i].elapsed() >= autoRepeatDelay ) {
  75           emit axisValueChanged(i, moved);
  76           axes[i] = moved;
  77         }
  78       } else
  79         axisRepeatTimers[i].restart();
  80     } else
  81       emit axisValueChanged(i, 0);
  82   }
  83   for (i = 0; i < numButtons; i++) {
  84     Uint8 changed = SDL_JoystickGetButton(joystick, i);
  85     if ( (changed != buttons[i]) ) {
  86       emit buttonValueChanged(i, (bool) changed);
  87       buttons[i] = changed;
  88       buttonRepeatTimers[i].restart();
  89     } else if (autoRepeat && changed != 0) {
  90       if ( buttonRepeatTimers[i].elapsed() >= autoRepeatDelay ) {
  91         emit buttonValueChanged(i, (bool) changed);
  92         buttons[i] = changed;
  93       }
  94     } else
  95       buttonRepeatTimers[i].restart();
  96   }
  97   for (i = 0; i < numHats; i++) {
  98     Uint8 changed = SDL_JoystickGetHat(joystick, i);
  99     if ( (changed != hats[i]) ) {
 100       emit hatValueChanged(i, changed);
 101       hats[i] = changed;
 102       hatRepeatTimers[i].restart();
 103     } else if (autoRepeat && changed != 0) {
 104       if ( hatRepeatTimers[i].elapsed() >= autoRepeatDelay ) {
 105         emit hatValueChanged(i, changed);
 106         hats[i] = changed;
 107       }
 108     } else
 109       hatRepeatTimers[i].restart();
 110   }
 111
 112   for (i = 0; i < numTrackballs; i++) {
 113     int dx, dy;
 114     SDL_JoystickGetBall(joystick, i, &dx, &dy);
 115     if ( dx != 0 || dy != 0 )
 116       emit trackballValueChanged(i, dx, dy);
 117   }
 118 }
 119
 120 int Joystick::getAxisValue(int axis)
 121 {
 122   if ( isOpen() ) {
 123     SDL_JoystickUpdate();
 124     return SDL_JoystickGetAxis(joystick, axis);
 125   } else
 126     return 0;
 127 }