summaryrefslogtreecommitdiffstats
path: root/utils/imxtools/scsitools
diff options
context:
space:
mode:
authorAmaury Pouly <amaury.pouly@gmail.com>2013-01-15 19:42:20 +0000
committerAmaury Pouly <amaury.pouly@gmail.com>2013-01-15 19:42:20 +0000
commit8ed0d198c504f2c6984de7bcdc07163b89f87ef0 (patch)
tree6ea45dbe67f757985dd9edb0243afb2b55233287 /utils/imxtools/scsitools
parent4b1c48f5f51d15159b6cdc1658bb78bff0fcba5f (diff)
downloadrockbox-8ed0d198c504f2c6984de7bcdc07163b89f87ef0.tar.gz
rockbox-8ed0d198c504f2c6984de7bcdc07163b89f87ef0.tar.bz2
rockbox-8ed0d198c504f2c6984de7bcdc07163b89f87ef0.zip
imxtools/scsitools: add support for more commands
Change-Id: Iddff64502ba357dcd36903d31015b9ae2d00ae62
Diffstat (limited to 'utils/imxtools/scsitools')
-rw-r--r--utils/imxtools/scsitools/misc.h1
-rw-r--r--utils/imxtools/scsitools/scsitool.c402
-rw-r--r--utils/imxtools/scsitools/stmp_scsi.h64
3 files changed, 459 insertions, 8 deletions
diff --git a/utils/imxtools/scsitools/misc.h b/utils/imxtools/scsitools/misc.h
index 035b0ef8c1..0ff5bdae50 100644
--- a/utils/imxtools/scsitools/misc.h
+++ b/utils/imxtools/scsitools/misc.h
@@ -46,5 +46,6 @@ void enable_color(bool enable);
#define cprintf(col, ...) do {color(col); printf(__VA_ARGS__); }while(0)
#define cprintf_field(str1, ...) do{ cprintf(GREEN, str1); cprintf(YELLOW, __VA_ARGS__); }while(0)
+#define cprintf_field2(str1, ...) do{ cprintf(BLUE, str1); cprintf(RED, __VA_ARGS__); }while(0)
#endif /* __MISC_H__ */
diff --git a/utils/imxtools/scsitools/scsitool.c b/utils/imxtools/scsitools/scsitool.c
index c534667f05..8ef2774f32 100644
--- a/utils/imxtools/scsitools/scsitool.c
+++ b/utils/imxtools/scsitools/scsitool.c
@@ -76,6 +76,21 @@ void *buffer_alloc(int sz)
}
#endif
+static uint16_t fix_endian16be(uint16_t w)
+{
+ return w << 8 | w >> 8;
+}
+
+static uint32_t fix_endian32be(uint32_t w)
+{
+ return __builtin_bswap32(w);
+}
+
+static uint64_t fix_endian64be(uint64_t w)
+{
+ return __builtin_bswap64(w);
+}
+
static void print_hex(void *_buffer, int buffer_size)
{
uint8_t *buffer = _buffer;
@@ -158,7 +173,7 @@ int do_scsi(uint8_t *cdb, int cdb_size, unsigned flags, void *sense, int *sense_
int do_sense_analysis(int status, uint8_t *sense, int sense_size)
{
- if(status != GOOD || g_debug)
+ if(status != GOOD && g_debug)
{
cprintf_field("Status:", " "); fflush(stdout);
sg_print_scsi_status(status);
@@ -200,11 +215,11 @@ int stmp_inquiry(uint8_t *dev_type, char vendor[9], char product[17])
static int stmp_get_protocol_version(struct scsi_stmp_protocol_version_t *ver)
{
- uint8_t cdb[10];
+ uint8_t cdb[16];
memset(cdb, 0, sizeof(cdb));
cdb[0] = SCSI_STMP_READ;
cdb[1] = SCSI_STMP_CMD_GET_PROTOCOL_VERSION;
-
+
uint8_t sense[32];
int sense_size = sizeof(sense);
@@ -220,6 +235,115 @@ static int stmp_get_protocol_version(struct scsi_stmp_protocol_version_t *ver)
return 0;
}
+static int stmp_get_chip_major_rev_id(struct scsi_stmp_chip_major_rev_id_t *ver)
+{
+ uint8_t cdb[16];
+ memset(cdb, 0, sizeof(cdb));
+ cdb[0] = SCSI_STMP_READ;
+ cdb[1] = SCSI_STMP_CMD_GET_CHIP_MAJOR_REV_ID;
+
+ uint8_t sense[32];
+ int sense_size = sizeof(sense);
+
+ int buf_sz = sizeof(struct scsi_stmp_chip_major_rev_id_t);
+ int ret = do_scsi(cdb, sizeof(cdb), DO_READ, sense, &sense_size, ver, &buf_sz);
+ if(ret < 0)
+ return ret;
+ ret = do_sense_analysis(ret, sense, sense_size);
+ if(ret)
+ return ret;
+ if(buf_sz != sizeof(struct scsi_stmp_chip_major_rev_id_t))
+ return -1;
+ ver->rev = fix_endian16be(ver->rev);
+ return 0;
+}
+
+static int stmp_get_rom_rev_id(struct scsi_stmp_rom_rev_id_t *ver)
+{
+ uint8_t cdb[16];
+ memset(cdb, 0, sizeof(cdb));
+ cdb[0] = SCSI_STMP_READ;
+ cdb[1] = SCSI_STMP_CMD_GET_ROM_REV_ID;
+
+ uint8_t sense[32];
+ int sense_size = sizeof(sense);
+
+ int buf_sz = sizeof(struct scsi_stmp_rom_rev_id_t);
+ int ret = do_scsi(cdb, sizeof(cdb), DO_READ, sense, &sense_size, ver, &buf_sz);
+ if(ret < 0)
+ return ret;
+ ret = do_sense_analysis(ret, sense, sense_size);
+ if(ret)
+ return ret;
+ if(buf_sz != sizeof(struct scsi_stmp_rom_rev_id_t))
+ return -1;
+ ver->rev = fix_endian16be(ver->rev);
+ return 0;
+}
+
+static int stmp_get_logical_media_info(uint8_t info, void *data, int *len)
+{
+ uint8_t cdb[16];
+ memset(cdb, 0, sizeof(cdb));
+ cdb[0] = SCSI_STMP_READ;
+ cdb[1] = SCSI_STMP_CMD_GET_LOGICAL_MEDIA_INFO;
+ cdb[2] = info;
+
+ uint8_t sense[32];
+ int sense_size = sizeof(sense);
+
+ int ret = do_scsi(cdb, sizeof(cdb), DO_READ, sense, &sense_size, data, len);
+ if(ret < 0)
+ return ret;
+ return do_sense_analysis(ret, sense, sense_size);
+}
+
+static int stmp_get_logical_table(struct scsi_stmp_logical_table_t *table, int entry_count)
+{
+ uint8_t cdb[16];
+ memset(cdb, 0, sizeof(cdb));
+ cdb[0] = SCSI_STMP_READ;
+ cdb[1] = SCSI_STMP_CMD_GET_LOGICAL_TABLE;
+ cdb[2] = entry_count;
+
+ uint8_t sense[32];
+ int sense_size = sizeof(sense);
+
+ int buf_sz = sizeof(struct scsi_stmp_logical_table_t) +
+ entry_count * sizeof(struct scsi_stmp_logical_table_entry_t);
+ int ret = do_scsi(cdb, sizeof(cdb), DO_READ, sense, &sense_size, table, &buf_sz);
+ if(ret < 0)
+ return ret;
+ ret = do_sense_analysis(ret, sense, sense_size);
+ if(ret)
+ return ret;
+ if((buf_sz - sizeof(struct scsi_stmp_logical_table_t)) % sizeof(struct scsi_stmp_logical_table_entry_t))
+ return -1;
+ table->count = fix_endian16be(table->count);
+ struct scsi_stmp_logical_table_entry_t *entry = (void *)(table + 1);
+ for(int i = 0; i < entry_count; i++)
+ entry[i].size = fix_endian64be(entry[i].size);
+ return 0;
+}
+
+static int stmp_get_logical_drive_info(uint8_t drive, uint8_t info, void *data, int *len)
+{
+ uint8_t cdb[16];
+ memset(cdb, 0, sizeof(cdb));
+ cdb[0] = SCSI_STMP_READ;
+ cdb[1] = SCSI_STMP_CMD_GET_LOGICAL_DRIVE_INFO;
+ cdb[2] = drive;
+ cdb[3] = info;
+
+ uint8_t sense[32];
+ int sense_size = sizeof(sense);
+
+ int ret = do_scsi(cdb, sizeof(cdb), DO_READ, sense, &sense_size, data, len);
+ if(ret < 0)
+ return ret;
+ return do_sense_analysis(ret, sense, sense_size);
+}
+
static int do_work(void)
{
cprintf(BLUE, "Information\n");
@@ -229,16 +353,278 @@ static int do_work(void)
char product[17];
int ret = stmp_inquiry(&dev_type, vendor, product);
if(ret)
- errorf("Cannot get inquiry data: %d\n", ret);
- cprintf_field(" Vendor: ", "%s\n", vendor);
- cprintf_field(" Product: ", "%s\n", product);
+ {
+ cprintf(GREY, "Cannot get inquiry data: %d\n", ret);
+ }
+ else
+ {
+ cprintf_field(" Vendor: ", "%s\n", vendor);
+ cprintf_field(" Product: ", "%s\n", product);
+ }
struct scsi_stmp_protocol_version_t ver;
ret = stmp_get_protocol_version(&ver);
if(ret)
- errorf("Cannot get protocol version: %d\n", ret);
+ cprintf(GREY, "Cannot get protocol version: %d\n", ret);
+ else
+ cprintf_field(" Protocol: ", "%x.%x\n", ver.major, ver.minor);
+
+ do
+ {
+ union
+ {
+ uint8_t u8;
+ uint16_t u16;
+ uint32_t u32;
+ uint64_t u64;
+ uint8_t buf[52];
+ }u;
+
+ int len = 2;
+ ret = stmp_get_logical_media_info(0, &u.u16, &len);
+ if(!ret && len == 2)
+ {
+ u.u16 = fix_endian16be(u.u16);
+ cprintf_field(" Logical Media Info (0): ", "%#x\n", u.u16);
+ }
+
+ len = 4;
+ ret = stmp_get_logical_media_info(6, &u.u32, &len);
+ if(!ret && len == 4)
+ {
+ u.u32 = fix_endian32be(u.u32);
+ cprintf_field(" Logical Media Info (6): ", "%#x\n", u.u32);
+ }
+
+ len = 1;
+ ret = stmp_get_logical_media_info(5, &u.u8, &len);
+ if(!ret && len == 1)
+ cprintf_field(" Logical Media Info (5): ", "%#x\n", u.u8);
+
+ len = 8;
+ ret = stmp_get_logical_media_info(1, &u.u64, &len);
+ if(!ret && len == 8)
+ {
+ u.u64 = fix_endian64be(u.u64);
+ cprintf_field(" Logical Media Info (1): ", "%#llx\n", u.u64);
+ }
+
+ len = 4;
+ ret = stmp_get_logical_media_info(7, &u.u32, &len);
+ if(!ret && len == 4)
+ {
+ u.u32 = fix_endian32be(u.u32);
+ cprintf_field(" Logical Media Info (7): ", "%#x\n", u.u32);
+ }
+
+ len = 52;
+ ret = stmp_get_logical_media_info(8, &u.buf, &len);
+ if(!ret && len != 0)
+ {
+ cprintf(GREEN, " Logical Media Info (8):");
+ /*
+ for(int i = 0; i < len; i++)
+ cprintf(YELLOW, " %02x", u.buf[i]);
+ printf("\n");
+ */
+ print_hex(u.buf, len);
+ }
+
+ len = 1;
+ ret = stmp_get_logical_media_info(9, &u.u8, &len);
+ if(!ret && len == 1)
+ cprintf_field(" Logical Media Info (9): ", "%#x\n", u.u8);
+
+ len = 4;
+ ret = stmp_get_logical_media_info(12, &u.u32, &len);
+ if(!ret && len == 4)
+ {
+ u.u32 = fix_endian32be(u.u32);
+ cprintf_field(" Logical Media Info (12): ", "%#x\n", u.u32);
+ }
+
+ len = 8;
+ ret = stmp_get_logical_media_info(13, &u.u64, &len);
+ if(!ret && len == 8)
+ {
+ u.u64 = fix_endian64be(u.u64);
+ cprintf_field(" Logical Media Info (13): ", "%#llx\n", u.u64);
+ }
+
+ len = 4;
+ ret = stmp_get_logical_media_info(11, &u.u32, &len);
+ if(!ret && len == 4)
+ {
+ u.u32 = fix_endian32be(u.u32);
+ cprintf_field(" Logical Media Info (11): ", "%#x\n", u.u32);
+ }
+
+ len = 4;
+ ret = stmp_get_logical_media_info(14, &u.u32, &len);
+ if(!ret && len == 4)
+ {
+ u.u32 = fix_endian32be(u.u32);
+ cprintf_field(" Logical Media Info (14): ", "%#x\n", u.u32);
+ }
+ }while(0);
+
+ struct scsi_stmp_chip_major_rev_id_t chip_rev;
+ ret = stmp_get_chip_major_rev_id(&chip_rev);
+ if(ret)
+ cprintf(GREY, "Cannot get chip major revision id: %d\n", ret);
+ else
+ cprintf_field(" Chip Major Rev ID: ", "%x\n", chip_rev.rev);
- cprintf_field(" Protocol: ", "%x.%x\n", ver.major, ver.minor);
+ struct scsi_stmp_rom_rev_id_t rom_rev;
+ ret = stmp_get_rom_rev_id(&rom_rev);
+ if(ret)
+ cprintf(GREY, "Cannot get rom revision id: %d\n", ret);
+ else
+ cprintf_field(" ROM Rev ID: ", "%x\n", rom_rev.rev);
+
+ struct
+ {
+ struct scsi_stmp_logical_table_t header;
+ struct scsi_stmp_logical_table_entry_t entry[20];
+ }table;
+
+ ret = stmp_get_logical_table(&table.header, sizeof(table.entry) / sizeof(table.entry[0]));
+ if(ret)
+ cprintf(GREY, "Cannot get logical table: %d\n", ret);
+ else
+ {
+ cprintf_field(" Logical Table: ", "%d entries\n", table.header.count);
+ for(int i = 0; i < table.header.count; i++)
+ {
+ cprintf_field2(" Drive No: ", "%2x", table.entry[i].drive_no);
+ cprintf_field2(" Type: ", "%2x", table.entry[i].type);
+ cprintf_field2(" Tag: ", "%2x", table.entry[i].tag);
+ unsigned long long size = table.entry[i].size;
+ int order = 0;
+ while(size >= 1024)
+ {
+ size /= 1024;
+ order++;
+ }
+ static const char *suffix[] = {"B", "KiB", "MiB", "GiB", "TiB"};
+ cprintf_field2(" Size: ", "%llu %s", size, suffix[order]);
+ cprintf(OFF, "\n");
+ }
+
+ for(int i = 0; i < table.header.count; i++)
+ {
+ union
+ {
+ uint8_t u8;
+ uint16_t u16;
+ uint32_t u32;
+ uint64_t u64;
+ uint8_t buf[52];
+ }u;
+ uint8_t drive = table.entry[i].drive_no;
+ cprintf_field(" Drive ", "%02x\n", drive);
+
+ int len = 4;
+ ret = stmp_get_logical_drive_info(drive, 0, &u.u32, &len);
+ if(!ret && len == 4)
+ {
+ u.u32 = fix_endian32be(u.u32);
+ cprintf_field(" Info 0: ", "%#x\n", u.u32);
+ }
+
+ len = 4;
+ ret = stmp_get_logical_drive_info(drive, 1, &u.u32, &len);
+ if(!ret && len == 4)
+ {
+ u.u32 = fix_endian32be(u.u32);
+ cprintf_field(" Info 1: ", "%#x\n", u.u32);
+ }
+
+ len = 8;
+ ret = stmp_get_logical_drive_info(drive, 2, &u.u64, &len);
+ if(!ret && len == 8)
+ {
+ u.u64 = fix_endian64be(u.u64);
+ cprintf_field(" Info 2: ", "%#llx\n", u.u64);
+ }
+
+ len = 4;
+ ret = stmp_get_logical_drive_info(drive, 3, &u.u32, &len);
+ if(!ret && len == 4)
+ {
+ u.u32 = fix_endian32be(u.u32);
+ cprintf_field(" Info 3: ", "%#x\n", u.u32);
+ }
+
+ len = 8;
+ ret = stmp_get_logical_drive_info(drive, 4, &u.u64, &len);
+ if(!ret && len == 8)
+ {
+ u.u64 = fix_endian64be(u.u64);
+ cprintf_field(" Info 4: ", "%#llx\n", u.u64);
+ }
+
+ len = 4;
+ ret = stmp_get_logical_drive_info(drive, 5, &u.u32, &len);
+ if(!ret && len == 4)
+ {
+ u.u32 = fix_endian32be(u.u32);
+ cprintf_field(" Info 5: ", "%#x\n", u.u32);
+ }
+
+ len = 1;
+ ret = stmp_get_logical_drive_info(drive, 6, &u.u8, &len);
+ if(!ret && len == 1)
+ {
+ cprintf_field(" Info 6: ", "%#x\n", u.u8);
+ }
+
+ len = 52;
+ ret = stmp_get_logical_drive_info(drive, 7, &u.buf, &len);
+ if(!ret && len != 0)
+ {
+ cprintf(GREEN, " Info 7:");
+ for(int i = 0; i < len; i++)
+ cprintf(YELLOW, " %02x", u.buf[i]);
+ printf("\n");
+ }
+
+ len = 52;
+ ret = stmp_get_logical_drive_info(drive, 8, &u.buf, &len);
+ if(!ret && len != 0)
+ {
+ cprintf(GREEN, " Info 8:");
+ for(int i = 0; i < len; i++)
+ cprintf(YELLOW, " %02x", u.buf[i]);
+ printf("\n");
+ }
+
+ len = 1;
+ ret = stmp_get_logical_drive_info(drive, 9, &u.u8, &len);
+ if(!ret && len == 1)
+ {
+ cprintf_field(" Info 9: ", "%#x\n", u.u8);
+ }
+
+ len = 2;
+ ret = stmp_get_logical_drive_info(drive, 10, &u.u16, &len);
+ if(!ret && len == 2)
+ {
+ u.u16 = fix_endian16be(u.u16);
+ cprintf_field(" Info 10: ", "%#x\n", u.u16);
+ }
+
+ len = 52;
+ ret = stmp_get_logical_drive_info(drive, 11, &u.buf, &len);
+ if(!ret && len != 0)
+ {
+ cprintf(GREEN, " Info 11:");
+ for(int i = 0; i < len; i++)
+ cprintf(YELLOW, " %02x", u.buf[i]);
+ printf("\n");
+ }
+ }
+ }
return 0;
}
diff --git a/utils/imxtools/scsitools/stmp_scsi.h b/utils/imxtools/scsitools/stmp_scsi.h
index 14f651f6dd..0b7453e70b 100644
--- a/utils/imxtools/scsitools/stmp_scsi.h
+++ b/utils/imxtools/scsitools/stmp_scsi.h
@@ -39,4 +39,68 @@ struct scsi_stmp_protocol_version_t
uint8_t minor;
} __attribute__((packed));
+struct scsi_stmp_rom_rev_id_t
+{
+ uint16_t rev; /* big-endian */
+} __attribute__((packed));
+
+struct scsi_stmp_chip_major_rev_id_t
+{
+ uint16_t rev; /* big-endian */
+} __attribute__((packed));
+
+struct scsi_stmp_logical_table_entry_t
+{
+ uint8_t drive_no;
+ uint8_t type;
+ uint8_t tag;
+ uint64_t size; /* big-endian */
+} __attribute__((packed));
+
+struct scsi_stmp_logical_table_t
+{
+ uint16_t count; /* big-endian */
+} __attribute__((packed));
+
+#define SCSI_STMP_MEDIA_INFO_TYPE 6
+#define SCSI_STMP_MEDIA_INFO_VENDOR 12
+
+#define SCSI_STMP_MEDIA_TYPE_NAND 0
+#define SCSI_STMP_MEDIA_TYPE_SDMMC 1
+#define SCSI_STMP_MEDIA_TYPE_HDD 2
+#define SCSI_STMP_MEDIA_TYPE_RAM 3
+#define SCSI_STMP_MEDIA_TYPE_iNAND 4
+
+#define SCSI_STMP_MEDIA_VENDOR_SAMSUNG 0xEC
+#define SCSI_STMP_MEDIA_VENDOR_STMICRO 0x20
+#define SCSI_STMP_MEDIA_VENDOR_HYNIX 0xAD
+#define SCSI_STMP_MEDIA_VENDOR_MICRON 0x2C
+#define SCSI_STMP_MEDIA_VENDOR_TOSHIBA 0x98
+#define SCSI_STMP_MEDIA_VENDOR_RENESAS 0x07
+#define SCSI_STMP_MEDIA_VENDOR_SANDISK 0x45
+#define SCSI_STMP_MEDIA_VENDOR_INTEL 0x89
+
+struct scsi_stmp_logical_media_info_type_t
+{
+ uint8_t type;
+} __attribute__((packed));
+
+struct scsi_stmp_logical_media_info_manufacturer_t
+{
+ uint32_t type; /* big-endian */
+} __attribute__((packed));
+
+#define SCSI_STMP_DRIVE_INFO_SIZE 2
+#define SCSI_STMP_DRIVE_INFO_TYPE 5
+
+struct scsi_stmp_logical_drive_info_size_t
+{
+ uint64_t size; /* big-endian */
+} __attribute__((packed));
+
+struct scsi_stmp_logical_drive_info_type_t
+{
+ uint8_t type;
+} __attribute__((packed));
+
#endif /* __STMP_SCSI__ */