Linux Audio

Check our new training course

Loading...
v3.1
 
 
 
 
 
  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
 19static inline const char *plural(int n)
 20{
 21	return (n == 1 ? "" : "s");
 22}
 23
 24static 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	while (size > 0) {
 33		h = (struct usb_descriptor_header *) buffer;
 34		if (h->bDescriptorType == dt1 || h->bDescriptorType == dt2)
 35			break;
 36		buffer += h->bLength;
 37		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	return buffer - buffer0;
 46}
 47
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 48static 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	if (desc->bDescriptorType != USB_DT_SS_ENDPOINT_COMP ||
 60			size < USB_DT_SS_EP_COMP_SIZE) {
 61		dev_warn(ddev, "No SuperSpeed endpoint companion for config %d "
 62				" interface %d altsetting %d ep %d: "
 63				"using minimum values\n",
 64				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		ep->ss_ep_comp.bLength = USB_DT_SS_EP_COMP_SIZE;
 74		ep->ss_ep_comp.bDescriptorType = USB_DT_SS_ENDPOINT_COMP;
 75		if (usb_endpoint_xfer_isoc(&ep->desc) ||
 76				usb_endpoint_xfer_int(&ep->desc))
 77			ep->ss_ep_comp.wBytesPerInterval =
 78					ep->desc.wMaxPacketSize;
 79		return;
 80	}
 81
 
 82	memcpy(&ep->ss_ep_comp, desc, USB_DT_SS_EP_COMP_SIZE);
 83
 84	/* Check the various values */
 85	if (usb_endpoint_xfer_control(&ep->desc) && desc->bMaxBurst != 0) {
 86		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				cfgno, inum, asnum, ep->desc.bEndpointAddress);
 90		ep->ss_ep_comp.bMaxBurst = 0;
 91	} else if (desc->bMaxBurst > 15) {
 92		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				cfgno, inum, asnum, ep->desc.bEndpointAddress);
 96		ep->ss_ep_comp.bMaxBurst = 15;
 97	}
 98
 99	if ((usb_endpoint_xfer_control(&ep->desc) ||
100			usb_endpoint_xfer_int(&ep->desc)) &&
101				desc->bmAttributes != 0) {
102		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				cfgno, inum, asnum, ep->desc.bEndpointAddress);
108		ep->ss_ep_comp.bmAttributes = 0;
109	} else if (usb_endpoint_xfer_bulk(&ep->desc) &&
110			desc->bmAttributes > 16) {
111		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				cfgno, inum, asnum, ep->desc.bEndpointAddress);
115		ep->ss_ep_comp.bmAttributes = 16;
116	} else if (usb_endpoint_xfer_isoc(&ep->desc) &&
117			desc->bmAttributes > 2) {
118		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				cfgno, inum, asnum, ep->desc.bEndpointAddress);
122		ep->ss_ep_comp.bmAttributes = 2;
123	}
124
125	if (usb_endpoint_xfer_isoc(&ep->desc))
126		max_tx = (desc->bMaxBurst + 1) * (desc->bmAttributes + 1) *
127			le16_to_cpu(ep->desc.wMaxPacketSize);
 
128	else if (usb_endpoint_xfer_int(&ep->desc))
129		max_tx = le16_to_cpu(ep->desc.wMaxPacketSize) *
130			(desc->bMaxBurst + 1);
131	else
132		max_tx = 999999;
133	if (le16_to_cpu(desc->wBytesPerInterval) > max_tx) {
134		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				cfgno, inum, asnum, ep->desc.bEndpointAddress,
140				max_tx);
141		ep->ss_ep_comp.wBytesPerInterval = cpu_to_le16(max_tx);
142	}
 
 
 
 
 
