usb.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:34k
- /* Driver for USB Mass Storage compliant devices
- *
- * $Id: usb.c,v 1.73 2002/01/27 09:02:15 mdharm Exp $
- *
- * Current development and maintenance by:
- * (c) 1999-2002 Matthew Dharm (mdharm-usb@one-eyed-alien.net)
- *
- * Developed with the assistance of:
- * (c) 2000 David L. Brown, Jr. (usb-storage@davidb.org)
- *
- * Initial work by:
- * (c) 1999 Michael Gee (michael@linuxspecific.com)
- *
- * usb_device_id support by Adam J. Richter (adam@yggdrasil.com):
- * (c) 2000 Yggdrasil Computing, Inc.
- *
- * This driver is based on the 'USB Mass Storage Class' document. This
- * describes in detail the protocol used to communicate with such
- * devices. Clearly, the designers had SCSI and ATAPI commands in
- * mind when they created this document. The commands are all very
- * similar to commands in the SCSI-II and ATAPI specifications.
- *
- * It is important to note that in a number of cases this class
- * exhibits class-specific exemptions from the USB specification.
- * Notably the usage of NAK, STALL and ACK differs from the norm, in
- * that they are used to communicate wait, failed and OK on commands.
- *
- * Also, for certain devices, the interrupt endpoint is used to convey
- * status of a command.
- *
- * Please see http://www.one-eyed-alien.net/~mdharm/linux-usb for more
- * information about this driver.
- *
- * This program is free software; you can redistribute it and/or modify it
- * under the terms of the GNU General Public License as published by the
- * Free Software Foundation; either version 2, or (at your option) any
- * later version.
- *
- * This program is distributed in the hope that it will be useful, but
- * WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License along
- * with this program; if not, write to the Free Software Foundation, Inc.,
- * 675 Mass Ave, Cambridge, MA 02139, USA.
- */
- #include <linux/config.h>
- #include "usb.h"
- #include "scsiglue.h"
- #include "transport.h"
- #include "protocol.h"
- #include "debug.h"
- #include "initializers.h"
- #ifdef CONFIG_USB_STORAGE_HP8200e
- #include "shuttle_usbat.h"
- #endif
- #ifdef CONFIG_USB_STORAGE_SDDR09
- #include "sddr09.h"
- #endif
- #ifdef CONFIG_USB_STORAGE_SDDR55
- #include "sddr55.h"
- #endif
- #ifdef CONFIG_USB_STORAGE_DPCM
- #include "dpcm.h"
- #endif
- #ifdef CONFIG_USB_STORAGE_FREECOM
- #include "freecom.h"
- #endif
- #ifdef CONFIG_USB_STORAGE_ISD200
- #include "isd200.h"
- #endif
- #ifdef CONFIG_USB_STORAGE_DATAFAB
- #include "datafab.h"
- #endif
- #ifdef CONFIG_USB_STORAGE_JUMPSHOT
- #include "jumpshot.h"
- #endif
- #include <linux/module.h>
- #include <linux/sched.h>
- #include <linux/errno.h>
- #include <linux/init.h>
- #include <linux/slab.h>
- /* Some informational data */
- MODULE_AUTHOR("Matthew Dharm <mdharm-usb@one-eyed-alien.net>");
- MODULE_DESCRIPTION("USB Mass Storage driver for Linux");
- MODULE_LICENSE("GPL");
- /*
- * Per device data
- */
- static int my_host_number;
- /*
- * kernel thread actions
- */
- #define US_ACT_COMMAND 1
- #define US_ACT_DEVICE_RESET 2
- #define US_ACT_BUS_RESET 3
- #define US_ACT_HOST_RESET 4
- #define US_ACT_EXIT 5
- /* The list of structures and the protective lock for them */
- struct us_data *us_list;
- struct semaphore us_list_semaphore;
- static void * storage_probe(struct usb_device *dev, unsigned int ifnum,
- const struct usb_device_id *id);
- static void storage_disconnect(struct usb_device *dev, void *ptr);
- /* The entries in this table, except for final ones here
- * (USB_MASS_STORAGE_CLASS and the empty entry), correspond,
- * line for line with the entries of us_unsuaul_dev_list[].
- * For now, we duplicate idVendor and idProduct in us_unsual_dev_list,
- * just to avoid alignment bugs.
- */
- #define UNUSUAL_DEV(id_vendor, id_product, bcdDeviceMin, bcdDeviceMax,
- vendorName, productName,useProtocol, useTransport,
- initFunction, flags)
- { USB_DEVICE_VER(id_vendor, id_product, bcdDeviceMin,bcdDeviceMax) }
- static struct usb_device_id storage_usb_ids [] = {
- # include "unusual_devs.h"
- #undef UNUSUAL_DEV
- /* Control/Bulk transport for all SubClass values */
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_RBC, US_PR_CB) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_8020, US_PR_CB) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_QIC, US_PR_CB) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_UFI, US_PR_CB) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_8070, US_PR_CB) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_SCSI, US_PR_CB) },
- /* Control/Bulk/Interrupt transport for all SubClass values */
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_RBC, US_PR_CBI) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_8020, US_PR_CBI) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_QIC, US_PR_CBI) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_UFI, US_PR_CBI) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_8070, US_PR_CBI) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_SCSI, US_PR_CBI) },
- /* Bulk-only transport for all SubClass values */
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_RBC, US_PR_BULK) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_8020, US_PR_BULK) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_QIC, US_PR_BULK) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_UFI, US_PR_BULK) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_8070, US_PR_BULK) },
- { USB_INTERFACE_INFO(USB_CLASS_MASS_STORAGE, US_SC_SCSI, US_PR_BULK) },
- /* Terminating entry */
- { }
- };
- MODULE_DEVICE_TABLE (usb, storage_usb_ids);
- /* This is the list of devices we recognize, along with their flag data */
- /* The vendor name should be kept at eight characters or less, and
- * the product name should be kept at 16 characters or less. If a device
- * has the US_FL_FIX_INQUIRY flag, then the vendor and product names
- * normally generated by a device thorugh the INQUIRY response will be
- * taken from this list, and this is the reason for the above size
- * restriction. However, if the flag is not present, then you
- * are free to use as many characters as you like.
- */
- #undef UNUSUAL_DEV
- #define UNUSUAL_DEV(idVendor, idProduct, bcdDeviceMin, bcdDeviceMax,
- vendor_name, product_name, use_protocol, use_transport,
- init_function, Flags)
- {
- vendorName: vendor_name,
- productName: product_name,
- useProtocol: use_protocol,
- useTransport: use_transport,
- initFunction : init_function,
- flags: Flags,
- }
- static struct us_unusual_dev us_unusual_dev_list[] = {
- # include "unusual_devs.h"
- # undef UNUSUAL_DEV
- /* Control/Bulk transport for all SubClass values */
- { useProtocol: US_SC_RBC,
- useTransport: US_PR_CB},
- { useProtocol: US_SC_8020,
- useTransport: US_PR_CB},
- { useProtocol: US_SC_QIC,
- useTransport: US_PR_CB},
- { useProtocol: US_SC_UFI,
- useTransport: US_PR_CB},
- { useProtocol: US_SC_8070,
- useTransport: US_PR_CB},
- { useProtocol: US_SC_SCSI,
- useTransport: US_PR_CB},
- /* Control/Bulk/Interrupt transport for all SubClass values */
- { useProtocol: US_SC_RBC,
- useTransport: US_PR_CBI},
- { useProtocol: US_SC_8020,
- useTransport: US_PR_CBI},
- { useProtocol: US_SC_QIC,
- useTransport: US_PR_CBI},
- { useProtocol: US_SC_UFI,
- useTransport: US_PR_CBI},
- { useProtocol: US_SC_8070,
- useTransport: US_PR_CBI},
- { useProtocol: US_SC_SCSI,
- useTransport: US_PR_CBI},
- /* Bulk-only transport for all SubClass values */
- { useProtocol: US_SC_RBC,
- useTransport: US_PR_BULK},
- { useProtocol: US_SC_8020,
- useTransport: US_PR_BULK},
- { useProtocol: US_SC_QIC,
- useTransport: US_PR_BULK},
- { useProtocol: US_SC_UFI,
- useTransport: US_PR_BULK},
- { useProtocol: US_SC_8070,
- useTransport: US_PR_BULK},
- { useProtocol: US_SC_SCSI,
- useTransport: US_PR_BULK},
- /* Terminating entry */
- { 0 }
- };
- struct usb_driver usb_storage_driver = {
- name: "usb-storage",
- probe: storage_probe,
- disconnect: storage_disconnect,
- id_table: storage_usb_ids,
- };
- /*
- * fill_inquiry_response takes an unsigned char array (which must
- * be at least 36 characters) and populates the vendor name,
- * product name, and revision fields. Then the array is copied
- * into the SCSI command's response buffer (oddly enough
- * called request_buffer). data_len contains the length of the
- * data array, which again must be at least 36.
- */
- void fill_inquiry_response(struct us_data *us, unsigned char *data,
- unsigned int data_len) {
- int i;
- struct scatterlist *sg;
- int len =
- us->srb->request_bufflen > data_len ? data_len :
- us->srb->request_bufflen;
- int transferred;
- int amt;
- if (data_len<36) // You lose.
- return;
- if(data[0]&0x20) { /* USB device currently not connected. Return
- peripheral qualifier 001b ("...however, the
- physical device is not currently connected
- to this logical unit") and leave vendor and
- product identification empty. ("If the target
- does store some of the INQUIRY data on the
- device, it may return zeros or ASCII spaces
- (20h) in those fields until the data is
- available from the device."). */
- memset(data+8,0,28);
- } else {
- memcpy(data+8, us->unusual_dev->vendorName,
- strlen(us->unusual_dev->vendorName) > 8 ? 8 :
- strlen(us->unusual_dev->vendorName));
- memcpy(data+16, us->unusual_dev->productName,
- strlen(us->unusual_dev->productName) > 16 ? 16 :
- strlen(us->unusual_dev->productName));
- data[32] = 0x30 + ((us->pusb_dev->descriptor.bcdDevice>>12) & 0x0F);
- data[33] = 0x30 + ((us->pusb_dev->descriptor.bcdDevice>>8) & 0x0F);
- data[34] = 0x30 + ((us->pusb_dev->descriptor.bcdDevice>>4) & 0x0F);
- data[35] = 0x30 + ((us->pusb_dev->descriptor.bcdDevice) & 0x0F);
- }
- if (us->srb->use_sg) {
- sg = (struct scatterlist *)us->srb->request_buffer;
- for (i=0; i<us->srb->use_sg; i++)
- memset(sg[i].address, 0, sg[i].length);
- for (i=0, transferred=0;
- i<us->srb->use_sg && transferred < len;
- i++) {
- amt = sg[i].length > len-transferred ?
- len-transferred : sg[i].length;
- memcpy(sg[i].address, data+transferred, amt);
- transferred -= amt;
- }
- } else {
- memset(us->srb->request_buffer, 0, us->srb->request_bufflen);
- memcpy(us->srb->request_buffer, data, len);
- }
- }
- static int usb_stor_control_thread(void * __us)
- {
- struct us_data *us = (struct us_data *)__us;
- int action;
- lock_kernel();
- /*
- * This thread doesn't need any user-level access,
- * so get rid of all our resources..
- */
- exit_files(current);
- current->files = init_task.files;
- atomic_inc(¤t->files->count);
- daemonize();
- reparent_to_init();
- /* avoid getting signals */
- spin_lock_irq(¤t->sigmask_lock);
- flush_signals(current);
- sigfillset(¤t->blocked);
- recalc_sigpending(current);
- spin_unlock_irq(¤t->sigmask_lock);
- /* set our name for identification purposes */
- sprintf(current->comm, "usb-storage-%d", us->host_number);
- unlock_kernel();
- /* set up for wakeups by new commands */
- init_MUTEX_LOCKED(&us->sema);
- /* signal that we've started the thread */
- complete(&(us->notify));
- set_current_state(TASK_INTERRUPTIBLE);
- for(;;) {
- US_DEBUGP("*** thread sleeping.n");
- if(down_interruptible(&us->sema))
- break;
-
- US_DEBUGP("*** thread awakened.n");
- /* lock access to the queue element */
- down(&(us->queue_exclusion));
- /* take the command off the queue */
- action = us->action;
- us->action = 0;
- us->srb = us->queue_srb;
- /* release the queue lock as fast as possible */
- up(&(us->queue_exclusion));
- switch (action) {
- case US_ACT_COMMAND:
- /* reject the command if the direction indicator
- * is UNKNOWN
- */
- if (us->srb->sc_data_direction == SCSI_DATA_UNKNOWN) {
- US_DEBUGP("UNKNOWN data directionn");
- us->srb->result = DID_ERROR << 16;
- set_current_state(TASK_INTERRUPTIBLE);
- us->srb->scsi_done(us->srb);
- us->srb = NULL;
- break;
- }
- /* reject if target != 0 or if LUN is higher than
- * the maximum known LUN
- */
- if (us->srb->target &&
- !(us->flags & US_FL_SCM_MULT_TARG)) {
- US_DEBUGP("Bad target number (%d/%d)n",
- us->srb->target, us->srb->lun);
- us->srb->result = DID_BAD_TARGET << 16;
- set_current_state(TASK_INTERRUPTIBLE);
- us->srb->scsi_done(us->srb);
- us->srb = NULL;
- break;
- }
- if (us->srb->lun > us->max_lun) {
- US_DEBUGP("Bad LUN (%d/%d)n",
- us->srb->target, us->srb->lun);
- us->srb->result = DID_BAD_TARGET << 16;
- set_current_state(TASK_INTERRUPTIBLE);
- us->srb->scsi_done(us->srb);
- us->srb = NULL;
- break;
- }
- /* handle those devices which can't do a START_STOP */
- if ((us->srb->cmnd[0] == START_STOP) &&
- (us->flags & US_FL_START_STOP)) {
- US_DEBUGP("Skipping START_STOP commandn");
- us->srb->result = GOOD << 1;
- set_current_state(TASK_INTERRUPTIBLE);
- us->srb->scsi_done(us->srb);
- us->srb = NULL;
- break;
- }
- /* lock the device pointers */
- down(&(us->dev_semaphore));
- /* our device has gone - pretend not ready */
- if (!us->pusb_dev) {
- US_DEBUGP("Request is for removed devicen");
- /* For REQUEST_SENSE, it's the data. But
- * for anything else, it should look like
- * we auto-sensed for it.
- */
- if (us->srb->cmnd[0] == REQUEST_SENSE) {
- memcpy(us->srb->request_buffer,
- usb_stor_sense_notready,
- sizeof(usb_stor_sense_notready));
- us->srb->result = GOOD << 1;
- } else if(us->srb->cmnd[0] == INQUIRY) {
- unsigned char data_ptr[36] = {
- 0x20, 0x80, 0x02, 0x02,
- 0x1F, 0x00, 0x00, 0x00};
- US_DEBUGP("Faking INQUIRY command for disconnected devicen");
- fill_inquiry_response(us, data_ptr, 36);
- us->srb->result = GOOD << 1;
- } else {
- memcpy(us->srb->sense_buffer,
- usb_stor_sense_notready,
- sizeof(usb_stor_sense_notready));
- us->srb->result = CHECK_CONDITION << 1;
- }
- } else { /* !us->pusb_dev */
- /* Handle those devices which need us to fake
- * their inquiry data */
- if ((us->srb->cmnd[0] == INQUIRY) &&
- (us->flags & US_FL_FIX_INQUIRY)) {
- unsigned char data_ptr[36] = {
- 0x00, 0x80, 0x02, 0x02,
- 0x1F, 0x00, 0x00, 0x00};
- US_DEBUGP("Faking INQUIRY commandn");
- fill_inquiry_response(us, data_ptr, 36);
- us->srb->result = GOOD << 1;
- } else {
- /* we've got a command, let's do it! */
- US_DEBUG(usb_stor_show_command(us->srb));
- us->proto_handler(us->srb, us);
- }
- }
- /* unlock the device pointers */
- up(&(us->dev_semaphore));
- /* indicate that the command is done */
- if (us->srb->result != DID_ABORT << 16) {
- US_DEBUGP("scsi cmd done, result=0x%xn",
- us->srb->result);
- set_current_state(TASK_INTERRUPTIBLE);
- us->srb->scsi_done(us->srb);
- } else {
- US_DEBUGP("scsi command abortedn");
- set_current_state(TASK_INTERRUPTIBLE);
- complete(&(us->notify));
- }
- us->srb = NULL;
- break;
- case US_ACT_DEVICE_RESET:
- break;
- case US_ACT_BUS_RESET:
- break;
- case US_ACT_HOST_RESET:
- break;
- } /* end switch on action */
- /* exit if we get a signal to exit */
- if (action == US_ACT_EXIT) {
- US_DEBUGP("-- US_ACT_EXIT command receivedn");
- break;
- }
- } /* for (;;) */
- /* clean up after ourselves */
- set_current_state(TASK_INTERRUPTIBLE);
- /* notify the exit routine that we're actually exiting now */
- complete(&(us->notify));
- return 0;
- }
- /* Set up the IRQ pipe and handler
- * Note that this function assumes that all the data in the us_data
- * strucuture is current. This includes the ep_int field, which gives us
- * the endpoint for the interrupt.
- * Returns non-zero on failure, zero on success
- */
- static int usb_stor_allocate_irq(struct us_data *ss)
- {
- unsigned int pipe;
- int maxp;
- int result;
- US_DEBUGP("Allocating IRQ for CBI transportn");
- /* lock access to the data structure */
- down(&(ss->irq_urb_sem));
- /* allocate the URB */
- ss->irq_urb = usb_alloc_urb(0);
- if (!ss->irq_urb) {
- up(&(ss->irq_urb_sem));
- US_DEBUGP("couldn't allocate interrupt URB");
- return 1;
- }
- /* calculate the pipe and max packet size */
- pipe = usb_rcvintpipe(ss->pusb_dev, ss->ep_int->bEndpointAddress &
- USB_ENDPOINT_NUMBER_MASK);
- maxp = usb_maxpacket(ss->pusb_dev, pipe, usb_pipeout(pipe));
- if (maxp > sizeof(ss->irqbuf))
- maxp = sizeof(ss->irqbuf);
- /* fill in the URB with our data */
- FILL_INT_URB(ss->irq_urb, ss->pusb_dev, pipe, ss->irqbuf, maxp,
- usb_stor_CBI_irq, ss, ss->ep_int->bInterval);
- /* submit the URB for processing */
- result = usb_submit_urb(ss->irq_urb);
- US_DEBUGP("usb_submit_urb() returns %dn", result);
- if (result) {
- usb_free_urb(ss->irq_urb);
- up(&(ss->irq_urb_sem));
- return 2;
- }
- /* unlock the data structure and return success */
- up(&(ss->irq_urb_sem));
- return 0;
- }
- /* Probe to see if a new device is actually a SCSI device */
- static void * storage_probe(struct usb_device *dev, unsigned int ifnum,
- const struct usb_device_id *id)
- {
- int i;
- const int id_index = id - storage_usb_ids;
- char mf[USB_STOR_STRING_LEN]; /* manufacturer */
- char prod[USB_STOR_STRING_LEN]; /* product */
- char serial[USB_STOR_STRING_LEN]; /* serial number */
- GUID(guid); /* Global Unique Identifier */
- unsigned int flags;
- struct us_unusual_dev *unusual_dev;
- struct us_data *ss = NULL;
- #ifdef CONFIG_USB_STORAGE_SDDR09
- int result;
- #endif
- /* these are temporary copies -- we test on these, then put them
- * in the us-data structure
- */
- struct usb_endpoint_descriptor *ep_in = NULL;
- struct usb_endpoint_descriptor *ep_out = NULL;
- struct usb_endpoint_descriptor *ep_int = NULL;
- u8 subclass = 0;
- u8 protocol = 0;
- /* the altsettting on the interface we're probing that matched our
- * usb_match_id table
- */
- struct usb_interface *intf = dev->actconfig->interface;
- struct usb_interface_descriptor *altsetting =
- intf[ifnum].altsetting + intf[ifnum].act_altsetting;
- US_DEBUGP("act_altsettting is %dn", intf[ifnum].act_altsetting);
- /* clear the temporary strings */
- memset(mf, 0, sizeof(mf));
- memset(prod, 0, sizeof(prod));
- memset(serial, 0, sizeof(serial));
- /*
- * Can we support this device, either because we know about it
- * from our unusual device list, or because it advertises that it's
- * compliant to the specification?
- *
- * id_index is calculated in the declaration to be the index number
- * of the match from the usb_device_id table, so we can find the
- * corresponding entry in the private table.
- */
- US_DEBUGP("id_index calculated to be: %dn", id_index);
- US_DEBUGP("Array length appears to be: %dn", sizeof(us_unusual_dev_list) / sizeof(us_unusual_dev_list[0]));
- if (id_index <
- sizeof(us_unusual_dev_list) / sizeof(us_unusual_dev_list[0])) {
- unusual_dev = &us_unusual_dev_list[id_index];
- if (unusual_dev->vendorName)
- US_DEBUGP("Vendor: %sn", unusual_dev->vendorName);
- if (unusual_dev->productName)
- US_DEBUGP("Product: %sn", unusual_dev->productName);
- } else
- /* no, we can't support it */
- return NULL;
- /* At this point, we know we've got a live one */
- US_DEBUGP("USB Mass Storage device detectedn");
- /* Determine subclass and protocol, or copy from the interface */
- subclass = unusual_dev->useProtocol;
- protocol = unusual_dev->useTransport;
- flags = unusual_dev->flags;
- /*
- * Find the endpoints we need
- * We are expecting a minimum of 2 endpoints - in and out (bulk).
- * An optional interrupt is OK (necessary for CBI protocol).
- * We will ignore any others.
- */
- for (i = 0; i < altsetting->bNumEndpoints; i++) {
- /* is it an BULK endpoint? */
- if ((altsetting->endpoint[i].bmAttributes &
- USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_BULK) {
- /* BULK in or out? */
- if (altsetting->endpoint[i].bEndpointAddress &
- USB_DIR_IN)
- ep_in = &altsetting->endpoint[i];
- else
- ep_out = &altsetting->endpoint[i];
- }
- /* is it an interrupt endpoint? */
- if ((altsetting->endpoint[i].bmAttributes &
- USB_ENDPOINT_XFERTYPE_MASK) == USB_ENDPOINT_XFER_INT) {
- ep_int = &altsetting->endpoint[i];
- }
- }
- US_DEBUGP("Endpoints: In: 0x%p Out: 0x%p Int: 0x%p (Period %d)n",
- ep_in, ep_out, ep_int, ep_int ? ep_int->bInterval : 0);
- #ifdef CONFIG_USB_STORAGE_SDDR09
- if (protocol == US_PR_EUSB_SDDR09 || protocol == US_PR_DPCM_USB) {
- /* set the configuration -- STALL is an acceptable response here */
- result = usb_set_configuration(dev, 1);
- US_DEBUGP("Result from usb_set_configuration is %dn", result);
- if (result == -EPIPE) {
- US_DEBUGP("-- clearing stall on control interfacen");
- usb_clear_halt(dev, usb_sndctrlpipe(dev, 0));
- } else if (result != 0) {
- /* it's not a stall, but another error -- time to bail */
- US_DEBUGP("-- Unknown error. Rejecting devicen");
- return NULL;
- }
- }
- #endif
- /* Do some basic sanity checks, and bail if we find a problem */
- if (!ep_in || !ep_out || (protocol == US_PR_CBI && !ep_int)) {
- US_DEBUGP("Endpoint sanity check failed! Rejecting dev.n");
- return NULL;
- }
- /* At this point, we're committed to using the device */
- usb_inc_dev_use(dev);
- /* clear the GUID and fetch the strings */
- GUID_CLEAR(guid);
- if (dev->descriptor.iManufacturer)
- usb_string(dev, dev->descriptor.iManufacturer,
- mf, sizeof(mf));
- if (dev->descriptor.iProduct)
- usb_string(dev, dev->descriptor.iProduct,
- prod, sizeof(prod));
- if (dev->descriptor.iSerialNumber && !(flags & US_FL_IGNORE_SER))
- usb_string(dev, dev->descriptor.iSerialNumber,
- serial, sizeof(serial));
- /* Create a GUID for this device */
- if (dev->descriptor.iSerialNumber && serial[0]) {
- /* If we have a serial number, and it's a non-NULL string */
- make_guid(guid, dev->descriptor.idVendor,
- dev->descriptor.idProduct, serial);
- } else {
- /* We don't have a serial number, so we use 0 */
- make_guid(guid, dev->descriptor.idVendor,
- dev->descriptor.idProduct, "0");
- }
- /*
- * Now check if we have seen this GUID before
- * We're looking for a device with a matching GUID that isn't
- * already on the system
- */
- ss = us_list;
- while ((ss != NULL) &&
- ((ss->pusb_dev) || !GUID_EQUAL(guid, ss->guid)))
- ss = ss->next;
- if (ss != NULL) {
- /* Existing device -- re-connect */
- US_DEBUGP("Found existing GUID " GUID_FORMAT "n",
- GUID_ARGS(guid));
- /* lock the device pointers */
- down(&(ss->dev_semaphore));
- /* establish the connection to the new device upon reconnect */
- ss->ifnum = ifnum;
- ss->pusb_dev = dev;
- /* copy over the endpoint data */
- if (ep_in)
- ss->ep_in = ep_in->bEndpointAddress &
- USB_ENDPOINT_NUMBER_MASK;
- if (ep_out)
- ss->ep_out = ep_out->bEndpointAddress &
- USB_ENDPOINT_NUMBER_MASK;
- ss->ep_int = ep_int;
- /* allocate an IRQ callback if one is needed */
- if ((ss->protocol == US_PR_CBI) && usb_stor_allocate_irq(ss)) {
- usb_dec_dev_use(dev);
- return NULL;
- }
- /* allocate the URB we're going to use */
- ss->current_urb = usb_alloc_urb(0);
- if (!ss->current_urb) {
- usb_dec_dev_use(dev);
- return NULL;
- }
- /* Re-Initialize the device if it needs it */
- if (unusual_dev && unusual_dev->initFunction)
- (unusual_dev->initFunction)(ss);
- /* unlock the device pointers */
- up(&(ss->dev_semaphore));
- } else {
- /* New device -- allocate memory and initialize */
- US_DEBUGP("New GUID " GUID_FORMAT "n", GUID_ARGS(guid));
- if ((ss = (struct us_data *)kmalloc(sizeof(struct us_data),
- GFP_KERNEL)) == NULL) {
- printk(KERN_WARNING USB_STORAGE "Out of memoryn");
- usb_dec_dev_use(dev);
- return NULL;
- }
- memset(ss, 0, sizeof(struct us_data));
- /* allocate the URB we're going to use */
- ss->current_urb = usb_alloc_urb(0);
- if (!ss->current_urb) {
- kfree(ss);
- usb_dec_dev_use(dev);
- return NULL;
- }
- /* Initialize the mutexes only when the struct is new */
- init_completion(&(ss->notify));
- init_MUTEX_LOCKED(&(ss->ip_waitq));
- init_MUTEX(&(ss->queue_exclusion));
- init_MUTEX(&(ss->irq_urb_sem));
- init_MUTEX(&(ss->current_urb_sem));
- init_MUTEX(&(ss->dev_semaphore));
- /* copy over the subclass and protocol data */
- ss->subclass = subclass;
- ss->protocol = protocol;
- ss->flags = flags;
- ss->unusual_dev = unusual_dev;
- /* copy over the endpoint data */
- if (ep_in)
- ss->ep_in = ep_in->bEndpointAddress &
- USB_ENDPOINT_NUMBER_MASK;
- if (ep_out)
- ss->ep_out = ep_out->bEndpointAddress &
- USB_ENDPOINT_NUMBER_MASK;
- ss->ep_int = ep_int;
- /* establish the connection to the new device */
- ss->ifnum = ifnum;
- ss->pusb_dev = dev;
- /* copy over the identifiying strings */
- strncpy(ss->vendor, mf, USB_STOR_STRING_LEN);
- strncpy(ss->product, prod, USB_STOR_STRING_LEN);
- strncpy(ss->serial, serial, USB_STOR_STRING_LEN);
- if (strlen(ss->vendor) == 0) {
- if (unusual_dev->vendorName)
- strncpy(ss->vendor, unusual_dev->vendorName,
- USB_STOR_STRING_LEN);
- else
- strncpy(ss->vendor, "Unknown",
- USB_STOR_STRING_LEN);
- }
- if (strlen(ss->product) == 0) {
- if (unusual_dev->productName)
- strncpy(ss->product, unusual_dev->productName,
- USB_STOR_STRING_LEN);
- else
- strncpy(ss->product, "Unknown",
- USB_STOR_STRING_LEN);
- }
- if (strlen(ss->serial) == 0)
- strncpy(ss->serial, "None", USB_STOR_STRING_LEN);
- /* copy the GUID we created before */
- memcpy(ss->guid, guid, sizeof(guid));
- /*
- * Set the handler pointers based on the protocol
- * Again, this data is persistant across reattachments
- */
- switch (ss->protocol) {
- case US_PR_CB:
- ss->transport_name = "Control/Bulk";
- ss->transport = usb_stor_CB_transport;
- ss->transport_reset = usb_stor_CB_reset;
- ss->max_lun = 7;
- break;
- case US_PR_CBI:
- ss->transport_name = "Control/Bulk/Interrupt";
- ss->transport = usb_stor_CBI_transport;
- ss->transport_reset = usb_stor_CB_reset;
- ss->max_lun = 7;
- break;
- case US_PR_BULK:
- ss->transport_name = "Bulk";
- ss->transport = usb_stor_Bulk_transport;
- ss->transport_reset = usb_stor_Bulk_reset;
- ss->max_lun = usb_stor_Bulk_max_lun(ss);
- break;
- #ifdef CONFIG_USB_STORAGE_HP8200e
- case US_PR_SCM_ATAPI:
- ss->transport_name = "SCM/ATAPI";
- ss->transport = hp8200e_transport;
- ss->transport_reset = usb_stor_CB_reset;
- ss->max_lun = 1;
- break;
- #endif
- #ifdef CONFIG_USB_STORAGE_SDDR09
- case US_PR_EUSB_SDDR09:
- ss->transport_name = "EUSB/SDDR09";
- ss->transport = sddr09_transport;
- ss->transport_reset = usb_stor_CB_reset;
- ss->max_lun = 0;
- break;
- #endif
- #ifdef CONFIG_USB_STORAGE_SDDR55
- case US_PR_SDDR55:
- ss->transport_name = "SDDR55";
- ss->transport = sddr55_transport;
- ss->transport_reset = sddr55_reset;
- ss->max_lun = 0;
- break;
- #endif
- #ifdef CONFIG_USB_STORAGE_DPCM
- case US_PR_DPCM_USB:
- ss->transport_name = "Control/Bulk-EUSB/SDDR09";
- ss->transport = dpcm_transport;
- ss->transport_reset = usb_stor_CB_reset;
- ss->max_lun = 1;
- break;
- #endif
- #ifdef CONFIG_USB_STORAGE_FREECOM
- case US_PR_FREECOM:
- ss->transport_name = "Freecom";
- ss->transport = freecom_transport;
- ss->transport_reset = usb_stor_freecom_reset;
- ss->max_lun = 0;
- break;
- #endif
- #ifdef CONFIG_USB_STORAGE_DATAFAB
- case US_PR_DATAFAB:
- ss->transport_name = "Datafab Bulk-Only";
- ss->transport = datafab_transport;
- ss->transport_reset = usb_stor_Bulk_reset;
- ss->max_lun = 1;
- break;
- #endif
- #ifdef CONFIG_USB_STORAGE_JUMPSHOT
- case US_PR_JUMPSHOT:
- ss->transport_name = "Lexar Jumpshot Control/Bulk";
- ss->transport = jumpshot_transport;
- ss->transport_reset = usb_stor_Bulk_reset;
- ss->max_lun = 1;
- break;
- #endif
- default:
- ss->transport_name = "Unknown";
- kfree(ss->current_urb);
- kfree(ss);
- usb_dec_dev_use(dev);
- return NULL;
- break;
- }
- US_DEBUGP("Transport: %sn", ss->transport_name);
- /* fix for single-lun devices */
- if (ss->flags & US_FL_SINGLE_LUN)
- ss->max_lun = 0;
- switch (ss->subclass) {
- case US_SC_RBC:
- ss->protocol_name = "Reduced Block Commands (RBC)";
- ss->proto_handler = usb_stor_transparent_scsi_command;
- break;
- case US_SC_8020:
- ss->protocol_name = "8020i";
- ss->proto_handler = usb_stor_ATAPI_command;
- ss->max_lun = 0;
- break;
- case US_SC_QIC:
- ss->protocol_name = "QIC-157";
- ss->proto_handler = usb_stor_qic157_command;
- ss->max_lun = 0;
- break;
- case US_SC_8070:
- ss->protocol_name = "8070i";
- ss->proto_handler = usb_stor_ATAPI_command;
- ss->max_lun = 0;
- break;
- case US_SC_SCSI:
- ss->protocol_name = "Transparent SCSI";
- ss->proto_handler = usb_stor_transparent_scsi_command;
- break;
- case US_SC_UFI:
- ss->protocol_name = "Uniform Floppy Interface (UFI)";
- ss->proto_handler = usb_stor_ufi_command;
- break;
- #ifdef CONFIG_USB_STORAGE_ISD200
- case US_SC_ISD200:
- ss->protocol_name = "ISD200 ATA/ATAPI";
- ss->proto_handler = isd200_ata_command;
- break;
- #endif
- default:
- ss->protocol_name = "Unknown";
- kfree(ss->current_urb);
- kfree(ss);
- usb_dec_dev_use(dev);
- return NULL;
- break;
- }
- US_DEBUGP("Protocol: %sn", ss->protocol_name);
- /* allocate an IRQ callback if one is needed */
- if ((ss->protocol == US_PR_CBI) && usb_stor_allocate_irq(ss)) {
- kfree(ss->current_urb);
- kfree(ss);
- usb_dec_dev_use(dev);
- return NULL;
- }
- /*
- * Since this is a new device, we need to generate a scsi
- * host definition, and register with the higher SCSI layers
- */
- /* Initialize the host template based on the default one */
- memcpy(&(ss->htmplt), &usb_stor_host_template,
- sizeof(usb_stor_host_template));
- /* Grab the next host number */
- ss->host_number = my_host_number++;
- /* We abuse this pointer so we can pass the ss pointer to
- * the host controller thread in us_detect. But how else are
- * we to do it?
- */
- (struct us_data *)ss->htmplt.proc_dir = ss;
- /* Just before we start our control thread, initialize
- * the device if it needs initialization */
- if (unusual_dev && unusual_dev->initFunction)
- unusual_dev->initFunction(ss);
- /* start up our control thread */
- ss->pid = kernel_thread(usb_stor_control_thread, ss,
- CLONE_VM);
- if (ss->pid < 0) {
- printk(KERN_WARNING USB_STORAGE
- "Unable to start control threadn");
- kfree(ss->current_urb);
- kfree(ss);
- usb_dec_dev_use(dev);
- return NULL;
- }
- /* wait for the thread to start */
- wait_for_completion(&(ss->notify));
- /* now register - our detect function will be called */
- ss->htmplt.module = THIS_MODULE;
- scsi_register_module(MODULE_SCSI_HA, &(ss->htmplt));
- /* lock access to the data structures */
- down(&us_list_semaphore);
- /* put us in the list */
- ss->next = us_list;
- us_list = ss;
- /* release the data structure lock */
- up(&us_list_semaphore);
- }
- printk(KERN_DEBUG
- "WARNING: USB Mass Storage data integrity not assuredn");
- printk(KERN_DEBUG
- "USB Mass Storage device found at %dn", dev->devnum);
- /* return a pointer for the disconnect function */
- return ss;
- }
- /* Handle a disconnect event from the USB core */
- static void storage_disconnect(struct usb_device *dev, void *ptr)
- {
- struct us_data *ss = ptr;
- int result;
- US_DEBUGP("storage_disconnect() calledn");
- /* this is the odd case -- we disconnected but weren't using it */
- if (!ss) {
- US_DEBUGP("-- device was not in usen");
- return;
- }
- /* lock access to the device data structure */
- down(&(ss->dev_semaphore));
- /* release the IRQ, if we have one */
- down(&(ss->irq_urb_sem));
- if (ss->irq_urb) {
- US_DEBUGP("-- releasing irq URBn");
- result = usb_unlink_urb(ss->irq_urb);
- US_DEBUGP("-- usb_unlink_urb() returned %dn", result);
- usb_free_urb(ss->irq_urb);
- ss->irq_urb = NULL;
- }
- up(&(ss->irq_urb_sem));
- /* free up the main URB for this device */
- US_DEBUGP("-- releasing main URBn");
- result = usb_unlink_urb(ss->current_urb);
- US_DEBUGP("-- usb_unlink_urb() returned %dn", result);
- usb_free_urb(ss->current_urb);
- ss->current_urb = NULL;
- /* mark the device as gone */
- usb_dec_dev_use(ss->pusb_dev);
- ss->pusb_dev = NULL;
- /* unlock access to the device data structure */
- up(&(ss->dev_semaphore));
- }
- /***********************************************************************
- * Initialization and registration
- ***********************************************************************/
- int __init usb_stor_init(void)
- {
- printk(KERN_INFO "Initializing USB Mass Storage driver...n");
- /* initialize internal global data elements */
- us_list = NULL;
- init_MUTEX(&us_list_semaphore);
- my_host_number = 0;
- /* register the driver, return -1 if error */
- if (usb_register(&usb_storage_driver) < 0)
- return -1;
- /* we're all set */
- printk(KERN_INFO "USB Mass Storage support registered.n");
- return 0;
- }
- void __exit usb_stor_exit(void)
- {
- struct us_data *next;
- US_DEBUGP("usb_stor_exit() calledn");
- /* Deregister the driver
- * This eliminates races with probes and disconnects
- */
- US_DEBUGP("-- calling usb_deregister()n");
- usb_deregister(&usb_storage_driver) ;
- /* While there are still virtual hosts, unregister them
- * Note that it's important to do this completely before removing
- * the structures because of possible races with the /proc
- * interface
- */
- for (next = us_list; next; next = next->next) {
- US_DEBUGP("-- calling scsi_unregister_module()n");
- scsi_unregister_module(MODULE_SCSI_HA, &(next->htmplt));
- }
- /* While there are still structures, free them. Note that we are
- * now race-free, since these structures can no longer be accessed
- * from either the SCSI command layer or the /proc interface
- */
- while (us_list) {
- /* keep track of where the next one is */
- next = us_list->next;
- /* If there's extra data in the us_data structure then
- * free that first */
- if (us_list->extra) {
- /* call the destructor routine, if it exists */
- if (us_list->extra_destructor) {
- US_DEBUGP("-- calling extra_destructor()n");
- us_list->extra_destructor(us_list->extra);
- }
- /* destroy the extra data */
- US_DEBUGP("-- freeing the data structuren");
- kfree(us_list->extra);
- }
- /* free the structure itself */
- kfree (us_list);
- /* advance the list pointer */
- us_list = next;
- }
- }
- module_init(usb_stor_init);
- module_exit(usb_stor_exit);