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 *dev = idev; 104 return (0); 105 fail: 106 free(idev); 107 return (err); 108 } 109 110 /* NB: devspec points to the whole device spec, and possible trailing path */ 111 int 112 devparse(struct devdesc **dev, const char *devspec, const char **path) 113 { 114 struct devdesc *idev; 115 struct devsw *dv; 116 int i, err; 117 const char *np; 118 119 /* minimum length check */ 120 if (strlen(devspec) < 2) 121 return (EINVAL); 122 123 /* look for a device that matches */ 124 for (i = 0; devsw[i] != NULL; i++) { 125 dv = devsw[i]; 126 if (dv->dv_match != NULL) { 127 if (dv->dv_match(dv, devspec) != 0) 128 break; 129 } else { 130 if (!strncmp(devspec, dv->dv_name, strlen(dv->dv_name))) 131 break; 132 } 133 } 134 if (devsw[i] == NULL) 135 return (ENOENT); 136 idev = NULL; 137 err = 0; 138 if (dv->dv_parsedev) { 139 err = dv->dv_parsedev(&idev, devspec, path); 140 } else { 141 np = devspec + strlen(dv->dv_name); 142 err = default_parsedev(&idev, np, path); 143 } 144 if (err != 0) 145 return (err); 146 147 idev->d_dev = dv; 148 if (dev != NULL) 149 *dev = idev; 150 else 151 free(idev); 152 return (0); 153 } 154 155 int 156 devinit(void) 157 { 158 int err = 0; 159 160 /* 161 * March through the device switch probing for things. 162 */ 163 for (int i = 0; devsw[i] != NULL; i++) { 164 if (devsw[i]->dv_init != NULL) { 165 if ((devsw[i]->dv_init)() != 0) { 166 err++; 167 } 168 } 169 } 170 return (err); 171 } 172 173 void 174 dev_cleanup(void) 175 { 176 int i; 177 178 /* Call cleanup routines */ 179 for (i = 0; devsw[i] != NULL; ++i) 180 if (devsw[i]->dv_cleanup != NULL) 181 (devsw[i]->dv_cleanup)(); 182 } 183