143}
144
145static 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	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	buffer += d->bLength;
156	size -= d->bLength;
157
158	if (d->bLength >= USB_DT_ENDPOINT_AUDIO_SIZE)
159		n = USB_DT_ENDPOINT_AUDIO_SIZE;
160	else if (d->bLength >= USB_DT_ENDPOINT_SIZE)
161		n = USB_DT_ENDPOINT_SIZE;
162	else {
163		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	i = d->bEndpointAddress & ~USB_ENDPOINT_DIR_MASK;
170	if (i >= 16 || i == 0) {
171		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	if (ifp->desc.bNumEndpoints >= num_ep)
179		goto skip_to_next_endpoint_or_interface_descriptor;
180
 
181	endpoint = &ifp->endpoint[ifp->desc.bNumEndpoints];
182	++ifp->desc.bNumEndpoints;
183
184	memcpy(&endpoint->desc, d, n);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
185	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	if (usb_endpoint_xfer_int(d)) {
192		i = 1;
193		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			n = fls(d->bInterval*8);
201			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	} else if (usb_endpoint_xfer_isoc(d)) {
213		i = 1;
214		j = 16;
215		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	if (d->bInterval < i || d->bInterval > j) {
225		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		    d->bEndpointAddress, d->bInterval, n);
230		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	if (to_usb_device(ddev)->speed == USB_SPEED_LOW &&
238			usb_endpoint_xfer_bulk(d)) {
239		dev_warn(ddev, "config %d interface %d altsetting %d "
240		    "endpoint 0x%X is Bulk; changing to Interrupt\n",
241		    cfgno, inum, asnum, d->bEndpointAddress);
242		endpoint->desc.bmAttributes = USB_ENDPOINT_XFER_INT;
243		endpoint->desc.bInterval = 1;
244		if (le16_to_cpu(endpoint->desc.wMaxPacketSize) > 8)
245			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	if (to_usb_device(ddev)->speed == USB_SPEED_HIGH
254			&& usb_endpoint_xfer_bulk(d)) {
255		unsigned maxp;
256
257		maxp = le16_to_cpu(endpoint->desc.wMaxPacketSize) & 0x07ff;
258		if (maxp != 512)
259			dev_warn(ddev, "config %d interface %d altsetting %d "
260				"bulk endpoint 0x%X has invalid maxpacket %d\n",
261				cfgno, inum, asnum, d->bEndpointAddress,
262				maxp);
263	}
264
265	/* Parse a possible SuperSpeed endpoint companion descriptor */
266	if (to_usb_device(ddev)->speed == USB_SPEED_SUPER)
267		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	endpoint->extra = buffer;
273	i = find_next_descriptor(buffer, size, USB_DT_ENDPOINT,
274			USB_DT_INTERFACE, &n);
275	endpoint->extralen = i;
276	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
282skip_to_next_endpoint_or_interface_descriptor:
283	i = find_next_descriptor(buffer, size, USB_DT_ENDPOINT,
284	    USB_DT_INTERFACE, NULL);
285	return buffer - buffer0 + i;
286}
287
288void usb_release_interface_cache(struct kref *ref)
289{
290	struct usb_interface_cache *intfc = ref_to_usb_interface_cache(ref);
291	int j;
292
293	for (j = 0; j < intfc->num_altsetting; j++) {
294		struct usb_host_interface *alt = &intfc->altsetting[j];
295
296		kfree(alt->endpoint);
297		kfree(alt->string);
298	}
299	kfree(intfc);
300}
301
302static 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	buffer += d->bLength;
317	size -= d->bLength;
318
319	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	inum = d->bInterfaceNumber;
325	for (i = 0; i < config->desc.bNumInterfaces; ++i) {
326		if (inums[i] == inum) {
327			intfc = config->intf_cache[i];
328			break;
329		}
330	}
331	if (!intfc || intfc->num_altsetting >= nalts[i])
332		goto skip_to_next_interface_descriptor;
333
334	/* Check for duplicate altsetting entries */
335	asnum = d->bAlternateSetting;
336	for ((i = 0, alt = &intfc->altsetting[0]);
337	      i < intfc->num_altsetting;
338	     (++i, ++alt)) {
339		if (alt->desc.bAlternateSetting == asnum) {
340			dev_warn(ddev, "Duplicate descriptor for config %d "
341			    "interface %d altsetting %d, skipping\n",
342			    cfgno, inum, asnum);
343			goto skip_to_next_interface_descriptor;
344		}
345	}
346
347	++intfc->num_altsetting;
348	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	alt->extra = buffer;
353	i = find_next_descriptor(buffer, size, USB_DT_ENDPOINT,
354	    USB_DT_INTERFACE, &n);
355	alt->extralen = i;
356	if (n > 0)
357		dev_dbg(ddev, "skipped %d descriptor%s after %s\n",
358		    n, plural(n), "interface");
359	buffer += i;
360	size -= i;
361
362	/* Allocate space for the right(?) number of endpoints */
363	num_ep = num_ep_orig = alt->desc.bNumEndpoints;
364	alt->desc.bNumEndpoints = 0;		/* Use as a counter */
365	if (num_ep > USB_MAXENDPOINTS) {
366		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	if (num_ep > 0) {
373		/* Can't allocate 0 bytes */
374		len = sizeof(struct usb_host_endpoint) * num_ep;
375		alt->endpoint = kzalloc(len, GFP_KERNEL);
376		if (!alt->endpoint)
377			return -ENOMEM;
378	}
379
380	/* Parse all the endpoint descriptors */
381	n = 0;
382	while (size > 0) {
383		if (((struct usb_descriptor_header *) buffer)->bDescriptorType
384		     == USB_DT_INTERFACE)
385			break;
386		retval = usb_parse_endpoint(ddev, cfgno, inum, asnum, alt,
387		    num_ep, buffer, size);
388		if (retval < 0)
389			return retval;
390		++n;
391
392		buffer += retval;
393		size -= retval;
394	}
395
396	if (n != num_ep_orig)
397		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	return buffer - buffer0;
402
403skip_to_next_interface_descriptor:
404	i = find_next_descriptor(buffer, size, USB_DT_INTERFACE,
405	    USB_DT_INTERFACE, NULL);
406	return buffer - buffer0 + i;
407}
408
409static int usb_parse_configuration(struct usb_device *dev, int cfgidx,
410    struct usb_host_config *config, unsigned char *buffer, int size)
411{
412	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	memcpy(&config->desc, buffer, USB_DT_CONFIG_SIZE);
 
 
 
426	if (config->desc.bDescriptorType != USB_DT_CONFIG ||
427	    config->desc.bLength < USB_DT_CONFIG_SIZE) {
428		dev_err(ddev, "invalid descriptor for config index %d: "
 
429		    "type = 0x%X, length = %d\n", cfgidx,
430		    config->desc.bDescriptorType, config->desc.bLength);
431		return -EINVAL;
432	}
433	cfgno = config->desc.bConfigurationValue;
434
435	buffer += config->desc.bLength;
436	size -= config->desc.bLength;
437
438	nintf = nintf_orig = config->desc.bNumInterfaces;
439	if (nintf > USB_MAXINTERFACES) {
440		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	for ((buffer2 = buffer, size2 = size);
450	      size2 > 0;
451	     (buffer2 += header->bLength, size2 -= header->bLength)) {
452
453		if (size2 < sizeof(struct usb_descriptor_header)) {
454			dev_warn(ddev, "config %d descriptor has %d excess "
455			    "byte%s, ignoring\n",
456			    cfgno, size2, plural(size2));
457			break;
458		}
459
460		header = (struct usb_descriptor_header *) buffer2;
461		if ((header->bLength > size2) || (header->bLength < 2)) {
462			dev_warn(ddev, "config %d has an invalid descriptor "
463			    "of length %d, skipping remainder of the config\n",
464			    cfgno, header->bLength);
465			break;
466		}
467
468		if (header->bDescriptorType == USB_DT_INTERFACE) {
469			struct usb_interface_descriptor *d;
470			int inum;
471
472			d = (struct usb_interface_descriptor *) header;
473			if (d->bLength < USB_DT_INTERFACE_SIZE) {
474				dev_warn(ddev, "config %d has an invalid "
475				    "interface descriptor of length %d, "
476				    "skipping\n", cfgno, d->bLength);
477				continue;
478			}
479
480			inum = d->bInterfaceNumber;
481
482			if ((dev->quirks & USB_QUIRK_HONOR_BNUMINTERFACES) &&
483			    n >= nintf_orig) {
484				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				continue;
489			}
490
491			if (inum >= nintf_orig)
492				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			for (i = 0; i < n; ++i) {
499				if (inums[i] == inum)
500					break;
501			}
502			if (i < n) {
503				if (nalts[i] < 255)
504					++nalts[i];
505			} else if (n < USB_MAXINTERFACES) {
506				inums[n] = inum;
507				nalts[n] = 1;
508				++n;
509			}
510
511		} else if (header->bDescriptorType ==
512				USB_DT_INTERFACE_ASSOCIATION) {
 
 
 
 
 
 
 
 
 
 
513			if (iad_num == USB_MAXIADS) {
514				dev_warn(ddev, "found more Interface "
515					       "Association Descriptors "
516					       "than allocated for in "
517					       "configuration %d\n", cfgno);
518			} else {
519				config->intf_assoc[iad_num] =
520					(struct usb_interface_assoc_descriptor
521					*)header;
522				iad_num++;
523			}
524
525		} else if (header->bDescriptorType == USB_DT_DEVICE ||
526			    header->bDescriptorType == USB_DT_CONFIG)
527			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	size = buffer2 - buffer;
533	config->desc.wTotalLength = cpu_to_le16(buffer2 - buffer0);
534
535	if (n != nintf)
536		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	else if (n == 0)
540		dev_warn(ddev, "config %d has no interfaces?\n", cfgno);
541	config->desc.bNumInterfaces = nintf = n;
542
543	/* Check for missing interface numbers */
544	for (i = 0; i < nintf; ++i) {
545		for (j = 0; j < nintf; ++j) {
546			if (inums[j] == i)
547				break;
548		}
549		if (j >= nintf)
550			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	for (i = 0; i < nintf; ++i) {
556		j = nalts[i];
557		if (j > USB_MAXALTSETTING) {
558			dev_warn(ddev, "too many alternate settings for "
559			    "config %d interface %d: %d, "
560			    "using maximum allowed: %d\n",
561			    cfgno, inums[i], j, USB_MAXALTSETTING);
562			nalts[i] = j = USB_MAXALTSETTING;
563		}
564
565		len = sizeof(*intfc) + sizeof(struct usb_host_interface) * j;
566		config->intf_cache[i] = intfc = kzalloc(len, GFP_KERNEL);
567		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	config->extra = buffer;
577	i = find_next_descriptor(buffer, size, USB_DT_INTERFACE,
578	    USB_DT_INTERFACE, &n);
579	config->extralen = i;
580	if (n > 0)
581		dev_dbg(ddev, "skipped %d descriptor%s after %s\n",
582		    n, plural(n), "configuration");
583	buffer += i;
584	size -= i;
585
586	/* Parse all the interface/altsetting descriptors */
587	while (size > 0) {
588		retval = usb_parse_interface(ddev, cfgno, config,
589		    buffer, size, inums, nalts);
590		if (retval < 0)
591			return retval;
592
593		buffer += retval;
594		size -= retval;
595	}
596
597	/* Check for missing altsettings */
598	for (i = 0; i < nintf; ++i) {
599		intfc = config->intf_cache[i];
600		for (j = 0; j < intfc->num_altsetting; ++j) {
601			for (n = 0; n < intfc->num_altsetting; ++n) {
602				if (intfc->altsetting[n].desc.
603				    bAlternateSetting == j)
604					break;
605			}
606			if (n >= intfc->num_altsetting)
607				dev_warn(ddev, "config %d interface %d has no "
608				    "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 */
618void usb_destroy_configuration(struct usb_device *dev)
619{
620	int c, i;
621
622	if (!dev->config)
623		return;
624
625	if (dev->rawdescriptors) {
626		for (i = 0; i < dev->descriptor.bNumConfigurations; i++)
627			kfree(dev->rawdescriptors[i]);
628
629		kfree(dev->rawdescriptors);
630		dev->rawdescriptors = NULL;
631	}
632
633	for (c = 0; c < dev->descriptor.bNumConfigurations; c++) {
634		struct usb_host_config *cf = &dev->config[c];
635
636		kfree(cf->string);
637		for (i = 0; i < cf->desc.bNumInterfaces; i++) {
638			if (cf->intf_cache[i])
639				kref_put(&cf->intf_cache[i]->ref,
640					  usb_release_interface_cache);
641		}
642	}
643	kfree(dev->config);
644	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 * NOTE: if this is a WUSB device and is not authorized, we skip the
655 *       whole thing. A non-authorized USB device has no
656 *       configurations.
657 */
658int usb_get_configuration(struct usb_device *dev)
659{
660	struct device *ddev = &dev->dev;
661	int ncfg = dev->descriptor.bNumConfigurations;
662	int result = 0;
663	unsigned int cfgno, length;
664	unsigned char *bigbuffer;
665	struct usb_config_descriptor *desc;
 
666
667	cfgno = 0;
668	if (dev->authorized == 0)	/* Not really an error */
669		goto out_not_authorized;
670	result = -ENOMEM;
671	if (ncfg > USB_MAXCONFIG) {
672		dev_warn(ddev, "too many configurations: %d, "
673		    "using maximum allowed: %d\n", ncfg, USB_MAXCONFIG);
674		dev->descriptor.bNumConfigurations = ncfg = USB_MAXCONFIG;
675	}
676
677	if (ncfg < 1) {
678		dev_err(ddev, "no configurations\n");
679		return -EINVAL;
680	}
681
682	length = ncfg * sizeof(struct usb_host_config);
683	dev->config = kzalloc(length, GFP_KERNEL);
684	if (!dev->config)
685		goto err2;
686
687	length = ncfg * sizeof(char *);
688	dev->rawdescriptors = kzalloc(length, GFP_KERNEL);
689	if (!dev->rawdescriptors)
690		goto err2;
691
692	desc = kmalloc(USB_DT_CONFIG_SIZE, GFP_KERNEL);
693	if (!desc)
694		goto err2;
695
696	result = 0;
697	for (; cfgno < ncfg; cfgno++) {
698		/* We grab just the first descriptor so we know how long
699		 * the whole configuration is */
700		result = usb_get_descriptor(dev, USB_DT_CONFIG, cfgno,
701		    desc, USB_DT_CONFIG_SIZE);
702		if (result < 0) {
703			dev_err(ddev, "unable to read config index %d "
704			    "descriptor/%s: %d\n", cfgno, "start", result);
705			dev_err(ddev, "chopping to %d config(s)\n", cfgno);
 
 
706			dev->descriptor.bNumConfigurations = cfgno;
707			break;
708		} else if (result < 4) {
709			dev_err(ddev, "config index %d descriptor too short "
710			    "(expected %i, got %i)\n", cfgno,
711			    USB_DT_CONFIG_SIZE, result);
712			result = -EINVAL;
713			goto err;
714		}
715		length = max((int) le16_to_cpu(desc->wTotalLength),
716		    USB_DT_CONFIG_SIZE);
717
718		/* Now that we know the length, get the whole thing */
719		bigbuffer = kmalloc(length, GFP_KERNEL);
720		if (!bigbuffer) {
721			result = -ENOMEM;
722			goto err;
723		}
 
 
 
 
724		result = usb_get_descriptor(dev, USB_DT_CONFIG, cfgno,
725		    bigbuffer, length);
726		if (result < 0) {
727			dev_err(ddev, "unable to read config index %d "
728			    "descriptor/%s\n", cfgno, "all");
729			kfree(bigbuffer);
730			goto err;
731		}
732		if (result < length) {
733			dev_warn(ddev, "config index %d descriptor too short "
734			    "(expected %i, got %i)\n", cfgno, length, result);
735			length = result;
736		}
737
738		dev->rawdescriptors[cfgno] = bigbuffer;
739
740		result = usb_parse_configuration(dev, cfgno,
741		    &dev->config[cfgno], bigbuffer, length);
742		if (result < 0) {
743			++cfgno;
744			goto err;
745		}
746	}
747	result = 0;
748
749err:
750	kfree(desc);
751out_not_authorized:
752	dev->descriptor.bNumConfigurations = cfgno;
753err2:
754	if (result == -ENOMEM)
755		dev_err(ddev, "out of memory\n");
756	return result;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
757}
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * Released under the GPLv2 only.
   4 */
   5
   6#include <linux/usb.h>
   7#include <linux/usb/ch9.h>
   8#include <linux/usb/hcd.h>
   9#include <linux/usb/quirks.h>
  10#include <linux/module.h>
 
  11#include <linux/slab.h>
  12#include <linux/device.h>
  13#include <asm/byteorder.h>
  14#include "usb.h"
  15
  16
  17#define USB_MAXALTSETTING		128	/* Hard limit */
 
  18
  19#define USB_MAXCONFIG			8	/* Arbitrary limit */
  20
  21
  22static inline const char *plural(int n)
  23{
  24	return (n == 1 ? "" : "s");
  25}
  26
  27static int find_next_descriptor(unsigned char *buffer, int size,
  28    int dt1, int dt2, int *num_skipped)
  29{
  30	struct usb_descriptor_header *h;
  31	int n = 0;
  32	unsigned char *buffer0 = buffer;
  33
  34	/* Find the next descriptor of type dt1 or dt2 */
  35	while (size > 0) {
  36		h = (struct usb_descriptor_header *) buffer;
  37		if (h->bDescriptorType == dt1 || h->bDescriptorType == dt2)
  38			break;
  39		buffer += h->bLength;
  40		size -= h->bLength;
  41		++n;
  42	}
  43
  44	/* Store the number of descriptors skipped and return the
  45	 * number of bytes skipped */
  46	if (num_skipped)
  47		*num_skipped = n;
  48	return buffer - buffer0;
  49}
  50
  51static void usb_parse_ssp_isoc_endpoint_companion(struct device *ddev,
  52		int cfgno, int inum, int asnum, struct usb_host_endpoint *ep,
  53		unsigned char *buffer, int size)
  54{
  55	struct usb_ssp_isoc_ep_comp_descriptor *desc;
  56
  57	/*
  58	 * The SuperSpeedPlus Isoc endpoint companion descriptor immediately
  59	 * follows the SuperSpeed Endpoint Companion descriptor
  60	 */
  61	desc = (struct usb_ssp_isoc_ep_comp_descriptor *) buffer;
  62	if (desc->bDescriptorType != USB_DT_SSP_ISOC_ENDPOINT_COMP ||
  63	    size < USB_DT_SSP_ISOC_EP_COMP_SIZE) {
  64		dev_notice(ddev, "Invalid SuperSpeedPlus isoc endpoint companion"
  65			 "for config %d interface %d altsetting %d ep %d.\n",
  66			 cfgno, inum, asnum, ep->desc.bEndpointAddress);
  67		return;
  68	}
  69	memcpy(&ep->ssp_isoc_ep_comp, desc, USB_DT_SSP_ISOC_EP_COMP_SIZE);
  70}
  71
  72static void usb_parse_ss_endpoint_companion(struct device *ddev, int cfgno,
  73		int inum, int asnum, struct usb_host_endpoint *ep,
  74		unsigned char *buffer, int size)
  75{
  76	struct usb_ss_ep_comp_descriptor *desc;
  77	int max_tx;
  78
  79	/* The SuperSpeed endpoint companion descriptor is supposed to
  80	 * be the first thing immediately following the endpoint descriptor.
  81	 */
  82	desc = (struct usb_ss_ep_comp_descriptor *) buffer;
  83
  84	if (desc->bDescriptorType != USB_DT_SS_ENDPOINT_COMP ||
  85			size < USB_DT_SS_EP_COMP_SIZE) {
  86		dev_notice(ddev, "No SuperSpeed endpoint companion for config %d "
  87				" interface %d altsetting %d ep %d: "
  88				"using minimum values\n",
  89				cfgno, inum, asnum, ep->desc.bEndpointAddress);
  90
  91		/* Fill in some default values.
  92		 * Leave bmAttributes as zero, which will mean no streams for
  93		 * bulk, and isoc won't support multiple bursts of packets.
  94		 * With bursts of only one packet, and a Mult of 1, the max
  95		 * amount of data moved per endpoint service interval is one
  96		 * packet.
  97		 */
  98		ep->ss_ep_comp.bLength = USB_DT_SS_EP_COMP_SIZE;
  99		ep->ss_ep_comp.bDescriptorType = USB_DT_SS_ENDPOINT_COMP;
 100		if (usb_endpoint_xfer_isoc(&ep->desc) ||
 101				usb_endpoint_xfer_int(&ep->desc))
 102			ep->ss_ep_comp.wBytesPerInterval =
 103					ep->desc.wMaxPacketSize;
 104		return;
 105	}
 106	buffer += desc->bLength;
 107	size -= desc->bLength;
 108	memcpy(&ep->ss_ep_comp, desc, USB_DT_SS_EP_COMP_SIZE);
 109
 110	/* Check the various values */
 111	if (usb_endpoint_xfer_control(&ep->desc) && desc->bMaxBurst != 0) {
 112		dev_notice(ddev, "Control endpoint with bMaxBurst = %d in "
 113				"config %d interface %d altsetting %d ep %d: "
 114				"setting to zero\n", desc->bMaxBurst,
 115				cfgno, inum, asnum, ep->desc.bEndpointAddress);
 116		ep->ss_ep_comp.bMaxBurst = 0;
 117	} else if (desc->bMaxBurst > 15) {
 118		dev_notice(ddev, "Endpoint with bMaxBurst = %d in "
 119				"config %d interface %d altsetting %d ep %d: "
 120				"setting to 15\n", desc->bMaxBurst,
 121				cfgno, inum, asnum, ep->desc.bEndpointAddress);
 122		ep->ss_ep_comp.bMaxBurst = 15;
 123	}
 124
 125	if ((usb_endpoint_xfer_control(&ep->desc) ||
 126			usb_endpoint_xfer_int(&ep->desc)) &&
 127				desc->bmAttributes != 0) {
 128		dev_notice(ddev, "%s endpoint with bmAttributes = %d in "
 129				"config %d interface %d altsetting %d ep %d: "
 130				"setting to zero\n",
 131				usb_endpoint_xfer_control(&ep->desc) ? "Control" : "Bulk",
 132				desc->bmAttributes,
 133				cfgno, inum, asnum, ep->desc.bEndpointAddress);
 134		ep->ss_ep_comp.bmAttributes = 0;
 135	} else if (usb_endpoint_xfer_bulk(&ep->desc) &&
 136			desc->bmAttributes > 16) {
 137		dev_notice(ddev, "Bulk endpoint with more than 65536 streams in "
 138				"config %d interface %d altsetting %d ep %d: "
 139				"setting to max\n",
 140				cfgno, inum, asnum, ep->desc.bEndpointAddress);
 141		ep->ss_ep_comp.bmAttributes = 16;
 142	} else if (usb_endpoint_xfer_isoc(&ep->desc) &&
 143		   !USB_SS_SSP_ISOC_COMP(desc->bmAttributes) &&
 144		   USB_SS_MULT(desc->bmAttributes) > 3) {
 145		dev_notice(ddev, "Isoc endpoint has Mult of %d in "
 146				"config %d interface %d altsetting %d ep %d: "
 147				"setting to 3\n",
 148				USB_SS_MULT(desc->bmAttributes),
 149				cfgno, inum, asnum, ep->desc.bEndpointAddress);
 150		ep->ss_ep_comp.bmAttributes = 2;
 151	}
 152
 153	if (usb_endpoint_xfer_isoc(&ep->desc))
 154		max_tx = (desc->bMaxBurst + 1) *
 155			(USB_SS_MULT(desc->bmAttributes)) *
 156			usb_endpoint_maxp(&ep->desc);
 157	else if (usb_endpoint_xfer_int(&ep->desc))
 158		max_tx = usb_endpoint_maxp(&ep->desc) *
 159			(desc->bMaxBurst + 1);
 160	else
 161		max_tx = 999999;
 162	if (le16_to_cpu(desc->wBytesPerInterval) > max_tx) {
 163		dev_notice(ddev, "%s endpoint with wBytesPerInterval of %d in "
 164				"config %d interface %d altsetting %d ep %d: "
 165				"setting to %d\n",
 166				usb_endpoint_xfer_isoc(&ep->desc) ? "Isoc" : "Int",
 167				le16_to_cpu(desc->wBytesPerInterval),
 168				cfgno, inum, asnum, ep->desc.bEndpointAddress,
 169				max_tx);
 170		ep->ss_ep_comp.wBytesPerInterval = cpu_to_le16(max_tx);
 171	}
 172	/* Parse a possible SuperSpeedPlus isoc ep companion descriptor */
 173	if (usb_endpoint_xfer_isoc(&ep->desc) &&
 174	    USB_SS_SSP_ISOC_COMP(desc->bmAttributes))
 175		usb_parse_ssp_isoc_endpoint_companion(ddev, cfgno, inum, asnum,
 176							ep, buffer, size);
 177}
 178
 179static const unsigned short low_speed_maxpacket_maxes[4] = {
 180	[USB_ENDPOINT_XFER_CONTROL] = 8,
 181	[USB_ENDPOINT_XFER_ISOC] = 0,
 182	[USB_ENDPOINT_XFER_BULK] = 0,
 183	[USB_ENDPOINT_XFER_INT] = 8,
 184};
 185static const unsigned short full_speed_maxpacket_maxes[4] = {
 186	[USB_ENDPOINT_XFER_CONTROL] = 64,
 187	[USB_ENDPOINT_XFER_ISOC] = 1023,
 188	[USB_ENDPOINT_XFER_BULK] = 64,
 189	[USB_ENDPOINT_XFER_INT] = 64,
 190};
 191static const unsigned short high_speed_maxpacket_maxes[4] = {
 192	[USB_ENDPOINT_XFER_CONTROL] = 64,
 193	[USB_ENDPOINT_XFER_ISOC] = 1024,
 194
 195	/* Bulk should be 512, but some devices use 1024: we will warn below */
 196	[USB_ENDPOINT_XFER_BULK] = 1024,
 197	[USB_ENDPOINT_XFER_INT] = 1024,
 198};
 199static const unsigned short super_speed_maxpacket_maxes[4] = {
 200	[USB_ENDPOINT_XFER_CONTROL] = 512,
 201	[USB_ENDPOINT_XFER_ISOC] = 1024,
 202	[USB_ENDPOINT_XFER_BULK] = 1024,
 203	[USB_ENDPOINT_XFER_INT] = 1024,
 204};
 205
 206static bool endpoint_is_duplicate(struct usb_endpoint_descriptor *e1,
 207		struct usb_endpoint_descriptor *e2)
 208{
 209	if (e1->bEndpointAddress == e2->bEndpointAddress)
 210		return true;
 211
 212	if (usb_endpoint_xfer_control(e1) || usb_endpoint_xfer_control(e2)) {
 213		if (usb_endpoint_num(e1) == usb_endpoint_num(e2))
 214			return true;
 215	}
 216
 217	return false;
 218}
 219
 220/*
 221 * Check for duplicate endpoint addresses in other interfaces and in the
 222 * altsetting currently being parsed.
 223 */
 224static bool config_endpoint_is_duplicate(struct usb_host_config *config,
 225		int inum, int asnum, struct usb_endpoint_descriptor *d)
 226{
 227	struct usb_endpoint_descriptor *epd;
 228	struct usb_interface_cache *intfc;
 229	struct usb_host_interface *alt;
 230	int i, j, k;
 231
 232	for (i = 0; i < config->desc.bNumInterfaces; ++i) {
 233		intfc = config->intf_cache[i];
 234
 235		for (j = 0; j < intfc->num_altsetting; ++j) {
 236			alt = &intfc->altsetting[j];
 237
 238			if (alt->desc.bInterfaceNumber == inum &&
 239					alt->desc.bAlternateSetting != asnum)
 240				continue;
 241
 242			for (k = 0; k < alt->desc.bNumEndpoints; ++k) {
 243				epd = &alt->endpoint[k].desc;
 244
 245				if (endpoint_is_duplicate(epd, d))
 246					return true;
 247			}
 248		}
 249	}
 250
 251	return false;
 252}
 253
 254static int usb_parse_endpoint(struct device *ddev, int cfgno,
 255		struct usb_host_config *config, int inum, int asnum,
 256		struct usb_host_interface *ifp, int num_ep,
 257		unsigned char *buffer, int size)
 258{
 259	struct usb_device *udev = to_usb_device(ddev);
 260	unsigned char *buffer0 = buffer;
 261	struct usb_endpoint_descriptor *d;
 262	struct usb_host_endpoint *endpoint;
 263	int n, i, j, retval;
 264	unsigned int maxp;
 265	const unsigned short *maxpacket_maxes;
 266
 267	d = (struct usb_endpoint_descriptor *) buffer;
 268	buffer += d->bLength;
 269	size -= d->bLength;
 270
 271	if (d->bLength >= USB_DT_ENDPOINT_AUDIO_SIZE)
 272		n = USB_DT_ENDPOINT_AUDIO_SIZE;
 273	else if (d->bLength >= USB_DT_ENDPOINT_SIZE)
 274		n = USB_DT_ENDPOINT_SIZE;
 275	else {
 276		dev_notice(ddev, "config %d interface %d altsetting %d has an "
 277		    "invalid endpoint descriptor of length %d, skipping\n",
 278		    cfgno, inum, asnum, d->bLength);
 279		goto skip_to_next_endpoint_or_interface_descriptor;
 280	}
 281
 282	i = d->bEndpointAddress & USB_ENDPOINT_NUMBER_MASK;
 283	if (i == 0) {
 284		dev_notice(ddev, "config %d interface %d altsetting %d has an "
 285		    "invalid descriptor for endpoint zero, skipping\n",
 286		    cfgno, inum, asnum);
 287		goto skip_to_next_endpoint_or_interface_descriptor;
 288	}
 289
 290	/* Only store as many endpoints as we have room for */
 291	if (ifp->desc.bNumEndpoints >= num_ep)
 292		goto skip_to_next_endpoint_or_interface_descriptor;
 293
 294	/* Save a copy of the descriptor and use it instead of the original */
 295	endpoint = &ifp->endpoint[ifp->desc.bNumEndpoints];
 
 
 296	memcpy(&endpoint->desc, d, n);
 297	d = &endpoint->desc;
 298
 299	/* Clear the reserved bits in bEndpointAddress */
 300	i = d->bEndpointAddress &
 301			(USB_ENDPOINT_DIR_MASK | USB_ENDPOINT_NUMBER_MASK);
 302	if (i != d->bEndpointAddress) {
 303		dev_notice(ddev, "config %d interface %d altsetting %d has an endpoint descriptor with address 0x%X, changing to 0x%X\n",
 304		    cfgno, inum, asnum, d->bEndpointAddress, i);
 305		endpoint->desc.bEndpointAddress = i;
 306	}
 307
 308	/* Check for duplicate endpoint addresses */
 309	if (config_endpoint_is_duplicate(config, inum, asnum, d)) {
 310		dev_notice(ddev, "config %d interface %d altsetting %d has a duplicate endpoint with address 0x%X, skipping\n",
 311				cfgno, inum, asnum, d->bEndpointAddress);
 312		goto skip_to_next_endpoint_or_interface_descriptor;
 313	}
 314
 315	/* Ignore some endpoints */
 316	if (udev->quirks & USB_QUIRK_ENDPOINT_IGNORE) {
 317		if (usb_endpoint_is_ignored(udev, ifp, d)) {
 318			dev_notice(ddev, "config %d interface %d altsetting %d has an ignored endpoint with address 0x%X, skipping\n",
 319					cfgno, inum, asnum,
 320					d->bEndpointAddress);
 321			goto skip_to_next_endpoint_or_interface_descriptor;
 322		}
 323	}
 324
 325	/* Accept this endpoint */
 326	++ifp->desc.bNumEndpoints;
 327	INIT_LIST_HEAD(&endpoint->urb_list);
 328
 329	/*
 330	 * Fix up bInterval values outside the legal range.
 331	 * Use 10 or 8 ms if no proper value can be guessed.
 332	 */
 333	i = 0;		/* i = min, j = max, n = default */
 334	j = 255;
 335	if (usb_endpoint_xfer_int(d)) {
 336		i = 1;
 337		switch (udev->speed) {
 338		case USB_SPEED_SUPER_PLUS:
 339		case USB_SPEED_SUPER:
 340		case USB_SPEED_HIGH:
 341			/*
 342			 * Many device manufacturers are using full-speed
 343			 * bInterval values in high-speed interrupt endpoint
 344			 * descriptors. Try to fix those and fall back to an
 345			 * 8-ms default value otherwise.
 346			 */
 347			n = fls(d->bInterval*8);
 348			if (n == 0)
 349				n = 7;	/* 8 ms = 2^(7-1) uframes */
 350			j = 16;
 351
 352			/*
 353			 * Adjust bInterval for quirked devices.
 354			 */
 355			/*
 356			 * This quirk fixes bIntervals reported in ms.
 357			 */
 358			if (udev->quirks & USB_QUIRK_LINEAR_FRAME_INTR_BINTERVAL) {
 359				n = clamp(fls(d->bInterval) + 3, i, j);
 360				i = j = n;
 361			}
 362			/*
 363			 * This quirk fixes bIntervals reported in
 364			 * linear microframes.
 365			 */
 366			if (udev->quirks & USB_QUIRK_LINEAR_UFRAME_INTR_BINTERVAL) {
 367				n = clamp(fls(d->bInterval), i, j);
 368				i = j = n;
 369			}
 370			break;
 371		default:		/* USB_SPEED_FULL or _LOW */
 372			/*
 373			 * For low-speed, 10 ms is the official minimum.
 374			 * But some "overclocked" devices might want faster
 375			 * polling so we'll allow it.
 376			 */
 377			n = 10;
 378			break;
 379		}
 380	} else if (usb_endpoint_xfer_isoc(d)) {
 381		i = 1;
 382		j = 16;
 383		switch (udev->speed) {
 384		case USB_SPEED_HIGH:
 385			n = 7;		/* 8 ms = 2^(7-1) uframes */
 386			break;
 387		default:		/* USB_SPEED_FULL */
 388			n = 4;		/* 8 ms = 2^(4-1) frames */
 389			break;
 390		}
 391	}
 392	if (d->bInterval < i || d->bInterval > j) {
 393		dev_notice(ddev, "config %d interface %d altsetting %d "
 394		    "endpoint 0x%X has an invalid bInterval %d, "
 395		    "changing to %d\n",
 396		    cfgno, inum, asnum,
 397		    d->bEndpointAddress, d->bInterval, n);
 398		endpoint->desc.bInterval = n;
 399	}
 400
 401	/* Some buggy low-speed devices have Bulk endpoints, which is
 402	 * explicitly forbidden by the USB spec.  In an attempt to make
 403	 * them usable, we will try treating them as Interrupt endpoints.
 404	 */
 405	if (udev->speed == USB_SPEED_LOW && usb_endpoint_xfer_bulk(d)) {
 406		dev_notice(ddev, "config %d interface %d altsetting %d "
 
 407		    "endpoint 0x%X is Bulk; changing to Interrupt\n",
 408		    cfgno, inum, asnum, d->bEndpointAddress);
 409		endpoint->desc.bmAttributes = USB_ENDPOINT_XFER_INT;
 410		endpoint->desc.bInterval = 1;
 411		if (usb_endpoint_maxp(&endpoint->desc) > 8)
 412			endpoint->desc.wMaxPacketSize = cpu_to_le16(8);
 413	}
 414
 415	/*
 416	 * Validate the wMaxPacketSize field.
 417	 * Some devices have isochronous endpoints in altsetting 0;
 418	 * the USB-2 spec requires such endpoints to have wMaxPacketSize = 0
 419	 * (see the end of section 5.6.3), so don't warn about them.
 420	 */
 421	maxp = le16_to_cpu(endpoint->desc.wMaxPacketSize);
 422	if (maxp == 0 && !(usb_endpoint_xfer_isoc(d) && asnum == 0)) {
 423		dev_notice(ddev, "config %d interface %d altsetting %d endpoint 0x%X has invalid wMaxPacketSize 0\n",
 424		    cfgno, inum, asnum, d->bEndpointAddress);
 425	}
 426
 427	/* Find the highest legal maxpacket size for this endpoint */
 428	i = 0;		/* additional transactions per microframe */
 429	switch (udev->speed) {
 430	case USB_SPEED_LOW:
 431		maxpacket_maxes = low_speed_maxpacket_maxes;
 432		break;
 433	case USB_SPEED_FULL:
 434		maxpacket_maxes = full_speed_maxpacket_maxes;
 435		break;
 436	case USB_SPEED_HIGH:
 437		/* Multiple-transactions bits are allowed only for HS periodic endpoints */
 438		if (usb_endpoint_xfer_int(d) || usb_endpoint_xfer_isoc(d)) {
 439			i = maxp & USB_EP_MAXP_MULT_MASK;
 440			maxp &= ~i;
 441		}
 442		fallthrough;
 443	default:
 444		maxpacket_maxes = high_speed_maxpacket_maxes;
 445		break;
 446	case USB_SPEED_SUPER:
 447	case USB_SPEED_SUPER_PLUS:
 448		maxpacket_maxes = super_speed_maxpacket_maxes;
 449		break;
 450	}
 451	j = maxpacket_maxes[usb_endpoint_type(&endpoint->desc)];
 452
 453	if (maxp > j) {
 454		dev_notice(ddev, "config %d interface %d altsetting %d endpoint 0x%X has invalid maxpacket %d, setting to %d\n",
 455		    cfgno, inum, asnum, d->bEndpointAddress, maxp, j);
 456		maxp = j;
 457		endpoint->desc.wMaxPacketSize = cpu_to_le16(i | maxp);
 458	}
 459
 460	/*
 461	 * Some buggy high speed devices have bulk endpoints using
 462	 * maxpacket sizes other than 512.  High speed HCDs may not
 463	 * be able to handle that particular bug, so let's warn...
 464	 */
 465	if (udev->speed == USB_SPEED_HIGH && usb_endpoint_xfer_bulk(d)) {
 
 
 
 
 466		if (maxp != 512)
 467			dev_notice(ddev, "config %d interface %d altsetting %d "
 468				"bulk endpoint 0x%X has invalid maxpacket %d\n",
 469				cfgno, inum, asnum, d->bEndpointAddress,
 470				maxp);
 471	}
 472
 473	/* Parse a possible SuperSpeed endpoint companion descriptor */
 474	if (udev->speed >= USB_SPEED_SUPER)
 475		usb_parse_ss_endpoint_companion(ddev, cfgno,
 476				inum, asnum, endpoint, buffer, size);
 477
 478	/* Skip over any Class Specific or Vendor Specific descriptors;
 479	 * find the next endpoint or interface descriptor */
 480	endpoint->extra = buffer;
 481	i = find_next_descriptor(buffer, size, USB_DT_ENDPOINT,
 482			USB_DT_INTERFACE, &n);
 483	endpoint->extralen = i;
 484	retval = buffer - buffer0 + i;
 485	if (n > 0)
 486		dev_dbg(ddev, "skipped %d descriptor%s after %s\n",
 487		    n, plural(n), "endpoint");
 488	return retval;
 489
 490skip_to_next_endpoint_or_interface_descriptor:
 491	i = find_next_descriptor(buffer, size, USB_DT_ENDPOINT,
 492	    USB_DT_INTERFACE, NULL);
 493	return buffer - buffer0 + i;
 494}
 495
 496void usb_release_interface_cache(struct kref *ref)
 497{
 498	struct usb_interface_cache *intfc = ref_to_usb_interface_cache(ref);
 499	int j;
 500
 501	for (j = 0; j < intfc->num_altsetting; j++) {
 502		struct usb_host_interface *alt = &intfc->altsetting[j];
 503
 504		kfree(alt->endpoint);
 505		kfree(alt->string);
 506	}
 507	kfree(intfc);
 508}
 509
 510static int usb_parse_interface(struct device *ddev, int cfgno,
 511    struct usb_host_config *config, unsigned char *buffer, int size,
 512    u8 inums[], u8 nalts[])
 513{
 514	unsigned char *buffer0 = buffer;
 515	struct usb_interface_descriptor	*d;
 516	int inum, asnum;
 517	struct usb_interface_cache *intfc;
 518	struct usb_host_interface *alt;
 519	int i, n;
 520	int len, retval;
 521	int num_ep, num_ep_orig;
 522
 523	d = (struct usb_interface_descriptor *) buffer;
 524	buffer += d->bLength;
 525	size -= d->bLength;
 526
 527	if (d->bLength < USB_DT_INTERFACE_SIZE)
 528		goto skip_to_next_interface_descriptor;
 529
 530	/* Which interface entry is this? */
 531	intfc = NULL;
 532	inum = d->bInterfaceNumber;
 533	for (i = 0; i < config->desc.bNumInterfaces; ++i) {
 534		if (inums[i] == inum) {
 535			intfc = config->intf_cache[i];
 536			break;
 537		}
 538	}
 539	if (!intfc || intfc->num_altsetting >= nalts[i])
 540		goto skip_to_next_interface_descriptor;
 541
 542	/* Check for duplicate altsetting entries */
 543	asnum = d->bAlternateSetting;
 544	for ((i = 0, alt = &intfc->altsetting[0]);
 545	      i < intfc->num_altsetting;
 546	     (++i, ++alt)) {
 547		if (alt->desc.bAlternateSetting == asnum) {
 548			dev_notice(ddev, "Duplicate descriptor for config %d "
 549			    "interface %d altsetting %d, skipping\n",
 550			    cfgno, inum, asnum);
 551			goto skip_to_next_interface_descriptor;
 552		}
 553	}
 554
 555	++intfc->num_altsetting;
 556	memcpy(&alt->desc, d, USB_DT_INTERFACE_SIZE);
 557
 558	/* Skip over any Class Specific or Vendor Specific descriptors;
 559	 * find the first endpoint or interface descriptor */
 560	alt->extra = buffer;
 561	i = find_next_descriptor(buffer, size, USB_DT_ENDPOINT,
 562	    USB_DT_INTERFACE, &n);
 563	alt->extralen = i;
 564	if (n > 0)
 565		dev_dbg(ddev, "skipped %d descriptor%s after %s\n",
 566		    n, plural(n), "interface");
 567	buffer += i;
 568	size -= i;
 569
 570	/* Allocate space for the right(?) number of endpoints */
 571	num_ep = num_ep_orig = alt->desc.bNumEndpoints;
 572	alt->desc.bNumEndpoints = 0;		/* Use as a counter */
 573	if (num_ep > USB_MAXENDPOINTS) {
 574		dev_notice(ddev, "too many endpoints for config %d interface %d "
 575		    "altsetting %d: %d, using maximum allowed: %d\n",
 576		    cfgno, inum, asnum, num_ep, USB_MAXENDPOINTS);
 577		num_ep = USB_MAXENDPOINTS;
 578	}
 579
 580	if (num_ep > 0) {
 581		/* Can't allocate 0 bytes */
 582		len = sizeof(struct usb_host_endpoint) * num_ep;
 583		alt->endpoint = kzalloc(len, GFP_KERNEL);
 584		if (!alt->endpoint)
 585			return -ENOMEM;
 586	}
 587
 588	/* Parse all the endpoint descriptors */
 589	n = 0;
 590	while (size > 0) {
 591		if (((struct usb_descriptor_header *) buffer)->bDescriptorType
 592		     == USB_DT_INTERFACE)
 593			break;
 594		retval = usb_parse_endpoint(ddev, cfgno, config, inum, asnum,
 595				alt, num_ep, buffer, size);
 596		if (retval < 0)
 597			return retval;
 598		++n;
 599
 600		buffer += retval;
 601		size -= retval;
 602	}
 603
 604	if (n != num_ep_orig)
 605		dev_notice(ddev, "config %d interface %d altsetting %d has %d "
 606		    "endpoint descriptor%s, different from the interface "
 607		    "descriptor's value: %d\n",
 608		    cfgno, inum, asnum, n, plural(n), num_ep_orig);
 609	return buffer - buffer0;
 610
 611skip_to_next_interface_descriptor:
 612	i = find_next_descriptor(buffer, size, USB_DT_INTERFACE,
 613	    USB_DT_INTERFACE, NULL);
 614	return buffer - buffer0 + i;
 615}
 616
 617static int usb_parse_configuration(struct usb_device *dev, int cfgidx,
 618    struct usb_host_config *config, unsigned char *buffer, int size)
 619{
 620	struct device *ddev = &dev->dev;
 621	unsigned char *buffer0 = buffer;
 622	int cfgno;
 623	int nintf, nintf_orig;
 624	int i, j, n;
 625	struct usb_interface_cache *intfc;
 626	unsigned char *buffer2;
 627	int size2;
 628	struct usb_descriptor_header *header;
 629	int retval;
 630	u8 inums[USB_MAXINTERFACES], nalts[USB_MAXINTERFACES];
 631	unsigned iad_num = 0;
 632
 633	memcpy(&config->desc, buffer, USB_DT_CONFIG_SIZE);
 634	nintf = nintf_orig = config->desc.bNumInterfaces;
 635	config->desc.bNumInterfaces = 0;	// Adjusted later
 636
 637	if (config->desc.bDescriptorType != USB_DT_CONFIG ||
 638	    config->desc.bLength < USB_DT_CONFIG_SIZE ||
 639	    config->desc.bLength > size) {
 640		dev_notice(ddev, "invalid descriptor for config index %d: "
 641		    "type = 0x%X, length = %d\n", cfgidx,
 642		    config->desc.bDescriptorType, config->desc.bLength);
 643		return -EINVAL;
 644	}
 645	cfgno = config->desc.bConfigurationValue;
 646
 647	buffer += config->desc.bLength;
 648	size -= config->desc.bLength;
 649
 
 650	if (nintf > USB_MAXINTERFACES) {
 651		dev_notice(ddev, "config %d has too many interfaces: %d, "
 652		    "using maximum allowed: %d\n",
 653		    cfgno, nintf, USB_MAXINTERFACES);
 654		nintf = USB_MAXINTERFACES;
 655	}
 656
 657	/* Go through the descriptors, checking their length and counting the
 658	 * number of altsettings for each interface */
 659	n = 0;
 660	for ((buffer2 = buffer, size2 = size);
 661	      size2 > 0;
 662	     (buffer2 += header->bLength, size2 -= header->bLength)) {
 663
 664		if (size2 < sizeof(struct usb_descriptor_header)) {
 665			dev_notice(ddev, "config %d descriptor has %d excess "
 666			    "byte%s, ignoring\n",
 667			    cfgno, size2, plural(size2));
 668			break;
 669		}
 670
 671		header = (struct usb_descriptor_header *) buffer2;
 672		if ((header->bLength > size2) || (header->bLength < 2)) {
 673			dev_notice(ddev, "config %d has an invalid descriptor "
 674			    "of length %d, skipping remainder of the config\n",
 675			    cfgno, header->bLength);
 676			break;
 677		}
 678
 679		if (header->bDescriptorType == USB_DT_INTERFACE) {
 680			struct usb_interface_descriptor *d;
 681			int inum;
 682
 683			d = (struct usb_interface_descriptor *) header;
 684			if (d->bLength < USB_DT_INTERFACE_SIZE) {
 685				dev_notice(ddev, "config %d has an invalid "
 686				    "interface descriptor of length %d, "
 687				    "skipping\n", cfgno, d->bLength);
 688				continue;
 689			}
 690
 691			inum = d->bInterfaceNumber;
 692
 693			if ((dev->quirks & USB_QUIRK_HONOR_BNUMINTERFACES) &&
 694			    n >= nintf_orig) {
 695				dev_notice(ddev, "config %d has more interface "
 696				    "descriptors, than it declares in "
 697				    "bNumInterfaces, ignoring interface "
 698				    "number: %d\n", cfgno, inum);
 699				continue;
 700			}
 701
 702			if (inum >= nintf_orig)
 703				dev_notice(ddev, "config %d has an invalid "
 704				    "interface number: %d but max is %d\n",
 705				    cfgno, inum, nintf_orig - 1);
 706
 707			/* Have we already encountered this interface?
 708			 * Count its altsettings */
 709			for (i = 0; i < n; ++i) {
 710				if (inums[i] == inum)
 711					break;
 712			}
 713			if (i < n) {
 714				if (nalts[i] < 255)
 715					++nalts[i];
 716			} else if (n < USB_MAXINTERFACES) {
 717				inums[n] = inum;
 718				nalts[n] = 1;
 719				++n;
 720			}
 721
 722		} else if (header->bDescriptorType ==
 723				USB_DT_INTERFACE_ASSOCIATION) {
 724			struct usb_interface_assoc_descriptor *d;
 725
 726			d = (struct usb_interface_assoc_descriptor *)header;
 727			if (d->bLength < USB_DT_INTERFACE_ASSOCIATION_SIZE) {
 728				dev_notice(ddev,
 729					 "config %d has an invalid interface association descriptor of length %d, skipping\n",
 730					 cfgno, d->bLength);
 731				continue;
 732			}
 733
 734			if (iad_num == USB_MAXIADS) {
 735				dev_notice(ddev, "found more Interface "
 736					       "Association Descriptors "
 737					       "than allocated for in "
 738					       "configuration %d\n", cfgno);
 739			} else {
 740				config->intf_assoc[iad_num] = d;
 
 
 741				iad_num++;
 742			}
 743
 744		} else if (header->bDescriptorType == USB_DT_DEVICE ||
 745			    header->bDescriptorType == USB_DT_CONFIG)
 746			dev_notice(ddev, "config %d contains an unexpected "
 747			    "descriptor of type 0x%X, skipping\n",
 748			    cfgno, header->bDescriptorType);
 749
 750	}	/* for ((buffer2 = buffer, size2 = size); ...) */
 751	size = buffer2 - buffer;
 752	config->desc.wTotalLength = cpu_to_le16(buffer2 - buffer0);
 753
 754	if (n != nintf)
 755		dev_notice(ddev, "config %d has %d interface%s, different from "
 756		    "the descriptor's value: %d\n",
 757		    cfgno, n, plural(n), nintf_orig);
 758	else if (n == 0)
 759		dev_notice(ddev, "config %d has no interfaces?\n", cfgno);
 760	config->desc.bNumInterfaces = nintf = n;
 761
 762	/* Check for missing interface numbers */
 763	for (i = 0; i < nintf; ++i) {
 764		for (j = 0; j < nintf; ++j) {
 765			if (inums[j] == i)
 766				break;
 767		}
 768		if (j >= nintf)
 769			dev_notice(ddev, "config %d has no interface number "
 770			    "%d\n", cfgno, i);
 771	}
 772
 773	/* Allocate the usb_interface_caches and altsetting arrays */
 774	for (i = 0; i < nintf; ++i) {
 775		j = nalts[i];
 776		if (j > USB_MAXALTSETTING) {
 777			dev_notice(ddev, "too many alternate settings for "
 778			    "config %d interface %d: %d, "
 779			    "using maximum allowed: %d\n",
 780			    cfgno, inums[i], j, USB_MAXALTSETTING);
 781			nalts[i] = j = USB_MAXALTSETTING;
 782		}
 783
 784		intfc = kzalloc(struct_size(intfc, altsetting, j), GFP_KERNEL);
 785		config->intf_cache[i] = intfc;
 786		if (!intfc)
 787			return -ENOMEM;
 788		kref_init(&intfc->ref);
 789	}
 790
 791	/* FIXME: parse the BOS descriptor */
 792
 793	/* Skip over any Class Specific or Vendor Specific descriptors;
 794	 * find the first interface descriptor */
 795	config->extra = buffer;
 796	i = find_next_descriptor(buffer, size, USB_DT_INTERFACE,
 797	    USB_DT_INTERFACE, &n);
 798	config->extralen = i;
 799	if (n > 0)
 800		dev_dbg(ddev, "skipped %d descriptor%s after %s\n",
 801		    n, plural(n), "configuration");
 802	buffer += i;
 803	size -= i;
 804
 805	/* Parse all the interface/altsetting descriptors */
 806	while (size > 0) {
 807		retval = usb_parse_interface(ddev, cfgno, config,
 808		    buffer, size, inums, nalts);
 809		if (retval < 0)
 810			return retval;
 811
 812		buffer += retval;
 813		size -= retval;
 814	}
 815
 816	/* Check for missing altsettings */
 817	for (i = 0; i < nintf; ++i) {
 818		intfc = config->intf_cache[i];
 819		for (j = 0; j < intfc->num_altsetting; ++j) {
 820			for (n = 0; n < intfc->num_altsetting; ++n) {
 821				if (intfc->altsetting[n].desc.
 822				    bAlternateSetting == j)
 823					break;
 824			}
 825			if (n >= intfc->num_altsetting)
 826				dev_notice(ddev, "config %d interface %d has no "
 827				    "altsetting %d\n", cfgno, inums[i], j);
 828		}
 829	}
 830
 831	return 0;
 832}
 833
 834/* hub-only!! ... and only exported for reset/reinit path.
 835 * otherwise used internally on disconnect/destroy path
 836 */
 837void usb_destroy_configuration(struct usb_device *dev)
 838{
 839	int c, i;
 840
 841	if (!dev->config)
 842		return;
 843
 844	if (dev->rawdescriptors) {
 845		for (i = 0; i < dev->descriptor.bNumConfigurations; i++)
 846			kfree(dev->rawdescriptors[i]);
 847
 848		kfree(dev->rawdescriptors);
 849		dev->rawdescriptors = NULL;
 850	}
 851
 852	for (c = 0; c < dev->descriptor.bNumConfigurations; c++) {
 853		struct usb_host_config *cf = &dev->config[c];
 854
 855		kfree(cf->string);
 856		for (i = 0; i < cf->desc.bNumInterfaces; i++) {
 857			if (cf->intf_cache[i])
 858				kref_put(&cf->intf_cache[i]->ref,
 859					  usb_release_interface_cache);
 860		}
 861	}
 862	kfree(dev->config);
 863	dev->config = NULL;
 864}
 865
 866
 867/*
 868 * Get the USB config descriptors, cache and parse'em
 869 *
 870 * hub-only!! ... and only in reset path, or usb_new_device()
 871 * (used by real hubs and virtual root hubs)
 
 
 
 
 872 */
 873int usb_get_configuration(struct usb_device *dev)
 874{
 875	struct device *ddev = &dev->dev;
 876	int ncfg = dev->descriptor.bNumConfigurations;
 
 877	unsigned int cfgno, length;
 878	unsigned char *bigbuffer;
 879	struct usb_config_descriptor *desc;
 880	int result;
 881
 
 
 
 
 882	if (ncfg > USB_MAXCONFIG) {
 883		dev_notice(ddev, "too many configurations: %d, "
 884		    "using maximum allowed: %d\n", ncfg, USB_MAXCONFIG);
 885		dev->descriptor.bNumConfigurations = ncfg = USB_MAXCONFIG;
 886	}
 887
 888	if (ncfg < 1) {
 889		dev_err(ddev, "no configurations\n");
 890		return -EINVAL;
 891	}
 892
 893	length = ncfg * sizeof(struct usb_host_config);
 894	dev->config = kzalloc(length, GFP_KERNEL);
 895	if (!dev->config)
 896		return -ENOMEM;
 897
 898	length = ncfg * sizeof(char *);
 899	dev->rawdescriptors = kzalloc(length, GFP_KERNEL);
 900	if (!dev->rawdescriptors)
 901		return -ENOMEM;
 902
 903	desc = kmalloc(USB_DT_CONFIG_SIZE, GFP_KERNEL);
 904	if (!desc)
 905		return -ENOMEM;
 906
 907	for (cfgno = 0; cfgno < ncfg; cfgno++) {
 
 908		/* We grab just the first descriptor so we know how long
 909		 * the whole configuration is */
 910		result = usb_get_descriptor(dev, USB_DT_CONFIG, cfgno,
 911		    desc, USB_DT_CONFIG_SIZE);
 912		if (result < 0) {
 913			dev_err(ddev, "unable to read config index %d "
 914			    "descriptor/%s: %d\n", cfgno, "start", result);
 915			if (result != -EPIPE)
 916				goto err;
 917			dev_notice(ddev, "chopping to %d config(s)\n", cfgno);
 918			dev->descriptor.bNumConfigurations = cfgno;
 919			break;
 920		} else if (result < 4) {
 921			dev_err(ddev, "config index %d descriptor too short "
 922			    "(expected %i, got %i)\n", cfgno,
 923			    USB_DT_CONFIG_SIZE, result);
 924			result = -EINVAL;
 925			goto err;
 926		}
 927		length = max_t(int, le16_to_cpu(desc->wTotalLength),
 928		    USB_DT_CONFIG_SIZE);
 929
 930		/* Now that we know the length, get the whole thing */
 931		bigbuffer = kmalloc(length, GFP_KERNEL);
 932		if (!bigbuffer) {
 933			result = -ENOMEM;
 934			goto err;
 935		}
 936
 937		if (dev->quirks & USB_QUIRK_DELAY_INIT)
 938			msleep(200);
 939
 940		result = usb_get_descriptor(dev, USB_DT_CONFIG, cfgno,
 941		    bigbuffer, length);
 942		if (result < 0) {
 943			dev_err(ddev, "unable to read config index %d "
 944			    "descriptor/%s\n", cfgno, "all");
 945			kfree(bigbuffer);
 946			goto err;
 947		}
 948		if (result < length) {
 949			dev_notice(ddev, "config index %d descriptor too short "
 950			    "(expected %i, got %i)\n", cfgno, length, result);
 951			length = result;
 952		}
 953
 954		dev->rawdescriptors[cfgno] = bigbuffer;
 955
 956		result = usb_parse_configuration(dev, cfgno,
 957		    &dev->config[cfgno], bigbuffer, length);
 958		if (result < 0) {
 959			++cfgno;
 960			goto err;
 961		}
 962	}
 
 963
 964err:
 965	kfree(desc);
 
 966	dev->descriptor.bNumConfigurations = cfgno;
 967
 
 
 968	return result;
 969}
 970
 971void usb_release_bos_descriptor(struct usb_device *dev)
 972{
 973	if (dev->bos) {
 974		kfree(dev->bos->desc);
 975		kfree(dev->bos);
 976		dev->bos = NULL;
 977	}
 978}
 979
 980static const __u8 bos_desc_len[256] = {
 981	[USB_CAP_TYPE_WIRELESS_USB] = USB_DT_USB_WIRELESS_CAP_SIZE,
 982	[USB_CAP_TYPE_EXT]          = USB_DT_USB_EXT_CAP_SIZE,
 983	[USB_SS_CAP_TYPE]           = USB_DT_USB_SS_CAP_SIZE,
 984	[USB_SSP_CAP_TYPE]          = USB_DT_USB_SSP_CAP_SIZE(1),
 985	[CONTAINER_ID_TYPE]         = USB_DT_USB_SS_CONTN_ID_SIZE,
 986	[USB_PTM_CAP_TYPE]          = USB_DT_USB_PTM_ID_SIZE,
 987};
 988
 989/* Get BOS descriptor set */
 990int usb_get_bos_descriptor(struct usb_device *dev)
 991{
 992	struct device *ddev = &dev->dev;
 993	struct usb_bos_descriptor *bos;
 994	struct usb_dev_cap_header *cap;
 995	struct usb_ssp_cap_descriptor *ssp_cap;
 996	unsigned char *buffer, *buffer0;
 997	int length, total_len, num, i, ssac;
 998	__u8 cap_type;
 999	int ret;
1000
1001	bos = kzalloc(sizeof(*bos), GFP_KERNEL);
1002	if (!bos)
1003		return -ENOMEM;
1004
1005	/* Get BOS descriptor */
1006	ret = usb_get_descriptor(dev, USB_DT_BOS, 0, bos, USB_DT_BOS_SIZE);
1007	if (ret < USB_DT_BOS_SIZE || bos->bLength < USB_DT_BOS_SIZE) {
1008		dev_notice(ddev, "unable to get BOS descriptor or descriptor too short\n");
1009		if (ret >= 0)
1010			ret = -ENOMSG;
1011		kfree(bos);
1012		return ret;
1013	}
1014
1015	length = bos->bLength;
1016	total_len = le16_to_cpu(bos->wTotalLength);
1017	num = bos->bNumDeviceCaps;
1018	kfree(bos);
1019	if (total_len < length)
1020		return -EINVAL;
1021
1022	dev->bos = kzalloc(sizeof(*dev->bos), GFP_KERNEL);
1023	if (!dev->bos)
1024		return -ENOMEM;
1025
1026	/* Now let's get the whole BOS descriptor set */
1027	buffer = kzalloc(total_len, GFP_KERNEL);
1028	if (!buffer) {
1029		ret = -ENOMEM;
1030		goto err;
1031	}
1032	dev->bos->desc = (struct usb_bos_descriptor *)buffer;
1033
1034	ret = usb_get_descriptor(dev, USB_DT_BOS, 0, buffer, total_len);
1035	if (ret < total_len) {
1036		dev_notice(ddev, "unable to get BOS descriptor set\n");
1037		if (ret >= 0)
1038			ret = -ENOMSG;
1039		goto err;
1040	}
1041
1042	buffer0 = buffer;
1043	total_len -= length;
1044	buffer += length;
1045
1046	for (i = 0; i < num; i++) {
1047		cap = (struct usb_dev_cap_header *)buffer;
1048
1049		if (total_len < sizeof(*cap) || total_len < cap->bLength) {
1050			dev->bos->desc->bNumDeviceCaps = i;
1051			break;
1052		}
1053		cap_type = cap->bDevCapabilityType;
1054		length = cap->bLength;
1055		if (bos_desc_len[cap_type] && length < bos_desc_len[cap_type]) {
1056			dev->bos->desc->bNumDeviceCaps = i;
1057			break;
1058		}
1059
1060		if (cap->bDescriptorType != USB_DT_DEVICE_CAPABILITY) {
1061			dev_notice(ddev, "descriptor type invalid, skip\n");
1062			goto skip_to_next_descriptor;
1063		}
1064
1065		switch (cap_type) {
1066		case USB_CAP_TYPE_EXT:
1067			dev->bos->ext_cap =
1068				(struct usb_ext_cap_descriptor *)buffer;
1069			break;
1070		case USB_SS_CAP_TYPE:
1071			dev->bos->ss_cap =
1072				(struct usb_ss_cap_descriptor *)buffer;
1073			break;
1074		case USB_SSP_CAP_TYPE:
1075			ssp_cap = (struct usb_ssp_cap_descriptor *)buffer;
1076			ssac = (le32_to_cpu(ssp_cap->bmAttributes) &
1077				USB_SSP_SUBLINK_SPEED_ATTRIBS);
1078			if (length >= USB_DT_USB_SSP_CAP_SIZE(ssac))
1079				dev->bos->ssp_cap = ssp_cap;
1080			break;
1081		case CONTAINER_ID_TYPE:
1082			dev->bos->ss_id =
1083				(struct usb_ss_container_id_descriptor *)buffer;
1084			break;
1085		case USB_PTM_CAP_TYPE:
1086			dev->bos->ptm_cap =
1087				(struct usb_ptm_cap_descriptor *)buffer;
1088			break;
1089		default:
1090			break;
1091		}
1092
1093skip_to_next_descriptor:
1094		total_len -= length;
1095		buffer += length;
1096	}
1097	dev->bos->desc->wTotalLength = cpu_to_le16(buffer - buffer0);
1098
1099	return 0;
1100
1101err:
1102	usb_release_bos_descriptor(dev);
1103	return ret;
1104}