if: Multiple TX queue support step 1 of many; introduce ifaltq subqueue
[dragonfly.git] / sys / netgraph7 / iface / ng_iface.c
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                         ifp->if_oerrors++;
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                 ifp->if_obytes += len;
523                 ifp->if_opackets++;
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         ifp->if_ipackets++;
794         ifp->if_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 }