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 } 181