Cleaned up Linux joystick code.

src/x11_joystick.c

@@ -30,47 +30,128 @@
 
 #include "internal.h"
 
-
-//========================================================================
-// Note: Only Linux joystick input is supported at the moment. Other
-// systems will behave as if there are no joysticks connected.
-//========================================================================
-
-
 #ifdef _GLFW_USE_LINUX_JOYSTICKS
+#include <linux/joystick.h>
 
-//------------------------------------------------------------------------
+#include <sys/types.h>
-// Here are the Linux joystick driver v1.x interface definitions that we
+#include <sys/stat.h>
-// use (we do not want to rely on <linux/joystick.h>):
-//------------------------------------------------------------------------
-
-#include <sys/ioctl.h>
 #include <fcntl.h>
-#include <errno.h>
+
 #include <stdio.h>
 #include <stdlib.h>
-
-// Joystick event types
-#define JS_EVENT_BUTTON     0x01    /* button pressed/released */
-#define JS_EVENT_AXIS       0x02    /* joystick moved */
-#define JS_EVENT_INIT       0x80    /* initial state of device */
-
-// Joystick event structure
-struct js_event {
-    unsigned int  time;    /* (u32) event timestamp in milliseconds */
-    signed short  value;   /* (s16) value */
-    unsigned char type;    /* (u8)  event type */
-    unsigned char number;  /* (u8)  axis/button number */
-};
-
-// Joystick IOCTL commands
-#define JSIOCGVERSION  _IOR('j', 0x01, int)   /* get driver version (u32) */
-#define JSIOCGAXES     _IOR('j', 0x11, char)  /* get number of axes (u8) */
-#define JSIOCGBUTTONS  _IOR('j', 0x12, char)  /* get number of buttons (u8) */
-
 #endif // _GLFW_USE_LINUX_JOYSTICKS
 
 
+//========================================================================
+// Attempt to open the specified joystick device
+//========================================================================
+
+static int openJoystickDevice(int joy, const char* path)
+{
+#ifdef _GLFW_USE_LINUX_JOYSTICKS
+    char numAxes, numButtons;
+    int fd, version;
+
+    fd = open(path, O_NONBLOCK);
+    if (fd == -1)
+        return GL_FALSE;
+
+    _glfwLibrary.X11.joystick[joy].fd = fd;
+
+    // Verify that the joystick driver version is at least 1.0
+    ioctl(fd, JSIOCGVERSION, &version);
+    if (version < 0x010000)
+    {
+        // It's an old 0.x interface (we don't support it)
+        close(fd);
+        return GL_FALSE;
+    }
+
+    ioctl(fd, JSIOCGAXES, &numAxes);
+    _glfwLibrary.X11.joystick[joy].numAxes = (int) numAxes;
+
+    ioctl(fd, JSIOCGBUTTONS, &numButtons);
+    _glfwLibrary.X11.joystick[joy].numButtons = (int) numButtons;
+
+    _glfwLibrary.X11.joystick[joy].axis =
+        (float*) malloc(sizeof(float) * numAxes);
+    if (_glfwLibrary.X11.joystick[joy].axis == NULL)
+    {
+        close(fd);
+
+        _glfwSetError(GLFW_OUT_OF_MEMORY, NULL);
+        return GL_FALSE;
+    }
+
+    _glfwLibrary.X11.joystick[joy].button =
+        (unsigned char*) malloc(sizeof(char) * numButtons);
+    if (_glfwLibrary.X11.joystick[joy].button == NULL)
+    {
+        free(_glfwLibrary.X11.joystick[joy].axis);
+        close(fd);
+
+        _glfwSetError(GLFW_OUT_OF_MEMORY, NULL);
+        return GL_FALSE;
+    }
+
+    _glfwLibrary.X11.joystick[joy].present = GL_TRUE;
+#endif // _GLFW_USE_LINUX_JOYSTICKS
+
+    return GL_TRUE;
+}
+
+
+//========================================================================
+// Polls for and processes events for all present joysticks
+//========================================================================
+
+static void pollJoystickEvents(void)
+{
+#ifdef _GLFW_USE_LINUX_JOYSTICKS
+    int i;
+    struct js_event e;
+
+    for (i = 0;  i <= GLFW_JOYSTICK_LAST;  i++)
+    {
+        if (!_glfwLibrary.X11.joystick[i].present)
+            continue;
+
+        // Read all queued events (non-blocking)
+        while (read(_glfwLibrary.X11.joystick[i].fd, &e, sizeof(e)) > 0)
+        {
+            // We don't care if it's an init event or not
+            e.type &= ~JS_EVENT_INIT;
+
+            switch (e.type)
+            {
+                case JS_EVENT_AXIS:
+                    _glfwLibrary.X11.joystick[i].axis[e.number] =
+                        (float) e.value / 32767.0f;
+
+                    // We need to change the sign for the Y axes, so that
+                    // positive = up/forward, according to the GLFW spec.
+                    if (e.number & 1)
+                    {
+                        _glfwLibrary.X11.joystick[i].axis[e.number] =
+                            -_glfwLibrary.X11.joystick[i].axis[e.number];
+                    }
+
+                    break;
+
+                case JS_EVENT_BUTTON:
+                    _glfwLibrary.X11.joystick[i].button[e.number] =
+                        e.value ? GLFW_PRESS : GLFW_RELEASE;
+                    break;
+
+                default:
+                    break;
+            }
+        }
+    }
+#endif // _GLFW_USE_LINUX_JOYSTICKS
+}
+
+
 //////////////////////////////////////////////////////////////////////////
 //////                       GLFW internal API                      //////
 //////////////////////////////////////////////////////////////////////////
