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