diff options
Diffstat (limited to 'sys/arch/armish/stand/boot/devopen.c')
| -rw-r--r-- | sys/arch/armish/stand/boot/devopen.c | 146 |
1 files changed, 146 insertions, 0 deletions
diff --git a/sys/arch/armish/stand/boot/devopen.c b/sys/arch/armish/stand/boot/devopen.c new file mode 100644 index 00000000000..78521074535 --- /dev/null +++ b/sys/arch/armish/stand/boot/devopen.c @@ -0,0 +1,146 @@ +/* $OpenBSD: devopen.c,v 1.1 2006/07/28 17:12:06 kettenis Exp $ */ +/* $NetBSD: devopen.c,v 1.1 2003/06/25 17:24:22 cdi Exp $ */ + +/*- + * Copyright (c) 2003 The NetBSD Foundation, Inc. + * All rights reserved. + * + * This code is derived from software contributed to The NetBSD Foundation + * by Rolf Grossmann. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. All advertising materials mentioning features or use of this software + * must display the following acknowledgement: + * This product includes software developed by the NetBSD + * Foundation, Inc. and its contributors. + * 4. Neither the name of The NetBSD Foundation nor the names of its + * contributors may be used to endorse or promote products derived + * from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS + * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED + * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR + * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS + * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#include <lib/libsa/stand.h> + +#include "boot.h" + +/* + * Parse a device spec. + * + * Format: + * [device:][filename] + */ +int +devparse(const char *fname, int *dev, u_int8_t *unit, + u_int8_t *part, const char **file) +{ + const char *col; + + *unit = 0; /* default to wd0a */ + *part = 0; + *dev = 0; + *file = DEFKERNELNAME; + + if (fname == NULL) + return (0); + + if ( (col = strchr(fname, ':')) != NULL) { + int devlen; + u_int8_t i, u, p; + struct devsw *dp; + char devname[MAXDEVNAME]; + + devlen = col - fname; + if (devlen > MAXDEVNAME) + return (EINVAL); + +#define isnum(c) (((c) >= '0') && ((c) <= '9')) +#if 0 +#define isalpha(c) (((c) >= 'a') && ((c) <= 'z')) +#endif + + /* extract device name */ + for (i = 0; isalpha(fname[i]) && (i < devlen); i++) + devname[i] = fname[i]; + devname[i] = 0; + + if (!isnum(fname[i])) + return (EUNIT); + + /* device number */ + for (u = 0; isnum(fname[i]) && (i < devlen); i++) + u = u * 10 + (fname[i] - '0'); + + if (!isalpha(fname[i])) + return (EPART); + + /* partition number */ + if (i < devlen) + p = fname[i++] - 'a'; + + if (i != devlen) + return (ENXIO); + + /* check device name */ + for (dp = devsw, i = 0; i < ndevs; dp++, i++) { + if (dp->dv_name && !strcmp(devname, dp->dv_name)) + break; + } + + if (i >= ndevs) + return (ENXIO); + + *unit = u; + *part = p; + *dev = i; + fname = ++col; + } + + if (*fname) + *file = fname; + + return (0); +} + +int +devopen(struct open_file *f, const char *fname, char **file) +{ + struct devsw *dp; + u_int8_t unit, part; + int dev, error; + + DPRINTF(("devopen(%s)\n", fname)); + + if ( (error = devparse(fname, &dev, &unit, &part, + (const char **)file)) != 0) + return error; + + dp = &devsw[dev]; + if ((void *)dp->dv_open == (void *)nodev) + return ENXIO; + + f->f_dev = dp; + + if ( (error = (*dp->dv_open)(f, unit, part)) != 0) + printf("%s%d%c: %d = %s\n", devsw[dev].dv_name, + unit, 'a' + part, error, strerror(error)); + + return error; +} |