src/joystick/bsd/SDL_sysjoystick.c
author Sam Lantinga <slouken@libsdl.org>
Mon, 12 Oct 2009 09:32:55 +0000
branchSDL-1.2
changeset 4323 b3171b7561d8
parent 4307 f4ee83767bfd
child 4401 1a7b62893c9d
permissions -rw-r--r--
Joystick patch from FreeBSD ports system
slouken@278
     1
/*
slouken@278
     2
    SDL - Simple DirectMedia Layer
slouken@4159
     3
    Copyright (C) 1997-2009 Sam Lantinga
slouken@278
     4
slouken@278
     5
    This library is free software; you can redistribute it and/or
slouken@1312
     6
    modify it under the terms of the GNU Lesser General Public
slouken@278
     7
    License as published by the Free Software Foundation; either
slouken@1312
     8
    version 2.1 of the License, or (at your option) any later version.
slouken@278
     9
slouken@278
    10
    This library is distributed in the hope that it will be useful,
slouken@278
    11
    but WITHOUT ANY WARRANTY; without even the implied warranty of
slouken@278
    12
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
slouken@1312
    13
    Lesser General Public License for more details.
slouken@278
    14
slouken@1312
    15
    You should have received a copy of the GNU Lesser General Public
slouken@1312
    16
    License along with this library; if not, write to the Free Software
slouken@1312
    17
    Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
slouken@278
    18
slouken@278
    19
    Sam Lantinga
slouken@1312
    20
    slouken@libsdl.org
slouken@278
    21
*/
slouken@1402
    22
#include "SDL_config.h"
slouken@278
    23
slouken@1635
    24
#ifdef SDL_JOYSTICK_USBHID
slouken@1635
    25
slouken@278
    26
/*
slouken@278
    27
 * Joystick driver for the uhid(4) interface found in OpenBSD,
slouken@278
    28
 * NetBSD and FreeBSD.
slouken@278
    29
 *
slouken@278
    30
 * Maintainer: <vedge at csoft.org>
slouken@278
    31
 */
slouken@278
    32
slouken@552
    33
#include <sys/param.h>
slouken@552
    34
slouken@278
    35
#include <unistd.h>
slouken@278
    36
#include <fcntl.h>
slouken@278
    37
#include <errno.h>
slouken@278
    38
slouken@4306
    39
#ifndef __FreeBSD_kernel_version
slouken@4306
    40
#define __FreeBSD_kernel_version __FreeBSD_version
slouken@4306
    41
#endif
slouken@4306
    42
slouken@403
    43
#if defined(HAVE_USB_H)
slouken@403
    44
#include <usb.h>
slouken@403
    45
#endif
slouken@1565
    46
#ifdef __DragonFly__
slouken@1565
    47
#include <bus/usb/usb.h>
slouken@1565
    48
#include <bus/usb/usbhid.h>
slouken@1565
    49
#else
slouken@278
    50
#include <dev/usb/usb.h>
slouken@278
    51
#include <dev/usb/usbhid.h>
slouken@1565
    52
#endif
slouken@358
    53
slouken@381
    54
#if defined(HAVE_USBHID_H)
slouken@381
    55
#include <usbhid.h>
slouken@381
    56
#elif defined(HAVE_LIBUSB_H)
slouken@381
    57
#include <libusb.h>
slouken@381
    58
#elif defined(HAVE_LIBUSBHID_H)
slouken@381
    59
#include <libusbhid.h>
slouken@358
    60
#endif
slouken@278
    61
slouken@1402
    62
#ifdef __FREEBSD__
slouken@1565
    63
#ifndef __DragonFly__
slouken@611
    64
#include <osreldate.h>
slouken@1565
    65
#endif
slouken@776
    66
#include <sys/joystick.h>
slouken@776
    67
#endif
slouken@776
    68
slouken@1565
    69
#if SDL_JOYSTICK_USBHID_MACHINE_JOYSTICK_H
slouken@776
    70
#include <machine/joystick.h>
slouken@611
    71
#endif
slouken@611
    72
slouken@278
    73
#include "SDL_joystick.h"
slouken@1361
    74
#include "../SDL_sysjoystick.h"
slouken@1361
    75
#include "../SDL_joystick_c.h"
slouken@278
    76
