Home | History | Annotate | Line # | Download | only in boot
      1 /*	$NetBSD: devopen.c,v 1.6 2022/04/30 03:41:05 rin Exp $	*/
      2 
      3 /*-
      4  *  Copyright (c) 1993 John Brezak
      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  *  2. Redistributions in binary form must reproduce the above copyright
     13  *     notice, this list of conditions and the following disclaimer in the
     14  *     documentation and/or other materials provided with the distribution.
     15  *  3. The name of the author may not be used to endorse or promote products
     16  *     derived from this software without specific prior written permission.
     17  *
     18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR `AS IS'' AND ANY EXPRESS OR
     19  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     20  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     21  * DISCLAIMED.	IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     22  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     23  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     24  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     26  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     27  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     28  * POSSIBILITY OF SUCH DAMAGE.
     29  */
     30 
     31 #include <lib/libsa/stand.h>
     32 #include <lib/libkern/libkern.h>
     33 
     34 #define	ispart(c)	((c) >= 'a' && (c) <= 'h')
     35 
     36 int devlookup(char *);
     37 int devparse(const char *, int *, int *, int *, int *, int *, char **);
     38 
     39 int
     40 devlookup(char *d)
     41 {
     42 	struct devsw *dp = devsw;
     43 	int i;
     44 
     45 	for (i = 0; i < ndevs; i++, dp++)
     46 		if (dp->dv_name && strcmp(dp->dv_name, d) == 0)
     47 			return (i);
     48 
     49 	printf("No such device - Configured devices are:\n");
     50 	for (dp = devsw, i = 0; i < ndevs; i++, dp++)
     51 		if (dp->dv_name)
     52 			printf(" %s", dp->dv_name);
     53 	printf("\n");
     54 	return (-1);
     55 }
     56 
     57 /*
     58  * Parse a device spec in one of two forms.
     59  *   dev(ctlr, unit, part)file
     60  */
     61 int
     62 devparse(const char *fname, int *dev, int *adapt, int *ctlr, int *unit,
     63 	int *part, char **file)
     64 {
     65 	int argc, flag;
     66 	char *s, *args[3];
     67 	extern char nametmp[];
     68 
     69 	/* get device name and make lower case */
     70 	strcpy(nametmp, (char *)fname);
     71 	for (s = nametmp; *s && *s != '('; s++)
     72 		if (isupper(*s)) *s = tolower(*s);
     73 
     74 	if (*s == '(') {
     75 		/* lookup device and get index */
     76 		*s = '\0';
     77 		if ((*dev = devlookup(nametmp)) < 0)
     78 		    goto baddev;
     79 
     80 		/* tokenize device ident */
     81 		for (++s, flag = 0, argc = 0; *s && *s != ')'; s++) {
     82 			if (*s != ',') {
     83 				if (!flag) {
     84 					flag++;
     85 					args[argc++] = s;
     86 				}
     87 			} else {
     88 				if (flag) {
     89 					*s = '\0';
     90 					flag = 0;
     91 				}
     92 			}
     93 		}
     94 		if (*s == ')')
     95 			*s = '\0';
     96 
     97 		switch (argc) {
     98 		case 3:
     99 		    *part = atoi(args[2]);
    100 		    /* FALL THROUGH */
    101 		case 2:
    102 		    *unit = atoi(args[1]);
    103 		    /* FALL THROUGH */
    104 		case 1:
    105 		    *ctlr = atoi(args[0]);
    106 		    break;
    107 		}
    108 		*file = ++s;
    109 	} else {
    110 		/* no device present */
    111 		*file = (char *)fname;
    112 	}
    113 	return (0);
    114 
    115 baddev:
    116 	return (EINVAL);
    117 }
    118 
    119 int
    120 devopen(struct open_file *f, const char *fname, char **file)
    121 {
    122 	int error;
    123 	int dev = 0, ctlr = 0, unit = 0, part = 0;
    124 	int adapt = 0;
    125 	struct devsw *dp = &devsw[0];
    126 	extern struct devsw pseudo_devsw;
    127 
    128 	error = devparse(fname, &dev, &adapt, &ctlr, &unit, &part, file);
    129 	if (error == 0) {
    130 		dp = &devsw[dev];
    131 		if (!dp->dv_open)
    132 			return (ENODEV);
    133 	} else {
    134 		if (strcmp(fname, "in()") == 0) {
    135 			/* special case: kernel in memory */
    136 			dp = &pseudo_devsw;
    137 			printf("in memory kernel\n");
    138 		} else
    139 			return (error);
    140 	}
    141 
    142 	f->f_dev = dp;
    143 	if ((error = (*dp->dv_open)(f, ctlr, unit, part)) == 0)
    144 		return (0);
    145 
    146 	if (strcmp(fname, "in()") == 0)
    147 		printf("in(): %s\n", strerror(error));
    148 	else
    149 		printf("%s(%d,%d,%d): %s\n", dp->dv_name,
    150 			ctlr, unit, part, strerror(error));
    151 
    152 	return (error);
    153 }
    154