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