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 #ifdef HID_COMPAT7 51 if (ret < 0) 52 ret = hid_set_immed_compat7(fd, enable); 53 #endif 54 return (ret); 55 } 56 57 int 58 hid_get_report_id(int fd) 59 { 60 report_desc_t rep; 61 hid_data_t d; 62 hid_item_t h; 63 int kindset; 64 int temp = -1; 65 int ret; 66 67 if ((rep = hid_get_report_desc(fd)) == NULL) 68 goto use_ioctl; 69 kindset = 1 << hid_input | 1 << hid_output | 1 << hid_feature; 70 for (d = hid_start_parse(rep, kindset, -1); hid_get_item(d, &h); ) { 71 /* Return the first report ID we met. */ 72 if (h.report_ID != 0) { 73 temp = h.report_ID; 74 break; 75 } 76 } 77 hid_end_parse(d); 78 hid_dispose_report_desc(rep); 79 80 if (temp > 0) 81 return (temp); 82 83 use_ioctl: 84 ret = ioctl(fd, USB_GET_REPORT_ID, &temp); 85 #ifdef HID_COMPAT7 86 if (ret < 0) 87 ret = hid_get_report_id_compat7(fd); 88 else 89 #endif 90 ret = temp; 91 92 return (ret); 93 } 94 95 report_desc_t 96 hid_get_report_desc(int fd) 97 { 98 struct usb_gen_descriptor ugd; 99 report_desc_t rep; 100 void *data; 101 102 memset(&ugd, 0, sizeof(ugd)); 103 104 /* get actual length first */ 105 ugd.ugd_data = hid_pass_ptr(NULL); 106 ugd.ugd_maxlen = 65535; 107 if (ioctl(fd, USB_GET_REPORT_DESC, &ugd) < 0) { 108 #ifdef HID_COMPAT7 109 /* could not read descriptor */ 110 /* try FreeBSD 7 compat code */ 111 return (hid_get_report_desc_compat7(fd)); 112 #else 113 return (NULL); 114 #endif 115 } 116 117 /* 118 * NOTE: The kernel will return a failure if 119 * "ugd_actlen" is zero. 120 */ 121 data = malloc(ugd.ugd_actlen); 122 if (data == NULL) 123 return (NULL); 124 125 /* fetch actual descriptor */ 126 ugd.ugd_data = hid_pass_ptr(data); 127 ugd.ugd_maxlen = ugd.ugd_actlen; 128 if (ioctl(fd, USB_GET_REPORT_DESC, &ugd) < 0) { 129 /* could not read descriptor */ 130 free(data); 131 return (NULL); 132 } 133 134 /* sanity check */ 135 if (ugd.ugd_actlen < 1) { 136 /* invalid report descriptor */ 137 free(data); 138 return (NULL); 139 } 140 141 /* check END_COLLECTION */ 142 if (((unsigned char *)data)[ugd.ugd_actlen -1] != 0xC0) { 143 /* invalid end byte */ 144 free(data); 145 return (NULL); 146 } 147 148 rep = hid_use_report_desc(data, ugd.ugd_actlen); 149 150 free(data); 151 152 return (rep); 153 } 154 155 report_desc_t 156 hid_use_report_desc(unsigned char *data, unsigned int size) 157 { 158 report_desc_t r; 159 160 r = malloc(sizeof(*r) + size); 161 if (r == 0) { 162 errno = ENOMEM; 163 return (NULL); 164 } 165 r->size = size; 166 memcpy(r->data, data, size); 167 return (r); 168 } 169 170 void 171 hid_dispose_report_desc(report_desc_t r) 172 { 173 174 free(r); 175 } 176