xref: /src/sys/arch/cobalt/stand/boot/devopen.c

/*	$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 <lib/libkern/libkern.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'))
#define isalpha(c)	(((c) >= 'a') && ((c) <= 'z'))

		/* 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;
}