Branch data Line data Source code
1 : : #include <linux/usb.h>
2 : : #include <linux/usb/ch9.h>
3 : : #include <linux/usb/hcd.h>
4 : : #include <linux/usb/quirks.h>
5 : : #include <linux/module.h>
6 : : #include <linux/init.h>
7 : : #include <linux/slab.h>
8 : : #include <linux/device.h>
9 : : #include <asm/byteorder.h>
10 : : #include "usb.h"
11 : :
12 : :
13 : : #define USB_MAXALTSETTING 128 /* Hard limit */
14 : : #define USB_MAXENDPOINTS 30 /* Hard limit */
15 : :
16 : : #define USB_MAXCONFIG 8 /* Arbitrary limit */
17 : :
18 : :
19 : : static inline const char *plural(int n)
20 : : {
21 [ # # ][ # # ]: 0 : return (n == 1 ? "" : "s");
[ # # ]
22 : : }
23 : :
24 : : static int find_next_descriptor(unsigned char *buffer, int size,
25 : : int dt1, int dt2, int *num_skipped)
26 : : {
27 : : struct usb_descriptor_header *h;
28 : : int n = 0;
29 : : unsigned char *buffer0 = buffer;
30 : :
31 : : /* Find the next descriptor of type dt1 or dt2 */
32 [ # # ][ # # ]: 0 : while (size > 0) {
[ # # ][ # # ]
[ # # ]
33 : : h = (struct usb_descriptor_header *) buffer;
34 [ # # ][ # # ]: 0 : if (h->bDescriptorType == dt1 || h->bDescriptorType == dt2)
[ # # ][ # # ]
[ # # ][ # # ]
[ # # ][ # # ]
[ # # ][ # # ]
35 : : break;
36 : 0 : buffer += h->bLength;
37 : 0 : size -= h->bLength;
38 : : ++n;
39 : : }
40 : :
41 : : /* Store the number of descriptors skipped and return the
42 : : * number of bytes skipped */
43 : : if (num_skipped)
44 : : *num_skipped = n;
45 : 0 : return buffer - buffer0;
46 : : }
47 : :
48 : 0 : static void usb_parse_ss_endpoint_companion(struct device *ddev, int cfgno,
49 : : int inum, int asnum, struct usb_host_endpoint *ep,
50 : : unsigned char *buffer, int size)
51 : : {
52 : : struct usb_ss_ep_comp_descriptor *desc;
53 : : int max_tx;
54 : :
55 : : /* The SuperSpeed endpoint companion descriptor is supposed to
56 : : * be the first thing immediately following the endpoint descriptor.
57 : : */
58 : : desc = (struct usb_ss_ep_comp_descriptor *) buffer;
59 [ # # ][ # # ]: 0 : if (desc->bDescriptorType != USB_DT_SS_ENDPOINT_COMP ||
60 : : size < USB_DT_SS_EP_COMP_SIZE) {
61 : 0 : dev_warn(ddev, "No SuperSpeed endpoint companion for config %d "
62 : : " interface %d altsetting %d ep %d: "
63 : : "using minimum values\n",
64 : 0 : cfgno, inum, asnum, ep->desc.bEndpointAddress);
65 : :
66 : : /* Fill in some default values.
67 : : * Leave bmAttributes as zero, which will mean no streams for
68 : : * bulk, and isoc won't support multiple bursts of packets.
69 : : * With bursts of only one packet, and a Mult of 1, the max
70 : : * amount of data moved per endpoint service interval is one
71 : : * packet.
72 : : */
73 : 0 : ep->ss_ep_comp.bLength = USB_DT_SS_EP_COMP_SIZE;
74 : 0 : ep->ss_ep_comp.bDescriptorType = USB_DT_SS_ENDPOINT_COMP;
75 [ # # ][ # # ]: 0 : if (usb_endpoint_xfer_isoc(&ep->desc) ||
76 : : usb_endpoint_xfer_int(&ep->desc))
77 : 0 : ep->ss_ep_comp.wBytesPerInterval =
78 : 0 : ep->desc.wMaxPacketSize;
79 : 0 : return;
80 : : }
81 : :
82 : 0 : memcpy(&ep->ss_ep_comp, desc, USB_DT_SS_EP_COMP_SIZE);
83 : :
84 : : /* Check the various values */
85 [ # # ][ # # ]: 0 : if (usb_endpoint_xfer_control(&ep->desc) && desc->bMaxBurst != 0) {
86 : 0 : dev_warn(ddev, "Control endpoint with bMaxBurst = %d in "
87 : : "config %d interface %d altsetting %d ep %d: "
88 : : "setting to zero\n", desc->bMaxBurst,
89 : 0 : cfgno, inum, asnum, ep->desc.bEndpointAddress);
90 : 0 : ep->ss_ep_comp.bMaxBurst = 0;
91 [ # # ]: 0 : } else if (desc->bMaxBurst > 15) {
92 : 0 : dev_warn(ddev, "Endpoint with bMaxBurst = %d in "
93 : : "config %d interface %d altsetting %d ep %d: "
94 : : "setting to 15\n", desc->bMaxBurst,
95 : 0 : cfgno, inum, asnum, ep->desc.bEndpointAddress);
96 : 0 : ep->ss_ep_comp.bMaxBurst = 15;
97 : : }
98 : :
99 [ # # ][ # # ]: 0 : if ((usb_endpoint_xfer_control(&ep->desc) ||
100 [ # # ]: 0 : usb_endpoint_xfer_int(&ep->desc)) &&
101 : 0 : desc->bmAttributes != 0) {
102 [ # # ]: 0 : dev_warn(ddev, "%s endpoint with bmAttributes = %d in "
103 : : "config %d interface %d altsetting %d ep %d: "
104 : : "setting to zero\n",
105 : : usb_endpoint_xfer_control(&ep->desc) ? "Control" : "Bulk",
106 : : desc->bmAttributes,
107 : 0 : cfgno, inum, asnum, ep->desc.bEndpointAddress);
108 : 0 : ep->ss_ep_comp.bmAttributes = 0;
109 [ # # ][ # # ]: 0 : } else if (usb_endpoint_xfer_bulk(&ep->desc) &&
110 : 0 : desc->bmAttributes > 16) {
111 : 0 : dev_warn(ddev, "Bulk endpoint with more than 65536 streams in "
112 : : "config %d interface %d altsetting %d ep %d: "
113 : : "setting to max\n",
114 : 0 : cfgno, inum, asnum, ep->desc.bEndpointAddress);
115 : 0 : ep->ss_ep_comp.bmAttributes = 16;
116 [ # # ][ # # ]: 0 : } else if (usb_endpoint_xfer_isoc(&ep->desc) &&
117 : 0 : desc->bmAttributes > 2) {
118 : 0 : dev_warn(ddev, "Isoc endpoint has Mult of %d in "
119 : : "config %d interface %d altsetting %d ep %d: "
120 : : "setting to 3\n", desc->bmAttributes + 1,
121 : 0 : cfgno, inum, asnum, ep->desc.bEndpointAddress);
122 : 0 : ep->ss_ep_comp.bmAttributes = 2;
123 : : }
124 : :
125 [ # # ]: 0 : if (usb_endpoint_xfer_isoc(&ep->desc))
126 : 0 : max_tx = (desc->bMaxBurst + 1) * (desc->bmAttributes + 1) *
127 : : usb_endpoint_maxp(&ep->desc);
128 [ # # ]: 0 : else if (usb_endpoint_xfer_int(&ep->desc))
129 : 0 : max_tx = usb_endpoint_maxp(&ep->desc) *
130 : 0 : (desc->bMaxBurst + 1);
131 : : else
132 : : max_tx = 999999;
133 [ # # ]: 0 : if (le16_to_cpu(desc->wBytesPerInterval) > max_tx) {
134 [ # # ]: 0 : dev_warn(ddev, "%s endpoint with wBytesPerInterval of %d in "
135 : : "config %d interface %d altsetting %d ep %d: "
136 : : "setting to %d\n",
137 : : usb_endpoint_xfer_isoc(&ep->desc) ? "Isoc" : "Int",
138 : : le16_to_cpu(desc->wBytesPerInterval),
139 : 0 : cfgno, inum, asnum, ep->desc.bEndpointAddress,
140 : : max_tx);
141 : 0 : ep->ss_ep_comp.wBytesPerInterval = cpu_to_le16(max_tx);
142 : : }
143 : : }
144 : :
145 : 0 : static int usb_parse_endpoint(struct device *ddev, int cfgno, int inum,
146 : : int asnum, struct usb_host_interface *ifp, int num_ep,
147 : : unsigned char *buffer, int size)
148 : : {
149 : : unsigned char *buffer0 = buffer;
150 : 0 : struct usb_endpoint_descriptor *d;
151 : : struct usb_host_endpoint *endpoint;
152 : : int n, i, j, retval;
153 : :
154 : : d = (struct usb_endpoint_descriptor *) buffer;
155 : 0 : buffer += d->bLength;
156 : 0 : size -= d->bLength;
157 : :
158 [ # # ]: 0 : if (d->bLength >= USB_DT_ENDPOINT_AUDIO_SIZE)
159 : : n = USB_DT_ENDPOINT_AUDIO_SIZE;
160 [ # # ]: 0 : else if (d->bLength >= USB_DT_ENDPOINT_SIZE)
161 : : n = USB_DT_ENDPOINT_SIZE;
162 : : else {
163 : 0 : dev_warn(ddev, "config %d interface %d altsetting %d has an "
164 : : "invalid endpoint descriptor of length %d, skipping\n",
165 : : cfgno, inum, asnum, d->bLength);
166 : : goto skip_to_next_endpoint_or_interface_descriptor;
167 : : }
168 : :
169 : 0 : i = d->bEndpointAddress & ~USB_ENDPOINT_DIR_MASK;
170 [ # # ]: 0 : if (i >= 16 || i == 0) {
171 : 0 : dev_warn(ddev, "config %d interface %d altsetting %d has an "
172 : : "invalid endpoint with address 0x%X, skipping\n",
173 : : cfgno, inum, asnum, d->bEndpointAddress);
174 : : goto skip_to_next_endpoint_or_interface_descriptor;
175 : : }
176 : :
177 : : /* Only store as many endpoints as we have room for */
178 [ # # ]: 0 : if (ifp->desc.bNumEndpoints >= num_ep)
179 : : goto skip_to_next_endpoint_or_interface_descriptor;
180 : :
181 : 0 : endpoint = &ifp->endpoint[ifp->desc.bNumEndpoints];
182 : 0 : ++ifp->desc.bNumEndpoints;
183 : :
184 : 0 : memcpy(&endpoint->desc, d, n);
185 : 0 : INIT_LIST_HEAD(&endpoint->urb_list);
186 : :
187 : : /* Fix up bInterval values outside the legal range. Use 32 ms if no
188 : : * proper value can be guessed. */
189 : : i = 0; /* i = min, j = max, n = default */
190 : : j = 255;
191 [ # # ]: 0 : if (usb_endpoint_xfer_int(d)) {
192 : : i = 1;
193 [ # # ]: 0 : switch (to_usb_device(ddev)->speed) {
194 : : case USB_SPEED_SUPER:
195 : : case USB_SPEED_HIGH:
196 : : /* Many device manufacturers are using full-speed
197 : : * bInterval values in high-speed interrupt endpoint
198 : : * descriptors. Try to fix those and fall back to a
199 : : * 32 ms default value otherwise. */
200 : 0 : n = fls(d->bInterval*8);
201 [ # # ]: 0 : if (n == 0)
202 : : n = 9; /* 32 ms = 2^(9-1) uframes */
203 : : j = 16;
204 : : break;
205 : : default: /* USB_SPEED_FULL or _LOW */
206 : : /* For low-speed, 10 ms is the official minimum.
207 : : * But some "overclocked" devices might want faster
208 : : * polling so we'll allow it. */
209 : : n = 32;
210 : : break;
211 : : }
212 [ # # ]: 0 : } else if (usb_endpoint_xfer_isoc(d)) {
213 : : i = 1;
214 : : j = 16;
215 [ # # ]: 0 : switch (to_usb_device(ddev)->speed) {
216 : : case USB_SPEED_HIGH:
217 : : n = 9; /* 32 ms = 2^(9-1) uframes */
218 : : break;
219 : : default: /* USB_SPEED_FULL */
220 : : n = 6; /* 32 ms = 2^(6-1) frames */
221 : : break;
222 : : }
223 : : }
224 [ # # ][ # # ]: 0 : if (d->bInterval < i || d->bInterval > j) {
225 : 0 : dev_warn(ddev, "config %d interface %d altsetting %d "
226 : : "endpoint 0x%X has an invalid bInterval %d, "
227 : : "changing to %d\n",
228 : : cfgno, inum, asnum,
229 : 0 : d->bEndpointAddress, d->bInterval, n);
230 : 0 : endpoint->desc.bInterval = n;
231 : : }
232 : :
233 : : /* Some buggy low-speed devices have Bulk endpoints, which is
234 : : * explicitly forbidden by the USB spec. In an attempt to make
235 : : * them usable, we will try treating them as Interrupt endpoints.
236 : : */
237 [ # # ][ # # ]: 0 : if (to_usb_device(ddev)->speed == USB_SPEED_LOW &&
238 : : usb_endpoint_xfer_bulk(d)) {
239 : 0 : dev_warn(ddev, "config %d interface %d altsetting %d "
240 : : "endpoint 0x%X is Bulk; changing to Interrupt\n",
241 : 0 : cfgno, inum, asnum, d->bEndpointAddress);
242 : 0 : endpoint->desc.bmAttributes = USB_ENDPOINT_XFER_INT;
243 : 0 : endpoint->desc.bInterval = 1;
244 [ # # ]: 0 : if (usb_endpoint_maxp(&endpoint->desc) > 8)
245 : 0 : endpoint->desc.wMaxPacketSize = cpu_to_le16(8);
246 : : }
247 : :
248 : : /*
249 : : * Some buggy high speed devices have bulk endpoints using
250 : : * maxpacket sizes other than 512. High speed HCDs may not
251 : : * be able to handle that particular bug, so let's warn...
252 : : */
253 [ # # ]: 0 : if (to_usb_device(ddev)->speed == USB_SPEED_HIGH
254 [ # # ]: 0 : && usb_endpoint_xfer_bulk(d)) {
255 : : unsigned maxp;
256 : :
257 : 0 : maxp = usb_endpoint_maxp(&endpoint->desc) & 0x07ff;
258 [ # # ]: 0 : if (maxp != 512)
259 : 0 : dev_warn(ddev, "config %d interface %d altsetting %d "
260 : : "bulk endpoint 0x%X has invalid maxpacket %d\n",
261 : 0 : cfgno, inum, asnum, d->bEndpointAddress,
262 : : maxp);
263 : : }
264 : :
265 : : /* Parse a possible SuperSpeed endpoint companion descriptor */
266 [ # # ]: 0 : if (to_usb_device(ddev)->speed == USB_SPEED_SUPER)
267 : 0 : usb_parse_ss_endpoint_companion(ddev, cfgno,
268 : : inum, asnum, endpoint, buffer, size);
269 : :
270 : : /* Skip over any Class Specific or Vendor Specific descriptors;
271 : : * find the next endpoint or interface descriptor */
272 : 0 : endpoint->extra = buffer;
273 : : i = find_next_descriptor(buffer, size, USB_DT_ENDPOINT,
274 : : USB_DT_INTERFACE, &n);
275 : 0 : endpoint->extralen = i;
276 : 0 : retval = buffer - buffer0 + i;
277 : : if (n > 0)
278 : : dev_dbg(ddev, "skipped %d descriptor%s after %s\n",
279 : : n, plural(n), "endpoint");
280 : : return retval;
281 : :
282 : : skip_to_next_endpoint_or_interface_descriptor:
283 : : i = find_next_descriptor(buffer, size, USB_DT_ENDPOINT,
284 : : USB_DT_INTERFACE, NULL);
285 : 0 : return buffer - buffer0 + i;
286 : : }
287 : :
288 : 0 : void usb_release_interface_cache(struct kref *ref)
289 : : {
290 : 0 : struct usb_interface_cache *intfc = ref_to_usb_interface_cache(ref);
291 : : int j;
292 : :
293 [ # # ]: 0 : for (j = 0; j < intfc->num_altsetting; j++) {
294 : 0 : struct usb_host_interface *alt = &intfc->altsetting[j];
295 : :
296 : 0 : kfree(alt->endpoint);
297 : 0 : kfree(alt->string);
298 : : }
299 : 0 : kfree(intfc);
300 : 0 : }
301 : :
302 : 0 : static int usb_parse_interface(struct device *ddev, int cfgno,
303 : : struct usb_host_config *config, unsigned char *buffer, int size,
304 : : u8 inums[], u8 nalts[])
305 : : {
306 : : unsigned char *buffer0 = buffer;
307 : : struct usb_interface_descriptor *d;
308 : : int inum, asnum;
309 : : struct usb_interface_cache *intfc;
310 : : struct usb_host_interface *alt;
311 : : int i, n;
312 : : int len, retval;
313 : : int num_ep, num_ep_orig;
314 : :
315 : : d = (struct usb_interface_descriptor *) buffer;
316 : 0 : buffer += d->bLength;
317 : 0 : size -= d->bLength;
318 : :
319 [ # # ]: 0 : if (d->bLength < USB_DT_INTERFACE_SIZE)
320 : : goto skip_to_next_interface_descriptor;
321 : :
322 : : /* Which interface entry is this? */
323 : : intfc = NULL;
324 : 0 : inum = d->bInterfaceNumber;
325 [ # # ]: 0 : for (i = 0; i < config->desc.bNumInterfaces; ++i) {
326 [ # # ]: 0 : if (inums[i] == inum) {
327 : 0 : intfc = config->intf_cache[i];
328 : 0 : break;
329 : : }
330 : : }
331 [ # # ][ # # ]: 0 : if (!intfc || intfc->num_altsetting >= nalts[i])
332 : : goto skip_to_next_interface_descriptor;
333 : :
334 : : /* Check for duplicate altsetting entries */
335 : 0 : asnum = d->bAlternateSetting;
336 [ # # ]: 0 : for ((i = 0, alt = &intfc->altsetting[0]);
337 : 0 : i < intfc->num_altsetting;
338 : 0 : (++i, ++alt)) {
339 [ # # ]: 0 : if (alt->desc.bAlternateSetting == asnum) {
340 : 0 : dev_warn(ddev, "Duplicate descriptor for config %d "
341 : : "interface %d altsetting %d, skipping\n",
342 : : cfgno, inum, asnum);
343 : 0 : goto skip_to_next_interface_descriptor;
344 : : }
345 : : }
346 : :
347 : 0 : ++intfc->num_altsetting;
348 : 0 : memcpy(&alt->desc, d, USB_DT_INTERFACE_SIZE);
349 : :
350 : : /* Skip over any Class Specific or Vendor Specific descriptors;
351 : : * find the first endpoint or interface descriptor */
352 : 0 : alt->extra = buffer;
353 : : i = find_next_descriptor(buffer, size, USB_DT_ENDPOINT,
354 : : USB_DT_INTERFACE, &n);
355 : 0 : alt->extralen = i;
356 : : if (n > 0)
357 : : dev_dbg(ddev, "skipped %d descriptor%s after %s\n",
358 : : n, plural(n), "interface");
359 : 0 : buffer += i;
360 : 0 : size -= i;
361 : :
362 : : /* Allocate space for the right(?) number of endpoints */
363 : 0 : num_ep = num_ep_orig = alt->desc.bNumEndpoints;
364 : 0 : alt->desc.bNumEndpoints = 0; /* Use as a counter */
365 [ # # ]: 0 : if (num_ep > USB_MAXENDPOINTS) {
366 : 0 : dev_warn(ddev, "too many endpoints for config %d interface %d "
367 : : "altsetting %d: %d, using maximum allowed: %d\n",
368 : : cfgno, inum, asnum, num_ep, USB_MAXENDPOINTS);
369 : : num_ep = USB_MAXENDPOINTS;
370 : : }
371 : :
372 [ # # ]: 0 : if (num_ep > 0) {
373 : : /* Can't allocate 0 bytes */
374 : 0 : len = sizeof(struct usb_host_endpoint) * num_ep;
375 : 0 : alt->endpoint = kzalloc(len, GFP_KERNEL);
376 [ # # ]: 0 : if (!alt->endpoint)
377 : : return -ENOMEM;
378 : : }
379 : :
380 : : /* Parse all the endpoint descriptors */
381 : : n = 0;
382 [ # # ]: 0 : while (size > 0) {
383 [ # # ]: 0 : if (((struct usb_descriptor_header *) buffer)->bDescriptorType
384 : : == USB_DT_INTERFACE)
385 : : break;
386 : 0 : retval = usb_parse_endpoint(ddev, cfgno, inum, asnum, alt,
387 : : num_ep, buffer, size);
388 [ # # ]: 0 : if (retval < 0)
389 : : return retval;
390 : 0 : ++n;
391 : :
392 : 0 : buffer += retval;
393 : 0 : size -= retval;
394 : : }
395 : :
396 [ # # ]: 0 : if (n != num_ep_orig)
397 : 0 : dev_warn(ddev, "config %d interface %d altsetting %d has %d "
398 : : "endpoint descriptor%s, different from the interface "
399 : : "descriptor's value: %d\n",
400 : : cfgno, inum, asnum, n, plural(n), num_ep_orig);
401 : 0 : return buffer - buffer0;
402 : :
403 : : skip_to_next_interface_descriptor:
404 : : i = find_next_descriptor(buffer, size, USB_DT_INTERFACE,
405 : : USB_DT_INTERFACE, NULL);
406 : 0 : return buffer - buffer0 + i;
407 : : }
408 : :
409 : 0 : static int usb_parse_configuration(struct usb_device *dev, int cfgidx,
410 : : struct usb_host_config *config, unsigned char *buffer, int size)
411 : : {
412 : 0 : struct device *ddev = &dev->dev;
413 : : unsigned char *buffer0 = buffer;
414 : : int cfgno;
415 : : int nintf, nintf_orig;
416 : : int i, j, n;
417 : : struct usb_interface_cache *intfc;
418 : : unsigned char *buffer2;
419 : : int size2;
420 : : struct usb_descriptor_header *header;
421 : : int len, retval;
422 : : u8 inums[USB_MAXINTERFACES], nalts[USB_MAXINTERFACES];
423 : : unsigned iad_num = 0;
424 : :
425 : 0 : memcpy(&config->desc, buffer, USB_DT_CONFIG_SIZE);
426 [ # # ][ # # ]: 0 : if (config->desc.bDescriptorType != USB_DT_CONFIG ||
427 [ # # ]: 0 : config->desc.bLength < USB_DT_CONFIG_SIZE ||
428 : 0 : config->desc.bLength > size) {
429 : 0 : dev_err(ddev, "invalid descriptor for config index %d: "
430 : : "type = 0x%X, length = %d\n", cfgidx,
431 : 0 : config->desc.bDescriptorType, config->desc.bLength);
432 : 0 : return -EINVAL;
433 : : }
434 : 0 : cfgno = config->desc.bConfigurationValue;
435 : :
436 : 0 : buffer += config->desc.bLength;
437 : 0 : size -= config->desc.bLength;
438 : :
439 : 0 : nintf = nintf_orig = config->desc.bNumInterfaces;
440 [ # # ]: 0 : if (nintf > USB_MAXINTERFACES) {
441 : 0 : dev_warn(ddev, "config %d has too many interfaces: %d, "
442 : : "using maximum allowed: %d\n",
443 : : cfgno, nintf, USB_MAXINTERFACES);
444 : : nintf = USB_MAXINTERFACES;
445 : : }
446 : :
447 : : /* Go through the descriptors, checking their length and counting the
448 : : * number of altsettings for each interface */
449 : : n = 0;
450 [ # # ]: 0 : for ((buffer2 = buffer, size2 = size);
451 : : size2 > 0;
452 : 0 : (buffer2 += header->bLength, size2 -= header->bLength)) {
453 : :
454 [ # # ]: 0 : if (size2 < sizeof(struct usb_descriptor_header)) {
455 : 0 : dev_warn(ddev, "config %d descriptor has %d excess "
456 : : "byte%s, ignoring\n",
457 : : cfgno, size2, plural(size2));
458 : 0 : break;
459 : : }
460 : :
461 : : header = (struct usb_descriptor_header *) buffer2;
462 [ # # ][ # # ]: 0 : if ((header->bLength > size2) || (header->bLength < 2)) {
463 : 0 : dev_warn(ddev, "config %d has an invalid descriptor "
464 : : "of length %d, skipping remainder of the config\n",
465 : : cfgno, header->bLength);
466 : 0 : break;
467 : : }
468 : :
469 [ # # ]: 0 : if (header->bDescriptorType == USB_DT_INTERFACE) {
470 : : struct usb_interface_descriptor *d;
471 : : int inum;
472 : :
473 : : d = (struct usb_interface_descriptor *) header;
474 [ # # ]: 0 : if (d->bLength < USB_DT_INTERFACE_SIZE) {
475 : 0 : dev_warn(ddev, "config %d has an invalid "
476 : : "interface descriptor of length %d, "
477 : : "skipping\n", cfgno, d->bLength);
478 : 0 : continue;
479 : : }
480 : :
481 : 0 : inum = d->bInterfaceNumber;
482 : :
483 [ # # ][ # # ]: 0 : if ((dev->quirks & USB_QUIRK_HONOR_BNUMINTERFACES) &&
484 : : n >= nintf_orig) {
485 : 0 : dev_warn(ddev, "config %d has more interface "
486 : : "descriptors, than it declares in "
487 : : "bNumInterfaces, ignoring interface "
488 : : "number: %d\n", cfgno, inum);
489 : 0 : continue;
490 : : }
491 : :
492 [ # # ]: 0 : if (inum >= nintf_orig)
493 : 0 : dev_warn(ddev, "config %d has an invalid "
494 : : "interface number: %d but max is %d\n",
495 : : cfgno, inum, nintf_orig - 1);
496 : :
497 : : /* Have we already encountered this interface?
498 : : * Count its altsettings */
499 [ # # ]: 0 : for (i = 0; i < n; ++i) {
500 [ # # ]: 0 : if (inums[i] == inum)
501 : : break;
502 : : }
503 [ # # ]: 0 : if (i < n) {
504 [ # # ]: 0 : if (nalts[i] < 255)
505 : 0 : ++nalts[i];
506 [ # # ]: 0 : } else if (n < USB_MAXINTERFACES) {
507 : 0 : inums[n] = inum;
508 : 0 : nalts[n] = 1;
509 : 0 : ++n;
510 : : }
511 : :
512 [ # # ]: 0 : } else if (header->bDescriptorType ==
513 : : USB_DT_INTERFACE_ASSOCIATION) {
514 [ # # ]: 0 : if (iad_num == USB_MAXIADS) {
515 : 0 : dev_warn(ddev, "found more Interface "
516 : : "Association Descriptors "
517 : : "than allocated for in "
518 : : "configuration %d\n", cfgno);
519 : : } else {
520 : 0 : config->intf_assoc[iad_num] =
521 : : (struct usb_interface_assoc_descriptor
522 : : *)header;
523 : 0 : iad_num++;
524 : : }
525 : :
526 [ # # ]: 0 : } else if (header->bDescriptorType == USB_DT_DEVICE ||
527 : : header->bDescriptorType == USB_DT_CONFIG)
528 : 0 : dev_warn(ddev, "config %d contains an unexpected "
529 : : "descriptor of type 0x%X, skipping\n",
530 : : cfgno, header->bDescriptorType);
531 : :
532 : : } /* for ((buffer2 = buffer, size2 = size); ...) */
533 : 0 : size = buffer2 - buffer;
534 : 0 : config->desc.wTotalLength = cpu_to_le16(buffer2 - buffer0);
535 : :
536 [ # # ]: 0 : if (n != nintf)
537 : 0 : dev_warn(ddev, "config %d has %d interface%s, different from "
538 : : "the descriptor's value: %d\n",
539 : : cfgno, n, plural(n), nintf_orig);
540 [ # # ]: 0 : else if (n == 0)
541 : 0 : dev_warn(ddev, "config %d has no interfaces?\n", cfgno);
542 : 0 : config->desc.bNumInterfaces = nintf = n;
543 : :
544 : : /* Check for missing interface numbers */
545 [ # # ]: 0 : for (i = 0; i < nintf; ++i) {
546 [ # # ]: 0 : for (j = 0; j < nintf; ++j) {
547 [ # # ]: 0 : if (inums[j] == i)
548 : : break;
549 : : }
550 [ # # ]: 0 : if (j >= nintf)
551 : 0 : dev_warn(ddev, "config %d has no interface number "
552 : : "%d\n", cfgno, i);
553 : : }
554 : :
555 : : /* Allocate the usb_interface_caches and altsetting arrays */
556 [ # # ]: 0 : for (i = 0; i < nintf; ++i) {
557 : 0 : j = nalts[i];
558 [ # # ]: 0 : if (j > USB_MAXALTSETTING) {
559 : 0 : dev_warn(ddev, "too many alternate settings for "
560 : : "config %d interface %d: %d, "
561 : : "using maximum allowed: %d\n",
562 : 0 : cfgno, inums[i], j, USB_MAXALTSETTING);
563 : 0 : nalts[i] = j = USB_MAXALTSETTING;
564 : : }
565 : :
566 : 0 : len = sizeof(*intfc) + sizeof(struct usb_host_interface) * j;
567 : 0 : config->intf_cache[i] = intfc = kzalloc(len, GFP_KERNEL);
568 [ # # ]: 0 : if (!intfc)
569 : : return -ENOMEM;
570 : : kref_init(&intfc->ref);
571 : : }
572 : :
573 : : /* FIXME: parse the BOS descriptor */
574 : :
575 : : /* Skip over any Class Specific or Vendor Specific descriptors;
576 : : * find the first interface descriptor */
577 : 0 : config->extra = buffer;
578 : : i = find_next_descriptor(buffer, size, USB_DT_INTERFACE,
579 : : USB_DT_INTERFACE, &n);
580 : 0 : config->extralen = i;
581 : : if (n > 0)
582 : : dev_dbg(ddev, "skipped %d descriptor%s after %s\n",
583 : : n, plural(n), "configuration");
584 : 0 : buffer += i;
585 : 0 : size -= i;
586 : :
587 : : /* Parse all the interface/altsetting descriptors */
588 [ # # ]: 0 : while (size > 0) {
589 : 0 : retval = usb_parse_interface(ddev, cfgno, config,
590 : : buffer, size, inums, nalts);
591 [ # # ]: 0 : if (retval < 0)
592 : : return retval;
593 : :
594 : 0 : buffer += retval;
595 : 0 : size -= retval;
596 : : }
597 : :
598 : : /* Check for missing altsettings */
599 [ # # ]: 0 : for (i = 0; i < nintf; ++i) {
600 : 0 : intfc = config->intf_cache[i];
601 [ # # ]: 0 : for (j = 0; j < intfc->num_altsetting; ++j) {
602 [ # # ]: 0 : for (n = 0; n < intfc->num_altsetting; ++n) {
603 [ # # ]: 0 : if (intfc->altsetting[n].desc.
604 : 0 : bAlternateSetting == j)
605 : : break;
606 : : }
607 [ # # ]: 0 : if (n >= intfc->num_altsetting)
608 : 0 : dev_warn(ddev, "config %d interface %d has no "
609 : 0 : "altsetting %d\n", cfgno, inums[i], j);
610 : : }
611 : : }
612 : :
613 : : return 0;
614 : : }
615 : :
616 : : /* hub-only!! ... and only exported for reset/reinit path.
617 : : * otherwise used internally on disconnect/destroy path
618 : : */
619 : 0 : void usb_destroy_configuration(struct usb_device *dev)
620 : : {
621 : : int c, i;
622 : :
623 [ # # ]: 0 : if (!dev->config)
624 : 0 : return;
625 : :
626 [ # # ]: 0 : if (dev->rawdescriptors) {
627 [ # # ]: 0 : for (i = 0; i < dev->descriptor.bNumConfigurations; i++)
628 : 0 : kfree(dev->rawdescriptors[i]);
629 : :
630 : 0 : kfree(dev->rawdescriptors);
631 : 0 : dev->rawdescriptors = NULL;
632 : : }
633 : :
634 [ # # ]: 0 : for (c = 0; c < dev->descriptor.bNumConfigurations; c++) {
635 : 0 : struct usb_host_config *cf = &dev->config[c];
636 : :
637 : 0 : kfree(cf->string);
638 [ # # ]: 0 : for (i = 0; i < cf->desc.bNumInterfaces; i++) {
639 [ # # ]: 0 : if (cf->intf_cache[i])
640 : 0 : kref_put(&cf->intf_cache[i]->ref,
641 : : usb_release_interface_cache);
642 : : }
643 : : }
644 : 0 : kfree(dev->config);
645 : 0 : dev->config = NULL;
646 : : }
647 : :
648 : :
649 : : /*
650 : : * Get the USB config descriptors, cache and parse'em
651 : : *
652 : : * hub-only!! ... and only in reset path, or usb_new_device()
653 : : * (used by real hubs and virtual root hubs)
654 : : *
655 : : * NOTE: if this is a WUSB device and is not authorized, we skip the
656 : : * whole thing. A non-authorized USB device has no
657 : : * configurations.
658 : : */
659 : 0 : int usb_get_configuration(struct usb_device *dev)
660 : : {
661 : 0 : struct device *ddev = &dev->dev;
662 : 0 : int ncfg = dev->descriptor.bNumConfigurations;
663 : : int result = 0;
664 : : unsigned int cfgno, length;
665 : : unsigned char *bigbuffer;
666 : : struct usb_config_descriptor *desc;
667 : :
668 : : cfgno = 0;
669 [ # # ]: 0 : if (dev->authorized == 0) /* Not really an error */
670 : : goto out_not_authorized;
671 : : result = -ENOMEM;
672 [ # # ]: 0 : if (ncfg > USB_MAXCONFIG) {
673 : 0 : dev_warn(ddev, "too many configurations: %d, "
674 : : "using maximum allowed: %d\n", ncfg, USB_MAXCONFIG);
675 : 0 : dev->descriptor.bNumConfigurations = ncfg = USB_MAXCONFIG;
676 : : }
677 : :
678 [ # # ]: 0 : if (ncfg < 1) {
679 : 0 : dev_err(ddev, "no configurations\n");
680 : 0 : return -EINVAL;
681 : : }
682 : :
683 : 0 : length = ncfg * sizeof(struct usb_host_config);
684 : 0 : dev->config = kzalloc(length, GFP_KERNEL);
685 [ # # ]: 0 : if (!dev->config)
686 : : goto err2;
687 : :
688 : 0 : length = ncfg * sizeof(char *);
689 : 0 : dev->rawdescriptors = kzalloc(length, GFP_KERNEL);
690 [ # # ]: 0 : if (!dev->rawdescriptors)
691 : : goto err2;
692 : :
693 : : desc = kmalloc(USB_DT_CONFIG_SIZE, GFP_KERNEL);
694 [ # # ]: 0 : if (!desc)
695 : : goto err2;
696 : :
697 : : result = 0;
698 [ # # ]: 0 : for (; cfgno < ncfg; cfgno++) {
699 : : /* We grab just the first descriptor so we know how long
700 : : * the whole configuration is */
701 : 0 : result = usb_get_descriptor(dev, USB_DT_CONFIG, cfgno,
702 : : desc, USB_DT_CONFIG_SIZE);
703 [ # # ]: 0 : if (result < 0) {
704 : 0 : dev_err(ddev, "unable to read config index %d "
705 : : "descriptor/%s: %d\n", cfgno, "start", result);
706 [ # # ]: 0 : if (result != -EPIPE)
707 : : goto err;
708 : 0 : dev_err(ddev, "chopping to %d config(s)\n", cfgno);
709 : 0 : dev->descriptor.bNumConfigurations = cfgno;
710 : 0 : break;
711 [ # # ]: 0 : } else if (result < 4) {
712 : 0 : dev_err(ddev, "config index %d descriptor too short "
713 : : "(expected %i, got %i)\n", cfgno,
714 : : USB_DT_CONFIG_SIZE, result);
715 : : result = -EINVAL;
716 : 0 : goto err;
717 : : }
718 : 0 : length = max((int) le16_to_cpu(desc->wTotalLength),
719 : : USB_DT_CONFIG_SIZE);
720 : :
721 : : /* Now that we know the length, get the whole thing */
722 : : bigbuffer = kmalloc(length, GFP_KERNEL);
723 [ # # ]: 0 : if (!bigbuffer) {
724 : : result = -ENOMEM;
725 : : goto err;
726 : : }
727 : 0 : result = usb_get_descriptor(dev, USB_DT_CONFIG, cfgno,
728 : : bigbuffer, length);
729 [ # # ]: 0 : if (result < 0) {
730 : 0 : dev_err(ddev, "unable to read config index %d "
731 : : "descriptor/%s\n", cfgno, "all");
732 : 0 : kfree(bigbuffer);
733 : 0 : goto err;
734 : : }
735 [ # # ]: 0 : if (result < length) {
736 : 0 : dev_warn(ddev, "config index %d descriptor too short "
737 : : "(expected %i, got %i)\n", cfgno, length, result);
738 : : length = result;
739 : : }
740 : :
741 : 0 : dev->rawdescriptors[cfgno] = bigbuffer;
742 : :
743 : 0 : result = usb_parse_configuration(dev, cfgno,
744 : 0 : &dev->config[cfgno], bigbuffer, length);
745 [ # # ]: 0 : if (result < 0) {
746 : 0 : ++cfgno;
747 : 0 : goto err;
748 : : }
749 : : }
750 : : result = 0;
751 : :
752 : : err:
753 : 0 : kfree(desc);
754 : : out_not_authorized:
755 : 0 : dev->descriptor.bNumConfigurations = cfgno;
756 : : err2:
757 [ # # ]: 0 : if (result == -ENOMEM)
758 : 0 : dev_err(ddev, "out of memory\n");
759 : 0 : return result;
760 : : }
761 : :
762 : 0 : void usb_release_bos_descriptor(struct usb_device *dev)
763 : : {
764 [ # # ]: 0 : if (dev->bos) {
765 : 0 : kfree(dev->bos->desc);
766 : 0 : kfree(dev->bos);
767 : 0 : dev->bos = NULL;
768 : : }
769 : 0 : }
770 : :
771 : : /* Get BOS descriptor set */
772 : 0 : int usb_get_bos_descriptor(struct usb_device *dev)
773 : : {
774 : 0 : struct device *ddev = &dev->dev;
775 : : struct usb_bos_descriptor *bos;
776 : : struct usb_dev_cap_header *cap;
777 : : unsigned char *buffer;
778 : : int length, total_len, num, i;
779 : : int ret;
780 : :
781 : : bos = kzalloc(sizeof(struct usb_bos_descriptor), GFP_KERNEL);
782 [ # # ]: 0 : if (!bos)
783 : : return -ENOMEM;
784 : :
785 : : /* Get BOS descriptor */
786 : 0 : ret = usb_get_descriptor(dev, USB_DT_BOS, 0, bos, USB_DT_BOS_SIZE);
787 [ # # ]: 0 : if (ret < USB_DT_BOS_SIZE) {
788 : 0 : dev_err(ddev, "unable to get BOS descriptor\n");
789 [ # # ]: 0 : if (ret >= 0)
790 : : ret = -ENOMSG;
791 : 0 : kfree(bos);
792 : 0 : return ret;
793 : : }
794 : :
795 : 0 : length = bos->bLength;
796 : 0 : total_len = le16_to_cpu(bos->wTotalLength);
797 : 0 : num = bos->bNumDeviceCaps;
798 : 0 : kfree(bos);
799 [ # # ]: 0 : if (total_len < length)
800 : : return -EINVAL;
801 : :
802 : 0 : dev->bos = kzalloc(sizeof(struct usb_host_bos), GFP_KERNEL);
803 [ # # ]: 0 : if (!dev->bos)
804 : : return -ENOMEM;
805 : :
806 : : /* Now let's get the whole BOS descriptor set */
807 : 0 : buffer = kzalloc(total_len, GFP_KERNEL);
808 [ # # ]: 0 : if (!buffer) {
809 : : ret = -ENOMEM;
810 : : goto err;
811 : : }
812 : 0 : dev->bos->desc = (struct usb_bos_descriptor *)buffer;
813 : :
814 : 0 : ret = usb_get_descriptor(dev, USB_DT_BOS, 0, buffer, total_len);
815 [ # # ]: 0 : if (ret < total_len) {
816 : 0 : dev_err(ddev, "unable to get BOS descriptor set\n");
817 [ # # ]: 0 : if (ret >= 0)
818 : : ret = -ENOMSG;
819 : : goto err;
820 : : }
821 : 0 : total_len -= length;
822 : :
823 [ # # ]: 0 : for (i = 0; i < num; i++) {
824 : 0 : buffer += length;
825 : : cap = (struct usb_dev_cap_header *)buffer;
826 : 0 : length = cap->bLength;
827 : :
828 [ # # ]: 0 : if (total_len < length)
829 : : break;
830 : 0 : total_len -= length;
831 : :
832 [ # # ]: 0 : if (cap->bDescriptorType != USB_DT_DEVICE_CAPABILITY) {
833 : 0 : dev_warn(ddev, "descriptor type invalid, skip\n");
834 : 0 : continue;
835 : : }
836 : :
837 [ # # # # ]: 0 : switch (cap->bDevCapabilityType) {
838 : : case USB_CAP_TYPE_WIRELESS_USB:
839 : : /* Wireless USB cap descriptor is handled by wusb */
840 : : break;
841 : : case USB_CAP_TYPE_EXT:
842 : 0 : dev->bos->ext_cap =
843 : : (struct usb_ext_cap_descriptor *)buffer;
844 : 0 : break;
845 : : case USB_SS_CAP_TYPE:
846 : 0 : dev->bos->ss_cap =
847 : : (struct usb_ss_cap_descriptor *)buffer;
848 : 0 : break;
849 : : case CONTAINER_ID_TYPE:
850 : 0 : dev->bos->ss_id =
851 : : (struct usb_ss_container_id_descriptor *)buffer;
852 : 0 : break;
853 : : default:
854 : : break;
855 : : }
856 : : }
857 : :
858 : : return 0;
859 : :
860 : : err:
861 : 0 : usb_release_bos_descriptor(dev);
862 : 0 : return ret;
863 : : }
|
