From 8ed0d198c504f2c6984de7bcdc07163b89f87ef0 Mon Sep 17 00:00:00 2001 From: Amaury Pouly Date: Tue, 15 Jan 2013 19:42:20 +0000 Subject: imxtools/scsitools: add support for more commands Change-Id: Iddff64502ba357dcd36903d31015b9ae2d00ae62 --- utils/imxtools/scsitools/scsitool.c | 402 +++++++++++++++++++++++++++++++++++- 1 file changed, 394 insertions(+), 8 deletions(-) (limited to 'utils/imxtools/scsitools/scsitool.c') 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; } -- cgit v1.2.3