src/joystick/bsd/SDL_sysjoystick.c
author Ryan C. Gordon <icculus@icculus.org>
Fri, 10 Aug 2018 14:42:40 -0400
changeset 12105 997ec56425a8
parent 12090 c3209fca27b2
child 12106 94f9bf5b9c36
permissions -rw-r--r--
bsd: Update joystick code for new interfaces.

(this is an untested push to see if buildbot likes it.)
slouken@278
     1
/*
slouken@5535
     2
  Simple DirectMedia Layer
slouken@11811
     3
  Copyright (C) 1997-2018 Sam Lantinga <slouken@libsdl.org>
slouken@278
     4
slouken@5535
     5
  This software is provided 'as-is', without any express or implied
slouken@5535
     6
  warranty.  In no event will the authors be held liable for any damages
slouken@5535
     7
  arising from the use of this software.
slouken@278
     8
slouken@5535
     9
  Permission is granted to anyone to use this software for any purpose,
slouken@5535
    10
  including commercial applications, and to alter it and redistribute it
slouken@5535
    11
  freely, subject to the following restrictions:
slouken@278
    12
slouken@5535
    13
  1. The origin of this software must not be misrepresented; you must not
slouken@5535
    14
     claim that you wrote the original software. If you use this software
slouken@5535
    15
     in a product, an acknowledgment in the product documentation would be
slouken@5535
    16
     appreciated but is not required.
slouken@5535
    17
  2. Altered source versions must be plainly marked as such, and must not be
slouken@5535
    18
     misrepresented as being the original software.
slouken@5535
    19
  3. This notice may not be removed or altered from any source distribution.
slouken@278
    20
*/
icculus@8093
    21
#include "../../SDL_internal.h"
slouken@278
    22
slouken@1635
    23
#ifdef SDL_JOYSTICK_USBHID
slouken@1635
    24
slouken@278
    25
/*
slouken@278
    26
 * Joystick driver for the uhid(4) interface found in OpenBSD,
slouken@278
    27
 * NetBSD and FreeBSD.
slouken@278
    28
 *
slouken@278
    29
 * Maintainer: <vedge at csoft.org>
slouken@278
    30
 */
slouken@278
    31
slouken@552
    32
#include <sys/param.h>
slouken@552
    33
slouken@278
    34
#include <unistd.h>
slouken@278
    35
#include <fcntl.h>
slouken@278
    36
#include <errno.h>
slouken@278
    37
slouken@3367
    38
#ifndef __FreeBSD_kernel_version
slouken@3367
    39
#define __FreeBSD_kernel_version __FreeBSD_version
slouken@3367
    40
#endif
slouken@3367
    41
slouken@403
    42
#if defined(HAVE_USB_H)
slouken@403
    43
#include <usb.h>
slouken@403
    44
#endif
slouken@1565
    45
#ifdef __DragonFly__
slouken@1565
    46
#include <bus/usb/usb.h>
slouken@1565
    47
#include <bus/usb/usbhid.h>
slouken@1565
    48
#else
slouken@278
    49
#include <dev/usb/usb.h>
slouken@278
    50
#include <dev/usb/usbhid.h>
slouken@1565
    51
#endif
slouken@358
    52
slouken@381
    53
#if defined(HAVE_USBHID_H)
slouken@381
    54
#include <usbhid.h>
slouken@381
    55
#elif defined(HAVE_LIBUSB_H)
slouken@381
    56
#include <libusb.h>
slouken@381
    57
#elif defined(HAVE_LIBUSBHID_H)
slouken@381
    58
#include <libusbhid.h>
slouken@358
    59
#endif
slouken@278
    60
slouken@4944
    61
#if defined(__FREEBSD__) || defined(__FreeBSD_kernel__)
slouken@1565
    62
#ifndef __DragonFly__
slouken@611
    63
#include <osreldate.h>
slouken@1565
    64
#endif
icculus@6080
    65
#if __FreeBSD_kernel_version > 800063
icculus@6080
    66
#include <dev/usb/usb_ioctl.h>
icculus@6080
    67
#endif
slouken@776
    68
#include <sys/joystick.h>
slouken@776
    69
#endif
slouken@776
    70
slouken@1565
    71
#if SDL_JOYSTICK_USBHID_MACHINE_JOYSTICK_H
slouken@776
    72
#include <machine/joystick.h>
slouken@611
    73
#endif
slouken@611
    74
slouken@278
    75
#include "SDL_joystick.h"
slouken@1361
    76
#include "../SDL_sysjoystick.h"
slouken@1361
    77
#include "../SDL_joystick_c.h"
slouken@278
    78
icculus@9986
    79
#define MAX_UHID_JOYS   64
slouken@7191
    80
#define MAX_JOY_JOYS    2
slouken@7191
    81
#define MAX_JOYS    (MAX_UHID_JOYS + MAX_JOY_JOYS)
slouken@278
    82
slouken@3385
    83
slouken@1895
    84
