sys/arch/next68k/stand/boot/devopen.c

   1 /*      $NetBSD: devopen.c,v 1.2.42.2 2005/11/10 13:57:58 skrll 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 }