slouken@278
    77
#define MAX_UHID_JOYS	4
slouken@278
    78
#define MAX_JOY_JOYS	2
slouken@278
    79
#define MAX_JOYS	(MAX_UHID_JOYS + MAX_JOY_JOYS)
slouken@278
    80
slouken@4323
    81
#if defined(__FREEBSD__) && (__FreeBSD_kernel_version > 800063)
slouken@4323
    82
struct usb_ctl_report {
slouken@4323
    83
	int	ucr_report;
slouken@4323
    84
	u_char	ucr_data[1024]; /* filled data size will vary */
slouken@4323
    85
};
slouken@4323
    86
#endif
slouken@4323
    87
slouken@278
    88
struct report {
slouken@278
    89
	struct	usb_ctl_report *buf;	/* Buffer */
slouken@278
    90
	size_t	size;			/* Buffer size */
slouken@278
    91
	int	rid;			/* Report ID */
slouken@278
    92
	enum {
slouken@278
    93
		SREPORT_UNINIT,
slouken@278
    94
		SREPORT_CLEAN,
slouken@278
    95
		SREPORT_DIRTY
slouken@278
    96
	} status;
slouken@278
    97
};
slouken@278
    98
slouken@278
    99
static struct {
slouken@278
   100
	int	uhid_report;
slouken@402
   101
	hid_kind_t kind;
slouken@278
   102
	const	char *name;
slouken@278
   103
} const repinfo[] = {
slouken@278
   104
	{ UHID_INPUT_REPORT,	hid_input,	"input" },
slouken@278
   105
	{ UHID_OUTPUT_REPORT,	hid_output,	"output" },
slouken@278
   106
	{ UHID_FEATURE_REPORT,	hid_feature,	"feature" }
slouken@278
   107
};
slouken@307
   108
slouken@307
   109
enum {
slouken@307
   110
	REPORT_INPUT = 0,
slouken@307
   111
	REPORT_OUTPUT = 1,
slouken@307
   112
	REPORT_FEATURE = 2
slouken@307
   113
};
slouken@307
   114
slouken@307
   115
enum {
slouken@307
   116
	JOYAXE_X,
slouken@307
   117
	JOYAXE_Y,
slouken@307
   118
	JOYAXE_Z,
slouken@307
   119
	JOYAXE_SLIDER,
slouken@632
   120
	JOYAXE_WHEEL,
slouken@632
   121
	JOYAXE_RX,
slouken@632
   122
	JOYAXE_RY,
slouken@632
   123
	JOYAXE_RZ,
slouken@632
   124
	JOYAXE_count
slouken@307
   125
};
slouken@278
   126
slouken@278
   127
struct joystick_hwdata {
slouken@278
   128
	int	fd;
slouken@278
   129
	char	*path;
slouken@278
   130
	enum {
slouken@278
   131
		BSDJOY_UHID,	/* uhid(4) */
slouken@278
   132
		BSDJOY_JOY	/* joy(4) */
slouken@278
   133
	} type;
slouken@278
   134
	struct	report_desc *repdesc;
slouken@278
   135
	struct	report inreport;
slouken@632
   136
	int	axis_map[JOYAXE_count];	/* map present JOYAXE_* to 0,1,..*/
slouken@4022
   137
	int	x;
slouken@4022
   138
	int	y;
slouken@4022
   139
	int	xmin;
slouken@4022
   140
	int	ymin;
slouken@4022
   141
	int	xmax;
slouken@4022
   142
	int	ymax;
slouken@278
   143
};
slouken@278
   144
slouken@278
   145
static char *joynames[MAX_JOYS];
slouken@278
   146
static char *joydevnames[MAX_JOYS];
slouken@278
   147
slouken@278
   148
static int	report_alloc(struct report *, struct report_desc *, int);
slouken@278
   149
static void	report_free(struct report *);
slouken@278
   150
slouken@4323
   151
#if defined(USBHID_UCR_DATA) || (defined(__FREEBSD__) && (__FreeBSD_kernel_version > 800063))
slouken@381
   152
#define REP_BUF_DATA(rep) ((rep)->buf->ucr_data)
slouken@381
   153
#else
slouken@381
   154
#define REP_BUF_DATA(rep) ((rep)->buf->data)
slouken@381
   155
