xref: /dragonfly/sys/netgraph/ether/ng_ether.c (revision 606a6e92)
1 
2 /*
3  * ng_ether.c
4  *
5  * Copyright (c) 1996-2000 Whistle Communications, Inc.
6  * All rights reserved.
7  *
8  * Subject to the following obligations and disclaimer of warranty, use and
9  * redistribution of this software, in source or object code forms, with or
10  * without modifications are expressly permitted by Whistle Communications;
11  * provided, however, that:
12  * 1. Any and all reproductions of the source or object code must include the
13  *    copyright notice above and the following disclaimer of warranties; and
14  * 2. No rights are granted, in any manner or form, to use Whistle
15  *    Communications, Inc. trademarks, including the mark "WHISTLE
16  *    COMMUNICATIONS" on advertising, endorsements, or otherwise except as
17  *    such appears in the above copyright notice or in the software.
18  *
19  * THIS SOFTWARE IS BEING PROVIDED BY WHISTLE COMMUNICATIONS "AS IS", AND
20  * TO THE MAXIMUM EXTENT PERMITTED BY LAW, WHISTLE COMMUNICATIONS MAKES NO
21  * REPRESENTATIONS OR WARRANTIES, EXPRESS OR IMPLIED, REGARDING THIS SOFTWARE,
22  * INCLUDING WITHOUT LIMITATION, ANY AND ALL IMPLIED WARRANTIES OF
23  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT.
24  * WHISTLE COMMUNICATIONS DOES NOT WARRANT, GUARANTEE, OR MAKE ANY
25  * REPRESENTATIONS REGARDING THE USE OF, OR THE RESULTS OF THE USE OF THIS
26  * SOFTWARE IN TERMS OF ITS CORRECTNESS, ACCURACY, RELIABILITY OR OTHERWISE.
27  * IN NO EVENT SHALL WHISTLE COMMUNICATIONS BE LIABLE FOR ANY DAMAGES
28  * RESULTING FROM OR ARISING OUT OF ANY USE OF THIS SOFTWARE, INCLUDING
29  * WITHOUT LIMITATION, ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
30  * PUNITIVE, OR CONSEQUENTIAL DAMAGES, PROCUREMENT OF SUBSTITUTE GOODS OR
31  * SERVICES, LOSS OF USE, DATA OR PROFITS, HOWEVER CAUSED AND UNDER ANY
32  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
33  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
34  * THIS SOFTWARE, EVEN IF WHISTLE COMMUNICATIONS IS ADVISED OF THE POSSIBILITY
35  * OF SUCH DAMAGE.
36  *
37  * Authors: Archie Cobbs <archie@freebsd.org>
38  *	    Julian Elischer <julian@freebsd.org>
39  *
40  * $FreeBSD: src/sys/netgraph/ng_ether.c,v 1.2.2.13 2002/07/02 20:10:25 archie Exp $
41  * $DragonFly: src/sys/netgraph/ether/ng_ether.c,v 1.5 2004/06/02 14:43:00 eirikn Exp $
42  */
43 
44 /*
45  * ng_ether(4) netgraph node type
46  */
47 
48 #include <sys/param.h>
49 #include <sys/systm.h>
50 #include <sys/kernel.h>
51 #include <sys/malloc.h>
52 #include <sys/mbuf.h>
53 #include <sys/errno.h>
54 #include <sys/syslog.h>
55 #include <sys/socket.h>
56 
57 #include <net/if.h>
58 #include <net/if_types.h>
59 #include <net/if_arp.h>
60 #include <net/if_var.h>
61 #include <net/ethernet.h>
62 
63 #include <netgraph/ng_message.h>
64 #include <netgraph/netgraph.h>
65 #include <netgraph/ng_parse.h>
66 #include "ng_ether.h"
67 
68 #define IFP2AC(IFP)  ((struct arpcom *)IFP)
69 #define IFP2NG(ifp)  ((struct ng_node *)((struct arpcom *)(ifp))->ac_netgraph)
70 
71 /* Per-node private data */
72 struct private {
73 	struct ifnet	*ifp;		/* associated interface */
74 	hook_p		upper;		/* upper hook connection */
75 	hook_p		lower;		/* lower OR orphan hook connection */
76 	u_char		lowerOrphan;	/* whether lower is lower or orphan */
77 	u_char		autoSrcAddr;	/* always overwrite source address */
78 	u_char		promisc;	/* promiscuous mode enabled */
79 	u_long		hwassist;	/* hardware checksum capabilities */
80 };
81 typedef struct private *priv_p;
82 
83 /* Functional hooks called from if_ethersubr.c */
84 static void	ng_ether_input(struct ifnet *ifp,
85 		    struct mbuf **mp, struct ether_header *eh);
86 static void	ng_ether_input_orphan(struct ifnet *ifp,
87 		    struct mbuf *m, struct ether_header *eh);
88 static int	ng_ether_output(struct ifnet *ifp, struct mbuf **mp);
89 static void	ng_ether_attach(struct ifnet *ifp);
90 static void	ng_ether_detach(struct ifnet *ifp);
91 
92 /* Other functions */
93 static void	ng_ether_input2(node_p node,
94 		    struct mbuf **mp, struct ether_header *eh);
95 static int	ng_ether_glueback_header(struct mbuf **mp,
96 			struct ether_header *eh);
97 static int	ng_ether_rcv_lower(node_p node, struct mbuf *m, meta_p meta);
98 static int	ng_ether_rcv_upper(node_p node, struct mbuf *m, meta_p meta);
99 
100 /* Netgraph node methods */
101 static ng_constructor_t	ng_ether_constructor;
102 static ng_rcvmsg_t	ng_ether_rcvmsg;
103 static ng_shutdown_t	ng_ether_rmnode;
104 static ng_newhook_t	ng_ether_newhook;
105 static ng_rcvdata_t	ng_ether_rcvdata;
106 static ng_disconnect_t	ng_ether_disconnect;
107 static int		ng_ether_mod_event(module_t mod, int event, void *data);
108 
109 /* Parse type for an Ethernet address */
110 static ng_parse_t	ng_enaddr_parse;
111 static ng_unparse_t	ng_enaddr_unparse;
112 const struct ng_parse_type ng_ether_enaddr_type = {
113 	NULL,
114 	NULL,
115 	NULL,
116 	ng_enaddr_parse,
117 	ng_enaddr_unparse,
118 	NULL,			/* no such thing as a "default" EN address */
119 	0
120 };
121 
122 /* List of commands and how to convert arguments to/from ASCII */
123 static const struct ng_cmdlist ng_ether_cmdlist[] = {
124 	{
125 	  NGM_ETHER_COOKIE,
126 	  NGM_ETHER_GET_IFNAME,
127 	  "getifname",
128 	  NULL,
129 	  &ng_parse_string_type
130 	},
131 	{
132 	  NGM_ETHER_COOKIE,
133 	  NGM_ETHER_GET_IFINDEX,
134 	  "getifindex",
135 	  NULL,
136 	  &ng_parse_int32_type
137 	},
138 	{
139 	  NGM_ETHER_COOKIE,
140 	  NGM_ETHER_GET_ENADDR,
141 	  "getenaddr",
142 	  NULL,
143 	  &ng_ether_enaddr_type
144 	},
145 	{
146 	  NGM_ETHER_COOKIE,
147 	  NGM_ETHER_SET_ENADDR,
148 	  "setenaddr",
149 	  &ng_ether_enaddr_type,
150 	  NULL
151 	},
152 	{
153 	  NGM_ETHER_COOKIE,
154 	  NGM_ETHER_GET_PROMISC,
155 	  "getpromisc",
156 	  NULL,
157 	  &ng_parse_int32_type
158 	},
159 	{
160 	  NGM_ETHER_COOKIE,
161 	  NGM_ETHER_SET_PROMISC,
162 	  "setpromisc",
163 	  &ng_parse_int32_type,
164 	  NULL
165 	},
166 	{
167 	  NGM_ETHER_COOKIE,
168 	  NGM_ETHER_GET_AUTOSRC,
169 	  "getautosrc",
170 	  NULL,
171 	  &ng_parse_int32_type
172 	},
173 	{
174 	  NGM_ETHER_COOKIE,
175 	  NGM_ETHER_SET_AUTOSRC,
176 	  "setautosrc",
177 	  &ng_parse_int32_type,
178 	  NULL
179 	},
180 	{ 0 }
181 };
182 
183 static struct ng_type ng_ether_typestruct = {
184 	NG_VERSION,
185 	NG_ETHER_NODE_TYPE,
186 	ng_ether_mod_event,
187 	ng_ether_constructor,
188 	ng_ether_rcvmsg,
189 	ng_ether_rmnode,
190 	ng_ether_newhook,
191 	NULL,
192 	NULL,
193 	ng_ether_rcvdata,
194 	ng_ether_rcvdata,
195 	ng_ether_disconnect,
196 	ng_ether_cmdlist,
197 };
198 NETGRAPH_INIT(ether, &ng_ether_typestruct);
199 
200 /******************************************************************
201 		    ETHERNET FUNCTION HOOKS
202 ******************************************************************/
203 
204 /*
205  * Handle a packet that has come in on an interface. We get to
206  * look at it here before any upper layer protocols do.
207  *
208  * NOTE: this function will get called at splimp()
209  */
210 static void
211 ng_ether_input(struct ifnet *ifp,
212 	struct mbuf **mp, struct ether_header *eh)
213 {
214 	const node_p node = IFP2NG(ifp);
215 	const priv_p priv = node->private;
216 
217 	/* If "lower" hook not connected, let packet continue */
218 	if (priv->lower == NULL || priv->lowerOrphan)
219 		return;
220 	ng_ether_input2(node, mp, eh);
221 }
222 
223 /*
224  * Handle a packet that has come in on an interface, and which
225  * does not match any of our known protocols (an ``orphan'').
226  *
227  * NOTE: this function will get called at splimp()
228  */
229 static void
230 ng_ether_input_orphan(struct ifnet *ifp,
231 	struct mbuf *m, struct ether_header *eh)
232 {
233 	const node_p node = IFP2NG(ifp);
234 	const priv_p priv = node->private;
235 
236 	/* If "orphan" hook not connected, let packet continue */
237 	if (priv->lower == NULL || !priv->lowerOrphan) {
238 		m_freem(m);
239 		return;
240 	}
241 	ng_ether_input2(node, &m, eh);
242 	if (m != NULL)
243 		m_freem(m);
244 }
245 
246 /*
247  * Handle a packet that has come in on an interface.
248  * The Ethernet header has already been detached from the mbuf,
249  * so we have to put it back.
250  *
251  * NOTE: this function will get called at splimp()
252  */
253 static void
254 ng_ether_input2(node_p node, struct mbuf **mp, struct ether_header *eh)
255 {
256 	const priv_p priv = node->private;
257 	meta_p meta = NULL;
258 	int error;
259 
260 	/* Glue Ethernet header back on */
261 	if ((error = ng_ether_glueback_header(mp, eh)) != 0)
262 		return;
263 
264 	/* Send out lower/orphan hook */
265 	(void)ng_queue_data(priv->lower, *mp, meta);
266 	*mp = NULL;
267 }
268 
269 /*
270  * Handle a packet that is going out on an interface.
271  * The Ethernet header is already attached to the mbuf.
272  */
273 static int
274 ng_ether_output(struct ifnet *ifp, struct mbuf **mp)
275 {
276 	const node_p node = IFP2NG(ifp);
277 	const priv_p priv = node->private;
278 	meta_p meta = NULL;
279 	int error = 0;
280 
281 	/* If "upper" hook not connected, let packet continue */
282 	if (priv->upper == NULL)
283 		return (0);
284 
285 	/* Send it out "upper" hook */
286 	NG_SEND_DATA(error, priv->upper, *mp, meta);
287 	*mp = NULL;
288 	return (error);
289 }
290 
291 /*
292  * A new Ethernet interface has been attached.
293  * Create a new node for it, etc.
294  */
295 static void
296 ng_ether_attach(struct ifnet *ifp)
297 {
298 	char name[IFNAMSIZ + 1];
299 	priv_p priv;
300 	node_p node;
301 
302 	/* Create node */
303 	KASSERT(!IFP2NG(ifp), ("%s: node already exists?", __FUNCTION__));
304 	strlcpy(name, ifp->if_xname, sizeof(name));
305 	if (ng_make_node_common(&ng_ether_typestruct, &node) != 0) {
306 		log(LOG_ERR, "%s: can't %s for %s\n",
307 		    __FUNCTION__, "create node", name);
308 		return;
309 	}
310 
311 	/* Allocate private data */
312 	MALLOC(priv, priv_p, sizeof(*priv), M_NETGRAPH, M_NOWAIT);
313 	if (priv == NULL) {
314 		log(LOG_ERR, "%s: can't %s for %s\n",
315 		    __FUNCTION__, "allocate memory", name);
316 		ng_unref(node);
317 		return;
318 	}
319 	bzero(priv, sizeof(*priv));
320 	node->private = priv;
321 	priv->ifp = ifp;
322 	IFP2NG(ifp) = node;
323 	priv->autoSrcAddr = 1;
324 	priv->hwassist = ifp->if_hwassist;
325 
326 	/* Try to give the node the same name as the interface */
327 	if (ng_name_node(node, name) != 0) {
328 		log(LOG_WARNING, "%s: can't name node %s\n",
329 		    __FUNCTION__, name);
330 	}
331 }
332 
333 /*
334  * An Ethernet interface is being detached.
335  * Destroy its node.
336  */
337 static void
338 ng_ether_detach(struct ifnet *ifp)
339 {
340 	const node_p node = IFP2NG(ifp);
341 	priv_p priv;
342 
343 	if (node == NULL)		/* no node (why not?), ignore */
344 		return;
345 	ng_rmnode(node);		/* break all links to other nodes */
346 	node->flags |= NG_INVALID;
347 	ng_unname(node);		/* free name (and its reference) */
348 	IFP2NG(ifp) = NULL;		/* detach node from interface */
349 	priv = node->private;		/* free node private info */
350 	bzero(priv, sizeof(*priv));
351 	FREE(priv, M_NETGRAPH);
352 	node->private = NULL;
353 	ng_unref(node);			/* free node itself */
354 }
355 
356 /*
357  * Optimization for gluing the Ethernet header back onto
358  * the front of an incoming packet.
359  */
360 static int
361 ng_ether_glueback_header(struct mbuf **mp, struct ether_header *eh)
362 {
363 	struct mbuf *m = *mp;
364 	int error = 0;
365 
366 	/*
367 	 * Optimize for the case where the header is already in place
368 	 * at the front of the mbuf. This is actually quite likely
369 	 * because many Ethernet drivers generate packets this way.
370 	 */
371 	if (eh == mtod(m, struct ether_header *) - 1) {
372 		m->m_len += sizeof(*eh);
373 		m->m_data -= sizeof(*eh);
374 		m->m_pkthdr.len += sizeof(*eh);
375 		goto done;
376 	}
377 
378 	/* Prepend the header back onto the front of the mbuf */
379 	M_PREPEND(m, sizeof(*eh), MB_DONTWAIT);
380 	if (m == NULL) {
381 		error = ENOBUFS;
382 		goto done;
383 	}
384 
385 	/* Copy header into front of mbuf */
386 	bcopy(eh, mtod(m, void *), sizeof(*eh));
387 
388 done:
389 	/* Done */
390 	*mp = m;
391 	return error;
392 }
393 
394 /******************************************************************
395 		    NETGRAPH NODE METHODS
396 ******************************************************************/
397 
398 /*
399  * It is not possible or allowable to create a node of this type.
400  * Nodes get created when the interface is attached (or, when
401  * this node type's KLD is loaded).
402  */
403 static int
404 ng_ether_constructor(node_p *nodep)
405 {
406 	return (EINVAL);
407 }
408 
409 /*
410  * Check for attaching a new hook.
411  */
412 static	int
413 ng_ether_newhook(node_p node, hook_p hook, const char *name)
414 {
415 	const priv_p priv = node->private;
416 	u_char orphan = priv->lowerOrphan;
417 	hook_p *hookptr;
418 
419 	/* Divert hook is an alias for lower */
420 	if (strcmp(name, NG_ETHER_HOOK_DIVERT) == 0)
421 		name = NG_ETHER_HOOK_LOWER;
422 
423 	/* Which hook? */
424 	if (strcmp(name, NG_ETHER_HOOK_UPPER) == 0)
425 		hookptr = &priv->upper;
426 	else if (strcmp(name, NG_ETHER_HOOK_LOWER) == 0) {
427 		hookptr = &priv->lower;
428 		orphan = 0;
429 	} else if (strcmp(name, NG_ETHER_HOOK_ORPHAN) == 0) {
430 		hookptr = &priv->lower;
431 		orphan = 1;
432 	} else
433 		return (EINVAL);
434 
435 	/* Check if already connected (shouldn't be, but doesn't hurt) */
436 	if (*hookptr != NULL)
437 		return (EISCONN);
438 
439 	/* Disable hardware checksums while 'upper' hook is connected */
440 	if (hookptr == &priv->upper)
441 		priv->ifp->if_hwassist = 0;
442 
443 	/* OK */
444 	*hookptr = hook;
445 	priv->lowerOrphan = orphan;
446 	return (0);
447 }
448 
449 /*
450  * Receive an incoming control message.
451  */
452 static int
453 ng_ether_rcvmsg(node_p node, struct ng_mesg *msg,
454 	const char *retaddr, struct ng_mesg **rptr)
455 {
456 	const priv_p priv = node->private;
457 	struct ng_mesg *resp = NULL;
458 	int error = 0;
459 
460 	switch (msg->header.typecookie) {
461 	case NGM_ETHER_COOKIE:
462 		switch (msg->header.cmd) {
463 		case NGM_ETHER_GET_IFNAME:
464 			NG_MKRESPONSE(resp, msg, IFNAMSIZ + 1, M_NOWAIT);
465 			if (resp == NULL) {
466 				error = ENOMEM;
467 				break;
468 			}
469 			strlcpy(resp->data, priv->ifp->if_xname, IFNAMSIZ);
470 			break;
471 		case NGM_ETHER_GET_IFINDEX:
472 			NG_MKRESPONSE(resp, msg, sizeof(u_int32_t), M_NOWAIT);
473 			if (resp == NULL) {
474 				error = ENOMEM;
475 				break;
476 			}
477 			*((u_int32_t *)resp->data) = priv->ifp->if_index;
478 			break;
479 		case NGM_ETHER_GET_ENADDR:
480 			NG_MKRESPONSE(resp, msg, ETHER_ADDR_LEN, M_NOWAIT);
481 			if (resp == NULL) {
482 				error = ENOMEM;
483 				break;
484 			}
485 			bcopy((IFP2AC(priv->ifp))->ac_enaddr,
486 			    resp->data, ETHER_ADDR_LEN);
487 			break;
488 		case NGM_ETHER_SET_ENADDR:
489 		    {
490 			if (msg->header.arglen != ETHER_ADDR_LEN) {
491 				error = EINVAL;
492 				break;
493 			}
494 			error = if_setlladdr(priv->ifp,
495 			    (u_char *)msg->data, ETHER_ADDR_LEN);
496 			break;
497 		    }
498 		case NGM_ETHER_GET_PROMISC:
499 			NG_MKRESPONSE(resp, msg, sizeof(u_int32_t), M_NOWAIT);
500 			if (resp == NULL) {
501 				error = ENOMEM;
502 				break;
503 			}
504 			*((u_int32_t *)resp->data) = priv->promisc;
505 			break;
506 		case NGM_ETHER_SET_PROMISC:
507 		    {
508 			u_char want;
509 
510 			if (msg->header.arglen != sizeof(u_int32_t)) {
511 				error = EINVAL;
512 				break;
513 			}
514 			want = !!*((u_int32_t *)msg->data);
515 			if (want ^ priv->promisc) {
516 				if ((error = ifpromisc(priv->ifp, want)) != 0)
517 					break;
518 				priv->promisc = want;
519 			}
520 			break;
521 		    }
522 		case NGM_ETHER_GET_AUTOSRC:
523 			NG_MKRESPONSE(resp, msg, sizeof(u_int32_t), M_NOWAIT);
524 			if (resp == NULL) {
525 				error = ENOMEM;
526 				break;
527 			}
528 			*((u_int32_t *)resp->data) = priv->autoSrcAddr;
529 			break;
530 		case NGM_ETHER_SET_AUTOSRC:
531 			if (msg->header.arglen != sizeof(u_int32_t)) {
532 				error = EINVAL;
533 				break;
534 			}
535 			priv->autoSrcAddr = !!*((u_int32_t *)msg->data);
536 			break;
537 		default:
538 			error = EINVAL;
539 			break;
540 		}
541 		break;
542 	default:
543 		error = EINVAL;
544 		break;
545 	}
546 	if (rptr)
547 		*rptr = resp;
548 	else if (resp != NULL)
549 		FREE(resp, M_NETGRAPH);
550 	FREE(msg, M_NETGRAPH);
551 	return (error);
552 }
553 
554 /*
555  * Receive data on a hook.
556  */
557 static int
558 ng_ether_rcvdata(hook_p hook, struct mbuf *m, meta_p meta)
559 {
560 	const node_p node = hook->node;
561 	const priv_p priv = node->private;
562 
563 	if (hook == priv->lower)
564 		return ng_ether_rcv_lower(node, m, meta);
565 	if (hook == priv->upper)
566 		return ng_ether_rcv_upper(node, m, meta);
567 	panic("%s: weird hook", __FUNCTION__);
568 }
569 
570 /*
571  * Handle an mbuf received on the "lower" hook.
572  */
573 static int
574 ng_ether_rcv_lower(node_p node, struct mbuf *m, meta_p meta)
575 {
576 	const priv_p priv = node->private;
577  	struct ifnet *const ifp = priv->ifp;
578 
579 	/* Discard meta info */
580 	NG_FREE_META(meta);
581 
582 	/* Check whether interface is ready for packets */
583 	if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) {
584 		m_freem(m);
585 		return (ENETDOWN);
586 	}
587 
588 	/* Make sure header is fully pulled up */
589 	if (m->m_pkthdr.len < sizeof(struct ether_header)) {
590 		m_freem(m);
591 		return (EINVAL);
592 	}
593 	if (m->m_len < sizeof(struct ether_header)
594 	    && (m = m_pullup(m, sizeof(struct ether_header))) == NULL)
595 		return (ENOBUFS);
596 
597 	/* Drop in the MAC address if desired */
598 	if (priv->autoSrcAddr) {
599 
600 		/* Make the mbuf writable if it's not already */
601 		if (!M_WRITABLE(m)
602 		    && (m = m_pullup(m, sizeof(struct ether_header))) == NULL)
603 			return (ENOBUFS);
604 
605 		/* Overwrite source MAC address */
606 		bcopy((IFP2AC(ifp))->ac_enaddr,
607 		    mtod(m, struct ether_header *)->ether_shost,
608 		    ETHER_ADDR_LEN);
609 	}
610 
611 	/* Send it on its way */
612 	return ether_output_frame(ifp, m);
613 }
614 
615 /*
616  * Handle an mbuf received on the "upper" hook.
617  */
618 static int
619 ng_ether_rcv_upper(node_p node, struct mbuf *m, meta_p meta)
620 {
621 	const priv_p priv = node->private;
622 	struct ether_header *eh;
623 
624 	/* Discard meta info */
625 	NG_FREE_META(meta);
626 
627 	/* Check length and pull off header */
628 	if (m->m_pkthdr.len < sizeof(*eh)) {
629 		m_freem(m);
630 		return (EINVAL);
631 	}
632 	if (m->m_len < sizeof(*eh) && (m = m_pullup(m, sizeof(*eh))) == NULL)
633 		return (ENOBUFS);
634 	eh = mtod(m, struct ether_header *);
635 	m->m_data += sizeof(*eh);
636 	m->m_len -= sizeof(*eh);
637 	m->m_pkthdr.len -= sizeof(*eh);
638 	m->m_pkthdr.rcvif = priv->ifp;
639 
640 	/* Route packet back in */
641 	ether_demux(priv->ifp, eh, m);
642 	return (0);
643 }
644 
645 /*
646  * Shutdown node. This resets the node but does not remove it.
647  */
648 static int
649 ng_ether_rmnode(node_p node)
650 {
651 	const priv_p priv = node->private;
652 
653 	ng_cutlinks(node);
654 	node->flags &= ~NG_INVALID;	/* bounce back to life */
655 	if (priv->promisc) {		/* disable promiscuous mode */
656 		(void)ifpromisc(priv->ifp, 0);
657 		priv->promisc = 0;
658 	}
659 	priv->autoSrcAddr = 1;		/* reset auto-src-addr flag */
660 	return (0);
661 }
662 
663 /*
664  * Hook disconnection.
665  */
666 static int
667 ng_ether_disconnect(hook_p hook)
668 {
669 	const priv_p priv = hook->node->private;
670 
671 	if (hook == priv->upper) {
672 		priv->upper = NULL;
673 		priv->ifp->if_hwassist = priv->hwassist;  /* restore h/w csum */
674 	} else if (hook == priv->lower) {
675 		priv->lower = NULL;
676 		priv->lowerOrphan = 0;
677 	} else
678 		panic("%s: weird hook", __FUNCTION__);
679 	if (hook->node->numhooks == 0)
680 		ng_rmnode(hook->node);	/* reset node */
681 	return (0);
682 }
683 
684 static int
685 ng_enaddr_parse(const struct ng_parse_type *type,
686 	const char *s, int *const off, const u_char *const start,
687 	u_char *const buf, int *const buflen)
688 {
689 	char *eptr;
690 	u_long val;
691 	int i;
692 
693 	if (*buflen < ETHER_ADDR_LEN)
694 		return (ERANGE);
695 	for (i = 0; i < ETHER_ADDR_LEN; i++) {
696 		val = strtoul(s + *off, &eptr, 16);
697 		if (val > 0xff || eptr == s + *off)
698 			return (EINVAL);
699 		buf[i] = (u_char)val;
700 		*off = (eptr - s);
701 		if (i < ETHER_ADDR_LEN - 1) {
702 			if (*eptr != ':')
703 				return (EINVAL);
704 			(*off)++;
705 		}
706 	}
707 	*buflen = ETHER_ADDR_LEN;
708 	return (0);
709 }
710 
711 static int
712 ng_enaddr_unparse(const struct ng_parse_type *type,
713 	const u_char *data, int *off, char *cbuf, int cbuflen)
714 {
715 	int len;
716 
717 	len = snprintf(cbuf, cbuflen, "%02x:%02x:%02x:%02x:%02x:%02x",
718 	    data[*off], data[*off + 1], data[*off + 2],
719 	    data[*off + 3], data[*off + 4], data[*off + 5]);
720 	if (len >= cbuflen)
721 		return (ERANGE);
722 	*off += ETHER_ADDR_LEN;
723 	return (0);
724 }
725 
726 /******************************************************************
727 		    	INITIALIZATION
728 ******************************************************************/
729 
730 /*
731  * Handle loading and unloading for this node type.
732  */
733 static int
734 ng_ether_mod_event(module_t mod, int event, void *data)
735 {
736 	struct ifnet *ifp;
737 	int error = 0;
738 	int s;
739 
740 	s = splnet();
741 	switch (event) {
742 	case MOD_LOAD:
743 
744 		/* Register function hooks */
745 		if (ng_ether_attach_p != NULL) {
746 			error = EEXIST;
747 			break;
748 		}
749 		ng_ether_attach_p = ng_ether_attach;
750 		ng_ether_detach_p = ng_ether_detach;
751 		ng_ether_output_p = ng_ether_output;
752 		ng_ether_input_p = ng_ether_input;
753 		ng_ether_input_orphan_p = ng_ether_input_orphan;
754 
755 		/* Create nodes for any already-existing Ethernet interfaces */
756 		TAILQ_FOREACH(ifp, &ifnet, if_link) {
757 			if (ifp->if_type == IFT_ETHER ||
758 			    ifp->if_type == IFT_L2VLAN)
759 				ng_ether_attach(ifp);
760 		}
761 		break;
762 
763 	case MOD_UNLOAD:
764 
765 		/*
766 		 * Note that the base code won't try to unload us until
767 		 * all nodes have been removed, and that can't happen
768 		 * until all Ethernet interfaces are removed. In any
769 		 * case, we know there are no nodes left if the action
770 		 * is MOD_UNLOAD, so there's no need to detach any nodes.
771 		 */
772 
773 		/* Unregister function hooks */
774 		ng_ether_attach_p = NULL;
775 		ng_ether_detach_p = NULL;
776 		ng_ether_output_p = NULL;
777 		ng_ether_input_p = NULL;
778 		ng_ether_input_orphan_p = NULL;
779 		break;
780 
781 	default:
782 		error = EOPNOTSUPP;
783 		break;
784 	}
785 	splx(s);
786 	return (error);
787 }
788 
789