Home | History | Annotate | Line # | Download | only in scsictl 
      1 /*	$NetBSD: scsi_subr.c,v 1.14 2012/02/21 02:22:54 jakllsch Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Charles M. Hannum; Jason R. Thorpe of the Numerical Aerospace
      9  * Simulation Facility, NASA Ames Research Center.
     10  *
     11  * Redistribution and use in source and binary forms, with or without
     12  * modification, are permitted provided that the following conditions
     13  * are met:
     14  * 1. Redistributions of source code must retain the above copyright
     15  *    notice, this list of conditions and the following disclaimer.
     16  * 2. Redistributions in binary form must reproduce the above copyright
     17  *    notice, this list of conditions and the following disclaimer in the
     18  *    documentation and/or other materials provided with the distribution.
     19  *
     20  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     21  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     22  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     23  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     24  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     25  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     26  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     27  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     28  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     29  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     30  * POSSIBILITY OF SUCH DAMAGE.
     31  */
     32 
     33 /*
     34  * SCSI support subroutines.
     35  *
     36  * XXX THESE SHOULD BE IN A LIBRARY!
     37  */
     38 #include <sys/cdefs.h>
     39 
     40 #ifndef lint
     41 __RCSID("$NetBSD: scsi_subr.c,v 1.14 2012/02/21 02:22:54 jakllsch Exp $");
     42 #endif
     43 
     44 
     45 #include <sys/param.h>
     46 #include <sys/ioctl.h>
     47 #include <sys/scsiio.h>
     48 #include <err.h>
     49 #include <errno.h>
     50 #include <stdio.h>
     51 #include <stdlib.h>
     52 #include <string.h>
     53 #include <unistd.h>
     54 
     55 #include <dev/scsipi/scsi_spc.h>
     56 
     57 #include "extern.h"
     58 
     59 #define	STRVIS_ISWHITE(x) ((x) == ' ' || (x) == '\0' || (x) == (u_char)'\377')
     60 
     61 void
     62 scsi_command(int fd, const void *cmd, size_t cmdlen,
     63 	void *data, size_t datalen, int timeout, int flags)
     64 {
     65 	scsireq_t req;
     66 
     67 	memset(&req, 0, sizeof(req));
     68 
     69 	cmdlen = MIN(cmdlen, sizeof(req.cmd));
     70 	memcpy(req.cmd, cmd, cmdlen);
     71 	req.cmdlen = cmdlen;
     72 	req.databuf = data;
     73 	req.datalen = datalen;
     74 	req.timeout = timeout;
     75 	req.flags = flags;
     76 	req.senselen = SENSEBUFLEN;
     77 
     78 	if (ioctl(fd, SCIOCCOMMAND, &req) == -1)
     79 		err(1, "SCIOCCOMMAND");
     80 
     81 	if (req.retsts == SCCMD_OK)
     82 		return;
     83 
     84 	/* Some problem; report it and exit. */
     85 	if (req.retsts == SCCMD_TIMEOUT)
     86 		fprintf(stderr, "%s: SCSI command timed out\n", dvname);
     87 	else if (req.retsts == SCCMD_BUSY)
     88 		fprintf(stderr, "%s: device is busy\n", dvname);
     89 	else if (req.retsts == SCCMD_SENSE)
     90 		scsi_print_sense(dvname, &req, 1);
     91 	else
     92 		fprintf(stderr, "%s: device had unknown status %x\n", dvname,
     93 		    req.retsts);
     94 
     95 	exit(1);
     96 }
     97 
     98 void
     99 scsi_mode_sense(int fd, u_int8_t pgcode, u_int8_t pctl, void *buf, size_t len)
    100 {
    101 	struct scsi_mode_sense_6 cmd;
    102 
    103 	memset(&cmd, 0, sizeof(cmd));
    104 	memset(buf, 0, len);
    105 
    106 	cmd.opcode = SCSI_MODE_SENSE_6;
    107 	cmd.page = pgcode | pctl;
    108 	cmd.length = len;
    109 
    110 	scsi_command(fd, &cmd, sizeof(cmd), buf, len, 10000, SCCMD_READ);
    111 }
    112 
    113 void
    114 scsi_mode_select(int fd, u_int8_t byte2, void *buf, size_t len)
    115 {
    116 	struct scsi_mode_select_6 cmd;
    117 
    118 	memset(&cmd, 0, sizeof(cmd));
    119 
    120 	cmd.opcode = SCSI_MODE_SELECT_6;
    121 	cmd.byte2 = SMS_PF | byte2;
    122 	cmd.length = len;
    123 
    124 	scsi_command(fd, &cmd, sizeof(cmd), buf, len, 10000, SCCMD_WRITE);
    125 }
    126 
    127 void
    128 scsi_request_sense(int fd, void *buf, size_t len)
    129 {
    130 	struct scsi_request_sense cmd;
    131 
    132 	memset(&cmd, 0, sizeof(cmd));
    133 	memset(buf, 0, len);
    134 
    135 	cmd.opcode = SCSI_REQUEST_SENSE;
    136 	cmd.length = len;
    137  	scsi_command(fd, &cmd, sizeof(cmd), buf, len, 10000, SCCMD_READ);
    138 }
    139 
    140 void
    141 scsi_strvis(char *sdst, size_t dlen, const char *ssrc, size_t slen)
    142 {
    143 	u_char *dst = (u_char *)sdst;
    144 	const u_char *src = (const u_char *)ssrc;
    145 
    146 	/* Trim leading and trailing blanks and NULs. */
    147 	while (slen > 0 && STRVIS_ISWHITE(src[0]))
    148 		++src, --slen;
    149 	while (slen > 0 && STRVIS_ISWHITE(src[slen - 1]))
    150 		--slen;
    151 
    152 	while (slen > 0) {
    153 		if (*src < 0x20 || *src >= 0x80) {
    154 			/* non-printable characters */
    155 			dlen -= 4;
    156 			if (dlen < 1)
    157 				break;
    158 			*dst++ = '\\';
    159 			*dst++ = ((*src & 0300) >> 6) + '0';
    160 			*dst++ = ((*src & 0070) >> 3) + '0';
    161 			*dst++ = ((*src & 0007) >> 0) + '0';
    162 		} else if (*src == '\\') {
    163 			/* quote characters */
    164 			dlen -= 2;
    165 			if (dlen < 1)
    166 				break;
    167 			*dst++ = '\\';
    168 			*dst++ = '\\';
    169 		} else {
    170 			/* normal characters */
    171 			if (--dlen < 1)
    172 				break;
    173 			*dst++ = *src;
    174 		}
    175 		++src, --slen;
    176 	}
    177 
    178 	*dst++ = 0;
    179 }
    180