static s32 __usbstorage_reset(usbstorage_handle *dev)
{
s32 retval;
if(dev->suspended == 1)
{
USB_ResumeDevice(dev->usb_fd);
dev->suspended = 0;
}
/*
retval = ehci_reset_device(dev->usb_fd);
if(retval < 0 && retval != -7004)
goto end;
*/
//debug_printf("usbstorage reset..\n");
retval = __USB_CtrlMsgTimeout(dev, (USB_CTRLTYPE_DIR_HOST2DEVICE | USB_CTRLTYPE_TYPE_CLASS | USB_CTRLTYPE_REC_INTERFACE), USBSTORAGE_RESET, 0, dev->interface, 0, NULL);
/* FIXME?: some devices return -7004 here which definitely violates the usb ms protocol but they still seem to be working... */
if(retval < 0 && retval != -7004)
goto end;
/* gives device enough time to process the reset */
msleep(10);
//debug_printf("cleat halt on bulk ep..\n");
retval = USB_ClearHalt(dev->usb_fd, dev->ep_in);
if(retval < 0)
goto end;
retval = USB_ClearHalt(dev->usb_fd, dev->ep_out);
end:
return retval;
}
static s32 __usbstorage_reset(usbstorage_handle *dev)
{
u32 t = usbtimeout;
usbtimeout = 1;
s32 retval = __USB_CtrlMsgTimeout(dev, (USB_CTRLTYPE_DIR_HOST2DEVICE | USB_CTRLTYPE_TYPE_CLASS | USB_CTRLTYPE_REC_INTERFACE), USBSTORAGE_RESET, 0, dev->interface, 0, NULL);
usleep(100);
usbtimeout = t;
usb_log("__usbstorage_reset, ret: %i\n",retval);
USB_ClearHalt(dev->usb_fd, dev->ep_in);usleep(100); //from http://www.usb.org/developers/devclass_docs/usbmassbulk_10.pdf
USB_ClearHalt(dev->usb_fd, dev->ep_out);usleep(100);
return retval;
}
static s32 __USB_BlkMsgTimeout(usbstorage_handle *dev, u8 bEndpoint, u16 wLength, void *rpData, u32 timeout)
{
s32 retval;
dev->retval = USBSTORAGE_PROCESSING;
retval = USB_WriteBlkMsgAsync(dev->usb_fd, bEndpoint, wLength, rpData, __usb_blkmsg_cb, (void *)dev);
if(retval < 0) return retval;
__usb_settimeout(dev, timeout);
do {
retval = dev->retval;
if(retval!=USBSTORAGE_PROCESSING) break;
else LWP_ThreadSleep(__usbstorage_waitq);
} while(retval==USBSTORAGE_PROCESSING);
if (retval<0)
USB_ClearHalt(dev->usb_fd, bEndpoint);
return retval;
}
static s32 __usbstorage_reset(struct ehci_hcd * ehci, usbstorage_handle *dev, int hard_reset) {
s32 retval;
u32 old_usb_timeout = usb_timeout;
usb_timeout = 1000 * 1000;
//int retry = hard_reset;
int retry = 0; //first try soft reset
retry:
if (retry >= 1) {
u8 conf;
debug_printf("reset device..\n");
retval = ehci_reset_device(ehci, dev->usb_fd);
ehci_msleep(10);
if (retval == -ENODEV) return retval;
if (retval < 0 && retval != -7004)
goto end;
// reset configuration
if (USB_GetConfiguration(ehci, dev->usb_fd, &conf) < 0)
goto end;
if (/*conf != dev->configuration &&*/ USB_SetConfiguration(ehci, dev->usb_fd, dev->configuration) < 0)
goto end;
if (dev->altInterface != 0 && USB_SetAlternativeInterface(ehci, dev->usb_fd, dev->interface, dev->altInterface) < 0)
goto end;
// find the device with the same ehci ptr
ehci_device_data * _device_data = find_ehci_data(ehci);
if (_device_data->__lun != 16) {
if (USBStorage_MountLUN(ehci, &_device_data->__usbfd, _device_data->__lun) < 0)
goto end;
}
}
debug_printf("usbstorage reset..\n");
retval = __USB_CtrlMsgTimeout(ehci, dev, (USB_CTRLTYPE_DIR_HOST2DEVICE | USB_CTRLTYPE_TYPE_CLASS | USB_CTRLTYPE_REC_INTERFACE), USBSTORAGE_RESET, 0, dev->interface, 0, NULL);
#ifdef MEM_PRINT
s_printf("usbstorage reset: Reset ret %i\n", retval);
#endif
/* FIXME?: some devices return -7004 here which definitely violates the usb ms protocol but they still seem to be working... */
if (retval < 0 && retval != -7004)
goto end;
/* gives device enough time to process the reset */
ehci_msleep(10);
debug_printf("clear halt on bulk ep..\n");
retval = USB_ClearHalt(ehci, dev->usb_fd, dev->ep_in);
#ifdef MEM_PRINT
s_printf("usbstorage reset: clearhalt in ret %i\n", retval);
#endif
if (retval < 0)
goto end;
ehci_msleep(10);
retval = USB_ClearHalt(ehci, dev->usb_fd, dev->ep_out);
#ifdef MEM_PRINT
s_printf("usbstorage reset: clearhalt in ret %i\n", retval);
#endif
if (retval < 0)
goto end;
ehci_msleep(50);
usb_timeout = old_usb_timeout;
return retval;
end:
if (retval == -ENODEV) return retval;
#ifdef HOMEBREW
if (disable_hardreset) return retval;
if (retry < 1) { //only 1 hard reset
ehci_msleep(100);
debug_printf("retry with hard reset..\n");
retry++;
goto retry;
}
#else
if (retry < 5) {
ehci_msleep(100);
debug_printf("retry with hard reset..\n");
retry++;
goto retry;
}
#endif
usb_timeout = old_usb_timeout;
return retval;
}
s32 USBStorage_Open(usbstorage_handle *dev, struct ehci_device *fd)
{
s32 retval = -1;
u8 conf,*max_lun = NULL;
u32 iConf, iInterface, iEp;
usb_devdesc udd;
usb_configurationdesc *ucd;
usb_interfacedesc *uid;
usb_endpointdesc *ued;
max_lun = USB_Alloc(1);
if(max_lun==NULL) return -ENOMEM;
memset(dev, 0, sizeof(*dev));
dev->tag = TAG_START;
dev->usb_fd = fd;
retval = USB_GetDescriptors(dev->usb_fd, &udd);
if(retval < 0)
goto free_and_return;
for(iConf = 0; iConf < udd.bNumConfigurations; iConf++)
{
ucd = &udd.configurations[iConf];
for(iInterface = 0; iInterface < ucd->bNumInterfaces; iInterface++)
{
uid = &ucd->interfaces[iInterface];
if(uid->bInterfaceClass == USB_CLASS_MASS_STORAGE &&
uid->bInterfaceSubClass == MASS_STORAGE_SCSI_COMMANDS &&
uid->bInterfaceProtocol == MASS_STORAGE_BULK_ONLY)
{
if(uid->bNumEndpoints < 2)
continue;
dev->ep_in = dev->ep_out = 0;
for(iEp = 0; iEp < uid->bNumEndpoints; iEp++)
{
ued = &uid->endpoints[iEp];
if(ued->bmAttributes != USB_ENDPOINT_BULK)
continue;
if(ued->bEndpointAddress & USB_ENDPOINT_IN)
dev->ep_in = ued->bEndpointAddress;
else
dev->ep_out = ued->bEndpointAddress;
}
if(dev->ep_in != 0 && dev->ep_out != 0)
{
dev->configuration = ucd->bConfigurationValue;
dev->interface = uid->bInterfaceNumber;
dev->altInterface = uid->bAlternateSetting;
goto found;
}
}
}
}
USB_FreeDescriptors(&udd);
retval = USBSTORAGE_ENOINTERFACE;
goto free_and_return;
found:
USB_FreeDescriptors(&udd);
retval = USBSTORAGE_EINIT;
if(USB_GetConfiguration(dev->usb_fd, &conf) < 0)
goto free_and_return;
if(conf != dev->configuration && USB_SetConfiguration(dev->usb_fd, dev->configuration) < 0)
goto free_and_return;
if(dev->altInterface != 0 && USB_SetAlternativeInterface(dev->usb_fd, dev->interface, dev->altInterface) < 0)
goto free_and_return;
dev->suspended = 0;
retval = USBStorage_Reset(dev);
if(retval < 0)
goto free_and_return;
retval = __USB_CtrlMsgTimeout(dev, (USB_CTRLTYPE_DIR_DEVICE2HOST | USB_CTRLTYPE_TYPE_CLASS | USB_CTRLTYPE_REC_INTERFACE), USBSTORAGE_GET_MAX_LUN, 0, dev->interface, 1, max_lun);
if(retval < 0)
dev->max_lun = 1;
else
dev->max_lun = *max_lun;
if(retval == USBSTORAGE_ETIMEDOUT)
goto free_and_return;
retval = USBSTORAGE_OK;
if(dev->max_lun == 0)
dev->max_lun++;
/* taken from linux usbstorage module (drivers/usb/storage/transport.c) */
/*
* Some devices (i.e. Iomega Zip100) need this -- apparently
* the bulk pipes get STALLed when the GetMaxLUN request is
* processed. This is, in theory, harmless to all other devices
* (regardless of if they stall or not).
*/
USB_ClearHalt(dev->usb_fd, dev->ep_in);
USB_ClearHalt(dev->usb_fd, dev->ep_out);
dev->buffer = USB_Alloc(MAX_TRANSFER_SIZE);
if(dev->buffer == NULL) retval = -ENOMEM;
else retval = USBSTORAGE_OK;
free_and_return:
if(max_lun!=NULL) USB_Free(max_lun);
if(retval < 0)
{
if(dev->buffer != NULL)
USB_Free(dev->buffer);
memset(dev, 0, sizeof(*dev));
return retval;
}
return 0;
}
