lib/libu4bhid/descr.c

   1 /*      $NetBSD: descr.c,v 1.9 2000/09/24 02:13:24 augustss Exp $       */
   2
   3 /*
   4  * Copyright (c) 1999 Lennart Augustsson <augustss@netbsd.org>
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  26  * SUCH DAMAGE.
  27  *
  28  * $FreeBSD: head/lib/libusbhid/descr.c 240762 2012-09-20 18:56:27Z mav $
  29  */
  30
  31 #include <sys/types.h>
  32
  33 #include <assert.h>
  34 #include <errno.h>
  35 #include <stdlib.h>
  36 #include <string.h>
  37 #include <unistd.h>
  38 #include <sys/time.h>
  39 #include <sys/ioctl.h>
  40 #include <bus/u4b/usb_ioctl.h>
  41
  42 #include "usbhid.h"
  43 #include "usbvar.h"
  44
  45 int
  46 hid_set_immed(int fd, int enable)
  47 {
  48         int ret;
  49         ret = ioctl(fd, USB_SET_IMMED, &enable);
  50         return (ret);
  51 }
  52
  53 int
  54 hid_get_report_id(int fd)
  55 {
  56         report_desc_t rep;
  57         hid_data_t d;
  58         hid_item_t h;
  59         int kindset;
  60         int temp = -1;
  61         int ret;
  62
  63         if ((rep = hid_get_report_desc(fd)) == NULL)
  64                 goto use_ioctl;
  65         kindset = 1 << hid_input | 1 << hid_output | 1 << hid_feature;
  66         for (d = hid_start_parse(rep, kindset, -1); hid_get_item(d, &h); ) {
  67                 /* Return the first report ID we met. */
  68                 if (h.report_ID != 0) {
  69                         temp = h.report_ID;
  70                         break;
  71                 }
  72         }
  73         hid_end_parse(d);
  74         hid_dispose_report_desc(rep);
  75
  76         if (temp > 0)
  77                 return (temp);
  78
  79 use_ioctl:
  80         ret = ioctl(fd, USB_GET_REPORT_ID, &temp);
  81         ret = temp;
  82
  83         return (ret);
  84 }
  85
  86 report_desc_t
  87 hid_get_report_desc(int fd)
  88 {
  89         struct usb_gen_descriptor ugd;
  90         report_desc_t rep;
  91         void *data;
  92
  93         memset(&ugd, 0, sizeof(ugd));
  94
  95         /* get actual length first */
  96         ugd.ugd_data = hid_pass_ptr(NULL);
  97         ugd.ugd_maxlen = 65535;
  98         if (ioctl(fd, USB_GET_REPORT_DESC, &ugd) < 0)
  99                 return (NULL);
 100
 101         /*
 102          * NOTE: The kernel will return a failure if
 103          * "ugd_actlen" is zero.
 104          */
 105         data = malloc(ugd.ugd_actlen);
 106         if (data == NULL)
 107                 return (NULL);
 108
 109         /* fetch actual descriptor */
 110         ugd.ugd_data = hid_pass_ptr(data);
 111         ugd.ugd_maxlen = ugd.ugd_actlen;
 112         if (ioctl(fd, USB_GET_REPORT_DESC, &ugd) < 0) {
 113                 /* could not read descriptor */
 114                 free(data);
 115                 return (NULL);
 116         }
 117
 118         /* sanity check */
 119         if (ugd.ugd_actlen < 1) {
 120                 /* invalid report descriptor */
 121                 free(data);
 122                 return (NULL);
 123         }
 124
 125         /* check END_COLLECTION */
 126         if (((unsigned char *)data)[ugd.ugd_actlen -1] != 0xC0) {
 127                 /* invalid end byte */
 128                 free(data);
 129                 return (NULL);
 130         }
 131
 132         rep = hid_use_report_desc(data, ugd.ugd_actlen);
 133
 134         free(data);
 135
 136         return (rep);
 137 }
 138
 139 report_desc_t
 140 hid_use_report_desc(unsigned char *data, unsigned int size)
 141 {
 142         report_desc_t r;
 143
 144         r = malloc(sizeof(*r) + size);
 145         if (r == 0) {
 146                 errno = ENOMEM;
 147                 return (NULL);
 148         }
 149         r->size = size;
 150         memcpy(r->data, data, size);
 151         return (r);
 152 }
 153
 154 void
 155 hid_dispose_report_desc(report_desc_t r)
 156 {
 157
 158         free(r);
 159 }