xref: /titanic_52/usr/src/boot/lib/libstand/netif.c (revision 7b2a1233f92b2b3cb858f2fdb69378a9ab0a42f1)
1 /*	$NetBSD: netif.c,v 1.10 1997/09/06 13:57:14 drochner Exp $	*/
2 
3 /*
4  * Copyright (c) 1993 Adam Glass
5  * 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. All advertising materials mentioning features or use of this software
16  *    must display the following acknowledgement:
17  *	This product includes software developed by Adam Glass.
18  * 4. The name of the Author may not be used to endorse or promote products
19  *    derived from this software without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY Adam Glass ``AS IS'' AND
22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31  * SUCH DAMAGE.
32  */
33 
34 #include <sys/cdefs.h>
35 
36 #include <sys/param.h>
37 #include <sys/types.h>
38 #include <sys/cdefs.h>
39 #include <sys/mount.h>
40 #include <string.h>
41 
42 #include <netinet/in.h>
43 #include <netinet/in_systm.h>
44 
45 #include "stand.h"
46 #include "net.h"
47 #include "netif.h"
48 
49 struct iodesc sockets[SOPEN_MAX];
50 #ifdef NETIF_DEBUG
51 int netif_debug = 0;
52 #endif
53 
54 /*
55  * netif_init:
56  *
57  * initialize the generic network interface layer
58  */
59 
60 void
61 netif_init(void)
62 {
63 	struct netif_driver *drv;
64 	int d, i;
65 
66 #ifdef NETIF_DEBUG
67 	if (netif_debug)
68 		printf("netif_init: called\n");
69 #endif
70 	for (d = 0; netif_drivers[d]; d++) {
71 		drv = netif_drivers[d];
72 		for (i = 0; i < drv->netif_nifs; i++)
73 			drv->netif_ifs[i].dif_used = 0;
74 	}
75 }
76 
77 int
78 netif_match(struct netif *nif, void *machdep_hint)
79 {
80 	struct netif_driver *drv = nif->nif_driver;
81 
82 #if NETIF_DEBUG
83 	if (netif_debug)
84 		printf("%s%d: netif_match (%d)\n", drv->netif_bname,
85 		    nif->nif_unit, nif->nif_sel);
86 #endif
87 	return drv->netif_match(nif, machdep_hint);
88 }
89 
90 struct netif *
91 netif_select(void *machdep_hint)
92 {
93 	int d, u, unit_done, s;
94 	struct netif_driver *drv;
95 	struct netif cur_if;
96 	static struct netif best_if;
97 	int best_val;
98 	int val;
99 
100 	best_val = 0;
101 	best_if.nif_driver = NULL;
102 
103 	for (d = 0; netif_drivers[d] != NULL; d++) {
104 		cur_if.nif_driver = netif_drivers[d];
105 		drv = cur_if.nif_driver;
106 
107 		for (u = 0; u < drv->netif_nifs; u++) {
108 			cur_if.nif_unit = u;
109 			unit_done = 0;
110 
111 #ifdef NETIF_DEBUG
112 			if (netif_debug)
113 				printf("\t%s%d:", drv->netif_bname,
114 				    cur_if.nif_unit);
115 #endif
116 
117 			for (s = 0; s < drv->netif_ifs[u].dif_nsel; s++) {
118 				cur_if.nif_sel = s;
119 
120 				if (drv->netif_ifs[u].dif_used & (1 << s)) {
121 #ifdef NETIF_DEBUG
122 					if (netif_debug)
123 						printf(" [%d used]", s);
124 #endif
125 					continue;
126 				}
127 
128 				val = netif_match(&cur_if, machdep_hint);
129 #ifdef NETIF_DEBUG
130 				if (netif_debug)
131 					printf(" [%d -> %d]", s, val);
132 #endif
133 				if (val > best_val) {
134 					best_val = val;
135 					best_if = cur_if;
136 				}
137 			}
138 #ifdef NETIF_DEBUG
139 			if (netif_debug)
140 				printf("\n");
141 #endif
142 		}
143 	}
144 
145 	if (best_if.nif_driver == NULL)
146 		return NULL;
147 
148 	best_if.nif_driver->
149 	    netif_ifs[best_if.nif_unit].dif_used |= (1 << best_if.nif_sel);
150 
151 #ifdef NETIF_DEBUG
152 	if (netif_debug)
153 		printf("netif_select: %s%d(%d) wins\n",
154 			best_if.nif_driver->netif_bname,
155 			best_if.nif_unit, best_if.nif_sel);
156 #endif
157 	return &best_if;
158 }
159 
160 int
161 netif_probe(struct netif *nif, void *machdep_hint)
162 {
163 	struct netif_driver *drv = nif->nif_driver;
164 
165 #ifdef NETIF_DEBUG
166 	if (netif_debug)
167 		printf("%s%d: netif_probe\n", drv->netif_bname, nif->nif_unit);
168 #endif
169 	return drv->netif_probe(nif, machdep_hint);
170 }
171 
172 void
173 netif_attach(struct netif *nif, struct iodesc *desc, void *machdep_hint)
174 {
175 	struct netif_driver *drv = nif->nif_driver;
176 
177 #ifdef NETIF_DEBUG
178 	if (netif_debug)
179 		printf("%s%d: netif_attach\n", drv->netif_bname, nif->nif_unit);
180 #endif
181 	desc->io_netif = nif;
182 #ifdef PARANOID
183 	if (drv->netif_init == NULL)
184 		panic("%s%d: no netif_init support\n", drv->netif_bname,
185 		    nif->nif_unit);
186 #endif
187 	drv->netif_init(desc, machdep_hint);
188 	bzero(drv->netif_ifs[nif->nif_unit].dif_stats,
189 	    sizeof(struct netif_stats));
190 }
191 
192 void
193 netif_detach(struct netif *nif)
194 {
195 	struct netif_driver *drv = nif->nif_driver;
196 
197 #ifdef NETIF_DEBUG
198 	if (netif_debug)
199 		printf("%s%d: netif_detach\n", drv->netif_bname, nif->nif_unit);
200 #endif
201 #ifdef PARANOID
202 	if (drv->netif_end == NULL)
203 		panic("%s%d: no netif_end support\n", drv->netif_bname,
204 		    nif->nif_unit);
205 #endif
206 	drv->netif_end(nif);
207 }
208 
209 ssize_t
210 netif_get(struct iodesc *desc, void **pkt, time_t timo)
211 {
212 #ifdef NETIF_DEBUG
213 	struct netif *nif = desc->io_netif;
214 #endif
215 	struct netif_driver *drv = desc->io_netif->nif_driver;
216 	ssize_t rv;
217 
218 #ifdef NETIF_DEBUG
219 	if (netif_debug)
220 		printf("%s%d: netif_get\n", drv->netif_bname, nif->nif_unit);
221 #endif
222 #ifdef PARANOID
223 	if (drv->netif_get == NULL)
224 		panic("%s%d: no netif_get support\n", drv->netif_bname,
225 		    nif->nif_unit);
226 #endif
227 	rv = drv->netif_get(desc, pkt, timo);
228 #ifdef NETIF_DEBUG
229 	if (netif_debug)
230 		printf("%s%d: netif_get returning %d\n", drv->netif_bname,
231 		    nif->nif_unit, (int)rv);
232 #endif
233 	return (rv);
234 }
235 
236 ssize_t
237 netif_put(struct iodesc *desc, void *pkt, size_t len)
238 {
239 #ifdef NETIF_DEBUG
240 	struct netif *nif = desc->io_netif;
241 #endif
242 	struct netif_driver *drv = desc->io_netif->nif_driver;
243 	ssize_t rv;
244 
245 #ifdef NETIF_DEBUG
246 	if (netif_debug)
247 		printf("%s%d: netif_put\n", drv->netif_bname, nif->nif_unit);
248 #endif
249 #ifdef PARANOID
250 	if (drv->netif_put == NULL)
251 		panic("%s%d: no netif_put support\n", drv->netif_bname,
252 		    nif->nif_unit);
253 #endif
254 	rv = drv->netif_put(desc, pkt, len);
255 #ifdef NETIF_DEBUG
256 	if (netif_debug)
257 		printf("%s%d: netif_put returning %d\n", drv->netif_bname,
258 		    nif->nif_unit, (int)rv);
259 #endif
260 	return (rv);
261 }
262 
263 struct iodesc *
264 socktodesc(int sock)
265 {
266 	if (sock >= SOPEN_MAX) {
267 		errno = EBADF;
268 		return (NULL);
269 	}
270 	return (&sockets[sock]);
271 }
272 
273 int
274 netif_open(void *machdep_hint)
275 {
276 	int fd;
277 	struct iodesc *s;
278 	struct netif *nif;
279 
280 	/* find a free socket */
281 	for (fd = 0, s = sockets; fd < SOPEN_MAX; fd++, s++)
282 		if (s->io_netif == (struct netif *)0)
283 			goto fnd;
284 	errno = EMFILE;
285 	return (-1);
286 
287 fnd:
288 	bzero(s, sizeof(*s));
289 	netif_init();
290 	nif = netif_select(machdep_hint);
291 	if (!nif)
292 		panic("netboot: no interfaces left untried");
293 	if (netif_probe(nif, machdep_hint)) {
294 		printf("netboot: couldn't probe %s%d\n",
295 		    nif->nif_driver->netif_bname, nif->nif_unit);
296 		errno = EINVAL;
297 		return (-1);
298 	}
299 	netif_attach(nif, s, machdep_hint);
300 
301 	return (fd);
302 }
303 
304 int
305 netif_close(int sock)
306 {
307 	if (sock >= SOPEN_MAX) {
308 		errno = EBADF;
309 		return (-1);
310 	}
311 	netif_detach(sockets[sock].io_netif);
312 	sockets[sock].io_netif = (struct netif *)0;
313 
314 	return (0);
315 }
316