stand/libsa/dev.c

   1 /*      $NetBSD: dev.c,v 1.4 1994/10/30 21:48:23 cgd Exp $      */
   2
   3 /*-
   4  * Copyright (c) 1993
   5  *      The Regents of the University of California.  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. Neither the name of the University nor the names of its contributors
  16  *    may be used to endorse or promote products derived from this software
  17  *    without specific prior written permission.
  18  *
  19  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  22  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  23  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  29  * SUCH DAMAGE.
  30  *
  31  *      @(#)dev.c       8.1 (Berkeley) 6/11/93
  32  */
  33
  34 #include <sys/cdefs.h>
  35 #include <sys/param.h>
  36 #include <sys/reboot.h>
  37
  38 #include "stand.h"
  39
  40 int
  41 nodev(void)
  42 {
  43         return (ENXIO);
  44 }
  45
  46 void
  47 nullsys(void)
  48 {
  49 }
  50
  51 /* ARGSUSED */
  52 int
  53 noioctl(struct open_file *f __unused, u_long cmd __unused, void *data __unused)
  54 {
  55         return (EINVAL);
  56 }
  57
  58 char *
  59 devformat(struct devdesc *d)
  60 {
  61         static char name[DEV_DEVLEN];
  62
  63         if (d->d_dev->dv_fmtdev != NULL)
  64                 return (d->d_dev->dv_fmtdev(d));
  65         snprintf(name, sizeof(name), "%s%d:", d->d_dev->dv_name, d->d_unit);
  66         return (name);
  67 }
  68
  69 /* NB: devspec points to the remainder of the device name after dv_name */
  70 static int
  71 default_parsedev(struct devdesc **dev, const char *devspec,
  72     const char **path)
  73 {
  74         struct devdesc *idev;
  75         int unit, err;
  76         char *cp;
  77
  78         idev = malloc(sizeof(struct devdesc));
  79         if (idev == NULL)
  80                 return (ENOMEM);
  81
  82         unit = 0;
  83         cp = (char *)devspec;   /* strtol interface, alas */
  84
  85         if (*devspec != '\0' && *devspec != ':') {
  86                 errno = 0;
  87                 unit = strtol(devspec, &cp, 0);
  88                 if (errno != 0 || cp == devspec) {
  89                         err = EUNIT;
  90                         goto fail;
  91                 }
  92         }
  93         if (*cp != '\0' && *cp != ':') {
  94                 err = EINVAL;
  95                 goto fail;
  96         }
  97
  98         idev->d_unit = unit;
  99         if (path != NULL)
 100                 *path = (*cp == 0) ? cp : cp + 1;
 101         *dev = idev;
 102         return (0);
 103 fail:
 104         free(idev);
 105         return (err);
 106 }
 107
 108 /* NB: devspec points to the whole device spec, and possible trailing path */
 109 int
 110 devparse(struct devdesc **dev, const char *devspec, const char **path)
 111 {
 112         struct devdesc *idev;
 113         struct devsw *dv;
 114         int i, err;
 115         const char *np;
 116
 117         /* minimum length check */
 118         if (strlen(devspec) < 2)
 119                 return (EINVAL);
 120
 121         /* look for a device that matches */
 122         for (i = 0; devsw[i] != NULL; i++) {
 123                 dv = devsw[i];
 124                 if (dv->dv_match != NULL) {
 125                         if (dv->dv_match(dv, devspec) != 0)
 126                                 break;
 127                 } else {
 128                         if (!strncmp(devspec, dv->dv_name, strlen(dv->dv_name)))
 129                                 break;
 130                 }
 131         }
 132         if (devsw[i] == NULL)
 133                 return (ENOENT);
 134         idev = NULL;
 135         err = 0;
 136         if (dv->dv_parsedev) {
 137                 err = dv->dv_parsedev(&idev, devspec, path);
 138         } else {
 139                 np = devspec + strlen(dv->dv_name);
 140                 err = default_parsedev(&idev, np, path);
 141         }
 142         if (err != 0)
 143                 return (err);
 144
 145         idev->d_dev = dv;
 146         if (dev != NULL)
 147                 *dev = idev;
 148         else
 149                 free(idev);
 150         return (0);
 151 }
 152
 153 int
 154 devinit(void)
 155 {
 156         int err = 0;
 157
 158         /*
 159          * March through the device switch probing for things.
 160          */
 161         for (int i = 0; devsw[i] != NULL; i++) {
 162                 if (devsw[i]->dv_init != NULL) {
 163                         if ((devsw[i]->dv_init)() != 0) {
 164                                 err++;
 165                         }
 166                 }
 167         }
 168         return (err);
 169 }
 170
 171 void
 172 dev_cleanup(void)
 173 {
 174     int         i;
 175
 176     /* Call cleanup routines */
 177     for (i = 0; devsw[i] != NULL; ++i)
 178         if (devsw[i]->dv_cleanup != NULL)
 179             (devsw[i]->dv_cleanup)();
 180 }