struct report
slouken@1895
    85
{
slouken@6963
    86
#if defined(__FREEBSD__) && (__FreeBSD_kernel_version > 900000)
slouken@6963
    87
    void *buf; /* Buffer */
slouken@6963
    88
#elif defined(__FREEBSD__) && (__FreeBSD_kernel_version > 800063)
icculus@6080
    89
    struct usb_gen_descriptor *buf; /* Buffer */
icculus@6080
    90
#else
slouken@1895
    91
    struct usb_ctl_report *buf; /* Buffer */
icculus@6080
    92
#endif
slouken@1895
    93
    size_t size;                /* Buffer size */
slouken@1895
    94
    int rid;                    /* Report ID */
slouken@1895
    95
    enum
slouken@1895
    96
    {
slouken@1895
    97
        SREPORT_UNINIT,
slouken@1895
    98
        SREPORT_CLEAN,
slouken@1895
    99
        SREPORT_DIRTY
slouken@1895
   100
    } status;
slouken@278
   101
};
slouken@278
   102
slouken@1895
   103
static struct
slouken@1895
   104
{
slouken@1895
   105
    int uhid_report;
slouken@1895
   106
    hid_kind_t kind;
slouken@1895
   107
    const char *name;
slouken@278
   108
} const repinfo[] = {
slouken@1895
   109
    {UHID_INPUT_REPORT, hid_input, "input"},
slouken@1895
   110
    {UHID_OUTPUT_REPORT, hid_output, "output"},
slouken@1895
   111
    {UHID_FEATURE_REPORT, hid_feature, "feature"}
slouken@278
   112
};
slouken@307
   113
slouken@1895
   114
enum
slouken@1895
   115
{
slouken@1895
   116
    REPORT_INPUT = 0,
slouken@1895
   117
    REPORT_OUTPUT = 1,
slouken@1895
   118
    REPORT_FEATURE = 2
slouken@307
   119
};
slouken@307
   120
slouken@1895
   121
enum
slouken@1895
   122
{
slouken@1895
   123
    JOYAXE_X,
slouken@1895
   124
    JOYAXE_Y,
slouken@1895
   125
    JOYAXE_Z,
slouken@1895
   126
    JOYAXE_SLIDER,
slouken@1895
   127
    JOYAXE_WHEEL,
slouken@1895
   128
    JOYAXE_RX,
slouken@1895
   129
    JOYAXE_RY,
slouken@1895
   130
    JOYAXE_RZ,
slouken@1895
   131
    JOYAXE_count
slouken@307
   132
};
slouken@278
   133
slouken@1895
   134
struct joystick_hwdata
slouken@1895
   135
{
slouken@1895
   136
    int fd;
slouken@1895
   137
    char *path;
slouken@1895
   138
    enum
slouken@1895
   139
    {
slouken@1895
   140
        BSDJOY_UHID,            /* uhid(4) */
slouken@1895
   141
        BSDJOY_JOY              /* joy(4) */
slouken@1895
   142
    } type;
slouken@1895
   143
    struct report_desc *repdesc;
slouken@1895
   144
    struct report inreport;
slouken@1895
   145
    int axis_map[JOYAXE_count]; /* map present JOYAXE_* to 0,1,.. */
slouken@278
   146
};
slouken@278
   147
slouken@278
   148
static char *joynames[MAX_JOYS];
slouken@278
   149
static char *joydevnames[MAX_JOYS];
slouken@278
   150
slouken@1895
   151
static int report_alloc(struct report *, struct report_desc *, int);
slouken@1895
   152
static void report_free(struct report *);
slouken@278
   153
slouken@6963
   154
#if defined(USBHID_UCR_DATA) || (defined(__FreeBSD_kernel__) && __FreeBSD_kernel_version <= 800063)
slouken@381
   155
#define REP_BUF_DATA(rep) ((rep)->buf->ucr_data)
slouken@6963
   156
#elif (defined(__FREEBSD__) && (__FreeBSD_kernel_version > 900000))
slouken@6963
   157
#define REP_BUF_DATA(rep) ((rep)->buf)
icculus@6080
   158
#elif (defined(__FREEBSD__) && (__FreeBSD_kernel_version > 800063))
icculus@6080
   159
#define REP_BUF_DATA(rep) ((rep)->buf->ugd_data)
slouken@381
   160
#else
slouken@381
   161
#define REP_BUF_DATA(rep) ((rep)->buf->data)
slouken@381
   162
#endif
slouken@381
   163
icculus@12105
   164
static int numjoysticks = 0;
slouken@6697
   165
icculus@12105
   166
static int
icculus@12105
   167
