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; }