xref: /dragonfly/sys/netgraph7/iface/ng_iface.c (revision 3170ffd7)
1 /*
2  * ng_iface.c
3  */
4 
5 /*-
6  * Copyright (c) 1996-1999 Whistle Communications, Inc.
7  * All rights reserved.
8  *
9  * Subject to the following obligations and disclaimer of warranty, use and
10  * redistribution of this software, in source or object code forms, with or
11  * without modifications are expressly permitted by Whistle Communications;
12  * provided, however, that:
13  * 1. Any and all reproductions of the source or object code must include the
14  *    copyright notice above and the following disclaimer of warranties; and
15  * 2. No rights are granted, in any manner or form, to use Whistle
16  *    Communications, Inc. trademarks, including the mark "WHISTLE
17  *    COMMUNICATIONS" on advertising, endorsements, or otherwise except as
18  *    such appears in the above copyright notice or in the software.
19  *
20  * THIS SOFTWARE IS BEING PROVIDED BY WHISTLE COMMUNICATIONS "AS IS", AND
21  * TO THE MAXIMUM EXTENT PERMITTED BY LAW, WHISTLE COMMUNICATIONS MAKES NO
22  * REPRESENTATIONS OR WARRANTIES, EXPRESS OR IMPLIED, REGARDING THIS SOFTWARE,
23  * INCLUDING WITHOUT LIMITATION, ANY AND ALL IMPLIED WARRANTIES OF
24  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT.
25  * WHISTLE COMMUNICATIONS DOES NOT WARRANT, GUARANTEE, OR MAKE ANY
26  * REPRESENTATIONS REGARDING THE USE OF, OR THE RESULTS OF THE USE OF THIS
27  * SOFTWARE IN TERMS OF ITS CORRECTNESS, ACCURACY, RELIABILITY OR OTHERWISE.
28  * IN NO EVENT SHALL WHISTLE COMMUNICATIONS BE LIABLE FOR ANY DAMAGES
29  * RESULTING FROM OR ARISING OUT OF ANY USE OF THIS SOFTWARE, INCLUDING
30  * WITHOUT LIMITATION, ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
31  * PUNITIVE, OR CONSEQUENTIAL DAMAGES, PROCUREMENT OF SUBSTITUTE GOODS OR
32  * SERVICES, LOSS OF USE, DATA OR PROFITS, HOWEVER CAUSED AND UNDER ANY
33  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
34  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
35  * THIS SOFTWARE, EVEN IF WHISTLE COMMUNICATIONS IS ADVISED OF THE POSSIBILITY
36  * OF SUCH DAMAGE.
37  *
38  * Author: Archie Cobbs <archie@freebsd.org>
39  *
40  * $FreeBSD: src/sys/netgraph/ng_iface.c,v 1.48 2008/01/31 08:51:48 mav Exp $
41  * $Whistle: ng_iface.c,v 1.33 1999/11/01 09:24:51 julian Exp $
42  */
43 
44 /*
45  * This node is also a system networking interface. It has
46  * a hook for each protocol (IP, AppleTalk, IPX, etc). Packets
47  * are simply relayed between the interface and the hooks.
48  *
49  * Interfaces are named ng0, ng1, etc.  New nodes take the
50  * first available interface name.
51  *
52  * This node also includes Berkeley packet filter support.
53  */
54 
55 #include "opt_inet.h"
56 #include "opt_inet6.h"
57 #include "opt_ipx.h"
58 
59 #include <sys/param.h>
60 #include <sys/systm.h>
61 #include <sys/errno.h>
62 #include <sys/kernel.h>
63 #include <sys/malloc.h>
64 #include <sys/mbuf.h>
65 #include <sys/errno.h>
66 #include <sys/random.h>
67 #include <sys/sockio.h>
68 #include <sys/socket.h>
69 #include <sys/syslog.h>
70 #include <sys/libkern.h>
71 
72 #include <net/if.h>
73 #include <net/if_types.h>
74 #include <net/ifq_var.h>
75 #include <net/bpf.h>
76 #include <net/netisr.h>
77 
78 #include <netinet/in.h>
79 
80 #include <netgraph7/ng_message.h>
81 #include <netgraph7/netgraph.h>
82 #include <netgraph7/ng_parse.h>
83 #include <netgraph7/cisco/ng_cisco.h>
84 #include "ng_iface.h"
85 
86 #ifdef NG_SEPARATE_MALLOC
87 MALLOC_DEFINE(M_NETGRAPH_IFACE, "netgraph_iface", "netgraph iface node ");
88 #else
89 #define M_NETGRAPH_IFACE M_NETGRAPH
90 #endif
91 
92 /* This struct describes one address family */
93 struct iffam {
94 	sa_family_t	family;		/* Address family */
95 	const char	*hookname;	/* Name for hook */
96 };
97 typedef const struct iffam *iffam_p;
98 
99 /* List of address families supported by our interface */
100 static const struct iffam gFamilies[] = {
101 	{ AF_INET,	NG_IFACE_HOOK_INET	},
102 	{ AF_INET6,	NG_IFACE_HOOK_INET6	},
103 	{ AF_IPX,	NG_IFACE_HOOK_IPX	},
104 	{ AF_ATM,	NG_IFACE_HOOK_ATM	},
105 	{ AF_NATM,	NG_IFACE_HOOK_NATM	},
106 };
107 #define NUM_FAMILIES		NELEM(gFamilies)
108 
109 /* Node private data */
110 struct ng_iface_private {
111 	struct	ifnet *ifp;		/* Our interface */
112 	int	unit;			/* Interface unit number */
113 	node_p	node;			/* Our netgraph node */
114 	hook_p	hooks[NUM_FAMILIES];	/* Hook for each address family */
115 };
116 typedef struct ng_iface_private *priv_p;
117 
118 /* Interface methods */
119 static void	ng_iface_start(struct ifnet *ifp, struct ifaltq_subque *);
120 static int	ng_iface_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data,
121 			struct ucred *cr);
122 static int	ng_iface_output(struct ifnet *ifp, struct mbuf *m0,
123 			struct sockaddr *dst, struct rtentry *rt0);
124 static void	ng_iface_bpftap(struct ifnet *ifp,
125 			struct mbuf *m, sa_family_t family);
126 static int	ng_iface_send(struct ifnet *ifp, struct mbuf *m,
127 			sa_family_t sa);
128 #ifdef DEBUG
129 static void	ng_iface_print_ioctl(struct ifnet *ifp, int cmd, caddr_t data);
130 #endif
131 
132 /* Netgraph methods */
133 static int		ng_iface_mod_event(module_t, int, void *);
134 static ng_constructor_t	ng_iface_constructor;
135 static ng_rcvmsg_t	ng_iface_rcvmsg;
136 static ng_shutdown_t	ng_iface_shutdown;
137 static ng_newhook_t	ng_iface_newhook;
138 static ng_rcvdata_t	ng_iface_rcvdata;
139 static ng_disconnect_t	ng_iface_disconnect;
140 
141 /* Helper stuff */
142 static iffam_p	get_iffam_from_af(sa_family_t family);
143 static iffam_p	get_iffam_from_hook(priv_p priv, hook_p hook);
144 static iffam_p	get_iffam_from_name(const char *name);
145 static hook_p  *get_hook_from_iffam(priv_p priv, iffam_p iffam);
146 
147 /* Parse type for struct ng_cisco_ipaddr */
148 static const struct ng_parse_struct_field ng_cisco_ipaddr_type_fields[]
149 	= NG_CISCO_IPADDR_TYPE_INFO;
150 static const struct ng_parse_type ng_cisco_ipaddr_type = {
151 	&ng_parse_struct_type,
152 	&ng_cisco_ipaddr_type_fields
153 };
154 
155 /* List of commands and how to convert arguments to/from ASCII */
156 static const struct ng_cmdlist ng_iface_cmds[] = {
157 	{
158 	  NGM_IFACE_COOKIE,
159 	  NGM_IFACE_GET_IFNAME,
160 	  "getifname",
161 	  NULL,
162 	  &ng_parse_string_type
163 	},
164 	{
165 	  NGM_IFACE_COOKIE,
166 	  NGM_IFACE_POINT2POINT,
167 	  "point2point",
168 	  NULL,
169 	  NULL
170 	},
171 	{
172 	  NGM_IFACE_COOKIE,
173 	  NGM_IFACE_BROADCAST,
174 	  "broadcast",
175 	  NULL,
176 	  NULL
177 	},
178 	{
179 	  NGM_CISCO_COOKIE,
180 	  NGM_CISCO_GET_IPADDR,
181 	  "getipaddr",
182 	  NULL,
183 	  &ng_cisco_ipaddr_type
184 	},
185 	{
186 	  NGM_IFACE_COOKIE,
187 	  NGM_IFACE_GET_IFINDEX,
188 	  "getifindex",
189 	  NULL,
190 	  &ng_parse_uint32_type
191 	},
192 	{ 0 }
193 };
194 
195 /* Node type descriptor */
196 static struct ng_type typestruct = {
197 	.version =	NG_ABI_VERSION,
198 	.name =		NG_IFACE_NODE_TYPE,
199 	.mod_event =	ng_iface_mod_event,
200 	.constructor =	ng_iface_constructor,
201 	.rcvmsg =	ng_iface_rcvmsg,
202 	.shutdown =	ng_iface_shutdown,
203 	.newhook =	ng_iface_newhook,
204 	.rcvdata =	ng_iface_rcvdata,
205 	.disconnect =	ng_iface_disconnect,
206 	.cmdlist =	ng_iface_cmds,
207 };
208 NETGRAPH_INIT(iface, &typestruct);
209 
210 /* We keep a bitmap indicating which unit numbers are free.
211    One means the unit number is free, zero means it's taken. */
212 static int	*ng_iface_units = NULL;
213 static int	ng_iface_units_len = 0;
214 
215 #define UNITS_BITSPERWORD	(sizeof(*ng_iface_units) * NBBY)
216 
217 
218 /************************************************************************
219 			HELPER STUFF
220  ************************************************************************/
221 
222 /*
223  * Get the family descriptor from the family ID
224  */
225 static __inline iffam_p
226 get_iffam_from_af(sa_family_t family)
227 {
228 	iffam_p iffam;
229 	int k;
230 
231 	for (k = 0; k < NUM_FAMILIES; k++) {
232 		iffam = &gFamilies[k];
233 		if (iffam->family == family)
234 			return (iffam);
235 	}
236 	return (NULL);
237 }
238 
239 /*
240  * Get the family descriptor from the hook
241  */
242 static __inline iffam_p
243 get_iffam_from_hook(priv_p priv, hook_p hook)
244 {
245 	int k;
246 
247 	for (k = 0; k < NUM_FAMILIES; k++)
248 		if (priv->hooks[k] == hook)
249 			return (&gFamilies[k]);
250 	return (NULL);
251 }
252 
253 /*
254  * Get the hook from the iffam descriptor
255  */
256 
257 static __inline hook_p *
258 get_hook_from_iffam(priv_p priv, iffam_p iffam)
259 {
260 	return (&priv->hooks[iffam - gFamilies]);
261 }
262 
263 /*
264  * Get the iffam descriptor from the name
265  */
266 static __inline iffam_p
267 get_iffam_from_name(const char *name)
268 {
269 	iffam_p iffam;
270 	int k;
271 
272 	for (k = 0; k < NUM_FAMILIES; k++) {
273 		iffam = &gFamilies[k];
274 		if (!strcmp(iffam->hookname, name))
275 			return (iffam);
276 	}
277 	return (NULL);
278 }
279 
280 /*
281  * Find the first free unit number for a new interface.
282  * Increase the size of the unit bitmap as necessary.
283  */
284 static __inline__ int
285 ng_iface_get_unit(int *unit)
286 {
287 	int index, bit;
288 
289 	for (index = 0; index < ng_iface_units_len
290 	    && ng_iface_units[index] == 0; index++);
291 	if (index == ng_iface_units_len) {		/* extend array */
292 		int i, *newarray, newlen;
293 
294 		newlen = (2 * ng_iface_units_len) + 4;
295 		newarray = kmalloc(newlen * sizeof(*ng_iface_units),
296 		    M_NETGRAPH_IFACE, M_NOWAIT);
297 		if (newarray == NULL)
298 			return (ENOMEM);
299 		bcopy(ng_iface_units, newarray,
300 		    ng_iface_units_len * sizeof(*ng_iface_units));
301 		for (i = ng_iface_units_len; i < newlen; i++)
302 			newarray[i] = ~0;
303 		if (ng_iface_units != NULL)
304 			kfree(ng_iface_units, M_NETGRAPH_IFACE);
305 		ng_iface_units = newarray;
306 		ng_iface_units_len = newlen;
307 	}
308 	bit = ffs(ng_iface_units[index]) - 1;
309 	KASSERT(bit >= 0 && bit <= UNITS_BITSPERWORD - 1,
310 	    ("%s: word=%d bit=%d", __func__, ng_iface_units[index], bit));
311 	ng_iface_units[index] &= ~(1 << bit);
312 	*unit = (index * UNITS_BITSPERWORD) + bit;
313 	return (0);
314 }
315 
316 /*
317  * Free a no longer needed unit number.
318  */
319 static __inline__ void
320 ng_iface_free_unit(int unit)
321 {
322 	int index, bit;
323 
324 	index = unit / UNITS_BITSPERWORD;
325 	bit = unit % UNITS_BITSPERWORD;
326 	KASSERT(index < ng_iface_units_len,
327 	    ("%s: unit=%d len=%d", __func__, unit, ng_iface_units_len));
328 	KASSERT((ng_iface_units[index] & (1 << bit)) == 0,
329 	    ("%s: unit=%d is free", __func__, unit));
330 	ng_iface_units[index] |= (1 << bit);
331 	/*
332 	 * XXX We could think about reducing the size of ng_iface_units[]
333 	 * XXX here if the last portion is all ones
334 	 */
335 }
336 
337 /************************************************************************
338 			INTERFACE STUFF
339  ************************************************************************/
340 
341 /*
342  * Process an ioctl for the virtual interface
343  */
344 static int
345 ng_iface_ioctl(struct ifnet *ifp, u_long command, caddr_t data,
346     struct ucred *cr)
347 {
348 	struct ifreq *const ifr = (struct ifreq *) data;
349 	int error = 0;
350 
351 #ifdef DEBUG
352 	ng_iface_print_ioctl(ifp, command, data);
353 #endif
354 	crit_enter();
355 	switch (command) {
356 
357 	/* These two are mostly handled at a higher layer */
358 	case SIOCSIFADDR:
359 		ifp->if_flags |= IFF_UP;
360 		ifp->if_flags |= IFF_RUNNING;
361 		ifq_clr_oactive(&ifp->if_snd);
362 		break;
363 	case SIOCGIFADDR:
364 		break;
365 
366 	/* Set flags */
367 	case SIOCSIFFLAGS:
368 		/*
369 		 * If the interface is marked up and stopped, then start it.
370 		 * If it is marked down and running, then stop it.
371 		 */
372 		if (ifr->ifr_flags & IFF_UP) {
373 			if (!(ifp->if_flags & IFF_RUNNING)) {
374 				ifq_clr_oactive(&ifp->if_snd);
375 				ifp->if_flags |= IFF_RUNNING;
376 			}
377 		} else {
378 			if (ifp->if_flags & IFF_RUNNING) {
379 				ifp->if_flags &= ~IFF_RUNNING;
380 				ifq_clr_oactive(&ifp->if_snd);
381 			}
382 		}
383 		break;
384 
385 	/* Set the interface MTU */
386 	case SIOCSIFMTU:
387 		if (ifr->ifr_mtu > NG_IFACE_MTU_MAX
388 		    || ifr->ifr_mtu < NG_IFACE_MTU_MIN)
389 			error = EINVAL;
390 		else
391 			ifp->if_mtu = ifr->ifr_mtu;
392 		break;
393 
394 	/* Stuff that's not supported */
395 	case SIOCADDMULTI:
396 	case SIOCDELMULTI:
397 		error = 0;
398 		break;
399 	case SIOCSIFPHYS:
400 		error = EOPNOTSUPP;
401 		break;
402 
403 	default:
404 		error = EINVAL;
405 		break;
406 	}
407 	crit_exit();
408 	return (error);
409 }
410 
411 /*
412  * This routine is called to deliver a packet out the interface.
413  * We simply look at the address family and relay the packet to
414  * the corresponding hook, if it exists and is connected.
415  */
416 
417 static int
418 ng_iface_output(struct ifnet *ifp, struct mbuf *m,
419 		struct sockaddr *dst, struct rtentry *rt0)
420 {
421 	uint32_t af;
422 	int error;
423 
424 	/* Check interface flags */
425 	if (!((ifp->if_flags & IFF_UP) && (ifp->if_flags & IFF_RUNNING))) {
426 		m_freem(m);
427 		return (ENETDOWN);
428 	}
429 
430 	/* BPF writes need to be handled specially. */
431 	if (dst->sa_family == AF_UNSPEC) {
432 		bcopy(dst->sa_data, &af, sizeof(af));
433 		dst->sa_family = af;
434 	}
435 
436 	/* Berkeley packet filter */
437 	ng_iface_bpftap(ifp, m, dst->sa_family);
438 
439 	if (ifq_is_enabled(&ifp->if_snd)) {
440 		M_PREPEND(m, sizeof(sa_family_t), MB_DONTWAIT);
441 		if (m == NULL) {
442 			IFNET_STAT_INC(ifp, oerrors, 1);
443 			return (ENOBUFS);
444 		}
445 		*(sa_family_t *)m->m_data = dst->sa_family;
446 		error = ifq_dispatch(ifp, m, NULL);
447 	} else
448 		error = ng_iface_send(ifp, m, dst->sa_family);
449 
450 	return (error);
451 }
452 
453 /*
454  * Start method is used only when ALTQ is enabled.
455  */
456 static void
457 ng_iface_start(struct ifnet *ifp, struct ifaltq_subque *ifsq)
458 {
459 	struct mbuf *m = NULL;
460 	sa_family_t sa;
461 
462 	KASSERT(ifq_is_enabled(&ifp->if_snd), ("%s without ALTQ", __func__));
463 
464 	for(;;) {
465 		m = ifq_dequeue(&ifp->if_snd, m);
466 		if (m == NULL)
467 			break;
468 		sa = *mtod(m, sa_family_t *);
469 		m_adj(m, sizeof(sa_family_t));
470 		ng_iface_send(ifp, m, sa);
471 	}
472 }
473 
474 /*
475  * Flash a packet by the BPF (requires prepending 4 byte AF header)
476  * Note the phoney mbuf; this is OK because BPF treats it read-only.
477  */
478 static void
479 ng_iface_bpftap(struct ifnet *ifp, struct mbuf *m, sa_family_t family)
480 {
481 	int32_t family4 = (int32_t)family;
482 
483 	KASSERT(family != AF_UNSPEC, ("%s: family=AF_UNSPEC", __func__));
484 
485 	if (ifp->if_bpf) {
486 		bpf_gettoken();
487 		if (ifp->if_bpf)
488 			bpf_ptap(ifp->if_bpf, m, &family4, sizeof(family4));
489 		bpf_reltoken();
490 	}
491 }
492 
493 /*
494  * This routine does actual delivery of the packet into the
495  * netgraph(4). It is called from ng_iface_start() and
496  * ng_iface_output().
497  */
498 static int
499 ng_iface_send(struct ifnet *ifp, struct mbuf *m, sa_family_t sa)
500 {
501 	const priv_p priv = (priv_p) ifp->if_softc;
502 	const iffam_p iffam = get_iffam_from_af(sa);
503 	int error;
504 	int len;
505 
506 	/* Check address family to determine hook (if known) */
507 	if (iffam == NULL) {
508 		m_freem(m);
509 		log(LOG_WARNING, "%s: can't handle af%d\n", ifp->if_xname, sa);
510 		return (EAFNOSUPPORT);
511 	}
512 
513 	/* Copy length before the mbuf gets invalidated. */
514 	len = m->m_pkthdr.len;
515 
516 	/* Send packet. If hook is not connected,
517 	   mbuf will get freed. */
518 	NG_SEND_DATA_ONLY(error, *get_hook_from_iffam(priv, iffam), m);
519 
520 	/* Update stats. */
521 	if (error == 0) {
522 		IFNET_STAT_INC(ifp, obytes, len);
523 		IFNET_STAT_INC(ifp, opackets, 1);
524 	}
525 
526 	return (error);
527 }
528 
529 #ifdef DEBUG
530 /*
531  * Display an ioctl to the virtual interface
532  */
533 
534 static void
535 ng_iface_print_ioctl(struct ifnet *ifp, int command, caddr_t data)
536 {
537 	char   *str;
538 
539 	switch (command & IOC_DIRMASK) {
540 	case IOC_VOID:
541 		str = "IO";
542 		break;
543 	case IOC_OUT:
544 		str = "IOR";
545 		break;
546 	case IOC_IN:
547 		str = "IOW";
548 		break;
549 	case IOC_INOUT:
550 		str = "IORW";
551 		break;
552 	default:
553 		str = "IO??";
554 	}
555 	log(LOG_DEBUG, "%s: %s('%c', %d, char[%d])\n",
556 	       ifp->if_xname,
557 	       str,
558 	       IOCGROUP(command),
559 	       command & 0xff,
560 	       IOCPARM_LEN(command));
561 }
562 #endif /* DEBUG */
563 
564 /************************************************************************
565 			NETGRAPH NODE STUFF
566  ************************************************************************/
567 
568 /*
569  * Constructor for a node
570  */
571 static int
572 ng_iface_constructor(node_p node)
573 {
574 	struct ifnet *ifp;
575 	priv_p priv;
576 	int error;
577 
578 	/* Allocate node and interface private structures */
579 	priv = kmalloc(sizeof(*priv), M_NETGRAPH_IFACE,
580 		       M_WAITOK | M_NULLOK | M_ZERO);
581 	if (priv == NULL)
582 		return (ENOMEM);
583 	ifp = kmalloc(sizeof(*ifp), M_NETGRAPH_IFACE, M_WAITOK | M_NULLOK | M_ZERO);
584 	if (ifp == NULL) {
585 		kfree(priv, M_NETGRAPH_IFACE);
586 		return (ENOMEM);
587 	}
588 
589 	/* Link them together */
590 	ifp->if_softc = priv;
591 	priv->ifp = ifp;
592 
593 	/* Get an interface unit number */
594 	if ((error = ng_iface_get_unit(&priv->unit)) != 0) {
595 		kfree(ifp, M_NETGRAPH_IFACE);
596 		kfree(priv, M_NETGRAPH_IFACE);
597 		return (error);
598 	}
599 
600 
601 	/* Link together node and private info */
602 	NG_NODE_SET_PRIVATE(node, priv);
603 	priv->node = node;
604 
605 	/* Initialize interface structure */
606 	if_initname(ifp, NG_IFACE_IFACE_NAME, priv->unit);
607 	ifp->if_output = ng_iface_output;
608 	ifp->if_start = ng_iface_start;
609 	ifp->if_ioctl = ng_iface_ioctl;
610 	ifp->if_watchdog = NULL;
611 	ifp->if_mtu = NG_IFACE_MTU_DEFAULT;
612 	ifp->if_flags = (IFF_SIMPLEX|IFF_POINTOPOINT|IFF_NOARP|IFF_MULTICAST);
613 	ifp->if_type = IFT_PROPVIRTUAL;		/* XXX */
614 	ifp->if_addrlen = 0;			/* XXX */
615 	ifp->if_hdrlen = 0;			/* XXX */
616 	ifp->if_baudrate = 64000;		/* XXX */
617 	ifq_set_maxlen(&ifp->if_snd, IFQ_MAXLEN);
618 	ifq_set_ready(&ifp->if_snd);
619 
620 	/* Give this node the same name as the interface (if possible) */
621 	if (ng_name_node(node, ifp->if_xname) != 0)
622 		log(LOG_WARNING, "%s: can't acquire netgraph name\n",
623 		    ifp->if_xname);
624 
625 	/* Attach the interface */
626 	if_attach(ifp, NULL);
627 	bpfattach(ifp, DLT_NULL, sizeof(u_int32_t));
628 
629 	/* Done */
630 	return (0);
631 }
632 
633 /*
634  * Give our ok for a hook to be added
635  */
636 static int
637 ng_iface_newhook(node_p node, hook_p hook, const char *name)
638 {
639 	const iffam_p iffam = get_iffam_from_name(name);
640 	hook_p *hookptr;
641 
642 	if (iffam == NULL)
643 		return (EPFNOSUPPORT);
644 	hookptr = get_hook_from_iffam(NG_NODE_PRIVATE(node), iffam);
645 	if (*hookptr != NULL)
646 		return (EISCONN);
647 	*hookptr = hook;
648 	NG_HOOK_HI_STACK(hook);
649 	return (0);
650 }
651 
652 /*
653  * Receive a control message
654  */
655 static int
656 ng_iface_rcvmsg(node_p node, item_p item, hook_p lasthook)
657 {
658 	const priv_p priv = NG_NODE_PRIVATE(node);
659 	struct ifnet *const ifp = priv->ifp;
660 	struct ng_mesg *resp = NULL;
661 	int error = 0;
662 	struct ng_mesg *msg;
663 
664 	NGI_GET_MSG(item, msg);
665 	switch (msg->header.typecookie) {
666 	case NGM_IFACE_COOKIE:
667 		switch (msg->header.cmd) {
668 		case NGM_IFACE_GET_IFNAME:
669 			NG_MKRESPONSE(resp, msg, IFNAMSIZ, M_WAITOK | M_NULLOK);
670 			if (resp == NULL) {
671 				error = ENOMEM;
672 				break;
673 			}
674 			strlcpy(resp->data, ifp->if_xname, IFNAMSIZ);
675 			break;
676 
677 		case NGM_IFACE_POINT2POINT:
678 		case NGM_IFACE_BROADCAST:
679 		    {
680 
681 			/* Deny request if interface is UP */
682 			if ((ifp->if_flags & IFF_UP) != 0)
683 				return (EBUSY);
684 
685 			/* Change flags */
686 			switch (msg->header.cmd) {
687 			case NGM_IFACE_POINT2POINT:
688 				ifp->if_flags |= IFF_POINTOPOINT;
689 				ifp->if_flags &= ~IFF_BROADCAST;
690 				break;
691 			case NGM_IFACE_BROADCAST:
692 				ifp->if_flags &= ~IFF_POINTOPOINT;
693 				ifp->if_flags |= IFF_BROADCAST;
694 				break;
695 			}
696 			break;
697 		    }
698 
699 		case NGM_IFACE_GET_IFINDEX:
700 			NG_MKRESPONSE(resp, msg, sizeof(uint32_t), M_WAITOK | M_NULLOK);
701 			if (resp == NULL) {
702 				error = ENOMEM;
703 				break;
704 			}
705 			*((uint32_t *)resp->data) = priv->ifp->if_index;
706 			break;
707 
708 		default:
709 			error = EINVAL;
710 			break;
711 		}
712 		break;
713 	case NGM_CISCO_COOKIE:
714 		switch (msg->header.cmd) {
715 		case NGM_CISCO_GET_IPADDR:	/* we understand this too */
716 		    {
717 			struct ifaddr_container *ifac;
718 
719 			/* Return the first configured IP address */
720 			TAILQ_FOREACH(ifac, &ifp->if_addrheads[mycpuid], ifa_link) {
721 				struct ifaddr *ifa = ifac->ifa;
722 				struct ng_cisco_ipaddr *ips;
723 
724 				if (ifa->ifa_addr->sa_family != AF_INET)
725 					continue;
726 				NG_MKRESPONSE(resp, msg, sizeof(ips), M_WAITOK | M_NULLOK);
727 				if (resp == NULL) {
728 					error = ENOMEM;
729 					break;
730 				}
731 				ips = (struct ng_cisco_ipaddr *)resp->data;
732 				ips->ipaddr = ((struct sockaddr_in *)
733 						ifa->ifa_addr)->sin_addr;
734 				ips->netmask = ((struct sockaddr_in *)
735 						ifa->ifa_netmask)->sin_addr;
736 				break;
737 			}
738 
739 			/* No IP addresses on this interface? */
740 			if (ifac == NULL)
741 				error = EADDRNOTAVAIL;
742 			break;
743 		    }
744 		default:
745 			error = EINVAL;
746 			break;
747 		}
748 		break;
749 	case NGM_FLOW_COOKIE:
750 		switch (msg->header.cmd) {
751 		case NGM_LINK_IS_UP:
752 			ifp->if_flags |= IFF_RUNNING;
753 			break;
754 		case NGM_LINK_IS_DOWN:
755 			ifp->if_flags &= ~IFF_RUNNING;
756 			break;
757 		default:
758 			break;
759 		}
760 		break;
761 	default:
762 		error = EINVAL;
763 		break;
764 	}
765 	NG_RESPOND_MSG(error, node, item, resp);
766 	NG_FREE_MSG(msg);
767 	return (error);
768 }
769 
770 /*
771  * Recive data from a hook. Pass the packet to the correct input routine.
772  */
773 static int
774 ng_iface_rcvdata(hook_p hook, item_p item)
775 {
776 	const priv_p priv = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
777 	const iffam_p iffam = get_iffam_from_hook(priv, hook);
778 	struct ifnet *const ifp = priv->ifp;
779 	struct mbuf *m;
780 	int isr;
781 
782 	NGI_GET_M(item, m);
783 	NG_FREE_ITEM(item);
784 	/* Sanity checks */
785 	KASSERT(iffam != NULL, ("%s: iffam", __func__));
786 	M_ASSERTPKTHDR(m);
787 	if ((ifp->if_flags & IFF_UP) == 0) {
788 		NG_FREE_M(m);
789 		return (ENETDOWN);
790 	}
791 
792 	/* Update interface stats */
793 	IFNET_STAT_INC(ifp, ipackets, 1);
794 	IFNET_STAT_INC(ifp, ibytes, m->m_pkthdr.len);
795 
796 	/* Note receiving interface */
797 	m->m_pkthdr.rcvif = ifp;
798 
799 	/* Berkeley packet filter */
800 	ng_iface_bpftap(ifp, m, iffam->family);
801 
802 	/* Send packet */
803 	switch (iffam->family) {
804 #ifdef INET
805 	case AF_INET:
806 		isr = NETISR_IP;
807 		break;
808 #endif
809 #ifdef INET6
810 	case AF_INET6:
811 		isr = NETISR_IPV6;
812 		break;
813 #endif
814 #ifdef IPX
815 	case AF_IPX:
816 		isr = NETISR_IPX;
817 		break;
818 #endif
819 	default:
820 		m_freem(m);
821 		return (EAFNOSUPPORT);
822 	}
823 #if 0
824 	/* First chunk of an mbuf contains good junk */
825 	if (harvest.point_to_point)
826 		random_harvest(m, 16, 3, 0, RANDOM_NET);
827 #endif
828 	netisr_queue(isr, m);
829 	return (0);
830 }
831 
832 /*
833  * Shutdown and remove the node and its associated interface.
834  */
835 static int
836 ng_iface_shutdown(node_p node)
837 {
838 	const priv_p priv = NG_NODE_PRIVATE(node);
839 
840 	bpfdetach(priv->ifp);
841 	if_detach(priv->ifp);
842 	kfree(priv->ifp, M_NETGRAPH_IFACE);
843 	priv->ifp = NULL;
844 	ng_iface_free_unit(priv->unit);
845 	kfree(priv, M_NETGRAPH_IFACE);
846 	NG_NODE_SET_PRIVATE(node, NULL);
847 	NG_NODE_UNREF(node);
848 	return (0);
849 }
850 
851 /*
852  * Hook disconnection. Note that we do *not* shutdown when all
853  * hooks have been disconnected.
854  */
855 static int
856 ng_iface_disconnect(hook_p hook)
857 {
858 	const priv_p priv = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
859 	const iffam_p iffam = get_iffam_from_hook(priv, hook);
860 
861 	if (iffam == NULL)
862 		panic(__func__);
863 	*get_hook_from_iffam(priv, iffam) = NULL;
864 	return (0);
865 }
866 
867 /*
868  * Handle loading and unloading for this node type.
869  */
870 static int
871 ng_iface_mod_event(module_t mod, int event, void *data)
872 {
873 	int error = 0;
874 
875 	switch (event) {
876 	case MOD_LOAD:
877 		break;
878 	case MOD_UNLOAD:
879 		break;
880 	default:
881 		error = EOPNOTSUPP;
882 		break;
883 	}
884 	return (error);
885 }
886