BSD_JoystickInit(void)
slouken@278
   168
{
slouken@1895
   169
    char s[16];
slouken@1895
   170
    int i, fd;
slouken@278
   171
icculus@12105
   172
    numjoysticks = 0;
slouken@278
   173
slouken@1895
   174
    SDL_memset(joynames, 0, sizeof(joynames));
slouken@1895
   175
    SDL_memset(joydevnames, 0, sizeof(joydevnames));
slouken@278
   176
slouken@1895
   177
    for (i = 0; i < MAX_UHID_JOYS; i++) {
slouken@1895
   178
        SDL_Joystick nj;
slouken@544
   179
slouken@1895
   180
        SDL_snprintf(s, SDL_arraysize(s), "/dev/uhid%d", i);
slouken@544
   181
icculus@12105
   182
        joynames[numjoysticks] = SDL_strdup(s);
slouken@544
   183
icculus@12105
   184
        if (BSD_JoystickOpen(&nj, numjoysticks) == 0) {
icculus@12105
   185
            BSD_JoystickClose(&nj);
icculus@12105
   186
            numjoysticks++;
slouken@1895
   187
        } else {
icculus@12105
   188
            SDL_free(joynames[numjoysticks]);
icculus@12105
   189
            joynames[numjoysticks] = NULL;
slouken@1895
   190
        }
slouken@1895
   191
    }
slouken@1895
   192
    for (i = 0; i < MAX_JOY_JOYS; i++) {
slouken@1895
   193
        SDL_snprintf(s, SDL_arraysize(s), "/dev/joy%d", i);
slouken@1895
   194
        fd = open(s, O_RDONLY);
slouken@1895
   195
        if (fd != -1) {
icculus@12105
   196
            joynames[numjoysticks++] = SDL_strdup(s);
slouken@1895
   197
            close(fd);
slouken@1895
   198
        }
slouken@1895
   199
    }
slouken@278
   200
slouken@1895
   201
    /* Read the default USB HID usage table. */
slouken@1895
   202
    hid_init(NULL);
slouken@278
   203
icculus@12105
   204
    return (numjoysticks);
slouken@278
   205
}
slouken@278
   206
icculus@12105
   207
static int
icculus@12105
   208
BSD_JoystickGetCount(void)
slouken@6707
   209
{
icculus@12105
   210
    return numjoysticks;
slouken@6707
   211
}
slouken@6707
   212
icculus@12105
   213
static void
icculus@12105
   214
BSD_JoystickDetect(void)
slouken@6707
   215
{
slouken@6707
   216
}
slouken@6707
   217
icculus@12105
   218
static const char *
icculus@12105
   219
BSD_JoystickGetDeviceName(int device_index)
slouken@278
   220
{
slouken@6707
   221
    if (joydevnames[device_index] != NULL) {
slouken@6707
   222
        return (joydevnames[device_index]);
slouken@1895
   223
    }
slouken@6707
   224
    return (joynames[device_index]);
slouken@6707
   225
}
slouken@6707
   226
slouken@6707
   227
/* Function to perform the mapping from device index to the instance id for this index */
icculus@12105
   228
static SDL_JoystickID
icculus@12105
   229
BSD_JoystickGetDeviceInstanceID(int device_index)
slouken@6707
   230
{
slouken@6707
   231
    return device_index;
slouken@278
   232
}
slouken@278
   233
slouken@632
   234
static int
slouken@632
   235
usage_to_joyaxe(unsigned usage)
slouken@632
   236
{
slouken@632
   237
    int joyaxe;
slouken@632
   238
    switch (usage) {
slouken@632
   239
    case HUG_X:
slouken@1895
   240
        joyaxe = JOYAXE_X;
slouken@1895
   241
        break;
slouken@632
   242
    case HUG_Y:
slouken@1895
   243
        joyaxe = JOYAXE_Y;
slouken@1895
   244
        break;
slouken@632
   245
    case HUG_Z:
slouken@1895
   246
        joyaxe = JOYAXE_Z;
slouken@1895
   247
        break;
slouken@632
   248
    case HUG_SLIDER:
slouken@1895
   249
        joyaxe = JOYAXE_SLIDER;
slouken@1895
   250
        break;
slouken@632
   251
    case HUG_WHEEL:
slouken@1895
   252
        joyaxe = JOYAXE_WHEEL;
slouken@1895
   253
        break;
slouken@632
   254
    case HUG_RX:
slouken@1895
   255
        joyaxe = JOYAXE_RX;
slouken@1895
   256
        break;
slouken@632
   257
    case HUG_RY:
slouken@1895
   258
        joyaxe = JOYAXE_RY;
slouken@1895
   259
        break;
slouken@632
   260
    case HUG_RZ:
slouken@1895
   261
        joyaxe = JOYAXE_RZ;
slouken@1895
   262
        break;
slouken@632
   263
    default:
slouken@1895
   264
        joyaxe = -1;
slouken@632
   265
    }
slouken@1895
   266
    return joyaxe;
slouken@632
   267
}
slouken@632
   268
slouken@632
   269
static unsigned
slouken@632
   270
