int
sg_normalize_sense(const struct sg_io_hdr * hp,
struct sg_scsi_sense_hdr * sshp)
{
if ((NULL == hp) || (0 == hp->sb_len_wr)) {
if (sshp)
memset(sshp, 0, sizeof(struct sg_scsi_sense_hdr));
return 0;
}
return sg_scsi_normalize_sense(hp->sbp, hp->sb_len_wr, sshp);
}
static int
do_read_gplog(int sg_fd, int ata_cmd, unsigned char *inbuff,
const struct opts_t * op)
{
int res, ret;
int extend = 1;
int protocol;
int t_dir = 1; /* 0 -> to device, 1 -> from device */
int byte_block = 1; /* 0 -> bytes, 1 -> 512 byte blocks */
int t_length = 2; /* 0 -> no data transferred, 2 -> sector count */
int t_type = 0; /* 0 -> 512 byte blocks, 1 -> logical sectors */
int resid = 0;
int got_ard = 0; /* got ATA result descriptor */
int sb_sz;
struct sg_scsi_sense_hdr ssh;
unsigned char sense_buffer[64];
unsigned char ata_return_desc[16];
unsigned char apt_cdb[SAT_ATA_PASS_THROUGH16_LEN] =
{SAT_ATA_PASS_THROUGH16, 0, 0, 0, 0, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0};
unsigned char apt12_cdb[SAT_ATA_PASS_THROUGH12_LEN] =
{SAT_ATA_PASS_THROUGH12, 0, 0, 0, 0, 0, 0, 0,
0, 0, 0, 0};
char cmd_name[32];
snprintf(cmd_name, sizeof(cmd_name), "ATA PASS-THROUGH (%d)",
op->cdb_len);
if (ata_cmd == ATA_READ_LOG_DMA_EXT) {
protocol = 6; /* DMA */
} else {
protocol = 4; /* PIO Data-In */
}
sb_sz = sizeof(sense_buffer);
memset(sense_buffer, 0, sb_sz);
memset(ata_return_desc, 0, sizeof(ata_return_desc));
memset(inbuff, 0, op->count * 512);
if (op->verbose > 1)
pr2serr("Building ATA READ LOG%s EXT command; la=0x%x, pn=0x%x\n",
((ata_cmd == ATA_READ_LOG_DMA_EXT) ? " DMA" : ""), op->la,
op->pn);
if (op->cdb_len == 16) {
/* Prepare ATA PASS-THROUGH COMMAND (16) command */
apt_cdb[14] = ata_cmd;
sg_put_unaligned_be16((uint16_t)op->count, apt_cdb + 5);
apt_cdb[8] = op->la;
sg_put_unaligned_be16((uint16_t)op->pn, apt_cdb + 9);
apt_cdb[1] = (protocol << 1) | extend;
apt_cdb[2] = (op->ck_cond << 5) | (t_type << 4) | (t_dir << 3) |
(byte_block << 2) | t_length;
res = sg_ll_ata_pt(sg_fd, apt_cdb, op->cdb_len, DEF_TIMEOUT, inbuff,
NULL, op->count * 512, sense_buffer,
sb_sz, ata_return_desc,
sizeof(ata_return_desc), &resid, op->verbose);
} else {
/* Prepare ATA PASS-THROUGH COMMAND (12) command */
/* Cannot map upper 8 bits of the pn since no LBA (39:32) field */
apt12_cdb[9] = ata_cmd;
apt12_cdb[4] = op->count;
apt12_cdb[5] = op->la;
apt12_cdb[6] = op->pn & 0xff;
/* apt12_cdb[7] = (op->pn >> 8) & 0xff; */
apt12_cdb[1] = (protocol << 1);
apt12_cdb[2] = (op->ck_cond << 5) | (t_type << 4) | (t_dir << 3) |
(byte_block << 2) | t_length;
res = sg_ll_ata_pt(sg_fd, apt12_cdb, op->cdb_len, DEF_TIMEOUT,
inbuff, NULL, op->count * 512, sense_buffer,
sb_sz, ata_return_desc,
sizeof(ata_return_desc), &resid, op->verbose);
}
if (0 == res) {
if (op->verbose > 2)
pr2serr("command completed with SCSI GOOD status\n");
if ((0 == op->hex) || (2 == op->hex))
dWordHex((const unsigned short *)inbuff, op->count * 256, 0,
sg_is_big_endian());
else if (1 == op->hex)
dStrHex((const char *)inbuff, 512, 0);
else if (3 == op->hex) /* '-HHH' suitable for "hdparm --Istdin" */
dWordHex((const unsigned short *)inbuff, 256, -2,
sg_is_big_endian());
else /* '-HHHH' hex bytes only */
dStrHex((const char *)inbuff, 512, -1);
} else if ((res > 0) && (res & SAM_STAT_CHECK_CONDITION)) {
if (op->verbose > 1) {
pr2serr("ATA pass through:\n");
sg_print_sense(NULL, sense_buffer, sb_sz,
((op->verbose > 2) ? 1 : 0));
}
if (sg_scsi_normalize_sense(sense_buffer, sb_sz, &ssh)) {
switch (ssh.sense_key) {
case SPC_SK_ILLEGAL_REQUEST:
if ((0x20 == ssh.asc) && (0x0 == ssh.ascq)) {
ret = SG_LIB_CAT_INVALID_OP;
if (op->verbose < 2)
pr2serr("%s not supported\n", cmd_name);
} else {
ret = SG_LIB_CAT_ILLEGAL_REQ;
if (op->verbose < 2)
pr2serr("%s, bad field in cdb\n", cmd_name);
}
return ret;
case SPC_SK_NO_SENSE:
case SPC_SK_RECOVERED_ERROR:
if ((0x0 == ssh.asc) &&
(ASCQ_ATA_PT_INFO_AVAILABLE == ssh.ascq)) {
if (SAT_ATA_RETURN_DESC != ata_return_desc[0]) {
if (op->verbose)
pr2serr("did not find ATA Return (sense) "
"Descriptor\n");
return SG_LIB_CAT_RECOVERED;
}
got_ard = 1;
break;
} else if (SPC_SK_RECOVERED_ERROR == ssh.sense_key)
return SG_LIB_CAT_RECOVERED;
else {
if ((0x0 == ssh.asc) && (0x0 == ssh.ascq))
break;
return SG_LIB_CAT_SENSE;
}
case SPC_SK_UNIT_ATTENTION:
if (op->verbose < 2)
pr2serr("%s, Unit Attention detected\n", cmd_name);
return SG_LIB_CAT_UNIT_ATTENTION;
case SPC_SK_NOT_READY:
if (op->verbose < 2)
pr2serr("%s, device not ready\n", cmd_name);
return SG_LIB_CAT_NOT_READY;
case SPC_SK_MEDIUM_ERROR:
case SPC_SK_HARDWARE_ERROR:
if (op->verbose < 2)
pr2serr("%s, medium or hardware error\n", cmd_name);
return SG_LIB_CAT_MEDIUM_HARD;
case SPC_SK_ABORTED_COMMAND:
if (0x10 == ssh.asc) {
pr2serr("Aborted command: protection information\n");
return SG_LIB_CAT_PROTECTION;
} else {
pr2serr("Aborted command\n");
return SG_LIB_CAT_ABORTED_COMMAND;
}
case SPC_SK_DATA_PROTECT:
pr2serr("%s: data protect, read only media?\n", cmd_name);
return SG_LIB_CAT_DATA_PROTECT;
default:
if (op->verbose < 2)
pr2serr("%s, some sense data, use '-v' for more "
"information\n", cmd_name);
return SG_LIB_CAT_SENSE;
}
} else {
pr2serr("CHECK CONDITION without response code ??\n");
return SG_LIB_CAT_SENSE;
}
if (0x72 != (sense_buffer[0] & 0x7f)) {
pr2serr("expected descriptor sense format, response "
"code=0x%x\n", sense_buffer[0]);
return SG_LIB_CAT_MALFORMED;
}
} else if (res > 0) {
if (SAM_STAT_RESERVATION_CONFLICT == res) {
pr2serr("SCSI status: RESERVATION CONFLICT\n");
return SG_LIB_CAT_RES_CONFLICT;
} else {
pr2serr("Unexpected SCSI status=0x%x\n", res);
return SG_LIB_CAT_MALFORMED;
}
} else {
pr2serr("%s failed\n", cmd_name);
if (op->verbose < 2)
pr2serr(" try adding '-v' for more information\n");
return -1;
}
if ((SAT_ATA_RETURN_DESC == ata_return_desc[0]) && (0 == got_ard))
pr2serr("Seem to have got ATA Result Descriptor but it was not "
"indicated\n");
if (got_ard) {
if (ata_return_desc[3] & 0x4) {
pr2serr("error indication in returned FIS: aborted "
"command\n");
return SG_LIB_CAT_ABORTED_COMMAND;
}
}
return 0;
}
static int
do_identify_dev(int sg_fd, bool do_packet, int cdb_len, bool ck_cond,
bool extend, bool do_ident, int do_hex, bool do_raw,
int verbose)
{
bool t_type = false;/* false -> 512 byte blocks,
true -> device's LB size */
bool t_dir = true; /* false -> to device, true -> from device */
bool byte_block = true; /* false -> bytes, true -> 512 byte blocks (if
t_type=false) */
bool got_ard = false; /* got ATA result descriptor */
bool got_fixsense = false; /* got ATA result in fixed format sense */
bool ok;
int j, res, ret, sb_sz;
/* Following for ATA READ/WRITE MULTIPLE (EXT) cmds, normally 0 */
int multiple_count = 0;
int protocol = 4; /* PIO data-in */
int t_length = 2; /* 0 -> no data transferred, 2 -> sector count */
int resid = 0;
uint64_t ull;
struct sg_scsi_sense_hdr ssh;
uint8_t inBuff[ID_RESPONSE_LEN];
uint8_t sense_buffer[64];
uint8_t ata_return_desc[16];
uint8_t apt_cdb[SAT_ATA_PASS_THROUGH16_LEN] =
{SAT_ATA_PASS_THROUGH16, 0, 0, 0, 0, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0};
uint8_t apt12_cdb[SAT_ATA_PASS_THROUGH12_LEN] =
{SAT_ATA_PASS_THROUGH12, 0, 0, 0, 0, 0, 0, 0,
0, 0, 0, 0};
uint8_t apt32_cdb[SAT_ATA_PASS_THROUGH32_LEN];
const unsigned short * usp;
sb_sz = sizeof(sense_buffer);
memset(sense_buffer, 0, sb_sz);
memset(apt32_cdb, 0, sizeof(apt32_cdb));
memset(ata_return_desc, 0, sizeof(ata_return_desc));
ok = false;
switch (cdb_len) {
case SAT_ATA_PASS_THROUGH32_LEN: /* SAT-4 revision 5 or later */
/* Prepare SCSI ATA PASS-THROUGH COMMAND(32) command */
sg_put_unaligned_be16(1, apt32_cdb + 22); /* count=1 */
apt32_cdb[25] = (do_packet ? ATA_IDENTIFY_PACKET_DEVICE :
ATA_IDENTIFY_DEVICE);
apt32_cdb[10] = (multiple_count << 5) | (protocol << 1);
if (extend)
apt32_cdb[10] |= 0x1;
apt32_cdb[11] = t_length;
if (ck_cond)
apt32_cdb[11] |= 0x20;
if (t_type)
apt32_cdb[11] |= 0x10;
if (t_dir)
apt32_cdb[11] |= 0x8;
if (byte_block)
apt32_cdb[11] |= 0x4;
/* following call takes care of all bytes below offset 10 in cdb */
res = sg_ll_ata_pt(sg_fd, apt32_cdb, cdb_len, DEF_TIMEOUT, inBuff,
NULL /* doutp */, ID_RESPONSE_LEN, sense_buffer,
sb_sz, ata_return_desc,
sizeof(ata_return_desc), &resid, verbose);
break;
case SAT_ATA_PASS_THROUGH16_LEN:
/* Prepare SCSI ATA PASS-THROUGH COMMAND(16) command */
apt_cdb[6] = 1; /* sector count */
apt_cdb[14] = (do_packet ? ATA_IDENTIFY_PACKET_DEVICE :
ATA_IDENTIFY_DEVICE);
apt_cdb[1] = (multiple_count << 5) | (protocol << 1);
if (extend)
apt_cdb[1] |= 0x1;
apt_cdb[2] = t_length;
if (ck_cond)
apt_cdb[2] |= 0x20;
if (t_type)
apt_cdb[2] |= 0x10;
if (t_dir)
apt_cdb[2] |= 0x8;
if (byte_block)
apt_cdb[2] |= 0x4;
res = sg_ll_ata_pt(sg_fd, apt_cdb, cdb_len, DEF_TIMEOUT, inBuff,
NULL /* doutp */, ID_RESPONSE_LEN, sense_buffer,
sb_sz, ata_return_desc,
sizeof(ata_return_desc), &resid, verbose);
break;
case SAT_ATA_PASS_THROUGH12_LEN:
/* Prepare SCSI ATA PASS-THROUGH COMMAND(12) command */
apt12_cdb[4] = 1; /* sector count */
apt12_cdb[9] = (do_packet ? ATA_IDENTIFY_PACKET_DEVICE :
ATA_IDENTIFY_DEVICE);
apt12_cdb[1] = (multiple_count << 5) | (protocol << 1);
apt12_cdb[2] = t_length;
if (ck_cond)
apt12_cdb[2] |= 0x20;
if (t_type)
apt12_cdb[2] |= 0x10;
if (t_dir)
apt12_cdb[2] |= 0x8;
if (byte_block)
apt12_cdb[2] |= 0x4;
res = sg_ll_ata_pt(sg_fd, apt12_cdb, cdb_len, DEF_TIMEOUT, inBuff,
NULL /* doutp */, ID_RESPONSE_LEN, sense_buffer,
sb_sz, ata_return_desc,
sizeof(ata_return_desc), &resid, verbose);
break;
default:
pr2serr("%s: bad cdb_len=%d\n", __func__, cdb_len);
return -1;
}
if (0 == res) {
ok = true;
if (verbose > 2)
pr2serr("command completed with SCSI GOOD status\n");
} else if ((res > 0) && (res & SAM_STAT_CHECK_CONDITION)) {
if (verbose > 1) {
pr2serr("ATA pass-through:\n");
sg_print_sense(NULL, sense_buffer, sb_sz,
((verbose > 2) ? 1 : 0));
}
if (sg_scsi_normalize_sense(sense_buffer, sb_sz, &ssh)) {
switch (ssh.sense_key) {
case SPC_SK_ILLEGAL_REQUEST:
if ((0x20 == ssh.asc) && (0x0 == ssh.ascq)) {
ret = SG_LIB_CAT_INVALID_OP;
if (verbose < 2)
pr2serr("ATA PASS-THROUGH (%d) not supported\n",
cdb_len);
} else {
ret = SG_LIB_CAT_ILLEGAL_REQ;
if (verbose < 2)
pr2serr("ATA PASS-THROUGH (%d), bad field in cdb\n",
cdb_len);
}
return ret;
case SPC_SK_NO_SENSE:
case SPC_SK_RECOVERED_ERROR:
if ((0x0 == ssh.asc) &&
(ASCQ_ATA_PT_INFO_AVAILABLE == ssh.ascq)) {
if (0x72 == ssh.response_code) {
if (SAT_ATA_RETURN_DESC != ata_return_desc[0]) {
if (verbose)
pr2serr("did not find ATA Return (sense) "
"Descriptor\n");
return SG_LIB_CAT_RECOVERED;
}
got_ard = true;
break;
} else if (0x70 == ssh.response_code) {
got_fixsense = true;
break;
} else {
if (verbose < 2)
pr2serr("ATA PASS-THROUGH (%d), unexpected "
"response_code=0x%x\n", ssh.response_code,
cdb_len);
return SG_LIB_CAT_RECOVERED;
}
} else if (SPC_SK_RECOVERED_ERROR == ssh.sense_key)
return SG_LIB_CAT_RECOVERED;
else {
if ((0x0 == ssh.asc) && (0x0 == ssh.ascq))
break;
return SG_LIB_CAT_SENSE;
}
case SPC_SK_UNIT_ATTENTION:
if (verbose < 2)
pr2serr("ATA PASS-THROUGH (%d), Unit Attention detected\n",
cdb_len);
return SG_LIB_CAT_UNIT_ATTENTION;
case SPC_SK_NOT_READY:
if (verbose < 2)
pr2serr("ATA PASS-THROUGH (%d), device not ready\n",
cdb_len);
return SG_LIB_CAT_NOT_READY;
case SPC_SK_MEDIUM_ERROR:
case SPC_SK_HARDWARE_ERROR:
if (verbose < 2)
pr2serr("ATA PASS-THROUGH (%d), medium or hardware "
"error\n", cdb_len);
return SG_LIB_CAT_MEDIUM_HARD;
case SPC_SK_ABORTED_COMMAND:
if (0x10 == ssh.asc) {
pr2serr("Aborted command: protection information\n");
return SG_LIB_CAT_PROTECTION;
} else {
pr2serr("Aborted command: try again with%s '-p' option\n",
(do_packet ? "out" : ""));
return SG_LIB_CAT_ABORTED_COMMAND;
}
case SPC_SK_DATA_PROTECT:
pr2serr("ATA PASS-THROUGH (%d): data protect, read only "
"media?\n", cdb_len);
return SG_LIB_CAT_DATA_PROTECT;
default:
if (verbose < 2)
pr2serr("ATA PASS-THROUGH (%d), some sense data, use "
"'-v' for more information\n", cdb_len);
return SG_LIB_CAT_SENSE;
}
} else {
pr2serr("CHECK CONDITION without response code ??\n");
return SG_LIB_CAT_SENSE;
}
if (0x72 != (sense_buffer[0] & 0x7f)) {
pr2serr("expected descriptor sense format, response code=0x%x\n",
sense_buffer[0]);
return SG_LIB_CAT_MALFORMED;
}
} else if (res > 0) {
if (SAM_STAT_RESERVATION_CONFLICT == res) {
pr2serr("SCSI status: RESERVATION CONFLICT\n");
return SG_LIB_CAT_RES_CONFLICT;
} else {
pr2serr("Unexpected SCSI status=0x%x\n", res);
return SG_LIB_CAT_MALFORMED;
}
} else {
pr2serr("ATA pass-through (%d) failed\n", cdb_len);
if (verbose < 2)
pr2serr(" try adding '-v' for more information\n");
return -1;
}
if ((SAT_ATA_RETURN_DESC == ata_return_desc[0]) && (! got_ard))
pr2serr("Seem to have got ATA Result Descriptor but it was not "
"indicated\n");
if (got_ard) {
if (ata_return_desc[3] & 0x4) {
pr2serr("error indication in returned FIS: aborted command\n");
pr2serr(" try again with%s '-p' option\n",
(do_packet ? "out" : ""));
return SG_LIB_CAT_ABORTED_COMMAND;
}
ok = true;
}
if (got_fixsense) {
if (0x4 & sense_buffer[3]) { /* Error is MSB of Info field */
pr2serr("error indication in returned FIS: aborted command\n");
pr2serr(" try again with%s '-p' option\n",
(do_packet ? "out" : ""));
return SG_LIB_CAT_ABORTED_COMMAND;
}
ok = true;
}
if (ok) { /* output result if it is available */
if (do_raw)
dStrRaw(inBuff, 512);
else if (0 == do_hex) {
if (do_ident) {
usp = (const unsigned short *)inBuff;
ull = 0;
for (j = 0; j < 4; ++j) {
if (j > 0)
ull <<= 16;
ull |= usp[108 + j];
}
printf("0x%016" PRIx64 "\n", ull);
} else {
printf("Response for IDENTIFY %sDEVICE ATA command:\n",
(do_packet ? "PACKET " : ""));
dWordHex((const unsigned short *)inBuff, 256, 0,
sg_is_big_endian());
}
} else if (1 == do_hex)
hex2stdout(inBuff, 512, 0);
else if (2 == do_hex)
dWordHex((const unsigned short *)inBuff, 256, 0,
sg_is_big_endian());
else if (3 == do_hex) /* '-HHH' suitable for "hdparm --Istdin" */
dWordHex((const unsigned short *)inBuff, 256, -2,
sg_is_big_endian());
else /* '-HHHH' hex bytes only */
hex2stdout(inBuff, 512, -1);
}
return 0;
}
