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