1 /* $NetBSD: devopen.c,v 1.5 2005/12/11 12:18:29 christos Exp $ */ 2 /* 3 * Copyright (c) 1994 Rolf Grossmann 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 3. All advertising materials mentioning features or use of this software 15 * must display the following acknowledgement: 16 * This product includes software developed by Rolf Grossmann. 17 * 4. The name of the author may not be used to endorse or promote products 18 * derived from this software without specific prior written permission 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 21 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 22 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 23 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 24 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 25 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 26 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 27 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 28 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 29 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 #include <lib/libsa/stand.h> 33 #include <lib/libkern/libkern.h> 34 35 int atoi(const char *); 36 int devlookup(const char *, int); 37 int devparse(const char *, int *, char *, char *, char *, char **); 38 39 int 40 atoi(const char *cp) 41 { 42 int val = 0; 43 44 while(isdigit((unsigned char)*cp)) 45 val = val * 10 + (*cp++ - '0'); 46 return val; 47 } 48 49 int 50 devlookup(const char *d, int len) 51 { 52 struct devsw *dp = devsw; 53 int i; 54 55 for (i = 0; i < ndevs; i++, dp++) 56 if (dp->dv_name && strncmp(dp->dv_name, d, len) == 0) 57 return i; 58 59 for (i = 0; i < len; i++) 60 printf("%c", d[i]); 61 printf(": no such device - Configured devices are:\n"); 62 for (dp = devsw, i = 0; i < ndevs; i++, dp++) 63 if (dp->dv_name && (void *)dp->dv_open != (void *)nodev) 64 printf(" %s", dp->dv_name); 65 printf("\n"); 66 errno = ENXIO; 67 return -1; 68 } 69 70 /* 71 * Parse a device spec. 72 * 73 * Format: 74 * dev(count, lun, part)file 75 */ 76 int 77 devparse(const char *fname, int *dev, 78 char *count, char *lun, char *part, char **file) 79 { 80 int i; 81 const char *s, *args[3]; 82 83 /* get device name */ 84 for (s = fname; *s && *s != '/' && *s != '('; s++) 85 ; 86 87 if (*s == '(') { 88 /* lookup device and get index */ 89 if ((*dev = devlookup(fname, s - fname)) < 0) 90 goto baddev; 91 92 /* tokenize device ident */ 93 args[0] = ++s; 94 for (i = 1; *s && *s != ')' && i<3; s++) { 95 if (*s == ',') 96 args[i++] = ++s; 97 } 98 if (*s != ')') 99 goto baddev; 100 101 switch(i) { 102 case 3: 103 *count = atoi(args[0]); 104 *lun = atoi(args[1]); 105 *part = atoi(args[2]); 106 break; 107 case 2: 108 *lun = atoi(args[0]); 109 *part = atoi(args[1]); 110 break; 111 case 1: 112 *part = atoi(args[0]); 113 break; 114 case 0: 115 break; 116 } 117 *file = (char *)++s; /* XXX discard const */ 118 } 119 /* no device present */ 120 else 121 *file = (char *)fname; /* XXX discard const */ 122 123 return 0; 124 125 baddev: 126 return ENXIO; 127 } 128 129 int 130 devopen(struct open_file *f, const char *fname, char **file) 131 { 132 int error; 133 int dev; 134 char count, lun, part; 135 struct devsw *dp; 136 137 dev = 0; /* default device is first in table (usually scsi disk) */ 138 count = 0; 139 lun = 0; 140 part = 0; 141 142 if ((error = devparse(fname, &dev, &count, &lun, &part, file)) != 0) 143 return error; 144 145 dp = &devsw[dev]; 146 147 if ((void *)dp->dv_open == (void *)nodev) 148 return ENXIO; 149 150 f->f_dev = dp; 151 152 if ((error = (*dp->dv_open)(f, count, lun, part)) != 0) 153 printf("%s(%d,%d,%d): %d = %s\n", devsw[dev].dv_name, 154 count, lun, part, error, strerror(error)); 155 156 return error; 157 } 158