Changeset 71fa44c in mainline

Timestamp:

2011-07-03T11:27:37Z (14 years ago)

Author:

Jiri Svoboda <jiri@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

9e34750

Parents:

6430ac6

Message:

Implement Read Capacity command for USB mass storage.

Location:

uspace

Files:

• drv/bus/usb/usbmast/main.c (modified) (1 diff)
• drv/bus/usb/usbmast/scsi_ms.c (modified) (5 diffs)
• drv/bus/usb/usbmast/scsi_ms.h (modified) (1 diff)
• lib/scsi/include/scsi/sbc.h (modified) (1 diff)

uspace/drv/bus/usb/usbmast/main.c

@@ -126 +126 @@
             lun_count);
 
+        uint32_t nblocks, block_size;
+
+        rc = usbmast_read_capacity(dev, &nblocks, &block_size);
+        if (rc != EOK) {
+                usb_log_warning("Failed to read capacity, device `%s': %s.\n",
+                    dev->ddf_dev->name, str_error(rc));
+                return EOK;
+        }
+
+        usb_log_info("Read Capacity: nblocks=%" PRIu32 ", "
+            "block_size=%" PRIu32 "\n", nblocks, block_size);
+
         return EOK;
 }

uspace/drv/bus/usb/usbmast/scsi_ms.c

@@ -1 +1 @@
 /*
  * Copyright (c) 2011 Vojtech Horky
+ * Copyright (c) 2011 Jiri Svoboda
  * All rights reserved.
  *
@@ -35 +36 @@
  */
 #include <bitops.h>
+#include <byteorder.h>
+#include <inttypes.h>
 #include <usb/dev/driver.h>
 #include <usb/debug.h>
-#include <usb/classes/classes.h>
-#include <usb/classes/massstor.h>
 #include <errno.h>
 #include <str_error.h>
 #include <str.h>
-#include <ctype.h>
+#include <scsi/sbc.h>
 #include <scsi/spc.h>
 #include "cmds.h"
@@ -58 +59 @@
 }
 
-/** Perform SCSI INQUIRY command on USB mass storage device.
+/** Perform SCSI Inquiry command on USB mass storage device.
  *
  * @param dev           USB device.
@@ -68 +69 @@
         scsi_std_inquiry_data_t inq_data;
         size_t response_len;
-        scsi_cdb_inquiry_t inquiry = {
-                .op_code = SCSI_CMD_INQUIRY,
-                .evpd = 0,
-                .page_code = 0,
-                .alloc_len = host2uint16_t_be(sizeof(inq_data)),
-                .control = 0
-        };
-
+        scsi_cdb_inquiry_t cdb;
         int rc;
 
-        rc = usb_massstor_data_in(dev, 0xDEADBEEF, 0, (uint8_t *) &inquiry,
-            sizeof(inquiry), &inq_data, sizeof(inq_data), &response_len);
+        memset(&cdb, 0, sizeof(cdb));
+        cdb.op_code = SCSI_CMD_INQUIRY;
+        cdb.alloc_len = host2uint16_t_be(sizeof(inq_data));
+
+        rc = usb_massstor_data_in(dev, 0xDEADBEEF, 0, (uint8_t *) &cdb,
+            sizeof(cdb), &inq_data, sizeof(inq_data), &response_len);
 
         if (rc != EOK) {
-                usb_log_error("Failed to probe device %s using %s: %s.\n",
-                   dev->ddf_dev->name, "SCSI:INQUIRY", str_error(rc));
+                usb_log_error("Inquiry failed, device %s: %s.\n",
+                   dev->ddf_dev->name, str_error(rc));
                 return rc;
         }
 
         if (response_len < SCSI_STD_INQUIRY_DATA_MIN_SIZE) {
-                usb_log_error("The SCSI inquiry response is too short.\n");
+                usb_log_error("SCSI Inquiry response too short (%zu).\n",
+                    response_len);
                 return EIO;
         }
@@ -116 +115 @@
 }
 
+/** Perform SCSI Read Capacity command on USB mass storage device.
+ *
+ * @param dev           USB device.
+ * @param nblocks       Output, number of blocks.
+ * @param block_size    Output, block size in bytes.
+ *
+ * @return              Error code.
+ */
+int usbmast_read_capacity(usb_device_t *dev, uint32_t *nblocks,
+    uint32_t *block_size)
+{
+        scsi_cdb_read_capacity_10_t cdb;
+        scsi_read_capacity_10_data_t data;
+        size_t data_len;
+        int rc;
+
+        memset(&cdb, 0, sizeof(cdb));
+        cdb.op_code = SCSI_CMD_READ_CAPACITY_10;
+
+        rc = usb_massstor_data_in(dev, 0xDEADBEEF, 0, (uint8_t *) &cdb,
+            sizeof(cdb), &data, sizeof(data), &data_len);
+
+        if (rc != EOK) {
+                usb_log_error("Read Capacity (10) failed, device %s: %s.\n",
+                   dev->ddf_dev->name, str_error(rc));
+                return rc;
+        }
+
+        if (data_len < sizeof(data)) {
+                usb_log_error("SCSI Read Capacity response too short (%zu).\n",
+                    data_len);
+                return EIO;
+        }
+
+        *nblocks = uint32_t_be2host(data.last_lba) + 1;
+        *block_size = uint32_t_be2host(data.block_size);
+
+        return EOK;
+}
+
 /**
  * @}

uspace/drv/bus/usb/usbmast/scsi_ms.h

@@ -59 +59 @@
 } usbmast_inquiry_data_t;
 
-int usbmast_inquiry(usb_device_t *, usbmast_inquiry_data_t *);
-const char *usbmast_scsi_dev_type_str(unsigned);
+extern int usbmast_inquiry(usb_device_t *, usbmast_inquiry_data_t *);
+extern int usbmast_read_capacity(usb_device_t *dev, uint32_t *, uint32_t *);
+extern const char *usbmast_scsi_dev_type_str(unsigned);
 
 #endif

uspace/lib/scsi/include/scsi/sbc.h

@@ -113 +113 @@
         /** Size of block in bytes */
         uint32_t block_size;
-} scsi_read_capacity_10_data;
+} scsi_read_capacity_10_data_t;
 
 /** SCSI Write (12) command */