1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29#include <common.h>
30#include <command.h>
31#include <dm.h>
32#include <memalign.h>
33#include <asm/processor.h>
34#include <linux/compiler.h>
35#include <linux/ctype.h>
36#include <asm/byteorder.h>
37#include <asm/unaligned.h>
38#include <errno.h>
39#include <usb.h>
40#ifdef CONFIG_4xx
41#include <asm/4xx_pci.h>
42#endif
43
44#define USB_BUFSIZ 512
45
46static int asynch_allowed;
47char usb_started;
48
49#ifndef CONFIG_DM_USB
50static struct usb_device usb_dev[USB_MAX_DEVICE];
51static int dev_index;
52
53#ifndef CONFIG_USB_MAX_CONTROLLER_COUNT
54#define CONFIG_USB_MAX_CONTROLLER_COUNT 1
55#endif
56
57
58
59
60int usb_init(void)
61{
62 void *ctrl;
63 struct usb_device *dev;
64 int i, start_index = 0;
65 int controllers_initialized = 0;
66 int ret;
67
68 dev_index = 0;
69 asynch_allowed = 1;
70 usb_hub_reset();
71
72
73 for (i = 0; i < USB_MAX_DEVICE; i++) {
74 memset(&usb_dev[i], 0, sizeof(struct usb_device));
75 usb_dev[i].devnum = -1;
76 }
77
78
79 for (i = 0; i < CONFIG_USB_MAX_CONTROLLER_COUNT; i++) {
80
81 printf("USB%d: ", i);
82 ret = usb_lowlevel_init(i, USB_INIT_HOST, &ctrl);
83 if (ret == -ENODEV) {
84 puts("Port not available.\n");
85 controllers_initialized++;
86 continue;
87 }
88
89 if (ret) {
90 puts("lowlevel init failed\n");
91 continue;
92 }
93
94
95
96
97 controllers_initialized++;
98 start_index = dev_index;
99 printf("scanning bus %d for devices... ", i);
100 ret = usb_alloc_new_device(ctrl, &dev);
101 if (ret)
102 break;
103
104
105
106
107
108 ret = usb_new_device(dev);
109 if (ret)
110 usb_free_device(dev->controller);
111
112 if (start_index == dev_index) {
113 puts("No USB Device found\n");
114 continue;
115 } else {
116 printf("%d USB Device(s) found\n",
117 dev_index - start_index);
118 }
119
120 usb_started = 1;
121 }
122
123 debug("scan end\n");
124
125 if (controllers_initialized == 0)
126 puts("USB error: all controllers failed lowlevel init\n");
127
128 return usb_started ? 0 : -ENODEV;
129}
130
131
132
133
134int usb_stop(void)
135{
136 int i;
137
138 if (usb_started) {
139 asynch_allowed = 1;
140 usb_started = 0;
141 usb_hub_reset();
142
143 for (i = 0; i < CONFIG_USB_MAX_CONTROLLER_COUNT; i++) {
144 if (usb_lowlevel_stop(i))
145 printf("failed to stop USB controller %d\n", i);
146 }
147 }
148
149 return 0;
150}
151
152
153
154
155int usb_detect_change(void)
156{
157 int i, j;
158 int change = 0;
159
160 for (j = 0; j < USB_MAX_DEVICE; j++) {
161 for (i = 0; i < usb_dev[j].maxchild; i++) {
162 struct usb_port_status status;
163
164 if (usb_get_port_status(&usb_dev[j], i + 1,
165 &status) < 0)
166
167 continue;
168
169 if (le16_to_cpu(status.wPortChange) &
170 USB_PORT_STAT_C_CONNECTION)
171 change++;
172 }
173 }
174
175 return change;
176}
177
178
179
180
181
182
183int usb_disable_asynch(int disable)
184{
185 int old_value = asynch_allowed;
186
187 asynch_allowed = !disable;
188 return old_value;
189}
190#endif
191
192
193
194
195
196
197
198
199
200
201int usb_submit_int_msg(struct usb_device *dev, unsigned long pipe,
202 void *buffer, int transfer_len, int interval)
203{
204 return submit_int_msg(dev, pipe, buffer, transfer_len, interval);
205}
206
207
208
209
210
211
212
213
214
215
216int usb_control_msg(struct usb_device *dev, unsigned int pipe,
217 unsigned char request, unsigned char requesttype,
218 unsigned short value, unsigned short index,
219 void *data, unsigned short size, int timeout)
220{
221 ALLOC_CACHE_ALIGN_BUFFER(struct devrequest, setup_packet, 1);
222 int err;
223
224 if ((timeout == 0) && (!asynch_allowed)) {
225
226 return -EINVAL;
227 }
228
229
230 setup_packet->requesttype = requesttype;
231 setup_packet->request = request;
232 setup_packet->value = cpu_to_le16(value);
233 setup_packet->index = cpu_to_le16(index);
234 setup_packet->length = cpu_to_le16(size);
235 debug("usb_control_msg: request: 0x%X, requesttype: 0x%X, " \
236 "value 0x%X index 0x%X length 0x%X\n",
237 request, requesttype, value, index, size);
238 dev->status = USB_ST_NOT_PROC;
239
240 err = submit_control_msg(dev, pipe, data, size, setup_packet);
241 if (err < 0)
242 return err;
243 if (timeout == 0)
244 return (int)size;
245
246
247
248
249
250
251 while (timeout--) {
252 if (!((volatile unsigned long)dev->status & USB_ST_NOT_PROC))
253 break;
254 mdelay(1);
255 }
256 if (dev->status)
257 return -1;
258
259 return dev->act_len;
260
261}
262
263
264
265
266
267
268int usb_bulk_msg(struct usb_device *dev, unsigned int pipe,
269 void *data, int len, int *actual_length, int timeout)
270{
271 if (len < 0)
272 return -EINVAL;
273 dev->status = USB_ST_NOT_PROC;
274 if (submit_bulk_msg(dev, pipe, data, len) < 0)
275 return -EIO;
276 while (timeout--) {
277 if (!((volatile unsigned long)dev->status & USB_ST_NOT_PROC))
278 break;
279 mdelay(1);
280 }
281 *actual_length = dev->act_len;
282 if (dev->status == 0)
283 return 0;
284 else
285 return -EIO;
286}
287
288
289
290
291
292
293
294
295
296
297int usb_maxpacket(struct usb_device *dev, unsigned long pipe)
298{
299
300 if ((pipe & USB_DIR_IN) == 0)
301 return dev->epmaxpacketout[((pipe>>15) & 0xf)];
302 else
303 return dev->epmaxpacketin[((pipe>>15) & 0xf)];
304}
305
306
307
308
309
310
311
312
313
314
315
316
317static void noinline
318usb_set_maxpacket_ep(struct usb_device *dev, int if_idx, int ep_idx)
319{
320 int b;
321 struct usb_endpoint_descriptor *ep;
322 u16 ep_wMaxPacketSize;
323
324 ep = &dev->config.if_desc[if_idx].ep_desc[ep_idx];
325
326 b = ep->bEndpointAddress & USB_ENDPOINT_NUMBER_MASK;
327 ep_wMaxPacketSize = get_unaligned(&ep->wMaxPacketSize);
328
329 if ((ep->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) ==
330 USB_ENDPOINT_XFER_CONTROL) {
331
332 dev->epmaxpacketout[b] = ep_wMaxPacketSize;
333 dev->epmaxpacketin[b] = ep_wMaxPacketSize;
334 debug("##Control EP epmaxpacketout/in[%d] = %d\n",
335 b, dev->epmaxpacketin[b]);
336 } else {
337 if ((ep->bEndpointAddress & 0x80) == 0) {
338
339 if (ep_wMaxPacketSize > dev->epmaxpacketout[b]) {
340 dev->epmaxpacketout[b] = ep_wMaxPacketSize;
341 debug("##EP epmaxpacketout[%d] = %d\n",
342 b, dev->epmaxpacketout[b]);
343 }
344 } else {
345
346 if (ep_wMaxPacketSize > dev->epmaxpacketin[b]) {
347 dev->epmaxpacketin[b] = ep_wMaxPacketSize;
348 debug("##EP epmaxpacketin[%d] = %d\n",
349 b, dev->epmaxpacketin[b]);
350 }
351 }
352 }
353}
354
355
356
357
358static int usb_set_maxpacket(struct usb_device *dev)
359{
360 int i, ii;
361
362 for (i = 0; i < dev->config.desc.bNumInterfaces; i++)
363 for (ii = 0; ii < dev->config.if_desc[i].desc.bNumEndpoints; ii++)
364 usb_set_maxpacket_ep(dev, i, ii);
365
366 return 0;
367}
368
369
370
371
372
373
374static int usb_parse_config(struct usb_device *dev,
375 unsigned char *buffer, int cfgno)
376{
377 struct usb_descriptor_header *head;
378 int index, ifno, epno, curr_if_num;
379 u16 ep_wMaxPacketSize;
380 struct usb_interface *if_desc = NULL;
381
382 ifno = -1;
383 epno = -1;
384 curr_if_num = -1;
385
386 dev->configno = cfgno;
387 head = (struct usb_descriptor_header *) &buffer[0];
388 if (head->bDescriptorType != USB_DT_CONFIG) {
389 printf(" ERROR: NOT USB_CONFIG_DESC %x\n",
390 head->bDescriptorType);
391 return -EINVAL;
392 }
393 if (head->bLength != USB_DT_CONFIG_SIZE) {
394 printf("ERROR: Invalid USB CFG length (%d)\n", head->bLength);
395 return -EINVAL;
396 }
397 memcpy(&dev->config, head, USB_DT_CONFIG_SIZE);
398 dev->config.no_of_if = 0;
399
400 index = dev->config.desc.bLength;
401
402
403 head = (struct usb_descriptor_header *) &buffer[index];
404 while (index + 1 < dev->config.desc.wTotalLength && head->bLength) {
405 switch (head->bDescriptorType) {
406 case USB_DT_INTERFACE:
407 if (head->bLength != USB_DT_INTERFACE_SIZE) {
408 printf("ERROR: Invalid USB IF length (%d)\n",
409 head->bLength);
410 break;
411 }
412 if (index + USB_DT_INTERFACE_SIZE >
413 dev->config.desc.wTotalLength) {
414 puts("USB IF descriptor overflowed buffer!\n");
415 break;
416 }
417 if (((struct usb_interface_descriptor *) \
418 head)->bInterfaceNumber != curr_if_num) {
419
420 ifno = dev->config.no_of_if;
421 if (ifno >= USB_MAXINTERFACES) {
422 puts("Too many USB interfaces!\n");
423
424 return -EINVAL;
425 }
426 if_desc = &dev->config.if_desc[ifno];
427 dev->config.no_of_if++;
428 memcpy(if_desc, head,
429 USB_DT_INTERFACE_SIZE);
430 if_desc->no_of_ep = 0;
431 if_desc->num_altsetting = 1;
432 curr_if_num =
433 if_desc->desc.bInterfaceNumber;
434 } else {
435
436 if (ifno >= 0) {
437 if_desc = &dev->config.if_desc[ifno];
438 if_desc->num_altsetting++;
439 }
440 }
441 break;
442 case USB_DT_ENDPOINT:
443 if (head->bLength != USB_DT_ENDPOINT_SIZE) {
444 printf("ERROR: Invalid USB EP length (%d)\n",
445 head->bLength);
446 break;
447 }
448 if (index + USB_DT_ENDPOINT_SIZE >
449 dev->config.desc.wTotalLength) {
450 puts("USB EP descriptor overflowed buffer!\n");
451 break;
452 }
453 if (ifno < 0) {
454 puts("Endpoint descriptor out of order!\n");
455 break;
456 }
457 epno = dev->config.if_desc[ifno].no_of_ep;
458 if_desc = &dev->config.if_desc[ifno];
459 if (epno >= USB_MAXENDPOINTS) {
460 printf("Interface %d has too many endpoints!\n",
461 if_desc->desc.bInterfaceNumber);
462 return -EINVAL;
463 }
464
465 if_desc->no_of_ep++;
466 memcpy(&if_desc->ep_desc[epno], head,
467 USB_DT_ENDPOINT_SIZE);
468 ep_wMaxPacketSize = get_unaligned(&dev->config.\
469 if_desc[ifno].\
470 ep_desc[epno].\
471 wMaxPacketSize);
472 put_unaligned(le16_to_cpu(ep_wMaxPacketSize),
473 &dev->config.\
474 if_desc[ifno].\
475 ep_desc[epno].\
476 wMaxPacketSize);
477 debug("if %d, ep %d\n", ifno, epno);
478 break;
479 case USB_DT_SS_ENDPOINT_COMP:
480 if (head->bLength != USB_DT_SS_EP_COMP_SIZE) {
481 printf("ERROR: Invalid USB EPC length (%d)\n",
482 head->bLength);
483 break;
484 }
485 if (index + USB_DT_SS_EP_COMP_SIZE >
486 dev->config.desc.wTotalLength) {
487 puts("USB EPC descriptor overflowed buffer!\n");
488 break;
489 }
490 if (ifno < 0 || epno < 0) {
491 puts("EPC descriptor out of order!\n");
492 break;
493 }
494 if_desc = &dev->config.if_desc[ifno];
495 memcpy(&if_desc->ss_ep_comp_desc[epno], head,
496 USB_DT_SS_EP_COMP_SIZE);
497 break;
498 default:
499 if (head->bLength == 0)
500 return -EINVAL;
501
502 debug("unknown Description Type : %x\n",
503 head->bDescriptorType);
504
505#ifdef DEBUG
506 {
507 unsigned char *ch = (unsigned char *)head;
508 int i;
509
510 for (i = 0; i < head->bLength; i++)
511 debug("%02X ", *ch++);
512 debug("\n\n\n");
513 }
514#endif
515 break;
516 }
517 index += head->bLength;
518 head = (struct usb_descriptor_header *)&buffer[index];
519 }
520 return 0;
521}
522
523
524
525
526
527
528int usb_clear_halt(struct usb_device *dev, int pipe)
529{
530 int result;
531 int endp = usb_pipeendpoint(pipe)|(usb_pipein(pipe)<<7);
532
533 result = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
534 USB_REQ_CLEAR_FEATURE, USB_RECIP_ENDPOINT, 0,
535 endp, NULL, 0, USB_CNTL_TIMEOUT * 3);
536
537
538 if (result < 0)
539 return result;
540
541
542
543
544
545
546 usb_endpoint_running(dev, usb_pipeendpoint(pipe), usb_pipeout(pipe));
547
548
549 usb_settoggle(dev, usb_pipeendpoint(pipe), usb_pipeout(pipe), 0);
550 return 0;
551}
552
553
554
555
556
557static int usb_get_descriptor(struct usb_device *dev, unsigned char type,
558 unsigned char index, void *buf, int size)
559{
560 int res;
561 res = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
562 USB_REQ_GET_DESCRIPTOR, USB_DIR_IN,
563 (type << 8) + index, 0,
564 buf, size, USB_CNTL_TIMEOUT);
565 return res;
566}
567
568
569
570
571int usb_get_configuration_len(struct usb_device *dev, int cfgno)
572{
573 int result;
574 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, buffer, 9);
575 struct usb_config_descriptor *config;
576
577 config = (struct usb_config_descriptor *)&buffer[0];
578 result = usb_get_descriptor(dev, USB_DT_CONFIG, cfgno, buffer, 9);
579 if (result < 9) {
580 if (result < 0)
581 printf("unable to get descriptor, error %lX\n",
582 dev->status);
583 else
584 printf("config descriptor too short " \
585 "(expected %i, got %i)\n", 9, result);
586 return -EIO;
587 }
588 return le16_to_cpu(config->wTotalLength);
589}
590
591
592
593
594int usb_get_configuration_no(struct usb_device *dev, int cfgno,
595 unsigned char *buffer, int length)
596{
597 int result;
598 struct usb_config_descriptor *config;
599
600 config = (struct usb_config_descriptor *)&buffer[0];
601 result = usb_get_descriptor(dev, USB_DT_CONFIG, cfgno, buffer, length);
602 debug("get_conf_no %d Result %d, wLength %d\n", cfgno, result,
603 le16_to_cpu(config->wTotalLength));
604 config->wTotalLength = result;
605
606 return result;
607}
608
609
610
611
612
613static int usb_set_address(struct usb_device *dev)
614{
615 int res;
616
617 debug("set address %d\n", dev->devnum);
618 res = usb_control_msg(dev, usb_snddefctrl(dev),
619 USB_REQ_SET_ADDRESS, 0,
620 (dev->devnum), 0,
621 NULL, 0, USB_CNTL_TIMEOUT);
622 return res;
623}
624
625
626
627
628int usb_set_interface(struct usb_device *dev, int interface, int alternate)
629{
630 struct usb_interface *if_face = NULL;
631 int ret, i;
632
633 for (i = 0; i < dev->config.desc.bNumInterfaces; i++) {
634 if (dev->config.if_desc[i].desc.bInterfaceNumber == interface) {
635 if_face = &dev->config.if_desc[i];
636 break;
637 }
638 }
639 if (!if_face) {
640 printf("selecting invalid interface %d", interface);
641 return -EINVAL;
642 }
643
644
645
646
647
648
649
650 if (if_face->num_altsetting == 1)
651 return 0;
652
653 ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
654 USB_REQ_SET_INTERFACE, USB_RECIP_INTERFACE,
655 alternate, interface, NULL, 0,
656 USB_CNTL_TIMEOUT * 5);
657 if (ret < 0)
658 return ret;
659
660 return 0;
661}
662
663
664
665
666static int usb_set_configuration(struct usb_device *dev, int configuration)
667{
668 int res;
669 debug("set configuration %d\n", configuration);
670
671 res = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
672 USB_REQ_SET_CONFIGURATION, 0,
673 configuration, 0,
674 NULL, 0, USB_CNTL_TIMEOUT);
675 if (res == 0) {
676 dev->toggle[0] = 0;
677 dev->toggle[1] = 0;
678 return 0;
679 } else
680 return -EIO;
681}
682
683
684
685
686int usb_set_protocol(struct usb_device *dev, int ifnum, int protocol)
687{
688 return usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
689 USB_REQ_SET_PROTOCOL, USB_TYPE_CLASS | USB_RECIP_INTERFACE,
690 protocol, ifnum, NULL, 0, USB_CNTL_TIMEOUT);
691}
692
693
694
695
696int usb_set_idle(struct usb_device *dev, int ifnum, int duration, int report_id)
697{
698 return usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
699 USB_REQ_SET_IDLE, USB_TYPE_CLASS | USB_RECIP_INTERFACE,
700 (duration << 8) | report_id, ifnum, NULL, 0, USB_CNTL_TIMEOUT);
701}
702
703
704
705
706int usb_get_report(struct usb_device *dev, int ifnum, unsigned char type,
707 unsigned char id, void *buf, int size)
708{
709 return usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
710 USB_REQ_GET_REPORT,
711 USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
712 (type << 8) + id, ifnum, buf, size, USB_CNTL_TIMEOUT);
713}
714
715
716
717
718int usb_get_class_descriptor(struct usb_device *dev, int ifnum,
719 unsigned char type, unsigned char id, void *buf, int size)
720{
721 return usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
722 USB_REQ_GET_DESCRIPTOR, USB_RECIP_INTERFACE | USB_DIR_IN,
723 (type << 8) + id, ifnum, buf, size, USB_CNTL_TIMEOUT);
724}
725
726
727
728
729static int usb_get_string(struct usb_device *dev, unsigned short langid,
730 unsigned char index, void *buf, int size)
731{
732 int i;
733 int result;
734
735 for (i = 0; i < 3; ++i) {
736
737 result = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
738 USB_REQ_GET_DESCRIPTOR, USB_DIR_IN,
739 (USB_DT_STRING << 8) + index, langid, buf, size,
740 USB_CNTL_TIMEOUT);
741
742 if (result > 0)
743 break;
744 }
745
746 return result;
747}
748
749
750static void usb_try_string_workarounds(unsigned char *buf, int *length)
751{
752 int newlength, oldlength = *length;
753
754 for (newlength = 2; newlength + 1 < oldlength; newlength += 2)
755 if (!isprint(buf[newlength]) || buf[newlength + 1])
756 break;
757
758 if (newlength > 2) {
759 buf[0] = newlength;
760 *length = newlength;
761 }
762}
763
764
765static int usb_string_sub(struct usb_device *dev, unsigned int langid,
766 unsigned int index, unsigned char *buf)
767{
768 int rc;
769
770
771
772 rc = usb_get_string(dev, langid, index, buf, 255);
773
774
775
776 if (rc < 2) {
777 rc = usb_get_string(dev, langid, index, buf, 2);
778 if (rc == 2)
779 rc = usb_get_string(dev, langid, index, buf, buf[0]);
780 }
781
782 if (rc >= 2) {
783 if (!buf[0] && !buf[1])
784 usb_try_string_workarounds(buf, &rc);
785
786
787 if (buf[0] < rc)
788 rc = buf[0];
789
790 rc = rc - (rc & 1);
791 }
792
793 if (rc < 2)
794 rc = -EINVAL;
795
796 return rc;
797}
798
799
800
801
802
803
804
805int usb_string(struct usb_device *dev, int index, char *buf, size_t size)
806{
807 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, mybuf, USB_BUFSIZ);
808 unsigned char *tbuf;
809 int err;
810 unsigned int u, idx;
811
812 if (size <= 0 || !buf || !index)
813 return -EINVAL;
814 buf[0] = 0;
815 tbuf = &mybuf[0];
816
817
818 if (!dev->have_langid) {
819 err = usb_string_sub(dev, 0, 0, tbuf);
820 if (err < 0) {
821 debug("error getting string descriptor 0 " \
822 "(error=%lx)\n", dev->status);
823 return -EIO;
824 } else if (tbuf[0] < 4) {
825 debug("string descriptor 0 too short\n");
826 return -EIO;
827 } else {
828 dev->have_langid = -1;
829 dev->string_langid = tbuf[2] | (tbuf[3] << 8);
830
831 debug("USB device number %d default " \
832 "language ID 0x%x\n",
833 dev->devnum, dev->string_langid);
834 }
835 }
836
837 err = usb_string_sub(dev, dev->string_langid, index, tbuf);
838 if (err < 0)
839 return err;
840
841 size--;
842 for (idx = 0, u = 2; u < err; u += 2) {
843 if (idx >= size)
844 break;
845 if (tbuf[u+1])
846 buf[idx++] = '?';
847 else
848 buf[idx++] = tbuf[u];
849 }
850 buf[idx] = 0;
851 err = idx;
852 return err;
853}
854
855
856
857
858
859
860
861#ifndef CONFIG_DM_USB
862
863
864
865
866struct usb_device *usb_get_dev_index(int index)
867{
868 if (usb_dev[index].devnum == -1)
869 return NULL;
870 else
871 return &usb_dev[index];
872}
873
874int usb_alloc_new_device(struct udevice *controller, struct usb_device **devp)
875{
876 int i;
877 debug("New Device %d\n", dev_index);
878 if (dev_index == USB_MAX_DEVICE) {
879 printf("ERROR, too many USB Devices, max=%d\n", USB_MAX_DEVICE);
880 return -ENOSPC;
881 }
882
883 usb_dev[dev_index].devnum = dev_index + 1;
884 usb_dev[dev_index].maxchild = 0;
885 for (i = 0; i < USB_MAXCHILDREN; i++)
886 usb_dev[dev_index].children[i] = NULL;
887 usb_dev[dev_index].parent = NULL;
888 usb_dev[dev_index].controller = controller;
889 dev_index++;
890 *devp = &usb_dev[dev_index - 1];
891
892 return 0;
893}
894
895
896
897
898
899
900void usb_free_device(struct udevice *controller)
901{
902 dev_index--;
903 debug("Freeing device node: %d\n", dev_index);
904 memset(&usb_dev[dev_index], 0, sizeof(struct usb_device));
905 usb_dev[dev_index].devnum = -1;
906}
907
908
909
910
911
912
913
914__weak int usb_alloc_device(struct usb_device *udev)
915{
916 return 0;
917}
918#endif
919
920static int usb_hub_port_reset(struct usb_device *dev, struct usb_device *hub)
921{
922 if (!hub)
923 usb_reset_root_port(dev);
924
925 return 0;
926}
927
928static int get_descriptor_len(struct usb_device *dev, int len, int expect_len)
929{
930 __maybe_unused struct usb_device_descriptor *desc;
931 ALLOC_CACHE_ALIGN_BUFFER(unsigned char, tmpbuf, USB_BUFSIZ);
932 int err;
933
934 desc = (struct usb_device_descriptor *)tmpbuf;
935
936 err = usb_get_descriptor(dev, USB_DT_DEVICE, 0, desc, len);
937 if (err < expect_len) {
938 if (err < 0) {
939 printf("unable to get device descriptor (error=%d)\n",
940 err);
941 return err;
942 } else {
943 printf("USB device descriptor short read (expected %i, got %i)\n",
944 expect_len, err);
945 return -EIO;
946 }
947 }
948 memcpy(&dev->descriptor, tmpbuf, sizeof(dev->descriptor));
949
950 return 0;
951}
952
953static int usb_setup_descriptor(struct usb_device *dev, bool do_read)
954{
955
956
957
958
959
960
961
962
963
964
965
966
967
968
969
970
971 if (dev->speed == USB_SPEED_LOW) {
972 dev->descriptor.bMaxPacketSize0 = 8;
973 dev->maxpacketsize = PACKET_SIZE_8;
974 } else {
975 dev->descriptor.bMaxPacketSize0 = 64;
976 dev->maxpacketsize = PACKET_SIZE_64;
977 }
978 dev->epmaxpacketin[0] = dev->descriptor.bMaxPacketSize0;
979 dev->epmaxpacketout[0] = dev->descriptor.bMaxPacketSize0;
980
981 if (do_read) {
982 int err;
983
984
985
986
987
988
989
990
991
992
993
994
995
996
997
998
999 err = get_descriptor_len(dev, 64, 8);
1000 if (err)
1001 return err;
1002 }
1003
1004 dev->epmaxpacketin[0] = dev->descriptor.bMaxPacketSize0;
1005 dev->epmaxpacketout[0] = dev->descriptor.bMaxPacketSize0;
1006 switch (dev->descriptor.bMaxPacketSize0) {
1007 case 8:
1008 dev->maxpacketsize = PACKET_SIZE_8;
1009 break;
1010 case 16:
1011 dev->maxpacketsize = PACKET_SIZE_16;
1012 break;
1013 case 32:
1014 dev->maxpacketsize = PACKET_SIZE_32;
1015 break;
1016 case 64:
1017 dev->maxpacketsize = PACKET_SIZE_64;
1018 break;
1019 default:
1020 printf("usb_new_device: invalid max packet size\n");
1021 return -EIO;
1022 }
1023
1024 return 0;
1025}
1026
1027static int usb_prepare_device(struct usb_device *dev, int addr, bool do_read,
1028 struct usb_device *parent)
1029{
1030 int err;
1031
1032
1033
1034
1035
1036
1037
1038 err = usb_alloc_device(dev);
1039 if (err) {
1040 printf("Cannot allocate device context to get SLOT_ID\n");
1041 return err;
1042 }
1043 err = usb_setup_descriptor(dev, do_read);
1044 if (err)
1045 return err;
1046 err = usb_hub_port_reset(dev, parent);
1047 if (err)
1048 return err;
1049
1050 dev->devnum = addr;
1051
1052 err = usb_set_address(dev);
1053
1054 if (err < 0) {
1055 printf("\n USB device not accepting new address " \
1056 "(error=%lX)\n", dev->status);
1057 return err;
1058 }
1059
1060 mdelay(10);
1061
1062 return 0;
1063}
1064
1065int usb_select_config(struct usb_device *dev)
1066{
1067 unsigned char *tmpbuf = NULL;
1068 int err;
1069
1070 err = get_descriptor_len(dev, USB_DT_DEVICE_SIZE, USB_DT_DEVICE_SIZE);
1071 if (err)
1072 return err;
1073
1074
1075 le16_to_cpus(&dev->descriptor.bcdUSB);
1076 le16_to_cpus(&dev->descriptor.idVendor);
1077 le16_to_cpus(&dev->descriptor.idProduct);
1078 le16_to_cpus(&dev->descriptor.bcdDevice);
1079
1080
1081
1082
1083
1084
1085
1086 mdelay(1);
1087
1088
1089 err = usb_get_configuration_len(dev, 0);
1090 if (err >= 0) {
1091 tmpbuf = (unsigned char *)malloc_cache_aligned(err);
1092 if (!tmpbuf)
1093 err = -ENOMEM;
1094 else
1095 err = usb_get_configuration_no(dev, 0, tmpbuf, err);
1096 }
1097 if (err < 0) {
1098 printf("usb_new_device: Cannot read configuration, " \
1099 "skipping device %04x:%04x\n",
1100 dev->descriptor.idVendor, dev->descriptor.idProduct);
1101 free(tmpbuf);
1102 return err;
1103 }
1104 usb_parse_config(dev, tmpbuf, 0);
1105 free(tmpbuf);
1106 usb_set_maxpacket(dev);
1107
1108
1109
1110
1111
1112 err = usb_set_configuration(dev, dev->config.desc.bConfigurationValue);
1113 if (err < 0) {
1114 printf("failed to set default configuration " \
1115 "len %d, status %lX\n", dev->act_len, dev->status);
1116 return err;
1117 }
1118
1119
1120
1121
1122
1123
1124 mdelay(10);
1125
1126 debug("new device strings: Mfr=%d, Product=%d, SerialNumber=%d\n",
1127 dev->descriptor.iManufacturer, dev->descriptor.iProduct,
1128 dev->descriptor.iSerialNumber);
1129 memset(dev->mf, 0, sizeof(dev->mf));
1130 memset(dev->prod, 0, sizeof(dev->prod));
1131 memset(dev->serial, 0, sizeof(dev->serial));
1132 if (dev->descriptor.iManufacturer)
1133 usb_string(dev, dev->descriptor.iManufacturer,
1134 dev->mf, sizeof(dev->mf));
1135 if (dev->descriptor.iProduct)
1136 usb_string(dev, dev->descriptor.iProduct,
1137 dev->prod, sizeof(dev->prod));
1138 if (dev->descriptor.iSerialNumber)
1139 usb_string(dev, dev->descriptor.iSerialNumber,
1140 dev->serial, sizeof(dev->serial));
1141 debug("Manufacturer %s\n", dev->mf);
1142 debug("Product %s\n", dev->prod);
1143 debug("SerialNumber %s\n", dev->serial);
1144
1145 return 0;
1146}
1147
1148int usb_setup_device(struct usb_device *dev, bool do_read,
1149 struct usb_device *parent)
1150{
1151 int addr;
1152 int ret;
1153
1154
1155 addr = dev->devnum;
1156 dev->devnum = 0;
1157
1158 ret = usb_prepare_device(dev, addr, do_read, parent);
1159 if (ret)
1160 return ret;
1161 ret = usb_select_config(dev);
1162
1163 return ret;
1164}
1165
1166#ifndef CONFIG_DM_USB
1167
1168
1169
1170
1171
1172
1173
1174int usb_new_device(struct usb_device *dev)
1175{
1176 bool do_read = true;
1177 int err;
1178
1179
1180
1181
1182
1183
1184
1185#ifdef CONFIG_USB_XHCI_HCD
1186 do_read = false;
1187#endif
1188 err = usb_setup_device(dev, do_read, dev->parent);
1189 if (err)
1190 return err;
1191
1192
1193 err = usb_hub_probe(dev, 0);
1194 if (err < 0)
1195 return err;
1196
1197 return 0;
1198}
1199#endif
1200
1201__weak
1202int board_usb_init(int index, enum usb_init_type init)
1203{
1204 return 0;
1205}
1206
1207__weak
1208int board_usb_cleanup(int index, enum usb_init_type init)
1209{
1210 return 0;
1211}
1212
1213bool usb_device_has_child_on_port(struct usb_device *parent, int port)
1214{
1215#ifdef CONFIG_DM_USB
1216 return false;
1217#else
1218 return parent->children[port] != NULL;
1219#endif
1220}
1221
1222#ifdef CONFIG_DM_USB
1223void usb_find_usb2_hub_address_port(struct usb_device *udev,
1224 uint8_t *hub_address, uint8_t *hub_port)
1225{
1226 struct udevice *parent;
1227 struct usb_device *uparent, *ttdev;
1228
1229
1230
1231
1232
1233
1234
1235
1236 ttdev = udev;
1237 parent = udev->dev;
1238 uparent = dev_get_parent_priv(parent);
1239
1240 while (uparent->speed != USB_SPEED_HIGH) {
1241 struct udevice *dev = parent;
1242
1243 if (device_get_uclass_id(dev->parent) != UCLASS_USB_HUB) {
1244 printf("Error: Cannot find high speed parent of usb-1 device\n");
1245 *hub_address = 0;
1246 *hub_port = 0;
1247 return;
1248 }
1249
1250 ttdev = dev_get_parent_priv(dev);
1251 parent = dev->parent;
1252 uparent = dev_get_parent_priv(parent);
1253 }
1254 *hub_address = uparent->devnum;
1255 *hub_port = ttdev->portnr;
1256}
1257#else
1258void usb_find_usb2_hub_address_port(struct usb_device *udev,
1259 uint8_t *hub_address, uint8_t *hub_port)
1260{
1261
1262 while (udev->parent->parent != NULL)
1263 if (udev->parent->speed != USB_SPEED_HIGH) {
1264 udev = udev->parent;
1265 } else {
1266 *hub_address = udev->parent->devnum;
1267 *hub_port = udev->portnr;
1268 return;
1269 }
1270
1271 printf("Error: Cannot find high speed parent of usb-1 device\n");
1272 *hub_address = 0;
1273 *hub_port = 0;
1274}
1275#endif
1276
1277
1278
1279