filename | src/drivers/joy_linux.c |
changeset | 669:ab344e42bca9 |
prev | 637:6a284eff5311 |
next | 736:a02d1475ccfd |
author | nkeynes |
date | Mon May 12 10:00:13 2008 +0000 (14 years ago) |
permissions | -rw-r--r-- |
last change | Cleanup most of the -Wall warnings (getting a bit sloppy...) Convert FP code to use fixed banks rather than indirect pointer (3-4% faster this way now) |
file | annotate | diff | log | raw |
nkeynes@614 | 1 | /** |
nkeynes@637 | 2 | * $Id$ |
nkeynes@614 | 3 | * |
nkeynes@614 | 4 | * Linux joystick input device support |
nkeynes@614 | 5 | * |
nkeynes@614 | 6 | * Copyright (c) 2008 Nathan Keynes. |
nkeynes@614 | 7 | * |
nkeynes@614 | 8 | * This program is free software; you can redistribute it and/or modify |
nkeynes@614 | 9 | * it under the terms of the GNU General Public License as published by |
nkeynes@614 | 10 | * the Free Software Foundation; either version 2 of the License, or |
nkeynes@614 | 11 | * (at your option) any later version. |
nkeynes@614 | 12 | * |
nkeynes@614 | 13 | * This program is distributed in the hope that it will be useful, |
nkeynes@614 | 14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
nkeynes@614 | 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
nkeynes@614 | 16 | * GNU General Public License for more details. |
nkeynes@614 | 17 | */ |
nkeynes@614 | 18 | |
nkeynes@620 | 19 | #define _GNU_SOURCE |
nkeynes@614 | 20 | #include <sys/types.h> |
nkeynes@614 | 21 | #include <sys/ioctl.h> |
nkeynes@614 | 22 | #include <errno.h> |
nkeynes@614 | 23 | #include <stdio.h> |
nkeynes@620 | 24 | #include <signal.h> |
nkeynes@614 | 25 | #include <string.h> |
nkeynes@669 | 26 | #include <stdlib.h> |
nkeynes@669 | 27 | #include <unistd.h> |
nkeynes@614 | 28 | #include <fcntl.h> |
nkeynes@614 | 29 | #include <dirent.h> |
nkeynes@614 | 30 | #include <ctype.h> |
nkeynes@614 | 31 | |
nkeynes@614 | 32 | #include <linux/joystick.h> |
nkeynes@614 | 33 | #include <glib/giochannel.h> |
nkeynes@614 | 34 | #include <glib.h> |
nkeynes@614 | 35 | |
nkeynes@614 | 36 | #include "lxdream.h" |
nkeynes@614 | 37 | #include "display.h" |
nkeynes@669 | 38 | #include "maple/maple.h" |
nkeynes@669 | 39 | #include "drivers/joy_linux.h" |
nkeynes@614 | 40 | |
nkeynes@614 | 41 | #define INPUT_PATH "/dev/input" |
nkeynes@614 | 42 | |
nkeynes@614 | 43 | typedef struct linux_joystick { |
nkeynes@614 | 44 | struct input_driver driver; |
nkeynes@614 | 45 | const gchar *filename; |
nkeynes@614 | 46 | char name[128]; |
nkeynes@614 | 47 | int fd; |
nkeynes@614 | 48 | int button_count, axis_count; |
nkeynes@614 | 49 | GIOChannel *channel; |
nkeynes@614 | 50 | |
nkeynes@614 | 51 | } *linux_joystick_t; |
nkeynes@614 | 52 | |
nkeynes@614 | 53 | static gboolean linux_joystick_callback( GIOChannel *source, GIOCondition condition, |
nkeynes@614 | 54 | gpointer data ); |
nkeynes@669 | 55 | static int linux_joystick_scan(); |
nkeynes@669 | 56 | static linux_joystick_t linux_joystick_new( const gchar *filename, int fd ); |
nkeynes@614 | 57 | static uint16_t linux_joystick_resolve_keysym( input_driver_t dev, const gchar *str ); |
nkeynes@614 | 58 | static gchar *linux_joystick_keysym_for_keycode( input_driver_t dev, uint16_t keycode ); |
nkeynes@614 | 59 | static void linux_joystick_destroy( input_driver_t joy ); |
nkeynes@620 | 60 | static gboolean linux_joystick_install_watch( const gchar *dir ); |
nkeynes@620 | 61 | static void linux_joystick_uninstall_watch( void ); |
nkeynes@614 | 62 | |
nkeynes@614 | 63 | /** |
nkeynes@615 | 64 | * Convert keysym to keycode. Keysyms are either Button%d or Axis%d[+-], with buttons |
nkeynes@615 | 65 | * numbered 1 .. button_count, then axes from button_count+1 .. button_count + axis_count*2. |
nkeynes@614 | 66 | * The first button is Button1. (no Button0) |
nkeynes@615 | 67 | * The first axis is Axis1+, then Axis1-, Axis2+ and so forth. |
nkeynes@614 | 68 | */ |
nkeynes@614 | 69 | static uint16_t linux_joystick_resolve_keysym( input_driver_t dev, const gchar *str ) |
nkeynes@614 | 70 | { |
nkeynes@614 | 71 | linux_joystick_t joy = (linux_joystick_t)dev; |
nkeynes@614 | 72 | if( strncasecmp( str, "Button", 6 ) == 0 ){ |
nkeynes@614 | 73 | unsigned long button = strtoul( str+6, NULL, 10 ); |
nkeynes@614 | 74 | if( button > joy->button_count ) { |
nkeynes@614 | 75 | return 0; |
nkeynes@614 | 76 | } |
nkeynes@614 | 77 | return (uint16_t)button; |
nkeynes@614 | 78 | } else if( strncasecmp( str, "Axis", 4 ) == 0 ) { |
nkeynes@615 | 79 | char *endptr; |
nkeynes@615 | 80 | unsigned long axis = strtoul( str+4, &endptr, 10 ); |
nkeynes@614 | 81 | if( axis > joy->axis_count || axis == 0 ) { |
nkeynes@614 | 82 | return 0; |
nkeynes@614 | 83 | } |
nkeynes@615 | 84 | int keycode = ((axis - 1) << 1) + joy->button_count + 1; |
nkeynes@615 | 85 | if( *endptr == '-' ) { |
nkeynes@615 | 86 | return keycode + 1; |
nkeynes@615 | 87 | } else { |
nkeynes@615 | 88 | return keycode; |
nkeynes@615 | 89 | } |
nkeynes@614 | 90 | } else { |
nkeynes@614 | 91 | return 0; |
nkeynes@614 | 92 | } |
nkeynes@614 | 93 | } |
nkeynes@614 | 94 | |
nkeynes@614 | 95 | static gchar *linux_joystick_keysym_for_keycode( input_driver_t dev, uint16_t keycode ) |
nkeynes@614 | 96 | { |
nkeynes@614 | 97 | linux_joystick_t joy = (linux_joystick_t)dev; |
nkeynes@614 | 98 | if( keycode == 0 ) { |
nkeynes@614 | 99 | return NULL; |
nkeynes@614 | 100 | } |
nkeynes@614 | 101 | if( keycode <= joy->button_count ) { |
nkeynes@614 | 102 | return g_strdup_printf( "Button%d", keycode ); |
nkeynes@614 | 103 | } |
nkeynes@615 | 104 | if( keycode <= joy->button_count + joy->axis_count*2 ) { |
nkeynes@615 | 105 | int axis = keycode - joy->button_count - 1; |
nkeynes@615 | 106 | if( (axis & 1) == 0 ) { |
nkeynes@615 | 107 | return g_strdup_printf( "Axis%d+", (axis >> 1)+1 ); |
nkeynes@615 | 108 | } else { |
nkeynes@615 | 109 | return g_strdup_printf( "Axis%d-", (axis >> 1)+1 ); |
nkeynes@615 | 110 | } |
nkeynes@614 | 111 | } |
nkeynes@614 | 112 | return NULL; |
nkeynes@614 | 113 | } |
nkeynes@614 | 114 | |
nkeynes@614 | 115 | static void linux_joystick_destroy( input_driver_t dev ) |
nkeynes@614 | 116 | { |
nkeynes@614 | 117 | linux_joystick_t joy = (linux_joystick_t)dev; |
nkeynes@614 | 118 | g_free( (gchar *)joy->filename ); |
nkeynes@614 | 119 | g_io_channel_shutdown(joy->channel, FALSE, NULL ); |
nkeynes@614 | 120 | g_io_channel_unref(joy->channel); |
nkeynes@614 | 121 | g_free( joy ); |
nkeynes@614 | 122 | } |
nkeynes@614 | 123 | |
nkeynes@614 | 124 | /** |
nkeynes@614 | 125 | * Callback from the GIOChannel whenever data is available, or an error/disconnect |
nkeynes@614 | 126 | * occurs. |
nkeynes@614 | 127 | * |
nkeynes@614 | 128 | * On data, process all pending events and direct them to the input system. |
nkeynes@614 | 129 | * On error, close the channel and delete the device. |
nkeynes@614 | 130 | */ |
nkeynes@614 | 131 | static gboolean linux_joystick_callback( GIOChannel *source, GIOCondition condition, |
nkeynes@614 | 132 | gpointer data ) |
nkeynes@614 | 133 | { |
nkeynes@614 | 134 | linux_joystick_t joy = (linux_joystick_t)data; |
nkeynes@614 | 135 | |
nkeynes@614 | 136 | if( condition & G_IO_HUP ) { |
nkeynes@614 | 137 | INFO( "Joystick '%s' disconnected\n", joy->name ); |
nkeynes@614 | 138 | input_unregister_device((input_driver_t)joy); |
nkeynes@614 | 139 | return FALSE; |
nkeynes@614 | 140 | } |
nkeynes@614 | 141 | if( condition & G_IO_IN ) { |
nkeynes@614 | 142 | struct js_event event; |
nkeynes@614 | 143 | while( read( joy->fd, &event, sizeof(event) ) == sizeof(event) ) { |
nkeynes@614 | 144 | if( event.type == JS_EVENT_BUTTON ) { |
nkeynes@615 | 145 | int keycode = event.number+1; |
nkeynes@614 | 146 | if( event.value == 0 ) { |
nkeynes@615 | 147 | input_event_keyup( (input_driver_t)joy, keycode, 0 ); |
nkeynes@614 | 148 | } else { |
nkeynes@614 | 149 | input_event_keydown( (input_driver_t)joy, keycode, event.value ); |
nkeynes@614 | 150 | } |
nkeynes@615 | 151 | } else if( event.type == JS_EVENT_AXIS ) { |
nkeynes@615 | 152 | int keycode = (event.number*2) + joy->button_count + 1; |
nkeynes@615 | 153 | if( event.value == 0 ) { |
nkeynes@615 | 154 | input_event_keyup( (input_driver_t)joy, keycode, 0 ); |
nkeynes@615 | 155 | input_event_keyup( (input_driver_t)joy, keycode+1, 0 ); |
nkeynes@615 | 156 | } else if( event.value < 0 ) { |
nkeynes@615 | 157 | input_event_keydown( (input_driver_t)joy, keycode+1, -event.value ); |
nkeynes@615 | 158 | input_event_keyup( (input_driver_t)joy, keycode, 0 ); |
nkeynes@615 | 159 | } else { |
nkeynes@615 | 160 | input_event_keydown( (input_driver_t)joy, keycode, event.value ); |
nkeynes@615 | 161 | input_event_keyup( (input_driver_t)joy, keycode+1, 0 ); |
nkeynes@615 | 162 | } |
nkeynes@614 | 163 | } |
nkeynes@614 | 164 | } |
nkeynes@614 | 165 | } |
nkeynes@669 | 166 | return TRUE; |
nkeynes@614 | 167 | } |
nkeynes@614 | 168 | |
nkeynes@614 | 169 | /** |
nkeynes@614 | 170 | * Create a new joystick device structure given filename and (open) file |
nkeynes@614 | 171 | * descriptor. The joystick is automatically added to the watch list. |
nkeynes@614 | 172 | * @return The new joystick, or NULL if an error occurred. |
nkeynes@614 | 173 | */ |
nkeynes@669 | 174 | static linux_joystick_t linux_joystick_new( const gchar *filename, int fd ) |
nkeynes@614 | 175 | { |
nkeynes@614 | 176 | linux_joystick_t joy = g_malloc0(sizeof(struct linux_joystick)); |
nkeynes@614 | 177 | joy->filename = filename; |
nkeynes@614 | 178 | joy->fd = fd; |
nkeynes@614 | 179 | joy->name[0] = '\0'; |
nkeynes@614 | 180 | joy->driver.resolve_keysym = linux_joystick_resolve_keysym; |
nkeynes@614 | 181 | joy->driver.get_keysym_for_keycode = linux_joystick_keysym_for_keycode; |
nkeynes@614 | 182 | joy->driver.destroy = linux_joystick_destroy; |
nkeynes@614 | 183 | |
nkeynes@614 | 184 | char *p = strrchr(filename, '/'); |
nkeynes@614 | 185 | if( p == NULL ) { |
nkeynes@614 | 186 | joy->driver.id = filename; |
nkeynes@614 | 187 | } else { |
nkeynes@614 | 188 | joy->driver.id = p+1; |
nkeynes@614 | 189 | } |
nkeynes@614 | 190 | |
nkeynes@614 | 191 | if( ioctl( fd, JSIOCGNAME(128), joy->name ) == -1 || |
nkeynes@614 | 192 | ioctl( fd, JSIOCGAXES, &joy->axis_count ) == -1 || |
nkeynes@614 | 193 | ioctl( fd, JSIOCGBUTTONS, &joy->button_count ) == -1 ) { |
nkeynes@614 | 194 | ERROR( "Error reading joystick data from %s (%s)\n", filename, strerror(errno) ); |
nkeynes@614 | 195 | g_free(joy); |
nkeynes@614 | 196 | return NULL; |
nkeynes@614 | 197 | } |
nkeynes@614 | 198 | |
nkeynes@614 | 199 | joy->channel = g_io_channel_unix_new(fd); |
nkeynes@614 | 200 | g_io_add_watch( joy->channel, G_IO_IN|G_IO_ERR|G_IO_HUP, linux_joystick_callback, joy ); |
nkeynes@614 | 201 | return joy; |
nkeynes@614 | 202 | } |
nkeynes@614 | 203 | |
nkeynes@669 | 204 | static int linux_joystick_scan() |
nkeynes@620 | 205 | { |
nkeynes@615 | 206 | int joysticks = 0; |
nkeynes@614 | 207 | struct dirent *ent; |
nkeynes@614 | 208 | DIR *dir = opendir(INPUT_PATH); |
nkeynes@614 | 209 | |
nkeynes@614 | 210 | if( dir == NULL ) { |
nkeynes@614 | 211 | return 0; |
nkeynes@614 | 212 | } |
nkeynes@614 | 213 | |
nkeynes@614 | 214 | while( (ent = readdir(dir)) != NULL ) { |
nkeynes@614 | 215 | if( ent->d_name[0] == 'j' && ent->d_name[1] == 's' && |
nkeynes@615 | 216 | isdigit(ent->d_name[2]) && !input_has_device(ent->d_name) ) { |
nkeynes@614 | 217 | gchar *name = g_strdup_printf( "%s/%s", INPUT_PATH, ent->d_name ); |
nkeynes@614 | 218 | int fd = open(name, O_RDONLY|O_NONBLOCK); |
nkeynes@614 | 219 | if( fd == -1 ) { |
nkeynes@614 | 220 | g_free( name ); |
nkeynes@614 | 221 | } else { |
nkeynes@615 | 222 | linux_joystick_t joy = linux_joystick_new( name, fd ); |
nkeynes@615 | 223 | input_register_device( (input_driver_t)joy, (joy->axis_count*2) + joy->button_count ); |
nkeynes@615 | 224 | INFO( "Attached joystick %s named '%s', (%d buttons, %d axes)", |
nkeynes@615 | 225 | joy->driver.id, joy->name, joy->button_count, joy->axis_count ); |
nkeynes@615 | 226 | joysticks++; |
nkeynes@614 | 227 | } |
nkeynes@614 | 228 | } |
nkeynes@614 | 229 | } |
nkeynes@614 | 230 | |
nkeynes@614 | 231 | closedir(dir); |
nkeynes@615 | 232 | return joysticks; |
nkeynes@614 | 233 | } |
nkeynes@615 | 234 | |
nkeynes@669 | 235 | gboolean linux_joystick_init() |
nkeynes@669 | 236 | { |
nkeynes@669 | 237 | if( !linux_joystick_install_watch(INPUT_PATH) ) { |
nkeynes@669 | 238 | return FALSE; |
nkeynes@669 | 239 | } |
nkeynes@669 | 240 | linux_joystick_scan(); |
nkeynes@669 | 241 | return TRUE; |
nkeynes@669 | 242 | } |
nkeynes@669 | 243 | |
nkeynes@620 | 244 | void linux_joystick_shutdown(void) |
nkeynes@620 | 245 | { |
nkeynes@620 | 246 | linux_joystick_uninstall_watch(); |
nkeynes@620 | 247 | } |
nkeynes@620 | 248 | |
nkeynes@620 | 249 | /*************************** dnotify support **********************/ |
nkeynes@620 | 250 | |
nkeynes@621 | 251 | static volatile int need_input_rescan = 0; |
nkeynes@620 | 252 | static int watch_dir_fd; |
nkeynes@620 | 253 | |
nkeynes@620 | 254 | static gboolean gtk_loop_check_input(gpointer data) |
nkeynes@620 | 255 | { |
nkeynes@621 | 256 | if( need_input_rescan == 1 ) { |
nkeynes@621 | 257 | need_input_rescan = 0; |
nkeynes@620 | 258 | int js = linux_joystick_scan(); |
nkeynes@620 | 259 | if( js > 0 ) { |
nkeynes@620 | 260 | maple_reattach_all(); |
nkeynes@620 | 261 | } |
nkeynes@620 | 262 | } |
nkeynes@621 | 263 | return need_input_rescan != 2; |
nkeynes@620 | 264 | } |
nkeynes@620 | 265 | |
nkeynes@620 | 266 | static void dnotify_handler(int sig ) |
nkeynes@620 | 267 | { |
nkeynes@621 | 268 | need_input_rescan = 1; |
nkeynes@620 | 269 | } |
nkeynes@620 | 270 | |
nkeynes@620 | 271 | static gboolean linux_joystick_install_watch( const gchar *dir ) |
nkeynes@620 | 272 | { |
nkeynes@620 | 273 | int fd = open( dir, O_RDONLY|O_NONBLOCK ); |
nkeynes@620 | 274 | if( fd == -1 ) { |
nkeynes@620 | 275 | return FALSE; |
nkeynes@620 | 276 | } |
nkeynes@620 | 277 | |
nkeynes@620 | 278 | signal( SIGRTMIN+1, dnotify_handler ); |
nkeynes@620 | 279 | fcntl(fd, F_SETSIG, SIGRTMIN + 1); |
nkeynes@620 | 280 | if( fcntl(fd, F_NOTIFY, DN_CREATE|DN_MULTISHOT) == -1 ) { |
nkeynes@620 | 281 | close(fd); |
nkeynes@620 | 282 | return FALSE; |
nkeynes@620 | 283 | } |
nkeynes@620 | 284 | watch_dir_fd = fd; |
nkeynes@620 | 285 | g_timeout_add( 500, gtk_loop_check_input, NULL ); |
nkeynes@669 | 286 | return TRUE; |
nkeynes@620 | 287 | } |
nkeynes@620 | 288 | |
nkeynes@620 | 289 | static void linux_joystick_uninstall_watch(void) |
nkeynes@620 | 290 | { |
nkeynes@620 | 291 | signal( SIGRTMIN+1, SIG_IGN ); |
nkeynes@620 | 292 | close( watch_dir_fd ); |
nkeynes@621 | 293 | need_input_rescan = 2; |
nkeynes@620 | 294 | } |
.