@@ -82,97 +163,24 @@ struct js_event {
 void _glfwInitJoysticks(void)
 {
 #ifdef _GLFW_USE_LINUX_JOYSTICKS
-    int  k, n, fd, joy_count;
+    int i, j, joy = 0;
-    const char* joy_base_name;
+    char path[20];
-    char joy_dev_name[20];
+    const char* bases[] =
-    int  driver_version = 0x000800;
-    char ret_data;
-#endif // _GLFW_USE_LINUX_JOYSTICKS
-    int  i;
-
-    // Start by saying that there are no sticks
-    for (i = 0;  i <= GLFW_JOYSTICK_LAST;  i++)
-        _glfwJoy[i].Present = GL_FALSE;
-
-#ifdef _GLFW_USE_LINUX_JOYSTICKS
-
-    // Try to open joysticks (nonblocking)
-    joy_count = 0;
-    for (k = 0;  k <= 1 && joy_count <= GLFW_JOYSTICK_LAST;  k++)
     {
-        // Pick joystick base name
+        "/dev/input/js",
-        switch (k)
+        "/dev/js"
+    };
+
+    for (i = 0;  i < sizeof(bases) / sizeof(bases[0]);  i++)
     {
-            case 0:
+        for (j = 0;  j < 50;  j++)
-                // USB joysticks
+        {
-                joy_base_name = "/dev/input/js";
+            if (joy > GLFW_JOYSTICK_LAST)
                 break;
-            case 1:
-                // "Legacy" joysticks
-                joy_base_name = "/dev/js";
-                break;
-            default:
-                // This should never happen
-                continue;
-        }
 
-        // Try to open a few of these sticks
+            sprintf(path, "%s%i", bases[i], j);
-        for (i = 0;  i <= 50 && joy_count <= GLFW_JOYSTICK_LAST;  i++)
+            if (openJoystickDevice(joy, path))
-        {
+                joy++;
-            sprintf(joy_dev_name, "%s%d", joy_base_name, i);
-            fd = open(joy_dev_name, O_NONBLOCK);
-            if (fd != -1)
-            {
-                // Remember fd
-                _glfwJoy[joy_count].fd = fd;
-
-                // Check that the joystick driver version is 1.0+
-                ioctl(fd, JSIOCGVERSION, &driver_version);
-                if (driver_version < 0x010000)
-                {
-                    // It's an old 0.x interface (we don't support it)
-                    close(fd);
-                    continue;
-                }
-
-                // Get number of joystick axes
-                ioctl(fd, JSIOCGAXES, &ret_data);
-                _glfwJoy[joy_count].NumAxes = (int) ret_data;
-
-                // Get number of joystick buttons
-                ioctl(fd, JSIOCGBUTTONS, &ret_data);
-                _glfwJoy[joy_count].NumButtons = (int) ret_data;
-
-                // Allocate memory for joystick state
-                _glfwJoy[joy_count].Axis =
-                    (float*) malloc(sizeof(float) *
-                                     _glfwJoy[joy_count].NumAxes);
-                if (_glfwJoy[joy_count].Axis == NULL)
-                {
-                    close(fd);
-                    continue;
-                }
-                _glfwJoy[joy_count].Button =
-                    (unsigned char*) malloc(sizeof(char) *
-                                     _glfwJoy[joy_count].NumButtons);
-                if (_glfwJoy[joy_count].Button == NULL)
-                {
-                    free(_glfwJoy[joy_count].Axis);
-                    close(fd);
-                    continue;
-                }
-
-                // Clear joystick state
-                for (n = 0;  n < _glfwJoy[joy_count].NumAxes;  n++)
-                    _glfwJoy[joy_count].Axis[n] = 0.0f;
-
-                for (n = 0;  n < _glfwJoy[joy_count].NumButtons;  n++)
-                    _glfwJoy[joy_count].Button[n] = GLFW_RELEASE;
-
-                // The joystick is supported and connected
-                _glfwJoy[joy_count].Present = GL_TRUE;
-                joy_count++;
-            }
         }
     }
 #endif // _GLFW_USE_LINUX_JOYSTICKS
@@ -185,72 +193,18 @@ void _glfwInitJoysticks(void)
 
 void _glfwTerminateJoysticks(void)
 {
-
 #ifdef _GLFW_USE_LINUX_JOYSTICKS
-
     int i;
 
-    // Close any opened joysticks
     for (i = 0;  i <= GLFW_JOYSTICK_LAST;  i++)
     {
-        if (_glfwJoy[i].Present)
+        if (_glfwLibrary.X11.joystick[i].present)
         {
-            close(_glfwJoy[i].fd);
+            close(_glfwLibrary.X11.joystick[i].fd);
-            free(_glfwJoy[i].Axis);
+            free(_glfwLibrary.X11.joystick[i].axis);
-            free(_glfwJoy[i].Button);
+            free(_glfwLibrary.X11.joystick[i].button);
 
-            _glfwJoy[i].Present = GL_FALSE;
+            _glfwLibrary.X11.joystick[i].present = GL_FALSE;
-        }
-    }
-
-#endif // _GLFW_USE_LINUX_JOYSTICKS
-
-}
-
-
-//========================================================================
-// Empty joystick event queue
-//========================================================================
-
-static void pollJoystickEvents(void)
-{
-#ifdef _GLFW_USE_LINUX_JOYSTICKS
-
-    struct js_event e;
-    int i;
-
-    // Get joystick events for all GLFW joysticks
-    for (i = 0;  i <= GLFW_JOYSTICK_LAST;  i++)
-    {
-        // Is the stick present?
-        if (_glfwJoy[i].Present)
-        {
-            // Read all queued events (non-blocking)
-            while (read(_glfwJoy[i].fd, &e, sizeof(struct js_event)) > 0)
-            {
-                // We don't care if it's an init event or not
-                e.type &= ~JS_EVENT_INIT;
-
-                // Check event type
-                switch (e.type)
-                {
-                    case JS_EVENT_AXIS:
-                        _glfwJoy[i].Axis[e.number] = (float) e.value / 32767.0f;
-                        // We need to change the sign for the Y axes, so that
-                        // positive = up/forward, according to the GLFW spec.
-                        if (e.number & 1)
-                            _glfwJoy[i].Axis[e.number] = -_glfwJoy[i].Axis[e.number];
-                        break;
-
-                    case JS_EVENT_BUTTON:
-                        _glfwJoy[i].Button[e.number] =
-                            e.value ? GLFW_PRESS : GLFW_RELEASE;
-                        break;
-
-                    default:
-                        break;
-                }
-            }
         }
     }
 #endif // _GLFW_USE_LINUX_JOYSTICKS
@@ -267,11 +221,8 @@ static void pollJoystickEvents(void)
 
 int _glfwPlatformGetJoystickParam(int joy, int param)
 {
-    if (!_glfwJoy[joy].Present)
+    if (!_glfwLibrary.X11.joystick[joy].present)
-    {
-        // TODO: Figure out if this is an error
         return 0;
-    }
 
     switch (param)
     {
@@ -279,10 +230,10 @@ int _glfwPlatformGetJoystickParam(int joy, int param)
             return GL_TRUE;
 
         case GLFW_AXES:
-            return _glfwJoy[joy].NumAxes;
+            return _glfwLibrary.X11.joystick[joy].numAxes;
 
         case GLFW_BUTTONS:
-            return _glfwJoy[joy].NumButtons;
+            return _glfwLibrary.X11.joystick[joy].numButtons;
 
         default:
             break;
@@ -296,28 +247,22 @@ int _glfwPlatformGetJoystickParam(int joy, int param)
 // Get joystick axis positions
 //========================================================================
 
-int _glfwPlatformGetJoystickPos(int joy, float* pos, int numaxes)
+int _glfwPlatformGetJoystickPos(int joy, float* pos, int numAxes)
 {
     int i;
 
-    if (!_glfwJoy[joy].Present)
+    if (!_glfwLibrary.X11.joystick[joy].present)
-    {
-        // TODO: Figure out if this is an error
         return 0;
-    }
 
-    // Update joystick state
     pollJoystickEvents();
 
-    // Does the joystick support less axes than requested?
+    if (_glfwLibrary.X11.joystick[joy].numAxes < numAxes)
-    if (_glfwJoy[joy].NumAxes < numaxes)
+        numAxes = _glfwLibrary.X11.joystick[joy].numAxes;
-        numaxes = _glfwJoy[joy].NumAxes;
 
-    // Copy axis positions from internal state
+    for (i = 0;  i < numAxes;  i++)
-    for (i = 0;  i < numaxes;  i++)
+        pos[i] = _glfwLibrary.X11.joystick[joy].axis[i];
-        pos[i] = _glfwJoy[joy].Axis[i];
 
-    return numaxes;
+    return numAxes;
 }
 
 
@@ -326,27 +271,21 @@ int _glfwPlatformGetJoystickPos(int joy, float* pos, int numaxes)
 //========================================================================
 
 int _glfwPlatformGetJoystickButtons(int joy, unsigned char* buttons,
-                                    int numbuttons)
+                                    int numButtons)
 {
     int i;
 
-    if (!_glfwJoy[joy].Present)
+    if (!_glfwLibrary.X11.joystick[joy].present)
-    {
-        // TODO: Figure out if this is an error
         return 0;
-    }
 
-    // Update joystick state
     pollJoystickEvents();
 
-    // Does the joystick support less buttons than requested?
+    if (_glfwLibrary.X11.joystick[joy].numButtons < numButtons)
-    if (_glfwJoy[joy].NumButtons < numbuttons)
+        numButtons = _glfwLibrary.X11.joystick[joy].numButtons;
-        numbuttons = _glfwJoy[joy].NumButtons;
 
-    // Copy button states from internal state
+    for (i = 0;  i < numButtons;  i++)
-    for (i = 0;  i < numbuttons;  i++)
+        buttons[i] = _glfwLibrary.X11.joystick[joy].button[i];
-        buttons[i] = _glfwJoy[joy].Button[i];
 
-    return numbuttons;
+    return numButtons;
 }
 

src/x11_platform.h

@@ -233,6 +233,15 @@ typedef struct _GLFWlibraryX11
         int status;
     } selection;
 
+    struct {
+        int             present;
+        int             fd;
+        int             numAxes;
+        int             numButtons;
+        float*          axis;
+        unsigned char*  button;
+    } joystick[GLFW_JOYSTICK_LAST + 1];
+
 } _GLFWlibraryX11;
 
 
@@ -269,19 +278,6 @@ typedef struct _GLFWlibraryGLX
 } _GLFWlibraryGLX;
 
 
-//------------------------------------------------------------------------
-// Joystick information & state
-//------------------------------------------------------------------------
-GLFWGLOBAL struct {
-    int           Present;
-    int           fd;
-    int           NumAxes;
-    int           NumButtons;
-    float*        Axis;
-    unsigned char* Button;
-} _glfwJoy[GLFW_JOYSTICK_LAST + 1];
-
-
 //========================================================================
 // Prototypes for platform specific internal functions
 //========================================================================