]> git.kernelconcepts.de Git - karo-tx-uboot.git/blobdiff - common/usb_storage.c
karo: configs: Update the tx6*_defconfig files from defconfigs generated with 'make...
[karo-tx-uboot.git] / common / usb_storage.c
index 5108d234346f9a8e28964767cc0db464ce8aa2db..b9784304086ecdc7ec7beaaeedb853af513824de 100644 (file)
@@ -9,6 +9,8 @@
  *
  * Adapted for U-Boot:
  *   (C) Copyright 2001 Denis Peter, MPL AG Switzerland
+ * Driver model conversion:
+ *   (C) Copyright 2015 Google, Inc
  *
  * For BBB support (C) Copyright 2003
  * Gary Jennejohn, DENX Software Engineering <garyj@denx.de>
 
 #include <common.h>
 #include <command.h>
+#include <dm.h>
+#include <errno.h>
 #include <inttypes.h>
+#include <mapmem.h>
 #include <asm/byteorder.h>
 #include <asm/processor.h>
+#include <dm/device-internal.h>
 
 #include <part.h>
 #include <usb.h>
@@ -104,7 +110,6 @@ struct us_data {
 
 static struct us_data usb_stor[USB_MAX_STOR_DEV];
 
-
 #define USB_STOR_TRANSPORT_GOOD           0
 #define USB_STOR_TRANSPORT_FAILED -1
 #define USB_STOR_TRANSPORT_ERROR  -2
@@ -117,7 +122,6 @@ unsigned long usb_stor_read(int device, lbaint_t blknr,
                            lbaint_t blkcnt, void *buffer);
 unsigned long usb_stor_write(int device, lbaint_t blknr,
                             lbaint_t blkcnt, const void *buffer);
-struct usb_device * usb_get_dev_index(int index);
 void uhci_show_temp_int_td(void);
 
 #ifdef CONFIG_PARTITIONS
@@ -167,30 +171,61 @@ static unsigned int usb_get_max_lun(struct us_data *us)
        return (len > 0) ? *result : 0;
 }
 
