diff options
Diffstat (limited to 'lib/sg_cmds_mmc.c')
| -rw-r--r-- | lib/sg_cmds_mmc.c | 306 |
1 files changed, 306 insertions, 0 deletions
diff --git a/lib/sg_cmds_mmc.c b/lib/sg_cmds_mmc.c new file mode 100644 index 00000000..b5840118 --- /dev/null +++ b/lib/sg_cmds_mmc.c @@ -0,0 +1,306 @@ +/* + * Copyright (c) 2008 Douglas Gilbert. + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND + * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE + * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + */ + +#include <stdio.h> +#include <stdlib.h> +#include <string.h> +#include <unistd.h> +#define __STDC_FORMAT_MACROS 1 +#include <inttypes.h> + +#include "sg_lib.h" +#include "sg_cmds_basic.h" +#include "sg_cmds_mmc.h" +#include "sg_pt.h" + + + +#define SENSE_BUFF_LEN 32 /* Arbitrary, could be larger */ + +#define DEF_PT_TIMEOUT 60 /* 60 seconds */ + +#define GET_CONFIG_CMD 0x46 +#define GET_CONFIG_CMD_LEN 10 +#define GET_PERFORMANCE_CMD 0xac +#define GET_PERFORMANCE_CMD_LEN 12 +#define SET_CD_SPEED_CMD 0xbb +#define SET_CD_SPEED_CMDLEN 12 + + +/* Invokes a SCSI SET CD SPEED command (MMC). + * Return of 0 -> success, SG_LIB_CAT_INVALID_OP -> command not supported, + * SG_LIB_CAT_ILLEGAL_REQ -> bad field in cdb, SG_LIB_CAT_UNIT_ATTENTION, + * SG_LIB_CAT_NOT_READY -> device not ready, SG_LIB_CAT_ABORTED_COMMAND, + * -1 -> other failure */ +int +sg_ll_set_cd_speed(int sg_fd, int rot_control, int drv_read_speed, + int drv_write_speed, int noisy, int verbose) +{ + int res, ret, k, sense_cat; + unsigned char scsCmdBlk[SET_CD_SPEED_CMDLEN] = {SET_CD_SPEED_CMD, 0, + 0, 0, 0, 0, 0, 0, 0, 0, 0 ,0}; + unsigned char sense_b[SENSE_BUFF_LEN]; + struct sg_pt_base * ptvp; + + if (NULL == sg_warnings_strm) + sg_warnings_strm = stderr; + scsCmdBlk[1] |= (rot_control & 0x3); + scsCmdBlk[2] = (drv_read_speed >> 8) & 0xff; + scsCmdBlk[3] = drv_read_speed & 0xff; + scsCmdBlk[4] = (drv_write_speed >> 8) & 0xff; + scsCmdBlk[5] = drv_write_speed & 0xff; + + if (verbose) { + fprintf(sg_warnings_strm, " set cd speed cdb: "); + for (k = 0; k < SET_CD_SPEED_CMDLEN; ++k) + fprintf(sg_warnings_strm, "%02x ", scsCmdBlk[k]); + fprintf(sg_warnings_strm, "\n"); + } + ptvp = construct_scsi_pt_obj(); + if (NULL == ptvp) { + fprintf(sg_warnings_strm, "set cd speed: out of memory\n"); + return -1; + } + set_scsi_pt_cdb(ptvp, scsCmdBlk, sizeof(scsCmdBlk)); + set_scsi_pt_sense(ptvp, sense_b, sizeof(sense_b)); + res = do_scsi_pt(ptvp, sg_fd, DEF_PT_TIMEOUT, verbose); + ret = sg_cmds_process_resp(ptvp, "set cd speed", res, 0, + sense_b, noisy, verbose, &sense_cat); + if (-1 == ret) + ; + else if (-2 == ret) { + switch (sense_cat) { + case SG_LIB_CAT_NOT_READY: + case SG_LIB_CAT_UNIT_ATTENTION: + case SG_LIB_CAT_INVALID_OP: + case SG_LIB_CAT_ILLEGAL_REQ: + case SG_LIB_CAT_ABORTED_COMMAND: + ret = sense_cat; + break; + case SG_LIB_CAT_RECOVERED: + case SG_LIB_CAT_NO_SENSE: + ret = 0; + break; + default: + ret = -1; + break; + } + } else + ret = 0; + + destruct_scsi_pt_obj(ptvp); + return ret; +} + +/* Invokes a SCSI GET CONFIGURATION command (MMC-3,4,5). + * Returns 0 when successful, SG_LIB_CAT_INVALID_OP if command not + * supported, SG_LIB_CAT_ILLEGAL_REQ if field in cdb not supported, + * SG_LIB_CAT_UNIT_ATTENTION, SG_LIB_CAT_ABORTED_COMMAND, else -1 */ +int +sg_ll_get_config(int sg_fd, int rt, int starting, void * resp, + int mx_resp_len, int noisy, int verbose) +{ + int res, k, ret, sense_cat; + unsigned char gcCmdBlk[GET_CONFIG_CMD_LEN] = {GET_CONFIG_CMD, 0, 0, 0, + 0, 0, 0, 0, 0, 0}; + unsigned char sense_b[SENSE_BUFF_LEN]; + struct sg_pt_base * ptvp; + + if (NULL == sg_warnings_strm) + sg_warnings_strm = stderr; + if ((rt < 0) || (rt > 3)) { + fprintf(sg_warnings_strm, "Bad rt value: %d\n", rt); + return -1; + } + gcCmdBlk[1] = (rt & 0x3); + if ((starting < 0) || (starting > 0xffff)) { + fprintf(sg_warnings_strm, "Bad starting field number: 0x%x\n", + starting); + return -1; + } + gcCmdBlk[2] = (unsigned char)((starting >> 8) & 0xff); + gcCmdBlk[3] = (unsigned char)(starting & 0xff); + if ((mx_resp_len < 0) || (mx_resp_len > 0xffff)) { + fprintf(sg_warnings_strm, "Bad mx_resp_len: 0x%x\n", starting); + return -1; + } + gcCmdBlk[7] = (unsigned char)((mx_resp_len >> 8) & 0xff); + gcCmdBlk[8] = (unsigned char)(mx_resp_len & 0xff); + + if (verbose) { + fprintf(sg_warnings_strm, " Get Configuration cdb: "); + for (k = 0; k < GET_CONFIG_CMD_LEN; ++k) + fprintf(sg_warnings_strm, "%02x ", gcCmdBlk[k]); + fprintf(sg_warnings_strm, "\n"); + } + + ptvp = construct_scsi_pt_obj(); + if (NULL == ptvp) { + fprintf(sg_warnings_strm, "get configuration: out of memory\n"); + return -1; + } + set_scsi_pt_cdb(ptvp, gcCmdBlk, sizeof(gcCmdBlk)); + set_scsi_pt_sense(ptvp, sense_b, sizeof(sense_b)); + set_scsi_pt_data_in(ptvp, (unsigned char *)resp, mx_resp_len); + res = do_scsi_pt(ptvp, sg_fd, DEF_PT_TIMEOUT, verbose); + ret = sg_cmds_process_resp(ptvp, "get configuration", res, mx_resp_len, + sense_b, noisy, verbose, &sense_cat); + if (-1 == ret) + ; + else if (-2 == ret) { + switch (sense_cat) { + case SG_LIB_CAT_INVALID_OP: + case SG_LIB_CAT_ILLEGAL_REQ: + case SG_LIB_CAT_UNIT_ATTENTION: + case SG_LIB_CAT_ABORTED_COMMAND: + ret = sense_cat; + break; + case SG_LIB_CAT_RECOVERED: + case SG_LIB_CAT_NO_SENSE: + ret = 0; + break; + default: + ret = -1; + break; + } + } else { + if ((verbose > 2) && (ret > 3)) { + unsigned char * ucp; + int len; + + ucp = (unsigned char *)resp; + len = (ucp[0] << 24) + (ucp[1] << 16) + (ucp[2] << 8) + ucp[3] + + 4; + if (len < 0) + len = 0; + len = (ret < len) ? ret : len; + fprintf(sg_warnings_strm, " get configuration: response%s\n", + (len > 256 ? ", first 256 bytes" : "")); + dStrHex((const char *)resp, (len > 256 ? 256 : len), -1); + } + ret = 0; + } + destruct_scsi_pt_obj(ptvp); + return ret; +} + +/* Invokes a SCSI GET PERFORMANCE command (MMC-3...6). + * Returns 0 when successful, SG_LIB_CAT_INVALID_OP if command not + * supported, SG_LIB_CAT_ILLEGAL_REQ if field in cdb not supported, + * SG_LIB_CAT_UNIT_ATTENTION, SG_LIB_CAT_ABORTED_COMMAND, else -1 */ +int +sg_ll_get_performance(int sg_fd, int data_type, unsigned long starting_lba, + int max_num_desc, int ttype, void * resp, + int mx_resp_len, int noisy, int verbose) +{ + int res, k, ret, sense_cat; + unsigned char gpCmdBlk[GET_PERFORMANCE_CMD_LEN] = {GET_PERFORMANCE_CMD, 0, + 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; + unsigned char sense_b[SENSE_BUFF_LEN]; + struct sg_pt_base * ptvp; + + if (NULL == sg_warnings_strm) + sg_warnings_strm = stderr; + if ((data_type < 0) || (data_type > 0x1f)) { + fprintf(sg_warnings_strm, "Bad data_type value: %d\n", data_type); + return -1; + } + gpCmdBlk[1] = (data_type & 0x1f); + gpCmdBlk[2] = (unsigned char)((starting_lba >> 24) & 0xff); + gpCmdBlk[3] = (unsigned char)((starting_lba >> 16) & 0xff); + gpCmdBlk[4] = (unsigned char)((starting_lba >> 8) & 0xff); + gpCmdBlk[3] = (unsigned char)(starting_lba & 0xff); + if ((max_num_desc < 0) || (max_num_desc > 0xffff)) { + fprintf(sg_warnings_strm, "Bad max_num_desc: 0x%x\n", max_num_desc); + return -1; + } + gpCmdBlk[8] = (unsigned char)((max_num_desc >> 8) & 0xff); + gpCmdBlk[9] = (unsigned char)(max_num_desc & 0xff); + if ((ttype < 0) || (ttype > 0xff)) { + fprintf(sg_warnings_strm, "Bad type: 0x%x\n", ttype); + return -1; + } + gpCmdBlk[10] = (unsigned char)ttype; + + if (verbose) { + fprintf(sg_warnings_strm, " Get Performance cdb: "); + for (k = 0; k < GET_PERFORMANCE_CMD_LEN; ++k) + fprintf(sg_warnings_strm, "%02x ", gpCmdBlk[k]); + fprintf(sg_warnings_strm, "\n"); + } + + ptvp = construct_scsi_pt_obj(); + if (NULL == ptvp) { + fprintf(sg_warnings_strm, "get performance: out of memory\n"); + return -1; + } + set_scsi_pt_cdb(ptvp, gpCmdBlk, sizeof(gpCmdBlk)); + set_scsi_pt_sense(ptvp, sense_b, sizeof(sense_b)); + set_scsi_pt_data_in(ptvp, (unsigned char *)resp, mx_resp_len); + res = do_scsi_pt(ptvp, sg_fd, DEF_PT_TIMEOUT, verbose); + ret = sg_cmds_process_resp(ptvp, "get performance", res, mx_resp_len, + sense_b, noisy, verbose, &sense_cat); + if (-1 == ret) + ; + else if (-2 == ret) { + switch (sense_cat) { + case SG_LIB_CAT_INVALID_OP: + case SG_LIB_CAT_ILLEGAL_REQ: + case SG_LIB_CAT_UNIT_ATTENTION: + case SG_LIB_CAT_ABORTED_COMMAND: + ret = sense_cat; + break; + case SG_LIB_CAT_RECOVERED: + case SG_LIB_CAT_NO_SENSE: + ret = 0; + break; + default: + ret = -1; + break; + } + } else { + if ((verbose > 2) && (ret > 3)) { + unsigned char * ucp; + int len; + + ucp = (unsigned char *)resp; + len = (ucp[0] << 24) + (ucp[1] << 16) + (ucp[2] << 8) + ucp[3] + + 4; + if (len < 0) + len = 0; + len = (ret < len) ? ret : len; + fprintf(sg_warnings_strm, " get performance:: response%s\n", + (len > 256 ? ", first 256 bytes" : "")); + dStrHex((const char *)resp, (len > 256 ? 256 : len), -1); + } + ret = 0; + } + destruct_scsi_pt_obj(ptvp); + return ret; +} |