1/* $FreeBSD: head/lib/libusb/libusb10_desc.c 195957 2009-07-30 00:11:41Z alfred $ */
|
| 1/* $FreeBSD: head/lib/libusb/libusb10_desc.c 199055 2009-11-08 20:03:52Z thompsa $ */ |
2/*-
3 * Copyright (c) 2009 Sylvestre Gallon. All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27#include <stdlib.h>
28#include <stdio.h>
29#include <pthread.h>
30#include <sys/queue.h>
31
32#include "libusb20.h"
33#include "libusb20_desc.h"
34#include "libusb20_int.h"
35#include "libusb.h"
36#include "libusb10.h"
37
|
38#define N_ALIGN(n) (-((-(n)) & (-8UL)))
39 |
40/* USB descriptors */
41
42int
43libusb_get_device_descriptor(libusb_device *dev,
44 struct libusb_device_descriptor *desc)
45{
46 struct LIBUSB20_DEVICE_DESC_DECODED *pdesc;
47 struct libusb20_device *pdev;
48
49 if ((dev == NULL) || (desc == NULL))
50 return (LIBUSB_ERROR_INVALID_PARAM);
51
52 pdev = dev->os_priv;
53 pdesc = libusb20_dev_get_device_desc(pdev);
54
55 desc->bLength = pdesc->bLength;
56 desc->bDescriptorType = pdesc->bDescriptorType;
57 desc->bcdUSB = pdesc->bcdUSB;
58 desc->bDeviceClass = pdesc->bDeviceClass;
59 desc->bDeviceSubClass = pdesc->bDeviceSubClass;
60 desc->bDeviceProtocol = pdesc->bDeviceProtocol;
61 desc->bMaxPacketSize0 = pdesc->bMaxPacketSize0;
62 desc->idVendor = pdesc->idVendor;
63 desc->idProduct = pdesc->idProduct;
64 desc->bcdDevice = pdesc->bcdDevice;
65 desc->iManufacturer = pdesc->iManufacturer;
66 desc->iProduct = pdesc->iProduct;
67 desc->iSerialNumber = pdesc->iSerialNumber;
68 desc->bNumConfigurations = pdesc->bNumConfigurations;
69
70 return (0);
71}
72
73int
74libusb_get_active_config_descriptor(libusb_device *dev,
75 struct libusb_config_descriptor **config)
76{
77 struct libusb20_device *pdev;
78 uint8_t config_index;
79
80 pdev = dev->os_priv;
81 config_index = libusb20_dev_get_config_index(pdev);
82
83 return (libusb_get_config_descriptor(dev, config_index, config));
84}
85
86int
87libusb_get_config_descriptor(libusb_device *dev, uint8_t config_index,
88 struct libusb_config_descriptor **config)
89{
90 struct libusb20_device *pdev;
91 struct libusb20_config *pconf;
92 struct libusb20_interface *pinf;
93 struct libusb20_endpoint *pend;
94 struct libusb_config_descriptor *pconfd;
95 struct libusb_interface_descriptor *ifd;
96 struct libusb_endpoint_descriptor *endd;
97 uint8_t *pextra;
98 uint16_t nextra;
99 uint8_t nif;
100 uint8_t nep;
101 uint8_t nalt;
102 uint8_t i;
103 uint8_t j;
104 uint8_t k;
105
106 if (dev == NULL || config == NULL)
107 return (LIBUSB_ERROR_INVALID_PARAM);
108
109 *config = NULL;
110
111 pdev = dev->os_priv;
112 pconf = libusb20_dev_alloc_config(pdev, config_index);
113
114 if (pconf == NULL)
115 return (LIBUSB_ERROR_NOT_FOUND);
116
117 nalt = nif = pconf->num_interface;
118 nep = 0;
|
117 nextra = pconf->extra.len;
|
| 119 nextra = N_ALIGN(pconf->extra.len); |
120
121 for (i = 0; i < nif; i++) {
122
123 pinf = pconf->interface + i;
|
122 nextra += pinf->extra.len;
|
| 124 nextra += N_ALIGN(pinf->extra.len); |
125 nep += pinf->num_endpoints;
126 k = pinf->num_endpoints;
127 pend = pinf->endpoints;
128 while (k--) {
|
127 nextra += pend->extra.len;
|
| 129 nextra += N_ALIGN(pend->extra.len); |
130 pend++;
131 }
132
133 j = pinf->num_altsetting;
134 nalt += pinf->num_altsetting;
135 pinf = pinf->altsetting;
136 while (j--) {
|
135 nextra += pinf->extra.len;
|
| 137 nextra += N_ALIGN(pinf->extra.len); |
138 nep += pinf->num_endpoints;
139 k = pinf->num_endpoints;
140 pend = pinf->endpoints;
141 while (k--) {
|
140 nextra += pend->extra.len;
|
| 142 nextra += N_ALIGN(pend->extra.len); |
143 pend++;
144 }
145 pinf++;
146 }
147 }
148
149 nextra = nextra +
150 (1 * sizeof(libusb_config_descriptor)) +
151 (nif * sizeof(libusb_interface)) +
152 (nalt * sizeof(libusb_interface_descriptor)) +
153 (nep * sizeof(libusb_endpoint_descriptor));
154
|
155 nextra = N_ALIGN(nextra);
156 |
157 pconfd = malloc(nextra);
158
159 if (pconfd == NULL) {
160 free(pconf);
161 return (LIBUSB_ERROR_NO_MEM);
162 }
|
159 /* make sure memory is clean */
|
| 163 /* make sure memory is initialised */ |
164 memset(pconfd, 0, nextra);
165
|
162 pconfd->interface = (libusb_interface *) (pconfd +
163 sizeof(libusb_config_descriptor));
|
| 166 pconfd->interface = (libusb_interface *) (pconfd + 1); |
167
168 ifd = (libusb_interface_descriptor *) (pconfd->interface + nif);
169 endd = (libusb_endpoint_descriptor *) (ifd + nalt);
170 pextra = (uint8_t *)(endd + nep);
171
172 /* fill in config descriptor */
173
174 pconfd->bLength = pconf->desc.bLength;
175 pconfd->bDescriptorType = pconf->desc.bDescriptorType;
176 pconfd->wTotalLength = pconf->desc.wTotalLength;
177 pconfd->bNumInterfaces = pconf->desc.bNumInterfaces;
178 pconfd->bConfigurationValue = pconf->desc.bConfigurationValue;
179 pconfd->iConfiguration = pconf->desc.iConfiguration;
180 pconfd->bmAttributes = pconf->desc.bmAttributes;
181 pconfd->MaxPower = pconf->desc.bMaxPower;
182
183 if (pconf->extra.len != 0) {
184 pconfd->extra_length = pconf->extra.len;
185 pconfd->extra = pextra;
186 memcpy(pextra, pconf->extra.ptr, pconfd->extra_length);
|
184 pextra += pconfd->extra_length;
|
| 187 pextra += N_ALIGN(pconfd->extra_length); |
188 }
189 /* setup all interface and endpoint pointers */
190
191 for (i = 0; i < nif; i++) {
192
193 pconfd->interface[i].altsetting = ifd;
194 ifd->endpoint = endd;
195 endd += pconf->interface[i].num_endpoints;
196 ifd++;
197
198 for (j = 0; j < pconf->interface[i].num_altsetting; j++) {
199 ifd->endpoint = endd;
200 endd += pconf->interface[i].altsetting[j].num_endpoints;
201 ifd++;
202 }
203 }
204
205 /* fill in all interface and endpoint data */
206
207 for (i = 0; i < nif; i++) {
208 pinf = &pconf->interface[i];
209 pconfd->interface[i].num_altsetting = pinf->num_altsetting + 1;
210 for (j = 0; j < pconfd->interface[i].num_altsetting; j++) {
211 if (j != 0)
212 pinf = &pconf->interface[i].altsetting[j - 1];
213 ifd = &pconfd->interface[i].altsetting[j];
214 ifd->bLength = pinf->desc.bLength;
215 ifd->bDescriptorType = pinf->desc.bDescriptorType;
216 ifd->bInterfaceNumber = pinf->desc.bInterfaceNumber;
217 ifd->bAlternateSetting = pinf->desc.bAlternateSetting;
218 ifd->bNumEndpoints = pinf->desc.bNumEndpoints;
219 ifd->bInterfaceClass = pinf->desc.bInterfaceClass;
220 ifd->bInterfaceSubClass = pinf->desc.bInterfaceSubClass;
221 ifd->bInterfaceProtocol = pinf->desc.bInterfaceProtocol;
222 ifd->iInterface = pinf->desc.iInterface;
223 if (pinf->extra.len != 0) {
224 ifd->extra_length = pinf->extra.len;
225 ifd->extra = pextra;
226 memcpy(pextra, pinf->extra.ptr, pinf->extra.len);
|
224 pextra += pinf->extra.len;
|
| 227 pextra += N_ALIGN(pinf->extra.len); |
228 }
229 for (k = 0; k < pinf->num_endpoints; k++) {
230 pend = &pinf->endpoints[k];
231 endd = &ifd->endpoint[k];
232 endd->bLength = pend->desc.bLength;
233 endd->bDescriptorType = pend->desc.bDescriptorType;
234 endd->bEndpointAddress = pend->desc.bEndpointAddress;
235 endd->bmAttributes = pend->desc.bmAttributes;
236 endd->wMaxPacketSize = pend->desc.wMaxPacketSize;
237 endd->bInterval = pend->desc.bInterval;
238 endd->bRefresh = pend->desc.bRefresh;
239 endd->bSynchAddress = pend->desc.bSynchAddress;
240 if (pend->extra.len != 0) {
241 endd->extra_length = pend->extra.len;
242 endd->extra = pextra;
243 memcpy(pextra, pend->extra.ptr, pend->extra.len);
|
241 pextra += pend->extra.len;
|
| 244 pextra += N_ALIGN(pend->extra.len); |
245 }
246 }
247 }
248 }
249
250 free(pconf);
251
252 *config = pconfd;
253
254 return (0); /* success */
255}
256
257int
258libusb_get_config_descriptor_by_value(libusb_device *dev,
259 uint8_t bConfigurationValue, struct libusb_config_descriptor **config)
260{
261 struct LIBUSB20_DEVICE_DESC_DECODED *pdesc;
262 struct libusb20_device *pdev;
263 int i;
264 int err;
265
266 if (dev == NULL || config == NULL)
267 return (LIBUSB_ERROR_INVALID_PARAM);
268
269 pdev = dev->os_priv;
270 pdesc = libusb20_dev_get_device_desc(pdev);
271
272 for (i = 0; i < pdesc->bNumConfigurations; i++) {
273 err = libusb_get_config_descriptor(dev, i, config);
274 if (err)
275 return (err);
276
277 if ((*config)->bConfigurationValue == bConfigurationValue)
278 return (0); /* success */
279
280 libusb_free_config_descriptor(*config);
281 }
282
283 *config = NULL;
284
285 return (LIBUSB_ERROR_NOT_FOUND);
286}
287
288void
289libusb_free_config_descriptor(struct libusb_config_descriptor *config)
290{
291 free(config);
292}
293
294int
295libusb_get_string_descriptor_ascii(libusb_device_handle *pdev,
296 uint8_t desc_index, unsigned char *data, int length)
297{
298 if (pdev == NULL || data == NULL || length < 1)
299 return (LIBUSB20_ERROR_INVALID_PARAM);
300
301 /* put some default data into the destination buffer */
302 data[0] = 0;
303
304 if (libusb20_dev_req_string_simple_sync(pdev, desc_index,
305 data, length) == 0)
306 return (strlen(data));
307
308 return (LIBUSB_ERROR_OTHER);
309}
|
310
311int
312libusb_get_descriptor(libusb_device_handle * devh, uint8_t desc_type,
313 uint8_t desc_index, uint8_t *data, int length)
314{
315 return (libusb_control_transfer(devh, LIBUSB_ENDPOINT_IN,
316 LIBUSB_REQUEST_GET_DESCRIPTOR, (desc_type << 8) | desc_index, 0, data,
317 length, 1000));
318} |
|