-static int usb_storage_register(struct usb_device *dev, unsigned char iface)
+static int usb_stor_probe_device(struct usb_device *dev)
 {
-       int lun, max_lun, start = usb_max_devs;
-       int nb_dev = 0;
-
-       if (!usb_storage_probe(dev, iface, &usb_stor[usb_max_devs]))
-               return nb_dev;
-
-       /*
-        * OK, it's a storage device.  Iterate over its LUNs
-        * and populate `usb_dev_desc'.
-        */
-       max_lun = usb_get_max_lun(&usb_stor[usb_max_devs]);
-       for (lun = 0; lun <= max_lun && usb_max_devs < USB_MAX_STOR_DEV; lun++) {
-               usb_dev_desc[usb_max_devs].lun = lun;
-               if (usb_stor_get_info(dev, &usb_stor[start],
-                   &usb_dev_desc[usb_max_devs]) == 1) {
-                       nb_dev++;
+       if (dev == NULL)
+               return -ENOENT; /* no more devices available */
+
+       debug("\n\nProbing for storage\n");
+       if (usb_storage_probe(dev, 0, &usb_stor[usb_max_devs])) {
+               /* OK, it's a storage device.  Iterate over its LUNs
+                       * and populate `usb_dev_desc'.
+                       */
+               int lun, max_lun, start = usb_max_devs;
+
+               max_lun = usb_get_max_lun(&usb_stor[usb_max_devs]);
+               for (lun = 0;
+                       lun <= max_lun && usb_max_devs < USB_MAX_STOR_DEV;
+                       lun++) {
+                       struct block_dev_desc *blkdev;
+
+                       blkdev = &usb_dev_desc[usb_max_devs];
+                       memset(blkdev, '\0', sizeof(block_dev_desc_t));
+                       blkdev->if_type = IF_TYPE_USB;
+                       blkdev->dev = usb_max_devs;
+                       blkdev->part_type = PART_TYPE_UNKNOWN;
+                       blkdev->target = 0xff;
+                       blkdev->type = DEV_TYPE_UNKNOWN;
+                       blkdev->block_read = usb_stor_read;
+                       blkdev->block_write = usb_stor_write;
+                       blkdev->lun = lun;
+                       blkdev->priv = dev;
+
+                       if (usb_stor_get_info(dev, &usb_stor[start],
+                                             &usb_dev_desc[usb_max_devs]) ==
+                                             1) {
+                               usb_max_devs++;
+                               debug("%s: Found device %p\n", __func__, dev);
+                       }
                }
        }
 
-       return nb_dev;
+       /* if storage device */
+       if (usb_max_devs == USB_MAX_STOR_DEV) {
+               printf("max USB Storage Device reached: %d stopping\n",
+                      usb_max_devs);
+               return -ENOSPC;
+       }
+
+       return 0;
 }
 
+void usb_stor_reset(void)
+{
+       usb_max_devs = 0;
+}
+
+#ifndef CONFIG_DM_USB
 /*******************************************************************************
  * scan the usb and reports device info
  * to the user if mode = 1
@@ -198,42 +233,21 @@ static int usb_storage_register(struct usb_device *dev, unsigned char iface)
  */
 int usb_stor_scan(int mode)
 {
-       unsigned char i, iface;
-       struct usb_device *dev;
+       unsigned char i;
 
        if (mode == 1)
                printf("       scanning usb for storage devices... ");
 
        usb_disable_asynch(1); /* asynch transfer not allowed */
 
-       for (i = 0; i < USB_MAX_STOR_DEV; i++) {
-               memset(&usb_dev_desc[i], 0, sizeof(block_dev_desc_t));
-               usb_dev_desc[i].if_type = IF_TYPE_USB;
-               usb_dev_desc[i].dev = i;
-               usb_dev_desc[i].part_type = PART_TYPE_UNKNOWN;
-               usb_dev_desc[i].target = 0xff;
-               usb_dev_desc[i].type = DEV_TYPE_UNKNOWN;
-               usb_dev_desc[i].block_read = usb_stor_read;
-               usb_dev_desc[i].block_write = usb_stor_write;
-       }
-
-       usb_max_devs = 0;
+       usb_stor_reset();
        for (i = 0; i < USB_MAX_DEVICE; i++) {
+               struct usb_device *dev;
+
                dev = usb_get_dev_index(i); /* get device */
                debug("i=%d\n", i);
-               if (dev == NULL)
-                       break; /* no more devices available */
-
-               for (iface = 0; iface < dev->config.no_of_if; iface++) {
-                       usb_max_devs += usb_storage_register(dev, iface);
-               }
-
-               /* if storage device */
-               if (usb_max_devs == USB_MAX_STOR_DEV) {
-                       printf("max USB Storage Device reached: %d stopping\n",
-                               usb_max_devs);
+               if (usb_stor_probe_device(dev))
                        break;
-               }
        } /* for */
 
        usb_disable_asynch(0); /* asynch transfer allowed */
@@ -242,6 +256,7 @@ int usb_stor_scan(int mode)
                return 0;
        return -1;
 }
+#endif
 
 static int usb_stor_irq(struct usb_device *dev)
 {
@@ -306,8 +321,9 @@ static int us_one_transfer(struct us_data *us, int pipe, char *buf, int length)
                /* set up the transfer loop */
                do {
                        /* transfer the data */
-                       debug("Bulk xfer %p(%d) try #%d\n",
-                             buf, this_xfer, 11 - maxtry);
+                       debug("Bulk xfer 0x%lx(%d) try #%d\n",
+                             (ulong)map_to_sysmem(buf), this_xfer,
+                             11 - maxtry);
                        result = usb_bulk_msg(us->pusb_dev, pipe, buf,
                                              this_xfer, &partial,
                                              USB_CNTL_TIMEOUT * 5);
@@ -1018,7 +1034,7 @@ unsigned long usb_stor_read(int device, lbaint_t blknr,
        unsigned short smallblks;
        struct usb_device *dev;
        struct us_data *ss;
-       int retry, i;
+       int retry;
        ccb *srb = &usb_ccb;
 
        if (blkcnt == 0)
@@ -1026,14 +1042,11 @@ unsigned long usb_stor_read(int device, lbaint_t blknr,
 
        device &= 0xff;
        /* Setup  device */
-       debug("\nusb_read: dev %d \n", device);
-       dev = NULL;
-       for (i = 0; i < USB_MAX_DEVICE; i++) {
-               dev = usb_get_dev_index(i);
-               if (dev == NULL)
-                       return 0;
-               if (dev->devnum == usb_dev_desc[device].target)
-                       break;
+       debug("\nusb_read: dev %d\n", device);
+       dev = usb_dev_desc[device].priv;
+       if (!dev) {
+               debug("%s: No device\n", __func__);
+               return 0;
        }
        ss = (struct us_data *)dev->privptr;
 
@@ -1091,7 +1104,7 @@ unsigned long usb_stor_write(int device, lbaint_t blknr,
        unsigned short smallblks;
        struct usb_device *dev;
        struct us_data *ss;
-       int retry, i;
+       int retry;
        ccb *srb = &usb_ccb;
 
        if (blkcnt == 0)
@@ -1099,15 +1112,10 @@ unsigned long usb_stor_write(int device, lbaint_t blknr,
 
        device &= 0xff;
        /* Setup  device */
-       debug("\nusb_write: dev %d \n", device);
-       dev = NULL;
-       for (i = 0; i < USB_MAX_DEVICE; i++) {
-               dev = usb_get_dev_index(i);
-               if (dev == NULL)
-                       return 0;
-               if (dev->devnum == usb_dev_desc[device].target)
-                       break;
-       }
+       debug("\nusb_write: dev %d\n", device);
+       dev = usb_dev_desc[device].priv;
+       if (!dev)
+               return 0;
        ss = (struct us_data *)dev->privptr;
 
        usb_disable_asynch(1); /* asynch transfer not allowed */
@@ -1394,3 +1402,46 @@ int usb_stor_get_info(struct usb_device *dev, struct us_data *ss,
        debug("partype: %d\n", dev_desc->part_type);
        return 1;
 }
+
+#ifdef CONFIG_DM_USB
+
+static int usb_mass_storage_probe(struct udevice *dev)
+{
+       struct usb_device *udev = dev_get_parentdata(dev);
+       int ret;
+
+       usb_disable_asynch(1); /* asynch transfer not allowed */
+       ret = usb_stor_probe_device(udev);
+       usb_disable_asynch(0); /* asynch transfer allowed */
+
+       return ret;
+}
+
+static const struct udevice_id usb_mass_storage_ids[] = {
+       { .compatible = "usb-mass-storage" },
+       { }
+};
+
+U_BOOT_DRIVER(usb_mass_storage) = {
+       .name   = "usb_mass_storage",
+       .id     = UCLASS_MASS_STORAGE,
+       .of_match = usb_mass_storage_ids,
+       .probe = usb_mass_storage_probe,
+};
+
+UCLASS_DRIVER(usb_mass_storage) = {
+       .id             = UCLASS_MASS_STORAGE,
+       .name           = "usb_mass_storage",
+};
+
+static const struct usb_device_id mass_storage_id_table[] = {
+       {
+               .match_flags = USB_DEVICE_ID_MATCH_INT_CLASS,
+               .bInterfaceClass = USB_CLASS_MASS_STORAGE
+       },
+       { }             /* Terminating entry */
+};
+
+U_BOOT_USB_DEVICE(usb_mass_storage, mass_storage_id_table);
+
+#endif