#endif
slouken@381
   156
slouken@278
   157
int
slouken@278
   158
SDL_SYS_JoystickInit(void)
slouken@278
   159
{
slouken@503
   160
	char s[16];
slouken@278
   161
	int i, fd;
slouken@278
   162
slouken@278
   163
	SDL_numjoysticks = 0;
slouken@278
   164
slouken@1336
   165
	SDL_memset(joynames, 0, sizeof(joynames));
slouken@1336
   166
	SDL_memset(joydevnames, 0, sizeof(joydevnames));
slouken@278
   167
slouken@278
   168
	for (i = 0; i < MAX_UHID_JOYS; i++) {
slouken@544
   169
		SDL_Joystick nj;
slouken@544
   170
slouken@1338
   171
		SDL_snprintf(s, SDL_arraysize(s), "/dev/uhid%d", i);
slouken@544
   172
slouken@544
   173
		nj.index = SDL_numjoysticks;
slouken@544
   174
		joynames[nj.index] = strdup(s);
slouken@544
   175
slouken@544
   176
		if (SDL_SYS_JoystickOpen(&nj) == 0) {
slouken@544
   177
			SDL_SYS_JoystickClose(&nj);
slouken@544
   178
			SDL_numjoysticks++;
slouken@544
   179
		} else {
slouken@1336
   180
			SDL_free(joynames[nj.index]);
slouken@965
   181
			joynames[nj.index] = NULL;
slouken@278
   182
		}
slouken@278
   183
	}
slouken@278
   184
	for (i = 0; i < MAX_JOY_JOYS; i++) {
slouken@1338
   185
		SDL_snprintf(s, SDL_arraysize(s), "/dev/joy%d", i);
slouken@544
   186
		fd = open(s, O_RDONLY);
slouken@544
   187
		if (fd != -1) {
slouken@278
   188
			joynames[SDL_numjoysticks++] = strdup(s);
slouken@278
   189
			close(fd);
slouken@278
   190
		}
slouken@278
   191
	}
slouken@278
   192
slouken@278
   193
	/* Read the default USB HID usage table. */
slouken@278
   194
	hid_init(NULL);
slouken@278
   195
slouken@278
   196
	return (SDL_numjoysticks);
slouken@278
   197
}
slouken@278
   198
slouken@278
   199
const char *
slouken@278
   200
SDL_SYS_JoystickName(int index)
slouken@278
   201
{
slouken@278
   202
	if (joydevnames[index] != NULL) {
slouken@278
   203
		return (joydevnames[index]);
slouken@278
   204
	}
slouken@278
   205
	return (joynames[index]);
slouken@278
   206
}
slouken@278
   207
slouken@632
   208
static int
slouken@632
   209
usage_to_joyaxe(unsigned usage)
slouken@632
   210
{
slouken@632
   211
    int joyaxe;
slouken@632
   212
    switch (usage) {
slouken@632
   213
    case HUG_X:
slouken@632
   214
	joyaxe = JOYAXE_X; break;
slouken@632
   215
    case HUG_Y:
slouken@632
   216
	joyaxe = JOYAXE_Y; break;
slouken@632
   217
    case HUG_Z:
slouken@632
   218
	joyaxe = JOYAXE_Z; break;
slouken@632
   219
    case HUG_SLIDER:
slouken@632
   220
	joyaxe = JOYAXE_SLIDER; break;
slouken@632
   221
    case HUG_WHEEL:
slouken@632
   222
	joyaxe = JOYAXE_WHEEL; break;
slouken@632
   223
    case HUG_RX:
slouken@632
   224
	joyaxe = JOYAXE_RX; break;
slouken@632
   225
    case HUG_RY:
slouken@632
   226
	joyaxe = JOYAXE_RY; break;
slouken@632
   227
    case HUG_RZ:
slouken@632
   228
	joyaxe = JOYAXE_RZ; break;
slouken@632
   229
    default:
slouken@632
   230
	joyaxe = -1;
slouken@632
   231
    }
slouken@632
   232
    return joyaxe;    
slouken@632
   233
}
slouken@632
   234
slouken@632
   235
static unsigned
slouken@632
   236
