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 __FBSDID("$FreeBSD$");
  36
  37 #include <sys/param.h>
  38 #include <sys/reboot.h>
  39
  40 #include "stand.h"
  41
  42 int
  43 nodev(void)
  44 {
  45         return (ENXIO);
  46 }
  47
  48 void
  49 nullsys(void)
  50 {
  51 }
  52
  53 /* ARGSUSED */
  54 int
  55 noioctl(struct open_file *f __unused, u_long cmd __unused, void *data __unused)
  56 {
  57         return (EINVAL);
  58 }
  59
  60 char *
  61 devformat(struct devdesc *d)
  62 {
  63         static char name[DEV_DEVLEN];
  64
  65         if (d->d_dev->dv_fmtdev != NULL)
  66                 return (d->d_dev->dv_fmtdev(d));
  67         snprintf(name, sizeof(name), "%s%d:", d->d_dev->dv_name, d->d_unit);
  68         return (name);
  69 }
  70
  71 /* NB: devspec points to the remainder of the device name after dv_name */
  72 static int
  73 default_parsedev(struct devdesc **dev, const char *devspec,
  74     const char **path)
  75 {
  76         struct devdesc *idev;
  77         int unit, err;
  78         char *cp;
  79
  80         idev = malloc(sizeof(struct devdesc));
  81         if (idev == NULL)
  82                 return (ENOMEM);
  83
  84         unit = 0;
  85         cp = (char *)devspec;   /* strtol interface, alas */
  86
  87         if (*devspec != '\0' && *devspec != ':') {
  88                 errno = 0;
  89                 unit = strtol(devspec, &cp, 0);
  90                 if (errno != 0 || cp == devspec) {
  91                         err = EUNIT;
  92                         goto fail;
  93                 }
  94         }
  95         if (*cp != '\0' && *cp != ':') {
  96                 err = EINVAL;
  97                 goto fail;
  98         }
  99
 100         idev->d_unit = unit;
 101         if (path != NULL)
 102                 *path = (*cp == 0) ? cp : cp + 1;
 103         if (dev != NULL)        /* maybe this can be required? */
 104                 *dev = idev;
 105         else
 106                 free(idev);
 107         return (0);
 108 fail:
 109         free(idev);
 110         return (err);
 111 }
 112
 113 /* NB: devspec points to the whole device spec, and possible trailing path */
 114 int
 115 devparse(struct devdesc **dev, const char *devspec, const char **path)
 116 {
 117         struct devdesc *idev;
 118         struct devsw *dv;
 119         int i, err;
 120         const char *np;
 121
 122         /* minimum length check */
 123         if (strlen(devspec) < 2)
 124                 return (EINVAL);
 125
 126         /* look for a device that matches */
 127         for (i = 0; devsw[i] != NULL; i++) {
 128                 dv = devsw[i];
 129                 if (dv->dv_match != NULL) {
 130                         if (dv->dv_match(dv, devspec) != 0)
 131                                 break;
 132                 } else {
 133                         if (!strncmp(devspec, dv->dv_name, strlen(dv->dv_name)))
 134                                 break;
 135                 }
 136         }
 137         if (devsw[i] == NULL)
 138                 return (ENOENT);
 139         idev = NULL;
 140         err = 0;
 141         if (dv->dv_parsedev) {
 142                 err = dv->dv_parsedev(&idev, devspec, path);
 143         } else {
 144                 np = devspec + strlen(dv->dv_name);
 145                 err = default_parsedev(&idev, np, path);
 146         }
 147         if (err != 0)
 148                 return (err);
 149
 150         idev->d_dev = dv;
 151         if (dev != NULL)
 152                 *dev = idev;
 153         else
 154                 free(idev);
 155         return (0);
 156 }
 157
 158 int
 159 devinit(void)
 160 {
 161         int err = 0;
 162
 163         /*
 164          * March through the device switch probing for things.
 165          */
 166         for (int i = 0; devsw[i] != NULL; i++) {
 167                 if (devsw[i]->dv_init != NULL) {
 168                         if ((devsw[i]->dv_init)() != 0) {
 169                                 err++;
 170                         }
 171                 }
 172         }
 173         return (err);
 174 }
 175
 176 void
 177 dev_cleanup(void)
 178 {
 179     int         i;
 180
 181     /* Call cleanup routines */
 182     for (i = 0; devsw[i] != NULL; ++i)
 183         if (devsw[i]->dv_cleanup != NULL)
 184             (devsw[i]->dv_cleanup)();
 185 }