hatval_to_sdl(Sint32 hatval)
slouken@632
   271
{
slouken@632
   272
    static const unsigned hat_dir_map[8] = {
slouken@1895
   273
        SDL_HAT_UP, SDL_HAT_RIGHTUP, SDL_HAT_RIGHT, SDL_HAT_RIGHTDOWN,
slouken@1895
   274
        SDL_HAT_DOWN, SDL_HAT_LEFTDOWN, SDL_HAT_LEFT, SDL_HAT_LEFTUP
slouken@632
   275
    };
slouken@632
   276
    unsigned result;
slouken@1895
   277
    if ((hatval & 7) == hatval)
slouken@1895
   278
        result = hat_dir_map[hatval];
slouken@1895
   279
    else
slouken@1895
   280
        result = SDL_HAT_CENTERED;
slouken@632
   281
    return result;
slouken@632
   282
}
slouken@632
   283
slouken@632
   284
icculus@12105
   285
static int
icculus@12105
   286
BSD_JoystickOpen(SDL_Joystick * joy, int device_index)
slouken@278
   287
{
slouken@6697
   288
    char *path = joynames[device_index];
slouken@1895
   289
    struct joystick_hwdata *hw;
slouken@1895
   290
    struct hid_item hitem;
slouken@1895
   291
    struct hid_data *hdata;
icculus@9986
   292
    struct report *rep = NULL;
slouken@1895
   293
    int fd;
slouken@1895
   294
    int i;
slouken@278
   295
slouken@1895
   296
    fd = open(path, O_RDONLY);
slouken@1895
   297
    if (fd == -1) {
icculus@7037
   298
        return SDL_SetError("%s: %s", path, strerror(errno));
slouken@1895
   299
    }
slouken@278
   300
slouken@6698
   301
    joy->instance_id = device_index;
slouken@1895
   302
    hw = (struct joystick_hwdata *)
slouken@1895
   303
        SDL_malloc(sizeof(struct joystick_hwdata));
slouken@1895
   304
    if (hw == NULL) {
slouken@1895
   305
        close(fd);
icculus@7037
   306
        return SDL_OutOfMemory();
slouken@1895
   307
    }
slouken@1895
   308
    joy->hwdata = hw;
slouken@1895
   309
    hw->fd = fd;
philipp@10187
   310
    hw->path = SDL_strdup(path);
slouken@1895
   311
    if (!SDL_strncmp(path, "/dev/joy", 8)) {
slouken@1895
   312
        hw->type = BSDJOY_JOY;
slouken@1895
   313
        joy->naxes = 2;
slouken@1895
   314
        joy->nbuttons = 2;
slouken@1895
   315
        joy->nhats = 0;
slouken@1895
   316
        joy->nballs = 0;
philipp@10187
   317
        joydevnames[device_index] = SDL_strdup("Gameport joystick");
slouken@1895
   318
        goto usbend;
slouken@1895
   319
    } else {
slouken@1895
   320
        hw->type = BSDJOY_UHID;
slouken@1895
   321
    }
slouken@776
   322
slouken@1895
   323
    {
slouken@1895
   324
        int ax;
slouken@1895
   325
        for (ax = 0; ax < JOYAXE_count; ax++)
slouken@1895
   326
            hw->axis_map[ax] = -1;
slouken@1895
   327
    }
slouken@1895
   328
    hw->repdesc = hid_get_report_desc(fd);
slouken@1895
   329
    if (hw->repdesc == NULL) {
slouken@1895
   330
        SDL_SetError("%s: USB_GET_REPORT_DESC: %s", hw->path,
slouken@1895
   331
                     strerror(errno));
slouken@1895
   332
        goto usberr;
slouken@1895
   333
    }
icculus@3703
   334
    rep = &hw->inreport;
slouken@4537
   335
#if defined(__FREEBSD__) && (__FreeBSD_kernel_version > 800063) || defined(__FreeBSD_kernel__)
slouken@3385
   336
    rep->rid = hid_get_report_id(fd);
slouken@3385
   337
    if (rep->rid < 0) {
slouken@3385
   338
#else
slouken@1895
   339
    if (ioctl(fd, USB_GET_REPORT_ID, &rep->rid) < 0) {
slouken@3385
   340
#endif
slouken@1895
   341
        rep->rid = -1;          /* XXX */
slouken@1895
   342
    }
icculus@9986
   343
#if defined(__NetBSD__)
icculus@9986
   344
    usb_device_descriptor_t udd;
icculus@9986
   345
    struct usb_string_desc usd;
icculus@9986
   346
    if (ioctl(fd, USB_GET_DEVICE_DESC, &udd) == -1)
icculus@9986
   347
        goto desc_failed;
icculus@9986
   348
icculus@9986
   349
    /* Get default language */
icculus@9986
   350
    usd.usd_string_index = USB_LANGUAGE_TABLE;
icculus@9986
   351
    usd.usd_language_id = 0;
icculus@9986
   352
    if (ioctl(fd, USB_GET_STRING_DESC, &usd) == -1 || usd.usd_desc.bLength < 4) {
icculus@9986
   353
        usd.usd_language_id = 0;
icculus@9986
   354
    } else {
icculus@9986
   355
        usd.usd_language_id = UGETW(usd.usd_desc.bString[0]);
icculus@9986
   356
    }
icculus@9986
   357
icculus@9986
   358
    usd.usd_string_index = udd.iProduct;
icculus@9986
   359
    if (ioctl(fd, USB_GET_STRING_DESC, &usd) == 0) {
icculus@9986
   360
        char str[128];
icculus@9986
   361
        char *new_name = NULL;
icculus@9986
   362
        int i;
icculus@9986
   363
        for (i = 0; i < (usd.usd_desc.bLength >> 1) - 1 && i < sizeof(str) - 1; i++) {
icculus@9986
   364
            str[i] = UGETW(usd.usd_desc.bString[i]);
icculus@9986
   365
        }
icculus@9986
   366
        str[i] = '\0';
icculus@9986
   367
        asprintf(&new_name, "%s @ %s", str, path);
icculus@9986
   368
        if (new_name != NULL) {
icculus@12105
   369
            SDL_free(joydevnames[numjoysticks]);
icculus@12105
   370
            joydevnames[numjoysticks] = new_name;
icculus@9986
   371
        }
icculus@9986
   372
    }
icculus@9986
   373
desc_failed:
icculus@9986
   374
#endif
slouken@1895
   375
    if (report_alloc(rep, hw->repdesc, REPORT_INPUT) < 0) {
slouken@1895
   376
        goto usberr;
slouken@1895
   377
    }
slouken@1895
   378
    if (rep->size <= 0) {
slouken@1895
   379
        SDL_SetError("%s: Input report descriptor has invalid length",
slouken@1895
   380
                     hw->path);
slouken@1895
   381
        goto usberr;
slouken@1895
   382
    }
slouken@4537
   383
#if defined(USBHID_NEW) || (defined(__FREEBSD__) && __FreeBSD_kernel_version >= 500111) || defined(__FreeBSD_kernel__)
slouken@1895
   384
    hdata = hid_start_parse(hw->repdesc, 1 << hid_input, rep->rid);
slouken@1895
   385
#else
slouken@1895
   386
    hdata = hid_start_parse(hw->repdesc, 1 << hid_input);
slouken@1895
   387
#endif
slouken@1895
   388
    if (hdata == NULL) {
slouken@1895
   389
        SDL_SetError("%s: Cannot start HID parser", hw->path);
slouken@1895
   390
        goto usberr;
slouken@1895
   391
    }
slouken@1895
   392
    joy->naxes = 0;
slouken@1895
   393
    joy->nbuttons = 0;
slouken@1895
   394
    joy->nhats = 0;
slouken@1895
   395
    joy->nballs = 0;
slouken@1895
   396
    for (i = 0; i < JOYAXE_count; i++)
slouken@1895
   397
        hw->axis_map[i] = -1;
slouken@278
   398
slouken@1895
   399
    while (hid_get_item(hdata, &hitem) > 0) {
slouken@1895
   400
        char *sp;
slouken@1895
   401
        const char *s;
slouken@278
   402
slouken@1895
   403
        switch (hitem.kind) {
slouken@1895
   404
        case hid_collection:
slouken@1895
   405
            switch (HID_PAGE(hitem.usage)) {
slouken@1895
   406
            case HUP_GENERIC_DESKTOP:
slouken@1895
   407
                switch (HID_USAGE(hitem.usage)) {
slouken@1895
   408
                case HUG_JOYSTICK:
slouken@1895
   409
                case HUG_GAME_PAD:
slouken@1895
   410
                    s = hid_usage_in_page(hitem.usage);
slouken@1895
   411
                    sp = SDL_malloc(SDL_strlen(s) + 5);
slouken@1895
   412
                    SDL_snprintf(sp, SDL_strlen(s) + 5, "%s (%d)",
slouken@6700
   413
                                 s, device_index);
slouken@6700
   414
                    joydevnames[device_index] = sp;
slouken@1895
   415
                }
slouken@1895
   416
            }
slouken@1895
   417
            break;
slouken@1895
   418
        case hid_input:
slouken@1895
   419
            switch (HID_PAGE(hitem.usage)) {
slouken@1895
   420
            case HUP_GENERIC_DESKTOP:
slouken@1895
   421
                {
slouken@1895
   422
                    unsigned usage = HID_USAGE(hitem.usage);
slouken@1895
   423
                    int joyaxe = usage_to_joyaxe(usage);
slouken@1895
   424
                    if (joyaxe >= 0) {
slouken@1895
   425
                        hw->axis_map[joyaxe] = 1;
slouken@1895
   426
                    } else if (usage == HUG_HAT_SWITCH) {
slouken@1895
   427
                        joy->nhats++;
slouken@1895
   428
                    }
slouken@1895
   429
                    break;
slouken@1895
   430
                }
slouken@1895
   431
            case HUP_BUTTON:
slouken@1895
   432
                joy->nbuttons++;
slouken@1895
   433
                break;
slouken@1895
   434
            default:
slouken@1895
   435
                break;
slouken@1895
   436
            }
slouken@1895
   437
            break;
slouken@1895
   438
        default:
slouken@1895
   439
            break;
slouken@1895
   440
        }
slouken@1895
   441
    }
slouken@1895
   442
    hid_end_parse(hdata);
slouken@1895
   443
    for (i = 0; i < JOYAXE_count; i++)
slouken@1895
   444
        if (hw->axis_map[i] > 0)
slouken@1895
   445
            hw->axis_map[i] = joy->naxes++;
slouken@278
   446
icculus@9986
   447
    if (joy->naxes == 0 && joy->nbuttons == 0 && joy->nhats == 0 && joy->nballs == 0) {
icculus@9986
   448
        SDL_SetError("%s: Not a joystick, ignoring", hw->path);
icculus@9986
   449
        goto usberr;
icculus@9986
   450
    }
icculus@9986
   451
slouken@1895
   452
  usbend:
slouken@1895
   453
    /* The poll blocks the event thread. */
slouken@1895
   454
    fcntl(fd, F_SETFL, O_NONBLOCK);
icculus@9986
   455
#ifdef __NetBSD__
icculus@9986
   456
    /* Flush pending events */
icculus@9986
   457
    if (rep) {
icculus@9986
   458
        while (read(joy->hwdata->fd, REP_BUF_DATA(rep), rep->size) == rep->size)
icculus@9986
   459
            ;
icculus@9986
   460
    }
icculus@9986
   461
#endif
slouken@278
   462
slouken@1895
   463
    return (0);
slouken@1895
   464
  usberr:
slouken@1895
   465
    close(hw->fd);
slouken@1895
   466
    SDL_free(hw->path);
slouken@1895
   467
    SDL_free(hw);
slouken@1895
   468
    return (-1);
slouken@278
   469
}
slouken@278
   470
icculus@12105
   471
static void
icculus@12105
   472
BSD_JoystickUpdate(SDL_Joystick * joy)
slouken@278
   473
{
slouken@1895
   474
    struct hid_item hitem;
slouken@1895
   475
    struct hid_data *hdata;
slouken@1895
   476
    struct report *rep;
slouken@1895
   477
    int nbutton, naxe = -1;
slouken@1895
   478
    Sint32 v;
slouken@776
   479
slouken@4537
   480
#if defined(__FREEBSD__) || SDL_JOYSTICK_USBHID_MACHINE_JOYSTICK_H || defined(__FreeBSD_kernel__)
slouken@1895
   481
    struct joystick gameport;
slouken@1895
   482
    static int x, y, xmin = 0xffff, ymin = 0xffff, xmax = 0, ymax = 0;
slouken@1895
   483
slouken@1895
   484
    if (joy->hwdata->type == BSDJOY_JOY) {
slouken@7733
   485
        while (read(joy->hwdata->fd, &gameport, sizeof gameport) == sizeof gameport) {
slouken@7733
   486
            if (abs(x - gameport.x) > 8) {
slouken@7733
   487
                x = gameport.x;
slouken@7733
   488
                if (x < xmin) {
slouken@7733
   489
                    xmin = x;
slouken@7733
   490
                }
slouken@7733
   491
                if (x > xmax) {
slouken@7733
   492
                    xmax = x;
slouken@7733
   493
                }
slouken@7733
   494
                if (xmin == xmax) {
slouken@7733
   495
                    xmin--;
slouken@7733
   496
                    xmax++;
slouken@7733
   497
                }
slouken@7733
   498
                v = (Sint32) x;
slouken@7733
   499
                v -= (xmax + xmin + 1) / 2;
slouken@7733
   500
                v *= 32768 / ((xmax - xmin + 1) / 2);
slouken@7733
   501
                SDL_PrivateJoystickAxis(joy, 0, v);
slouken@1895
   502
            }
slouken@7733
   503
            if (abs(y - gameport.y) > 8) {
slouken@7733
   504
                y = gameport.y;
slouken@7733
   505
                if (y < ymin) {
slouken@7733
   506
                    ymin = y;
slouken@7733
   507
                }
slouken@7733
   508
                if (y > ymax) {
slouken@7733
   509
                    ymax = y;
slouken@7733
   510
                }
slouken@7733
   511
                if (ymin == ymax) {
slouken@7733
   512
                    ymin--;
slouken@7733
   513
                    ymax++;
slouken@7733
   514
                }
slouken@7733
   515
                v = (Sint32) y;
slouken@7733
   516
                v -= (ymax + ymin + 1) / 2;
slouken@7733
   517
                v *= 32768 / ((ymax - ymin + 1) / 2);
slouken@7733
   518
                SDL_PrivateJoystickAxis(joy, 1, v);
slouken@1895
   519
            }
slouken@10745
   520
            SDL_PrivateJoystickButton(joy, 0, gameport.b1);
slouken@10745
   521
            SDL_PrivateJoystickButton(joy, 1, gameport.b2);
slouken@1895
   522
        }
slouken@1895
   523
        return;
slouken@1895
   524
    }
slouken@1565
   525
#endif /* defined(__FREEBSD__) || SDL_JOYSTICK_USBHID_MACHINE_JOYSTICK_H */
slouken@381
   526
slouken@1895
   527
    rep = &joy->hwdata->inreport;
slouken@1895
   528
slouken@7733
   529
    while (read(joy->hwdata->fd, REP_BUF_DATA(rep), rep->size) == rep->size) {
slouken@4537
   530
#if defined(USBHID_NEW) || (defined(__FREEBSD__) && __FreeBSD_kernel_version >= 500111) || defined(__FreeBSD_kernel__)
slouken@7733
   531
        hdata = hid_start_parse(joy->hwdata->repdesc, 1 << hid_input, rep->rid);
slouken@407
   532
#else
slouken@7733
   533
        hdata = hid_start_parse(joy->hwdata->repdesc, 1 << hid_input);
slouken@407
   534
#endif
slouken@7733
   535
        if (hdata == NULL) {
slouken@7733
   536
            /*fprintf(stderr, "%s: Cannot start HID parser\n", joy->hwdata->path);*/
slouken@7733
   537
            continue;
slouken@7733
   538
        }
slouken@278
   539
slouken@7733
   540
        for (nbutton = 0; hid_get_item(hdata, &hitem) > 0;) {
slouken@7733
   541
            switch (hitem.kind) {
slouken@7733
   542
            case hid_input:
slouken@7733
   543
                switch (HID_PAGE(hitem.usage)) {
slouken@7733
   544
                case HUP_GENERIC_DESKTOP:
slouken@7733
   545
                    {
slouken@7733
   546
                        unsigned usage = HID_USAGE(hitem.usage);
slouken@7733
   547
                        int joyaxe = usage_to_joyaxe(usage);
slouken@7733
   548
                        if (joyaxe >= 0) {
slouken@7733
   549
                            naxe = joy->hwdata->axis_map[joyaxe];
slouken@7733
   550
                            /* scaleaxe */
slouken@7733
   551
                            v = (Sint32) hid_get_data(REP_BUF_DATA(rep), &hitem);
slouken@7733
   552
                            v -= (hitem.logical_maximum +
slouken@7733
   553
                                  hitem.logical_minimum + 1) / 2;
slouken@7733
   554
                            v *= 32768 /
slouken@7733
   555
                                ((hitem.logical_maximum -
slouken@7733
   556
                                  hitem.logical_minimum + 1) / 2);
slouken@10745
   557
                            SDL_PrivateJoystickAxis(joy, naxe, v);
slouken@7733
   558
                        } else if (usage == HUG_HAT_SWITCH) {
slouken@7733
   559
                            v = (Sint32) hid_get_data(REP_BUF_DATA(rep), &hitem);
slouken@7733
   560
                            SDL_PrivateJoystickHat(joy, 0,
slouken@7733
   561
                                                   hatval_to_sdl(v) -
slouken@7733
   562
                                                   hitem.logical_minimum);
slouken@1895
   563
                        }
slouken@7733
   564
                        break;
slouken@1895
   565
                    }
slouken@7733
   566
                case HUP_BUTTON:
slouken@7733
   567
                    v = (Sint32) hid_get_data(REP_BUF_DATA(rep), &hitem);
slouken@10745
   568
                    SDL_PrivateJoystickButton(joy, nbutton, v);
slouken@7733
   569
                    nbutton++;
slouken@1895
   570
                    break;
slouken@7733
   571
                default:
slouken@7733
   572
                    continue;
slouken@1895
   573
                }
slouken@1895
   574
                break;
slouken@1895
   575
            default:
slouken@7733
   576
                break;
slouken@1895
   577
            }
slouken@1895
   578
        }
slouken@7733
   579
        hid_end_parse(hdata);
slouken@1895
   580
    }
slouken@278
   581
}
slouken@278
   582
slouken@278
   583
/* Function to close a joystick after use */
icculus@12105
   584
static void
icculus@12105
   585
BSD_JoystickClose(SDL_Joystick * joy)
slouken@278
   586
{
slouken@1895
   587
    if (SDL_strncmp(joy->hwdata->path, "/dev/joy", 8)) {
slouken@1895
   588
        report_free(&joy->hwdata->inreport);
slouken@1895
   589
        hid_dispose_report_desc(joy->hwdata->repdesc);
slouken@1895
   590
    }
slouken@1895
   591
    close(joy->hwdata->fd);
slouken@1895
   592
    SDL_free(joy->hwdata->path);
slouken@1895
   593
    SDL_free(joy->hwdata);
slouken@278
   594
}
slouken@278
   595
icculus@12105
   596
static void
icculus@12105
   597
BSD_JoystickQuit(void)
slouken@278
   598
{
slouken@1895
   599
    int i;
slouken@278
   600
slouken@1895
   601
    for (i = 0; i < MAX_JOYS; i++) {
slouken@7719
   602
        SDL_free(joynames[i]);
slouken@7719
   603
        SDL_free(joydevnames[i]);
slouken@1895
   604
    }
slouken@278
   605
slouken@1895
   606
    return;
slouken@278
   607
}
slouken@278
   608
icculus@12105
   609
static SDL_JoystickGUID
icculus@12105
   610
BSD_JoystickGetDeviceGUID( int device_index )
slouken@6697
   611
{
slouken@6744
   612
    SDL_JoystickGUID guid;
slouken@7191
   613
    /* the GUID is just the first 16 chars of the name for now */
icculus@12105
   614
    const char *name = BSD_JoystickNameForDeviceIndex( device_index );
slouken@6697
   615
    SDL_zero( guid );
slouken@6697
   616
    SDL_memcpy( &guid, name, SDL_min( sizeof(guid), SDL_strlen( name ) ) );
slouken@6697
   617
    return guid;
slouken@6697
   618
}
slouken@6697
   619
slouken@278
   620
static int
slouken@278
   621
report_alloc(struct report *r, struct report_desc *rd, int repind)
slouken@278
   622
{
slouken@1895
   623
    int len;
slouken@278
   624
slouken@1565
   625
#ifdef __DragonFly__
slouken@1895
   626
    len = hid_report_size(rd, r->rid, repinfo[repind].kind);
slouken@1565
   627
#elif __FREEBSD__
slouken@3366
   628
# if (__FreeBSD_kernel_version >= 460000) || defined(__FreeBSD_kernel__)
slouken@3366
   629
#  if (__FreeBSD_kernel_version <= 500111)
slouken@1895
   630
    len = hid_report_size(rd, r->rid, repinfo[repind].kind);
slouken@611
   631
#  else
slouken@1895
   632
    len = hid_report_size(rd, repinfo[repind].kind, r->rid);
slouken@611
   633
#  endif
slouken@552
   634
# else
slouken@1895
   635
    len = hid_report_size(rd, repinfo[repind].kind, &r->rid);
slouken@1565
   636
# endif
slouken@552
   637
#else
slouken@552
   638
# ifdef USBHID_NEW
slouken@1895
   639
    len = hid_report_size(rd, repinfo[repind].kind, r->rid);
slouken@1565
   640
# else
slouken@1895
   641
    len = hid_report_size(rd, repinfo[repind].kind, &r->rid);
slouken@552
   642
# endif
slouken@552
   643
#endif
slouken@552
   644
slouken@1895
   645
    if (len < 0) {
icculus@7037
   646
        return SDL_SetError("Negative HID report size");
slouken@1895
   647
    }
slouken@1895
   648
    r->size = len;
slouken@278
   649
slouken@1895
   650
    if (r->size > 0) {
slouken@6963
   651
#if defined(__FREEBSD__) && (__FreeBSD_kernel_version > 900000)
slouken@6963
   652
        r->buf = SDL_malloc(r->size);
slouken@6963
   653
#else
slouken@1895
   654
        r->buf = SDL_malloc(sizeof(*r->buf) - sizeof(REP_BUF_DATA(r)) +
slouken@1895
   655
                            r->size);
slouken@6963
   656
#endif
slouken@1895
   657
        if (r->buf == NULL) {
icculus@7037
   658
            return SDL_OutOfMemory();
slouken@1895
   659
        }
slouken@1895
   660
    } else {
slouken@1895
   661
        r->buf = NULL;
slouken@1895
   662
    }
slouken@278
   663
slouken@1895
   664
    r->status = SREPORT_CLEAN;
icculus@7037
   665
    return 0;
slouken@278
   666
}
slouken@278
   667
slouken@278
   668
static void
slouken@278
   669
report_free(struct report *r)
slouken@278
   670
{
slouken@7719
   671
    SDL_free(r->buf);
slouken@1895
   672
    r->status = SREPORT_UNINIT;
slouken@278
   673
}
slouken@278
   674
icculus@12105
   675
static int
icculus@12105
   676
BSD_JoystickRumble(SDL_Joystick * joystick, Uint16 low_frequency_rumble, Uint16 high_frequency_rumble, Uint32 duration_ms)
icculus@12105
   677
{
icculus@12105
   678
    return SDL_Unsupported();
icculus@12105
   679
}
icculus@12105
   680
icculus@12105
   681
SDL_JoystickDriver SDL_BSD_JoystickDriver =
icculus@12105
   682
{
icculus@12105
   683
    BSD_JoystickInit,
icculus@12105
   684
    BSD_JoystickGetCount,
icculus@12105
   685
    BSD_JoystickDetect,
icculus@12105
   686
    BSD_JoystickGetDeviceName,
icculus@12105
   687
    BSD_JoystickGetDeviceGUID,
icculus@12105
   688
    BSD_JoystickGetDeviceInstanceID,
icculus@12105
   689
    BSD_JoystickOpen,
icculus@12105
   690
    BSD_JoystickRumble,
icculus@12105
   691
    BSD_JoystickUpdate,
icculus@12105
   692
    BSD_JoystickClose,
icculus@12105
   693
    BSD_JoystickQuit,
icculus@12105
   694
};
icculus@12105
   695
slouken@1635
   696
#endif /* SDL_JOYSTICK_USBHID */
slouken@6697
   697
slouken@1895
   698
/* vi: set ts=4 sw=4 expandtab: */