|
|
@ -280,9 +280,13 @@ int usb_set_maxpacket(struct usb_device *dev) |
|
|
|
int usb_parse_config(struct usb_device *dev, unsigned char *buffer, int cfgno) |
|
|
|
int usb_parse_config(struct usb_device *dev, unsigned char *buffer, int cfgno) |
|
|
|
{ |
|
|
|
{ |
|
|
|
struct usb_descriptor_header *head; |
|
|
|
struct usb_descriptor_header *head; |
|
|
|
int index,ifno,epno; |
|
|
|
int index, ifno, epno, curr_if_num; |
|
|
|
|
|
|
|
int i; |
|
|
|
|
|
|
|
unsigned char *ch; |
|
|
|
|
|
|
|
|
|
|
|
ifno = -1; |
|
|
|
ifno = -1; |
|
|
|
epno = -1; |
|
|
|
epno = -1; |
|
|
|
|
|
|
|
curr_if_num = -1; |
|
|
|
|
|
|
|
|
|
|
|
dev->configno = cfgno; |
|
|
|
dev->configno = cfgno; |
|
|
|
head = (struct usb_descriptor_header *) &buffer[0]; |
|
|
|
head = (struct usb_descriptor_header *) &buffer[0]; |
|
|
@ -300,18 +304,28 @@ int usb_parse_config(struct usb_device *dev, unsigned char *buffer, int cfgno) |
|
|
|
while(index + 1 < dev->config.wTotalLength) { |
|
|
|
while(index + 1 < dev->config.wTotalLength) { |
|
|
|
switch(head->bDescriptorType) { |
|
|
|
switch(head->bDescriptorType) { |
|
|
|
case USB_DT_INTERFACE: |
|
|
|
case USB_DT_INTERFACE: |
|
|
|
|
|
|
|
if(((struct usb_interface_descriptor *) &buffer[index])-> |
|
|
|
|
|
|
|
bInterfaceNumber != curr_if_num) { |
|
|
|
|
|
|
|
/* this is a new interface, copy new desc */ |
|
|
|
ifno = dev->config.no_of_if; |
|
|
|
ifno = dev->config.no_of_if; |
|
|
|
dev->config.no_of_if++; /* found an interface desc, increase numbers */ |
|
|
|
dev->config.no_of_if++; |
|
|
|
memcpy(&dev->config.if_desc[ifno],&buffer[index],buffer[index]); /* copy new desc */ |
|
|
|
memcpy(&dev->config.if_desc[ifno], |
|
|
|
|
|
|
|
&buffer[index], buffer[index]); |
|
|
|
dev->config.if_desc[ifno].no_of_ep = 0; |
|
|
|
dev->config.if_desc[ifno].no_of_ep = 0; |
|
|
|
|
|
|
|
dev->config.if_desc[ifno].num_altsetting = 1; |
|
|
|
|
|
|
|
curr_if_num = dev->config.if_desc[ifno].bInterfaceNumber; |
|
|
|
|
|
|
|
} else { |
|
|
|
|
|
|
|
/* found alternate setting for the interface */ |
|
|
|
|
|
|
|
dev->config.if_desc[ifno].num_altsetting++; |
|
|
|
|
|
|
|
} |
|
|
|
break; |
|
|
|
break; |
|
|
|
case USB_DT_ENDPOINT: |
|
|
|
case USB_DT_ENDPOINT: |
|
|
|
epno = dev->config.if_desc[ifno].no_of_ep; |
|
|
|
epno = dev->config.if_desc[ifno].no_of_ep; |
|
|
|
dev->config.if_desc[ifno].no_of_ep++; /* found an endpoint */ |
|
|
|
dev->config.if_desc[ifno].no_of_ep++; /* found an endpoint */ |
|
|
|
memcpy(&dev->config.if_desc[ifno].ep_desc[epno],&buffer[index],buffer[index]); |
|
|
|
memcpy(&dev->config.if_desc[ifno].ep_desc[epno], |
|
|
|
dev->config.if_desc[ifno].ep_desc[epno].wMaxPacketSize |
|
|
|
&buffer[index], buffer[index]); |
|
|
|
=swap_16(dev->config.if_desc[ifno].ep_desc[epno].wMaxPacketSize); |
|
|
|
dev->config.if_desc[ifno].ep_desc[epno].wMaxPacketSize = |
|
|
|
|
|
|
|
swap_16(dev->config.if_desc[ifno].ep_desc[epno].wMaxPacketSize); |
|
|
|
USB_PRINTF("if %d, ep %d\n", ifno, epno); |
|
|
|
USB_PRINTF("if %d, ep %d\n", ifno, epno); |
|
|
|
break; |
|
|
|
break; |
|
|
|
default: |
|
|
|
default: |
|
|
@ -319,8 +333,6 @@ int usb_parse_config(struct usb_device *dev, unsigned char *buffer, int cfgno) |
|
|
|
return 1; |
|
|
|
return 1; |
|
|
|
USB_PRINTF("unknown Description Type : %x\n", head->bDescriptorType); |
|
|
|
USB_PRINTF("unknown Description Type : %x\n", head->bDescriptorType); |
|
|
|
{ |
|
|
|
{ |
|
|
|
int i; |
|
|
|
|
|
|
|
unsigned char *ch; |
|
|
|
|
|
|
|
ch = (unsigned char *)head; |
|
|
|
ch = (unsigned char *)head; |
|
|
|
for(i = 0; i < head->bLength; i++) |
|
|
|
for(i = 0; i < head->bLength; i++) |
|
|
|
USB_PRINTF("%02X ", *ch++); |
|
|
|
USB_PRINTF("%02X ", *ch++); |
|
|
@ -443,6 +455,14 @@ int usb_set_interface(struct usb_device *dev, int interface, int alternate) |
|
|
|
printf("selecting invalid interface %d", interface); |
|
|
|
printf("selecting invalid interface %d", interface); |
|
|
|
return -1; |
|
|
|
return -1; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/*
|
|
|
|
|
|
|
|
* We should return now for devices with only one alternate setting. |
|
|
|
|
|
|
|
* According to 9.4.10 of the Universal Serial Bus Specification Revision 2.0 |
|
|
|
|
|
|
|
* such devices can return with a STALL. This results in some USB sticks |
|
|
|
|
|
|
|
* timeouting during initialization and then being unusable in U-Boot. |
|
|
|
|
|
|
|
*/ |
|
|
|
|
|
|
|
if (if_face->num_altsetting == 1) |
|
|
|
|
|
|
|
return 0; |
|
|
|
|
|
|
|
|
|
|
|
if ((ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), |
|
|
|
if ((ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), |
|
|
|
USB_REQ_SET_INTERFACE, USB_RECIP_INTERFACE, alternate, |
|
|
|
USB_REQ_SET_INTERFACE, USB_RECIP_INTERFACE, alternate, |
|
|
|