root/sys/arch/bebox/stand/boot/devopen.c
/*      $NetBSD: devopen.c,v 1.11 2012/12/19 13:53:47 kiyohara Exp $    */

/*-
 *  Copyright (c) 1993 John Brezak
 *  All rights reserved.
 *
 *  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. The name of the author may not be used to endorse or promote products
 *     derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR `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 AUTHOR 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 <sys/param.h>
#include <sys/reboot.h>

static int devparse(const char *, int *, int *, int *, int *, int *, char **);


/*
 * Parse a device spec.
 *   i.e.
 *     /dev/disk/floppy
 *     /dev/disk/ide/0/master/0_n
 *     /dev/disk/ide/0/slave/0_n
 *     /dev/disk/scsi/000/0_n
 *     /dev/disk/scsi/030/0_n
 */
static int
devparse(const char *fname, int *dev, int *ctlr, int *unit, int *lunit,
         int *part, char **file)
{
        int i;
        char devdir[] = "/dev/disk/";
        char floppy[] = "floppy";
        char ide[] = "ide";
        char scsi[] = "scsi";
        char *p;

        if (strncmp(fname, devdir, strlen(devdir)) != 0)
                return EINVAL;
        p = __UNCONST(fname) + strlen(devdir);

        if (strncmp(p, floppy, strlen(floppy)) == 0) {
                p += strlen(floppy);
                for (i = 0; devsw[i].dv_name != NULL; i++)
                        if (strcmp(devsw[i].dv_name, "fd") == 0) {
                                *dev = i;
                                *ctlr = 0;
                                *unit = 1;
                                *lunit = 0;
                                break;
                        }
        } else if (strncmp(p, ide, strlen(ide)) == 0) {
                char master[] = "master";
                char slave[] = "slave";

                p += strlen(ide);
                if (*p++ != '/' ||
                    !isdigit(*p++) ||
                    *p++ != '/')
                        return EINVAL;
                *ctlr = *(p - 2) - '0';
                if (strncmp(p, master, strlen(master)) == 0) {
                        *unit = 0;
                        p += strlen(master);
                } else if (strncmp(p, slave, strlen(slave)) == 0) {
                        *unit = 1;
                        p += strlen(slave);
                } else
                        return EINVAL;
                if (*p++ != '/' ||
                    !isdigit(*p++) ||
                    *p++ != '_' ||
                    !isdigit(*p++))
                        return EINVAL;
                *lunit = *(p - 3) - '0';
                *part = *(p - 1) - '0';
                for (i = 0; devsw[i].dv_name != NULL; i++)
                        if (strcmp(devsw[i].dv_name, "wd") == 0) {
                                *dev = i;
                                break;
                        }
                if (devsw[i].dv_name == NULL)
                        return EINVAL;
        } else if (strncmp(p, scsi, strlen(scsi)) == 0) {
                p += strlen(scsi);
                if (*p++ != '/' ||
                    !isdigit(*p++) ||
                    !isdigit(*p++) ||
                    !isdigit(*p++) ||
                    *p++ != '/' ||
                    !isdigit(*p++) ||
                    *p++ != '_' ||
                    !isdigit(*p++))
                        return EINVAL;
                *ctlr = *(p - 7) - '0';
                *unit = *(p - 6) - '0';
                *lunit = *(p - 5) - '0';
                *part = *(p - 1) - '0';
                for (i = 0; devsw[i].dv_name != NULL; i++)
                        if (strcmp(devsw[i].dv_name, "sd") == 0) {
                                *dev = i;
                                break;
                        }
                if (devsw[i].dv_name == NULL)
                        return EINVAL;
        }

        if (*p++ != ':')
                return EINVAL;
        *file = p;
        return 0;
}

int
devopen(struct open_file *f, const char *fname, char **file)
{
        int error;
        int dev = 0, ctlr = 0, unit = 0, lunit = 0, part = 0;
        struct devsw *dp = &devsw[0];
        extern struct devsw pseudo_devsw;

        **file = '\0';
        error = devparse(fname, &dev, &ctlr, &unit, &lunit, &part, file);
        if (error == 0) {
                dp = &devsw[dev];
                if (!dp->dv_open)
                        return ENODEV;
        } else {
                if (strcmp(fname, "in") == 0)
                        /* special case: kernel in memory */
                        dp = &pseudo_devsw;
                else
                        return error;
        }

        f->f_dev = dp;
        if ((error = (*dp->dv_open)(f, ctlr, unit, lunit, part)) == 0)
                return 0;

        printf("%s %s\n", fname, strerror(error));

        return error;
}