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 } 160