Tests: Fix broken OS-X and Linux builds
[platform/upstream/libusb.git] / libusb / descriptor.c
1 /*
2  * USB descriptor handling functions for libusbx
3  * Copyright © 2007 Daniel Drake <dsd@gentoo.org>
4  * Copyright © 2001 Johannes Erdfelt <johannes@erdfelt.com>
5  *
6  * This library is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Lesser General Public
8  * License as published by the Free Software Foundation; either
9  * version 2.1 of the License, or (at your option) any later version.
10  *
11  * This library is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public
17  * License along with this library; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
19  */
20
21 #include <errno.h>
22 #include <stdint.h>
23 #include <stdlib.h>
24 #include <string.h>
25
26 #include "libusbi.h"
27
28 #define DESC_HEADER_LENGTH              2
29 #define DEVICE_DESC_LENGTH              18
30 #define CONFIG_DESC_LENGTH              9
31 #define INTERFACE_DESC_LENGTH           9
32 #define ENDPOINT_DESC_LENGTH            7
33 #define ENDPOINT_AUDIO_DESC_LENGTH      9
34
35 /** @defgroup desc USB descriptors
36  * This page details how to examine the various standard USB descriptors
37  * for detected devices
38  */
39
40 /* set host_endian if the w values are already in host endian format,
41  * as opposed to bus endian. */
42 int usbi_parse_descriptor(unsigned char *source, const char *descriptor,
43         void *dest, int host_endian)
44 {
45         unsigned char *sp = source, *dp = dest;
46         uint16_t w;
47         const char *cp;
48
49         for (cp = descriptor; *cp; cp++) {
50                 switch (*cp) {
51                         case 'b':       /* 8-bit byte */
52                                 *dp++ = *sp++;
53                                 break;
54                         case 'w':       /* 16-bit word, convert from little endian to CPU */
55                                 dp += ((uintptr_t)dp & 1);      /* Align to word boundary */
56
57                                 if (host_endian) {
58                                         memcpy(dp, sp, 2);
59                                 } else {
60                                         w = (sp[1] << 8) | sp[0];
61                                         *((uint16_t *)dp) = w;
62                                 }
63                                 sp += 2;
64                                 dp += 2;
65                                 break;
66                 }
67         }
68
69         return (int) (sp - source);
70 }
71
72 static void clear_endpoint(struct libusb_endpoint_descriptor *endpoint)
73 {
74         if (endpoint->extra)
75                 free((unsigned char *) endpoint->extra);
76 }
77
78 static int parse_endpoint(struct libusb_context *ctx,
79         struct libusb_endpoint_descriptor *endpoint, unsigned char *buffer,
80         int size, int host_endian)
81 {
82         struct usb_descriptor_header header;
83         unsigned char *extra;
84         unsigned char *begin;
85         int parsed = 0;
86         int len;
87
88         usbi_parse_descriptor(buffer, "bb", &header, 0);
89
90         /* Everything should be fine being passed into here, but we sanity */
91         /*  check JIC */
92         if (header.bLength > size) {
93                 usbi_err(ctx, "ran out of descriptors parsing");
94                 return -1;
95         }
96
97         if (header.bDescriptorType != LIBUSB_DT_ENDPOINT) {
98                 usbi_err(ctx, "unexpected descriptor %x (expected %x)",
99                         header.bDescriptorType, LIBUSB_DT_ENDPOINT);
100                 return parsed;
101         }
102
103         if (header.bLength >= ENDPOINT_AUDIO_DESC_LENGTH)
104                 usbi_parse_descriptor(buffer, "bbbbwbbb", endpoint, host_endian);
105         else if (header.bLength >= ENDPOINT_DESC_LENGTH)
106                 usbi_parse_descriptor(buffer, "bbbbwb", endpoint, host_endian);
107
108         buffer += header.bLength;
109         size -= header.bLength;
110         parsed += header.bLength;
111
112         /* Skip over the rest of the Class Specific or Vendor Specific */
113         /*  descriptors */
114         begin = buffer;
115         while (size >= DESC_HEADER_LENGTH) {
116                 usbi_parse_descriptor(buffer, "bb", &header, 0);
117
118                 if (header.bLength < 2) {
119                         usbi_err(ctx, "invalid descriptor length %d", header.bLength);
120                         return -1;
121                 }
122
123                 /* If we find another "proper" descriptor then we're done  */
124                 if ((header.bDescriptorType == LIBUSB_DT_ENDPOINT) ||
125                                 (header.bDescriptorType == LIBUSB_DT_INTERFACE) ||
126                                 (header.bDescriptorType == LIBUSB_DT_CONFIG) ||
127                                 (header.bDescriptorType == LIBUSB_DT_DEVICE))
128                         break;
129
130                 usbi_dbg("skipping descriptor %x", header.bDescriptorType);
131                 buffer += header.bLength;
132                 size -= header.bLength;
133                 parsed += header.bLength;
134         }
135
136         /* Copy any unknown descriptors into a storage area for drivers */
137         /*  to later parse */
138         len = (int)(buffer - begin);
139         if (!len) {
140                 endpoint->extra = NULL;
141                 endpoint->extra_length = 0;
142                 return parsed;
143         }
144
145         extra = malloc(len);
146         endpoint->extra = extra;
147         if (!extra) {
148                 endpoint->extra_length = 0;
149                 return LIBUSB_ERROR_NO_MEM;
150         }
151
152         memcpy(extra, begin, len);
153         endpoint->extra_length = len;
154
155         return parsed;
156 }
157
158 static void clear_interface(struct libusb_interface *usb_interface)
159 {
160         int i;
161         int j;
162
163         if (usb_interface->altsetting) {
164                 for (i = 0; i < usb_interface->num_altsetting; i++) {
165                         struct libusb_interface_descriptor *ifp =
166                                 (struct libusb_interface_descriptor *)
167                                 usb_interface->altsetting + i;
168                         if (ifp->extra)
169                                 free((void *) ifp->extra);
170                         if (ifp->endpoint) {
171                                 for (j = 0; j < ifp->bNumEndpoints; j++)
172                                         clear_endpoint((struct libusb_endpoint_descriptor *)
173                                                 ifp->endpoint + j);
174                                 free((void *) ifp->endpoint);
175                         }
176                 }
177                 free((void *) usb_interface->altsetting);
178                 usb_interface->altsetting = NULL;
179         }
180
181 }
182
183 static int parse_interface(libusb_context *ctx,
184         struct libusb_interface *usb_interface, unsigned char *buffer, int size,
185         int host_endian)
186 {
187         int i;
188         int len;
189         int r;
190         int parsed = 0;
191         size_t tmp;
192         struct usb_descriptor_header header;
193         struct libusb_interface_descriptor *ifp;
194         unsigned char *begin;
195
196         usb_interface->num_altsetting = 0;
197
198         while (size >= INTERFACE_DESC_LENGTH) {
199                 struct libusb_interface_descriptor *altsetting =
200                         (struct libusb_interface_descriptor *) usb_interface->altsetting;
201                 altsetting = usbi_reallocf(altsetting,
202                         sizeof(struct libusb_interface_descriptor) *
203                         (usb_interface->num_altsetting + 1));
204                 if (!altsetting) {
205                         r = LIBUSB_ERROR_NO_MEM;
206                         goto err;
207                 }
208                 usb_interface->altsetting = altsetting;
209
210                 ifp = altsetting + usb_interface->num_altsetting;
211                 usb_interface->num_altsetting++;
212                 usbi_parse_descriptor(buffer, "bbbbbbbbb", ifp, 0);
213                 ifp->extra = NULL;
214                 ifp->extra_length = 0;
215                 ifp->endpoint = NULL;
216
217                 /* Skip over the interface */
218                 buffer += ifp->bLength;
219                 parsed += ifp->bLength;
220                 size -= ifp->bLength;
221
222                 begin = buffer;
223
224                 /* Skip over any interface, class or vendor descriptors */
225                 while (size >= DESC_HEADER_LENGTH) {
226                         usbi_parse_descriptor(buffer, "bb", &header, 0);
227                         if (header.bLength < 2) {
228                                 usbi_err(ctx, "invalid descriptor of length %d",
229                                         header.bLength);
230                                 r = LIBUSB_ERROR_IO;
231                                 goto err;
232                         } else if (header.bLength > size) {
233                                 usbi_warn(ctx, "invalid descriptor of length %d",
234                                         header.bLength);
235                                 /* The remaining bytes are bogus, but at least
236                                  * one interface is OK, so let's continue. */
237                                 break;
238                         }
239
240                         /* If we find another "proper" descriptor then we're done */
241                         if ((header.bDescriptorType == LIBUSB_DT_INTERFACE) ||
242                                         (header.bDescriptorType == LIBUSB_DT_ENDPOINT) ||
243                                         (header.bDescriptorType == LIBUSB_DT_CONFIG) ||
244                                         (header.bDescriptorType == LIBUSB_DT_DEVICE))
245                                 break;
246
247                         buffer += header.bLength;
248                         parsed += header.bLength;
249                         size -= header.bLength;
250                 }
251
252                 /* Copy any unknown descriptors into a storage area for */
253                 /*  drivers to later parse */
254                 len = (int)(buffer - begin);
255                 if (len) {
256                         ifp->extra = malloc(len);
257                         if (!ifp->extra) {
258                                 r = LIBUSB_ERROR_NO_MEM;
259                                 goto err;
260                         }
261                         memcpy((unsigned char *) ifp->extra, begin, len);
262                         ifp->extra_length = len;
263                 }
264
265                 /* Did we hit an unexpected descriptor? */
266                 if (size >= DESC_HEADER_LENGTH) {
267                         usbi_parse_descriptor(buffer, "bb", &header, 0);
268                         if ((header.bDescriptorType == LIBUSB_DT_CONFIG) ||
269                             (header.bDescriptorType == LIBUSB_DT_DEVICE)) {
270                                 return parsed;
271                         }
272                 }
273
274                 if (ifp->bNumEndpoints > USB_MAXENDPOINTS) {
275                         usbi_err(ctx, "too many endpoints (%d)", ifp->bNumEndpoints);
276                         r = LIBUSB_ERROR_IO;
277                         goto err;
278                 }
279
280                 if (ifp->bNumEndpoints > 0) {
281                         struct libusb_endpoint_descriptor *endpoint;
282                         tmp = ifp->bNumEndpoints * sizeof(struct libusb_endpoint_descriptor);
283                         endpoint = malloc(tmp);
284                         ifp->endpoint = endpoint;
285                         if (!endpoint) {
286                                 r = LIBUSB_ERROR_NO_MEM;
287                                 goto err;
288                         }
289
290                         memset(endpoint, 0, tmp);
291                         for (i = 0; i < ifp->bNumEndpoints; i++) {
292                                 usbi_parse_descriptor(buffer, "bb", &header, 0);
293
294                                 if (header.bLength > size) {
295                                         usbi_err(ctx, "ran out of descriptors parsing");
296                                         r = LIBUSB_ERROR_IO;
297                                         goto err;
298                                 }
299
300                                 r = parse_endpoint(ctx, endpoint + i, buffer, size,
301                                         host_endian);
302                                 if (r < 0)
303                                         goto err;
304
305                                 buffer += r;
306                                 parsed += r;
307                                 size -= r;
308                         }
309                 }
310
311                 /* We check to see if it's an alternate to this one */
312                 ifp = (struct libusb_interface_descriptor *) buffer;
313                 if (size < LIBUSB_DT_INTERFACE_SIZE ||
314                                 ifp->bDescriptorType != LIBUSB_DT_INTERFACE ||
315                                 !ifp->bAlternateSetting)
316                         return parsed;
317         }
318
319         return parsed;
320 err:
321         clear_interface(usb_interface);
322         return r;
323 }
324
325 static void clear_configuration(struct libusb_config_descriptor *config)
326 {
327         if (config->interface) {
328                 int i;
329                 for (i = 0; i < config->bNumInterfaces; i++)
330                         clear_interface((struct libusb_interface *)
331                                 config->interface + i);
332                 free((void *) config->interface);
333         }
334         if (config->extra)
335                 free((void *) config->extra);
336 }
337
338 static int parse_configuration(struct libusb_context *ctx,
339         struct libusb_config_descriptor *config, unsigned char *buffer,
340         int host_endian)
341 {
342         int i;
343         int r;
344         int size;
345         size_t tmp;
346         struct usb_descriptor_header header;
347         struct libusb_interface *usb_interface;
348
349         usbi_parse_descriptor(buffer, "bbwbbbbb", config, host_endian);
350         size = config->wTotalLength;
351
352         if (config->bNumInterfaces > USB_MAXINTERFACES) {
353                 usbi_err(ctx, "too many interfaces (%d)", config->bNumInterfaces);
354                 return LIBUSB_ERROR_IO;
355         }
356
357         tmp = config->bNumInterfaces * sizeof(struct libusb_interface);
358         usb_interface = malloc(tmp);
359         config->interface = usb_interface;
360         if (!config->interface)
361                 return LIBUSB_ERROR_NO_MEM;
362
363         memset(usb_interface, 0, tmp);
364         buffer += config->bLength;
365         size -= config->bLength;
366
367         config->extra = NULL;
368         config->extra_length = 0;
369
370         for (i = 0; i < config->bNumInterfaces; i++) {
371                 int len;
372                 unsigned char *begin;
373
374                 /* Skip over the rest of the Class Specific or Vendor */
375                 /*  Specific descriptors */
376                 begin = buffer;
377                 while (size >= DESC_HEADER_LENGTH) {
378                         usbi_parse_descriptor(buffer, "bb", &header, 0);
379
380                         /* If we've parsed at least one config descriptor then
381                          * let's return that. */
382                         if (header.bLength > size && i) {
383                                 usbi_warn(ctx, "invalid descriptor length of %d",
384                                         header.bLength);
385                                 return size;
386                         }
387
388                         if ((header.bLength > size) ||
389                                         (header.bLength < DESC_HEADER_LENGTH)) {
390                                 usbi_err(ctx, "invalid descriptor length of %d",
391                                         header.bLength);
392                                 r = LIBUSB_ERROR_IO;
393                                 goto err;
394                         }
395
396                         /* If we find another "proper" descriptor then we're done */
397                         if ((header.bDescriptorType == LIBUSB_DT_ENDPOINT) ||
398                                         (header.bDescriptorType == LIBUSB_DT_INTERFACE) ||
399                                         (header.bDescriptorType == LIBUSB_DT_CONFIG) ||
400                                         (header.bDescriptorType == LIBUSB_DT_DEVICE))
401                                 break;
402
403                         usbi_dbg("skipping descriptor 0x%x\n", header.bDescriptorType);
404                         buffer += header.bLength;
405                         size -= header.bLength;
406                 }
407
408                 /* Copy any unknown descriptors into a storage area for */
409                 /*  drivers to later parse */
410                 len = (int)(buffer - begin);
411                 if (len) {
412                         /* FIXME: We should realloc and append here */
413                         if (!config->extra_length) {
414                                 config->extra = malloc(len);
415                                 if (!config->extra) {
416                                         r = LIBUSB_ERROR_NO_MEM;
417                                         goto err;
418                                 }
419
420                                 memcpy((unsigned char *) config->extra, begin, len);
421                                 config->extra_length = len;
422                         }
423                 }
424
425                 r = parse_interface(ctx, usb_interface + i, buffer, size, host_endian);
426                 if (r < 0)
427                         goto err;
428
429                 buffer += r;
430                 size -= r;
431         }
432
433         return size;
434
435 err:
436         clear_configuration(config);
437         return r;
438 }
439
440 /** \ingroup desc
441  * Get the USB device descriptor for a given device.
442  *
443  * This is a non-blocking function; the device descriptor is cached in memory.
444  *
445  * \param dev the device
446  * \param desc output location for the descriptor data
447  * \returns 0 on success or a LIBUSB_ERROR code on failure
448  */
449 int API_EXPORTED libusb_get_device_descriptor(libusb_device *dev,
450         struct libusb_device_descriptor *desc)
451 {
452         unsigned char raw_desc[DEVICE_DESC_LENGTH];
453         int host_endian = 0;
454         int r;
455
456         usbi_dbg("");
457         r = usbi_backend->get_device_descriptor(dev, raw_desc, &host_endian);
458         if (r < 0)
459                 return r;
460
461         memcpy((unsigned char *) desc, raw_desc, sizeof(raw_desc));
462         if (!host_endian) {
463                 desc->bcdUSB = libusb_le16_to_cpu(desc->bcdUSB);
464                 desc->idVendor = libusb_le16_to_cpu(desc->idVendor);
465                 desc->idProduct = libusb_le16_to_cpu(desc->idProduct);
466                 desc->bcdDevice = libusb_le16_to_cpu(desc->bcdDevice);
467         }
468         return 0;
469 }
470
471 /** \ingroup desc
472  * Get the USB configuration descriptor for the currently active configuration.
473  * This is a non-blocking function which does not involve any requests being
474  * sent to the device.
475  *
476  * \param dev a device
477  * \param config output location for the USB configuration descriptor. Only
478  * valid if 0 was returned. Must be freed with libusb_free_config_descriptor()
479  * after use.
480  * \returns 0 on success
481  * \returns LIBUSB_ERROR_NOT_FOUND if the device is in unconfigured state
482  * \returns another LIBUSB_ERROR code on error
483  * \see libusb_get_config_descriptor
484  */
485 int API_EXPORTED libusb_get_active_config_descriptor(libusb_device *dev,
486         struct libusb_config_descriptor **config)
487 {
488         struct libusb_config_descriptor *_config = malloc(sizeof(*_config));
489         unsigned char tmp[8];
490         unsigned char *buf = NULL;
491         int host_endian = 0;
492         int r;
493
494         usbi_dbg("");
495         if (!_config)
496                 return LIBUSB_ERROR_NO_MEM;
497
498         r = usbi_backend->get_active_config_descriptor(dev, tmp, sizeof(tmp),
499                 &host_endian);
500         if (r < 0)
501                 goto err;
502
503         _config->wTotalLength = 0;
504         usbi_parse_descriptor(tmp, "bbw", _config, host_endian);
505         if (_config->wTotalLength != 0)
506                 buf = malloc(_config->wTotalLength);
507         if (!buf) {
508                 r = LIBUSB_ERROR_NO_MEM;
509                 goto err;
510         }
511
512         r = usbi_backend->get_active_config_descriptor(dev, buf,
513                 _config->wTotalLength, &host_endian);
514         if (r < 0)
515                 goto err;
516
517         r = parse_configuration(dev->ctx, _config, buf, host_endian);
518         if (r < 0) {
519                 usbi_err(dev->ctx, "parse_configuration failed with error %d", r);
520                 goto err;
521         } else if (r > 0) {
522                 usbi_warn(dev->ctx, "descriptor data still left");
523         }
524
525         free(buf);
526         *config = _config;
527         return 0;
528
529 err:
530         free(_config);
531         if (buf)
532                 free(buf);
533         return r;
534 }
535
536 /** \ingroup desc
537  * Get a USB configuration descriptor based on its index.
538  * This is a non-blocking function which does not involve any requests being
539  * sent to the device.
540  *
541  * \param dev a device
542  * \param config_index the index of the configuration you wish to retrieve
543  * \param config output location for the USB configuration descriptor. Only
544  * valid if 0 was returned. Must be freed with libusb_free_config_descriptor()
545  * after use.
546  * \returns 0 on success
547  * \returns LIBUSB_ERROR_NOT_FOUND if the configuration does not exist
548  * \returns another LIBUSB_ERROR code on error
549  * \see libusb_get_active_config_descriptor()
550  * \see libusb_get_config_descriptor_by_value()
551  */
552 int API_EXPORTED libusb_get_config_descriptor(libusb_device *dev,
553         uint8_t config_index, struct libusb_config_descriptor **config)
554 {
555         struct libusb_config_descriptor *_config;
556         unsigned char tmp[8];
557         unsigned char *buf = NULL;
558         int host_endian = 0;
559         int r;
560
561         usbi_dbg("index %d", config_index);
562         if (config_index >= dev->num_configurations)
563                 return LIBUSB_ERROR_NOT_FOUND;
564
565         _config = malloc(sizeof(*_config));
566         if (!_config)
567                 return LIBUSB_ERROR_NO_MEM;
568
569         r = usbi_backend->get_config_descriptor(dev, config_index, tmp,
570                 sizeof(tmp), &host_endian);
571         if (r < 0)
572                 goto err;
573
574         usbi_parse_descriptor(tmp, "bbw", _config, host_endian);
575         buf = malloc(_config->wTotalLength);
576         if (!buf) {
577                 r = LIBUSB_ERROR_NO_MEM;
578                 goto err;
579         }
580
581         host_endian = 0;
582         r = usbi_backend->get_config_descriptor(dev, config_index, buf,
583                 _config->wTotalLength, &host_endian);
584         if (r < 0)
585                 goto err;
586
587         r = parse_configuration(dev->ctx, _config, buf, host_endian);
588         if (r < 0) {
589                 usbi_err(dev->ctx, "parse_configuration failed with error %d", r);
590                 goto err;
591         } else if (r > 0) {
592                 usbi_warn(dev->ctx, "descriptor data still left");
593         }
594
595         free(buf);
596         *config = _config;
597         return 0;
598
599 err:
600         free(_config);
601         if (buf)
602                 free(buf);
603         return r;
604 }
605
606 /* iterate through all configurations, returning the index of the configuration
607  * matching a specific bConfigurationValue in the idx output parameter, or -1
608  * if the config was not found.
609  * returns 0 or a LIBUSB_ERROR code
610  */
611 int usbi_get_config_index_by_value(struct libusb_device *dev,
612         uint8_t bConfigurationValue, int *idx)
613 {
614         uint8_t i;
615
616         usbi_dbg("value %d", bConfigurationValue);
617         for (i = 0; i < dev->num_configurations; i++) {
618                 unsigned char tmp[6];
619                 int host_endian;
620                 int r = usbi_backend->get_config_descriptor(dev, i, tmp, sizeof(tmp),
621                         &host_endian);
622                 if (r < 0)
623                         return r;
624                 if (tmp[5] == bConfigurationValue) {
625                         *idx = i;
626                         return 0;
627                 }
628         }
629
630         *idx = -1;
631         return 0;
632 }
633
634 /** \ingroup desc
635  * Get a USB configuration descriptor with a specific bConfigurationValue.
636  * This is a non-blocking function which does not involve any requests being
637  * sent to the device.
638  *
639  * \param dev a device
640  * \param bConfigurationValue the bConfigurationValue of the configuration you
641  * wish to retrieve
642  * \param config output location for the USB configuration descriptor. Only
643  * valid if 0 was returned. Must be freed with libusb_free_config_descriptor()
644  * after use.
645  * \returns 0 on success
646  * \returns LIBUSB_ERROR_NOT_FOUND if the configuration does not exist
647  * \returns another LIBUSB_ERROR code on error
648  * \see libusb_get_active_config_descriptor()
649  * \see libusb_get_config_descriptor()
650  */
651 int API_EXPORTED libusb_get_config_descriptor_by_value(libusb_device *dev,
652         uint8_t bConfigurationValue, struct libusb_config_descriptor **config)
653 {
654         int idx;
655         int r = usbi_get_config_index_by_value(dev, bConfigurationValue, &idx);
656         if (r < 0)
657                 return r;
658         else if (idx == -1)
659                 return LIBUSB_ERROR_NOT_FOUND;
660         else
661                 return libusb_get_config_descriptor(dev, (uint8_t) idx, config);
662 }
663
664 /** \ingroup desc
665  * Free a configuration descriptor obtained from
666  * libusb_get_active_config_descriptor() or libusb_get_config_descriptor().
667  * It is safe to call this function with a NULL config parameter, in which
668  * case the function simply returns.
669  *
670  * \param config the configuration descriptor to free
671  */
672 void API_EXPORTED libusb_free_config_descriptor(
673         struct libusb_config_descriptor *config)
674 {
675         if (!config)
676                 return;
677
678         clear_configuration(config);
679         free(config);
680 }
681
682 /** \ingroup desc
683  * Retrieve a string descriptor in C style ASCII.
684  *
685  * Wrapper around libusb_get_string_descriptor(). Uses the first language
686  * supported by the device.
687  *
688  * \param dev a device handle
689  * \param desc_index the index of the descriptor to retrieve
690  * \param data output buffer for ASCII string descriptor
691  * \param length size of data buffer
692  * \returns number of bytes returned in data, or LIBUSB_ERROR code on failure
693  */
694 int API_EXPORTED libusb_get_string_descriptor_ascii(libusb_device_handle *dev,
695         uint8_t desc_index, unsigned char *data, int length)
696 {
697         unsigned char tbuf[255]; /* Some devices choke on size > 255 */
698         int r, si, di;
699         uint16_t langid;
700
701         /* Asking for the zero'th index is special - it returns a string
702          * descriptor that contains all the language IDs supported by the
703          * device. Typically there aren't many - often only one. Language
704          * IDs are 16 bit numbers, and they start at the third byte in the
705          * descriptor. There's also no point in trying to read descriptor 0
706          * with this function. See USB 2.0 specification section 9.6.7 for
707          * more information.
708          */
709
710         if (desc_index == 0)
711                 return LIBUSB_ERROR_INVALID_PARAM;
712
713         r = libusb_get_string_descriptor(dev, 0, 0, tbuf, sizeof(tbuf));
714         if (r < 0)
715                 return r;
716
717         if (r < 4)
718                 return LIBUSB_ERROR_IO;
719
720         langid = tbuf[2] | (tbuf[3] << 8);
721
722         r = libusb_get_string_descriptor(dev, desc_index, langid, tbuf,
723                 sizeof(tbuf));
724         if (r < 0)
725                 return r;
726
727         if (tbuf[1] != LIBUSB_DT_STRING)
728                 return LIBUSB_ERROR_IO;
729
730         if (tbuf[0] > r)
731                 return LIBUSB_ERROR_IO;
732
733         for (di = 0, si = 2; si < tbuf[0]; si += 2) {
734                 if (di >= (length - 1))
735                         break;
736
737                 if ((tbuf[si] & 0x80) || (tbuf[si + 1])) /* non-ASCII */
738                         data[di++] = '?';
739                 else
740                         data[di++] = tbuf[si];
741         }
742
743         data[di] = 0;
744         return di;
745 }