hatval_to_sdl(Sint32 hatval)
slouken@632
   237
{
slouken@632
   238
    static const unsigned hat_dir_map[8] = {
slouken@632
   239
	SDL_HAT_UP, SDL_HAT_RIGHTUP, SDL_HAT_RIGHT, SDL_HAT_RIGHTDOWN, 
slouken@632
   240
	SDL_HAT_DOWN, SDL_HAT_LEFTDOWN, SDL_HAT_LEFT, SDL_HAT_LEFTUP
slouken@632
   241
    };
slouken@632
   242
    unsigned result;
slouken@632
   243
    if ((hatval & 7) == hatval) 
slouken@632
   244
	result = hat_dir_map[hatval];
slouken@632
   245
    else 
slouken@632
   246
	result = SDL_HAT_CENTERED;
slouken@632
   247
    return result;
slouken@632
   248
}
slouken@632
   249
slouken@632
   250
slouken@278
   251
int
slouken@278
   252
SDL_SYS_JoystickOpen(SDL_Joystick *joy)
slouken@278
   253
{
slouken@278
   254
	char *path = joynames[joy->index];
slouken@278
   255
	struct joystick_hwdata *hw;
slouken@278
   256
	struct hid_item hitem;
slouken@278
   257
	struct hid_data *hdata;
slouken@278
   258
	struct report *rep;
slouken@278
   259
	int fd;
slouken@1565
   260
	int i;
slouken@278
   261
slouken@715
   262
	fd = open(path, O_RDONLY);
slouken@544
   263
	if (fd == -1) {
slouken@278
   264
		SDL_SetError("%s: %s", path, strerror(errno));
slouken@278
   265
		return (-1);
slouken@278
   266
	}
slouken@278
   267
slouken@1336
   268
	hw = (struct joystick_hwdata *)SDL_malloc(sizeof(struct joystick_hwdata));
slouken@278
   269
	if (hw == NULL) {
slouken@278
   270
		SDL_OutOfMemory();
slouken@278
   271
		close(fd);
slouken@278
   272
		return (-1);
slouken@278
   273
	}
slouken@278
   274
	joy->hwdata = hw;
slouken@278
   275
	hw->fd = fd;
slouken@278
   276
	hw->path = strdup(path);
slouken@4022
   277
	hw->x = 0;
slouken@4022
   278
	hw->y = 0;
slouken@4022
   279
	hw->xmin = 0xffff;
slouken@4022
   280
	hw->ymin = 0xffff;
slouken@4022
   281
	hw->xmax = 0;
slouken@4022
   282
	hw->ymax = 0;
slouken@1336
   283
	if (! SDL_strncmp(path, "/dev/joy", 8)) {
slouken@776
   284
		hw->type = BSDJOY_JOY;
slouken@776
   285
		joy->naxes = 2;
slouken@776
   286
		joy->nbuttons = 2;
slouken@776
   287
		joy->nhats = 0;
slouken@776
   288
		joy->nballs = 0;
slouken@776
   289
		joydevnames[joy->index] = strdup("Gameport joystick");
slouken@776
   290
		goto usbend;
slouken@776
   291
	} else {
slouken@776
   292
		hw->type = BSDJOY_UHID;
slouken@776
   293
	}
slouken@776
   294
slouken@632
   295
	{
slouken@632
   296
	    int ax;
slouken@632
   297
	    for (ax = 0; ax < JOYAXE_count; ax++)
slouken@632
   298
		hw->axis_map[ax] = -1;
slouken@632
   299
	}
slouken@278
   300
	hw->repdesc = hid_get_report_desc(fd);
slouken@278
   301
	if (hw->repdesc == NULL) {
slouken@278
   302
		SDL_SetError("%s: USB_GET_REPORT_DESC: %s", hw->path,
slouken@278
   303
		    strerror(errno));
slouken@278
   304
		goto usberr;
slouken@278
   305
	}
slouken@4323
   306
#if defined(__FREEBSD__) && (__FreeBSD_kernel_version > 800063)
slouken@4323
   307
       rep->rid = hid_get_report_id(fd);
slouken@4323
   308
       if (rep->rid < 0) {
slouken@4323
   309
#else
slouken@278
   310
	rep = &hw->inreport;
slouken@1559
   311
	if (ioctl(fd, USB_GET_REPORT_ID, &rep->rid) < 0) {
slouken@4323
   312
#endif
slouken@1559
   313
		rep->rid = -1; /* XXX */
slouken@1559
   314
	}
slouken@278
   315
	if (report_alloc(rep, hw->repdesc, REPORT_INPUT) < 0) {
slouken@278
   316
		goto usberr;
slouken@278
   317
	}
slouken@278
   318
	if (rep->size <= 0) {
slouken@307
   319
		SDL_SetError("%s: Input report descriptor has invalid length",
slouken@307
   320
		    hw->path);
slouken@278
   321
		goto usberr;
slouken@278
   322
	}
slouken@278
   323
slouken@4305
   324
#if defined(USBHID_NEW) || (defined(__FREEBSD__) && __FreeBSD_kernel_version >= 500111)
slouken@407
   325
	hdata = hid_start_parse(hw->repdesc, 1 << hid_input, rep->rid);
slouken@407
   326
#else
slouken@278
   327
	hdata = hid_start_parse(hw->repdesc, 1 << hid_input);
slouken@407
   328
#endif
slouken@278
   329
	if (hdata == NULL) {
slouken@278
   330
		SDL_SetError("%s: Cannot start HID parser", hw->path);
slouken@278
   331
		goto usberr;
slouken@278
   332
	}
slouken@278
   333
	joy->naxes = 0;
slouken@278
   334
	joy->nbuttons = 0;
slouken@278
   335
	joy->nhats = 0;
slouken@278
   336
	joy->nballs = 0;
slouken@1565
   337
	for (i=0; i<JOYAXE_count; i++)
slouken@1565
   338
		hw->axis_map[i] = -1;
slouken@278
   339
slouken@278
   340
	while (hid_get_item(hdata, &hitem) > 0) {
slouken@358
   341
		char *sp;
slouken@358
   342
		const char *s;
slouken@278
   343
slouken@278
   344
		switch (hitem.kind) {
slouken@278
   345
		case hid_collection:
slouken@278
   346
			switch (HID_PAGE(hitem.usage)) {
slouken@278
   347
			case HUP_GENERIC_DESKTOP:
slouken@278
   348
				switch (HID_USAGE(hitem.usage)) {
slouken@278
   349
				case HUG_JOYSTICK:
slouken@278
   350
				case HUG_GAME_PAD:
slouken@278
   351
					s = hid_usage_in_page(hitem.usage);
slouken@1336
   352
					sp = SDL_malloc(SDL_strlen(s) + 5);
slouken@1338
   353
					SDL_snprintf(sp, SDL_strlen(s) + 5, "%s (%d)", s,
slouken@278
   354
					    joy->index);
slouken@278
   355
					joydevnames[joy->index] = sp;
slouken@278
   356
				}
slouken@278
   357
			}
slouken@278
   358
			break;
slouken@278
   359
		case hid_input:
slouken@278
   360
			switch (HID_PAGE(hitem.usage)) {
slouken@632
   361
			case HUP_GENERIC_DESKTOP: {
slouken@632
   362
			    unsigned usage = HID_USAGE(hitem.usage);
slouken@632
   363
			    int joyaxe = usage_to_joyaxe(usage);
slouken@632
   364
			    if (joyaxe >= 0) {
slouken@1565
   365
				hw->axis_map[joyaxe] = 1;
slouken@632
   366
			    } else if (usage == HUG_HAT_SWITCH) {
slouken@632
   367
				joy->nhats++;
slouken@632
   368
			    }
slouken@632
   369
			    break;
slouken@632
   370
			}
slouken@278
   371
			case HUP_BUTTON:
slouken@278
   372
				joy->nbuttons++;
slouken@278
   373
				break;
slouken@405
   374
			default:
slouken@405
   375
				break;
slouken@278
   376
			}
slouken@278
   377
			break;
slouken@278
   378
		default:
slouken@278
   379
			break;
slouken@278
   380
		}
slouken@278
   381
	}
slouken@278
   382
	hid_end_parse(hdata);
slouken@1565
   383
	for (i=0; i<JOYAXE_count; i++)
slouken@1565
   384
		if (hw->axis_map[i] > 0)
slouken@1565
   385
			hw->axis_map[i] = joy->naxes++;
slouken@278
   386
slouken@776
   387
usbend:
slouken@278
   388
	/* The poll blocks the event thread. */
slouken@278
   389
	fcntl(fd, F_SETFL, O_NONBLOCK);
slouken@278
   390
slouken@278
   391
	return (0);
slouken@278
   392
usberr:
slouken@278
   393
	close(hw->fd);
slouken@1336
   394
	SDL_free(hw->path);
slouken@1336
   395
	SDL_free(hw);
slouken@278
   396
	return (-1);
slouken@278
   397
}
slouken@278
   398
slouken@278
   399
void
slouken@278
   400
SDL_SYS_JoystickUpdate(SDL_Joystick *joy)
slouken@278
   401
{
slouken@381
   402
	struct hid_item hitem;
slouken@381
   403
	struct hid_data *hdata;
slouken@381
   404
	struct report *rep;
slouken@358
   405
	int nbutton, naxe = -1;
slouken@307
   406
	Sint32 v;
slouken@776
   407
slouken@1565
   408
#if defined(__FREEBSD__) || SDL_JOYSTICK_USBHID_MACHINE_JOYSTICK_H
slouken@776
   409
	struct joystick gameport;
slouken@776
   410
 
slouken@776
   411
	if (joy->hwdata->type == BSDJOY_JOY) {
slouken@776
   412
		if (read(joy->hwdata->fd, &gameport, sizeof gameport) != sizeof gameport)
slouken@776
   413
			return;
slouken@4022
   414
		if (abs(joy->hwdata->x - gameport.x) > 8) {
slouken@4022
   415
			joy->hwdata->x = gameport.x;
slouken@4022
   416
			if (joy->hwdata->x < joy->hwdata->xmin) {
slouken@4022
   417
				joy->hwdata->xmin = joy->hwdata->x;
slouken@776
   418
			}
slouken@4022
   419
			if (joy->hwdata->x > joy->hwdata->xmax) {
slouken@4022
   420
				joy->hwdata->xmax = joy->hwdata->x;
slouken@776
   421
			}
slouken@4022
   422
			if (joy->hwdata->xmin == joy->hwdata->xmax) {
slouken@4022
   423
				joy->hwdata->xmin--;
slouken@4022
   424
				joy->hwdata->xmax++;
slouken@776
   425
			}
slouken@4022
   426
			v = (Sint32)joy->hwdata->x;
slouken@4022
   427
			v -= (joy->hwdata->xmax + joy->hwdata->xmin + 1)/2;
slouken@4022
   428
			v *= 32768/((joy->hwdata->xmax - joy->hwdata->xmin + 1)/2);
slouken@776
   429
			SDL_PrivateJoystickAxis(joy, 0, v);
slouken@776
   430
		}
slouken@4022
   431
		if (abs(joy->hwdata->y - gameport.y) > 8) {
slouken@4022
   432
			joy->hwdata->y = gameport.y;
slouken@4022
   433
			if (joy->hwdata->y < joy->hwdata->ymin) {
slouken@4022
   434
				joy->hwdata->ymin = joy->hwdata->y;
slouken@776
   435
			}
slouken@4022
   436
			if (joy->hwdata->y > joy->hwdata->ymax) {
slouken@4022
   437
				joy->hwdata->ymax = joy->hwdata->y;
slouken@776
   438
			}
slouken@4022
   439
			if (joy->hwdata->ymin == joy->hwdata->ymax) {
slouken@4022
   440
				joy->hwdata->ymin--;
slouken@4022
   441
				joy->hwdata->ymax++;
slouken@776
   442
			}
slouken@4022
   443
			v = (Sint32)joy->hwdata->y;
slouken@4022
   444
			v -= (joy->hwdata->ymax + joy->hwdata->ymin + 1)/2;
slouken@4022
   445
			v *= 32768/((joy->hwdata->ymax - joy->hwdata->ymin + 1)/2);
slouken@776
   446
			SDL_PrivateJoystickAxis(joy, 1, v);
slouken@776
   447
		}
slouken@776
   448
		if (gameport.b1 != joy->buttons[0]) {
slouken@776
   449
			SDL_PrivateJoystickButton(joy, 0, gameport.b1);
slouken@776
   450
		}
slouken@776
   451
		if (gameport.b2 != joy->buttons[1]) {
slouken@776
   452
			SDL_PrivateJoystickButton(joy, 1, gameport.b2);
slouken@776
   453
		}
slouken@776
   454
		return;
slouken@776
   455
	}
slouken@1565
   456
#endif /* defined(__FREEBSD__) || SDL_JOYSTICK_USBHID_MACHINE_JOYSTICK_H */
slouken@278
   457
	
slouken@278
   458
	rep = &joy->hwdata->inreport;
slouken@381
   459
slouken@381
   460
	if (read(joy->hwdata->fd, REP_BUF_DATA(rep), rep->size) != rep->size) {
slouken@278
   461
		return;
slouken@278
   462
	}
slouken@4305
   463
#if defined(USBHID_NEW) || (defined(__FREEBSD__) && __FreeBSD_kernel_version >= 500111)
slouken@407
   464
	hdata = hid_start_parse(joy->hwdata->repdesc, 1 << hid_input, rep->rid);
slouken@407
   465
#else
slouken@278
   466
	hdata = hid_start_parse(joy->hwdata->repdesc, 1 << hid_input);
slouken@407
   467
#endif
slouken@278
   468
	if (hdata == NULL) {
slouken@278
   469
		fprintf(stderr, "%s: Cannot start HID parser\n",
slouken@278
   470
		    joy->hwdata->path);
slouken@278
   471
		return;
slouken@278
   472
	}
slouken@278
   473
slouken@307
   474
	for (nbutton = 0; hid_get_item(hdata, &hitem) > 0;) {
slouken@278
   475
		switch (hitem.kind) {
slouken@278
   476
		case hid_input:
slouken@278
   477
			switch (HID_PAGE(hitem.usage)) {
slouken@632
   478
			case HUP_GENERIC_DESKTOP: {
slouken@632
   479
			    unsigned usage = HID_USAGE(hitem.usage);
slouken@632
   480
			    int joyaxe = usage_to_joyaxe(usage);
slouken@632
   481
			    if (joyaxe >= 0) {
slouken@632
   482
				naxe = joy->hwdata->axis_map[joyaxe];
slouken@632
   483
				/* scaleaxe */
slouken@381
   484
				v = (Sint32)hid_get_data(REP_BUF_DATA(rep),
slouken@632
   485
							 &hitem);
slouken@461
   486
				v -= (hitem.logical_maximum + hitem.logical_minimum + 1)/2;
slouken@461
   487
				v *= 32768/((hitem.logical_maximum - hitem.logical_minimum + 1)/2);
slouken@307
   488
				if (v != joy->axes[naxe]) {
slouken@632
   489
				    SDL_PrivateJoystickAxis(joy, naxe, v);
slouken@278
   490
				}
slouken@632
   491
			    } else if (usage == HUG_HAT_SWITCH) {
slouken@632
   492
				v = (Sint32)hid_get_data(REP_BUF_DATA(rep),
slouken@632
   493
							 &hitem);
slouken@1565
   494
				SDL_PrivateJoystickHat(joy, 0,
slouken@1565
   495
					hatval_to_sdl(v)-hitem.logical_minimum);
slouken@632
   496
			    }
slouken@632
   497
			    break;
slouken@632
   498
			}
slouken@278
   499
			case HUP_BUTTON:
slouken@381
   500
				v = (Sint32)hid_get_data(REP_BUF_DATA(rep),
slouken@307
   501
				    &hitem);
slouken@278
   502
				if (joy->buttons[nbutton] != v) {
slouken@278
   503
					SDL_PrivateJoystickButton(joy,
slouken@278
   504
					    nbutton, v);
slouken@278
   505
				}
slouken@278
   506
				nbutton++;
slouken@278
   507
				break;
slouken@405
   508
			default:
slouken@405
   509
				continue;
slouken@278
   510
			}
slouken@278
   511
			break;
slouken@278
   512
		default:
slouken@278
   513
			break;
slouken@278
   514
		}
slouken@278
   515
	}
slouken@278
   516
	hid_end_parse(hdata);
slouken@278
   517
slouken@278
   518
	return;
slouken@278
   519
}
slouken@278
   520
slouken@278
   521
/* Function to close a joystick after use */
slouken@278
   522
void
slouken@278
   523
SDL_SYS_JoystickClose(SDL_Joystick *joy)
slouken@278
   524
{
slouken@1336
   525
	if (SDL_strncmp(joy->hwdata->path, "/dev/joy", 8))	{
slouken@776
   526
		report_free(&joy->hwdata->inreport);
slouken@776
   527
		hid_dispose_report_desc(joy->hwdata->repdesc);
slouken@776
   528
	}
slouken@278
   529
	close(joy->hwdata->fd);
slouken@1336
   530
	SDL_free(joy->hwdata->path);
slouken@1336
   531
	SDL_free(joy->hwdata);
slouken@278
   532
slouken@278
   533
	return;
slouken@278
   534
}
slouken@278
   535
slouken@278
   536
void
slouken@278
   537
SDL_SYS_JoystickQuit(void)
slouken@278
   538
{
slouken@278
   539
	int i;
slouken@278
   540
slouken@278
   541
	for (i = 0; i < MAX_JOYS; i++) {
slouken@278
   542
		if (joynames[i] != NULL)
slouken@1336
   543
			SDL_free(joynames[i]);
slouken@278
   544
		if (joydevnames[i] != NULL)
slouken@1336
   545
			SDL_free(joydevnames[i]);
slouken@278
   546
	}
slouken@278
   547
slouken@278
   548
	return;
slouken@278
   549
}
slouken@278
   550
slouken@278
   551
static int
slouken@278
   552
report_alloc(struct report *r, struct report_desc *rd, int repind)
slouken@278
   553
{
slouken@278
   554
	int len;
slouken@278
   555
slouken@1565
   556
#ifdef __DragonFly__
slouken@1565
   557
	len = hid_report_size(rd, r->rid, repinfo[repind].kind);
slouken@1565
   558
#elif __FREEBSD__
slouken@4305
   559
# if (__FreeBSD_kernel_version >= 460000) || defined(__FreeBSD_kernel__)
slouken@4305
   560
#  if (__FreeBSD_kernel_version <= 500111)
slouken@552
   561
	len = hid_report_size(rd, r->rid, repinfo[repind].kind);
slouken@611
   562
#  else
slouken@611
   563
	len = hid_report_size(rd, repinfo[repind].kind, r->rid);
slouken@611
   564
#  endif
slouken@552
   565
# else
icculus@426
   566
	len = hid_report_size(rd, repinfo[repind].kind, &r->rid);
slouken@1565
   567
# endif
slouken@552
   568
#else
slouken@552
   569
# ifdef USBHID_NEW
slouken@1565
   570
	len = hid_report_size(rd, repinfo[repind].kind, r->rid);
slouken@1565
   571
# else
slouken@552
   572
	len = hid_report_size(rd, repinfo[repind].kind, &r->rid);
slouken@552
   573
# endif
slouken@552
   574
#endif
slouken@552
   575
slouken@278
   576
	if (len < 0) {
slouken@278
   577
		SDL_SetError("Negative HID report size");
slouken@278
   578
		return (-1);
slouken@278
   579
	}
slouken@278
   580
	r->size = len;
slouken@278
   581
slouken@278
   582
	if (r->size > 0) {
slouken@1336
   583
		r->buf = SDL_malloc(sizeof(*r->buf) - sizeof(REP_BUF_DATA(r)) +
slouken@278
   584
		    r->size);
slouken@278
   585
		if (r->buf == NULL) {
slouken@278
   586
			SDL_OutOfMemory();
slouken@278
   587
			return (-1);
slouken@278
   588
		}
slouken@278
   589
	} else {
slouken@278
   590
		r->buf = NULL;
slouken@278
   591
	}
slouken@278
   592
slouken@278
   593
	r->status = SREPORT_CLEAN;
slouken@278
   594
	return (0);
slouken@278
   595
}
slouken@278
   596
slouken@278
   597
static void
slouken@278
   598
report_free(struct report *r)
slouken@278
   599
{
slouken@278
   600
	if (r->buf != NULL) {
slouken@1336
   601
		SDL_free(r->buf);
slouken@278
   602
	}
slouken@278
   603
	r->status = SREPORT_UNINIT;
slouken@278
   604
}
slouken@278
   605
slouken@1635
   606
#endif /* SDL_JOYSTICK_USBHID */