1 /* 2 * Generic utility routines for the Common Access Method layer. 3 * 4 * Copyright (c) 1997 Justin T. Gibbs. 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions, and the following disclaimer, 12 * without modification, immediately at the beginning of the file. 13 * 2. The name of the author may not be used to endorse or promote products 14 * derived from this software without specific prior written permission. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR 20 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 * SUCH DAMAGE. 27 * 28 * $FreeBSD: src/sys/cam/cam.c,v 1.3 1999/08/28 00:40:38 peter Exp $ 29 * $DragonFly: src/sys/bus/cam/cam.c,v 1.6 2004/02/16 19:43:27 dillon Exp $ 30 */ 31 #include <sys/param.h> 32 #ifdef _KERNEL 33 #include <sys/systm.h> 34 #include <sys/kernel.h> 35 #include <sys/sysctl.h> 36 #else 37 #include <stdlib.h> 38 #include <stdio.h> 39 #endif 40 41 #include "cam.h" 42 #include "cam_ccb.h" 43 #include "scsi/scsi_all.h" 44 #include <sys/sbuf.h> 45 46 #ifdef _KERNEL 47 #include <sys/libkern.h> 48 #include "cam_xpt.h" 49 #endif 50 51 #ifdef _KERNEL 52 53 SYSCTL_NODE(_kern, OID_AUTO, cam, CTLFLAG_RD, 0, "CAM Subsystem"); 54 55 #endif 56 57 void 58 cam_strvis(u_int8_t *dst, const u_int8_t *src, int srclen, int dstlen) 59 { 60 61 /* Trim leading/trailing spaces, nulls. */ 62 while (srclen > 0 && src[0] == ' ') 63 src++, srclen--; 64 while (srclen > 0 65 && (src[srclen-1] == ' ' || src[srclen-1] == '\0')) 66 srclen--; 67 68 while (srclen > 0 && dstlen > 1) { 69 u_int8_t *cur_pos = dst; 70 71 if (*src < 0x20 || *src >= 0x80) { 72 /* SCSI-II Specifies that these should never occur. */ 73 /* non-printable character */ 74 if (dstlen > 4) { 75 *cur_pos++ = '\\'; 76 *cur_pos++ = ((*src & 0300) >> 6) + '0'; 77 *cur_pos++ = ((*src & 0070) >> 3) + '0'; 78 *cur_pos++ = ((*src & 0007) >> 0) + '0'; 79 } else { 80 *cur_pos++ = '?'; 81 } 82 } else { 83 /* normal character */ 84 *cur_pos++ = *src; 85 } 86 src++; 87 srclen--; 88 dstlen -= cur_pos - dst; 89 dst = cur_pos; 90 } 91 *dst = '\0'; 92 } 93 94 /* 95 * Compare string with pattern, returning 0 on match. 96 * Short pattern matches trailing blanks in name, 97 * wildcard '*' in pattern matches rest of name, 98 * wildcard '?' matches a single non-space character. 99 */ 100 int 101 cam_strmatch(const u_int8_t *str, const u_int8_t *pattern, int str_len) 102 { 103 104 while (*pattern != '\0'&& str_len > 0) { 105 106 if (*pattern == '*') { 107 return (0); 108 } 109 if ((*pattern != *str) 110 && (*pattern != '?' || *str == ' ')) { 111 return (1); 112 } 113 pattern++; 114 str++; 115 str_len--; 116 } 117 while (str_len > 0 && *str++ == ' ') 118 str_len--; 119 120 return (str_len); 121 } 122 123 caddr_t 124 cam_quirkmatch(caddr_t target, caddr_t quirk_table, int num_entries, 125 int entry_size, cam_quirkmatch_t *comp_func) 126 { 127 for (; num_entries > 0; num_entries--, quirk_table += entry_size) { 128 if ((*comp_func)(target, quirk_table) == 0) 129 return (quirk_table); 130 } 131 return (NULL); 132 } 133 134 /* 135 * Common calculate geometry fuction 136 * 137 * Caller should set ccg->volume_size and block_size. 138 * The extended parameter should be zero if extended translation 139 * should not be used. 140 */ 141 void 142 cam_calc_geometry(struct ccb_calc_geometry *ccg, int extended) 143 { 144 uint32_t size_mb, secs_per_cylinder; 145 146 size_mb = ccg->volume_size / ((1024L * 1024L) / ccg->block_size); 147 if (size_mb > 1024 && extended) { 148 ccg->heads = 255; 149 ccg->secs_per_track = 63; 150 } else { 151 ccg->heads = 64; 152 ccg->secs_per_track = 32; 153 } 154 secs_per_cylinder = ccg->heads * ccg->secs_per_track; 155 ccg->cylinders = ccg->volume_size / secs_per_cylinder; 156 ccg->ccb_h.status = CAM_REQ_CMP; 157 } 158 159