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 * $Whistle: ng_iface.c,v 1.33 1999/11/01 09:24:51 julian Exp $ 40 */ 41 42 /* 43 * This node is also a system networking interface. It has 44 * a hook for each protocol (IP, AppleTalk, etc). Packets 45 * are simply relayed between the interface and the hooks. 46 * 47 * Interfaces are named ng0, ng1, etc. New nodes take the 48 * first available interface name. 49 * 50 * This node also includes Berkeley packet filter support. 51 */ 52 53 #include "opt_inet.h" 54 #include "opt_inet6.h" 55 56 #include <sys/param.h> 57 #include <sys/systm.h> 58 #include <sys/errno.h> 59 #include <sys/kernel.h> 60 #include <sys/lock.h> 61 #include <sys/malloc.h> 62 #include <sys/mbuf.h> 63 #include <sys/errno.h> 64 #include <sys/proc.h> 65 #include <sys/random.h> 66 #include <sys/rmlock.h> 67 #include <sys/sockio.h> 68 #include <sys/socket.h> 69 #include <sys/sysctl.h> 70 #include <sys/syslog.h> 71 #include <sys/libkern.h> 72 73 #include <net/if.h> 74 #include <net/if_var.h> 75 #include <net/if_private.h> 76 #include <net/if_types.h> 77 #include <net/bpf.h> 78 #include <net/netisr.h> 79 #include <net/route.h> 80 #include <net/vnet.h> 81 82 #include <netinet/in.h> 83 84 #include <netgraph/ng_message.h> 85 #include <netgraph/netgraph.h> 86 #include <netgraph/ng_parse.h> 87 #include <netgraph/ng_iface.h> 88 89 #ifdef NG_SEPARATE_MALLOC 90 static MALLOC_DEFINE(M_NETGRAPH_IFACE, "netgraph_iface", "netgraph iface node"); 91 #else 92 #define M_NETGRAPH_IFACE M_NETGRAPH 93 #endif 94 95 static SYSCTL_NODE(_net_graph, OID_AUTO, iface, CTLFLAG_RW | CTLFLAG_MPSAFE, 0, 96 "Point to point netgraph interface"); 97 VNET_DEFINE_STATIC(int, ng_iface_max_nest) = 2; 98 #define V_ng_iface_max_nest VNET(ng_iface_max_nest) 99 SYSCTL_INT(_net_graph_iface, OID_AUTO, max_nesting, CTLFLAG_VNET | CTLFLAG_RW, 100 &VNET_NAME(ng_iface_max_nest), 0, "Max nested tunnels"); 101 102 /* This struct describes one address family */ 103 struct iffam { 104 sa_family_t family; /* Address family */ 105 const char *hookname; /* Name for hook */ 106 }; 107 typedef const struct iffam *iffam_p; 108 109 /* List of address families supported by our interface */ 110 const static struct iffam gFamilies[] = { 111 { AF_INET, NG_IFACE_HOOK_INET }, 112 { AF_INET6, NG_IFACE_HOOK_INET6 }, 113 }; 114 #define NUM_FAMILIES nitems(gFamilies) 115 116 /* Node private data */ 117 struct ng_iface_private { 118 struct ifnet *ifp; /* Our interface */ 119 int unit; /* Interface unit number */ 120 node_p node; /* Our netgraph node */ 121 hook_p hooks[NUM_FAMILIES]; /* Hook for each address family */ 122 struct rmlock lock; /* Protect private data changes */ 123 }; 124 typedef struct ng_iface_private *priv_p; 125 126 #define PRIV_RLOCK(priv, t) rm_rlock(&priv->lock, t) 127 #define PRIV_RUNLOCK(priv, t) rm_runlock(&priv->lock, t) 128 #define PRIV_WLOCK(priv) rm_wlock(&priv->lock) 129 #define PRIV_WUNLOCK(priv) rm_wunlock(&priv->lock) 130 131 /* Interface methods */ 132 static void ng_iface_start(struct ifnet *ifp); 133 static int ng_iface_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data); 134 static int ng_iface_output(struct ifnet *ifp, struct mbuf *m0, 135 const struct sockaddr *dst, struct route *ro); 136 static void ng_iface_bpftap(struct ifnet *ifp, 137 struct mbuf *m, sa_family_t family); 138 static int ng_iface_send(struct ifnet *ifp, struct mbuf *m, 139 sa_family_t sa); 140 #ifdef DEBUG 141 static void ng_iface_print_ioctl(struct ifnet *ifp, int cmd, caddr_t data); 142 #endif 143 144 /* Netgraph methods */ 145 static int ng_iface_mod_event(module_t, int, void *); 146 static ng_constructor_t ng_iface_constructor; 147 static ng_rcvmsg_t ng_iface_rcvmsg; 148 static ng_shutdown_t ng_iface_shutdown; 149 static ng_newhook_t ng_iface_newhook; 150 static ng_rcvdata_t ng_iface_rcvdata; 151 static ng_disconnect_t ng_iface_disconnect; 152 153 /* Helper stuff */ 154 static iffam_p get_iffam_from_af(sa_family_t family); 155 static iffam_p get_iffam_from_hook(priv_p priv, hook_p hook); 156 static iffam_p get_iffam_from_name(const char *name); 157 static hook_p *get_hook_from_iffam(priv_p priv, iffam_p iffam); 158 159 /* List of commands and how to convert arguments to/from ASCII */ 160 static const struct ng_cmdlist ng_iface_cmds[] = { 161 { 162 NGM_IFACE_COOKIE, 163 NGM_IFACE_GET_IFNAME, 164 "getifname", 165 NULL, 166 &ng_parse_string_type 167 }, 168 { 169 NGM_IFACE_COOKIE, 170 NGM_IFACE_POINT2POINT, 171 "point2point", 172 NULL, 173 NULL 174 }, 175 { 176 NGM_IFACE_COOKIE, 177 NGM_IFACE_BROADCAST, 178 "broadcast", 179 NULL, 180 NULL 181 }, 182 { 183 NGM_IFACE_COOKIE, 184 NGM_IFACE_GET_IFINDEX, 185 "getifindex", 186 NULL, 187 &ng_parse_uint32_type 188 }, 189 { 0 } 190 }; 191 192 /* Node type descriptor */ 193 static struct ng_type typestruct = { 194 .version = NG_ABI_VERSION, 195 .name = NG_IFACE_NODE_TYPE, 196 .mod_event = ng_iface_mod_event, 197 .constructor = ng_iface_constructor, 198 .rcvmsg = ng_iface_rcvmsg, 199 .shutdown = ng_iface_shutdown, 200 .newhook = ng_iface_newhook, 201 .rcvdata = ng_iface_rcvdata, 202 .disconnect = ng_iface_disconnect, 203 .cmdlist = ng_iface_cmds, 204 }; 205 NETGRAPH_INIT(iface, &typestruct); 206 207 VNET_DEFINE_STATIC(struct unrhdr *, ng_iface_unit); 208 #define V_ng_iface_unit VNET(ng_iface_unit) 209 210 /************************************************************************ 211 HELPER STUFF 212 ************************************************************************/ 213 214 /* 215 * Get the family descriptor from the family ID 216 */ 217 static __inline iffam_p 218 get_iffam_from_af(sa_family_t family) 219 { 220 iffam_p iffam; 221 int k; 222 223 for (k = 0; k < NUM_FAMILIES; k++) { 224 iffam = &gFamilies[k]; 225 if (iffam->family == family) 226 return (iffam); 227 } 228 return (NULL); 229 } 230 231 /* 232 * Get the family descriptor from the hook 233 */ 234 static __inline iffam_p 235 get_iffam_from_hook(priv_p priv, hook_p hook) 236 { 237 int k; 238 239 for (k = 0; k < NUM_FAMILIES; k++) 240 if (priv->hooks[k] == hook) 241 return (&gFamilies[k]); 242 return (NULL); 243 } 244 245 /* 246 * Get the hook from the iffam descriptor 247 */ 248 249 static __inline hook_p * 250 get_hook_from_iffam(priv_p priv, iffam_p iffam) 251 { 252 return (&priv->hooks[iffam - gFamilies]); 253 } 254 255 /* 256 * Get the iffam descriptor from the name 257 */ 258 static __inline iffam_p 259 get_iffam_from_name(const char *name) 260 { 261 iffam_p iffam; 262 int k; 263 264 for (k = 0; k < NUM_FAMILIES; k++) { 265 iffam = &gFamilies[k]; 266 if (!strcmp(iffam->hookname, name)) 267 return (iffam); 268 } 269 return (NULL); 270 } 271 272 /************************************************************************ 273 INTERFACE STUFF 274 ************************************************************************/ 275 276 /* 277 * Process an ioctl for the virtual interface 278 */ 279 static int 280 ng_iface_ioctl(struct ifnet *ifp, u_long command, caddr_t data) 281 { 282 struct ifreq *const ifr = (struct ifreq *) data; 283 int error = 0; 284 285 #ifdef DEBUG 286 ng_iface_print_ioctl(ifp, command, data); 287 #endif 288 switch (command) { 289 /* These two are mostly handled at a higher layer */ 290 case SIOCSIFADDR: 291 ifp->if_flags |= IFF_UP; 292 ifp->if_drv_flags |= IFF_DRV_RUNNING; 293 ifp->if_drv_flags &= ~(IFF_DRV_OACTIVE); 294 break; 295 case SIOCGIFADDR: 296 break; 297 298 /* Set flags */ 299 case SIOCSIFFLAGS: 300 /* 301 * If the interface is marked up and stopped, then start it. 302 * If it is marked down and running, then stop it. 303 */ 304 if (ifr->ifr_flags & IFF_UP) { 305 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 306 ifp->if_drv_flags &= ~(IFF_DRV_OACTIVE); 307 ifp->if_drv_flags |= IFF_DRV_RUNNING; 308 } 309 } else { 310 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 311 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | 312 IFF_DRV_OACTIVE); 313 } 314 break; 315 316 /* Set the interface MTU */ 317 case SIOCSIFMTU: 318 if (ifr->ifr_mtu > NG_IFACE_MTU_MAX 319 || ifr->ifr_mtu < NG_IFACE_MTU_MIN) 320 error = EINVAL; 321 else 322 ifp->if_mtu = ifr->ifr_mtu; 323 break; 324 325 /* Stuff that's not supported */ 326 case SIOCADDMULTI: 327 case SIOCDELMULTI: 328 error = 0; 329 break; 330 case SIOCSIFPHYS: 331 error = EOPNOTSUPP; 332 break; 333 334 default: 335 error = EINVAL; 336 break; 337 } 338 return (error); 339 } 340 341 /* 342 * This routine is called to deliver a packet out the interface. 343 * We simply look at the address family and relay the packet to 344 * the corresponding hook, if it exists and is connected. 345 */ 346 347 static int 348 ng_iface_output(struct ifnet *ifp, struct mbuf *m, 349 const struct sockaddr *dst, struct route *ro) 350 { 351 uint32_t af; 352 int error; 353 354 /* Check interface flags */ 355 if (!((ifp->if_flags & IFF_UP) && 356 (ifp->if_drv_flags & IFF_DRV_RUNNING))) { 357 m_freem(m); 358 return (ENETDOWN); 359 } 360 361 /* Protect from deadly infinite recursion. */ 362 error = if_tunnel_check_nesting(ifp, m, NGM_IFACE_COOKIE, 363 V_ng_iface_max_nest); 364 if (error) { 365 m_freem(m); 366 return (error); 367 } 368 369 /* BPF writes need to be handled specially. */ 370 if (dst->sa_family == AF_UNSPEC) 371 bcopy(dst->sa_data, &af, sizeof(af)); 372 else 373 af = RO_GET_FAMILY(ro, dst); 374 375 /* Berkeley packet filter */ 376 ng_iface_bpftap(ifp, m, af); 377 378 if (ALTQ_IS_ENABLED(&ifp->if_snd)) { 379 M_PREPEND(m, sizeof(sa_family_t), M_NOWAIT); 380 if (m == NULL) { 381 if_inc_counter(ifp, IFCOUNTER_OQDROPS, 1); 382 return (ENOBUFS); 383 } 384 *(sa_family_t *)m->m_data = af; 385 error = (ifp->if_transmit)(ifp, m); 386 } else 387 error = ng_iface_send(ifp, m, af); 388 389 return (error); 390 } 391 392 /* 393 * Start method is used only when ALTQ is enabled. 394 */ 395 static void 396 ng_iface_start(struct ifnet *ifp) 397 { 398 struct mbuf *m; 399 sa_family_t sa; 400 401 KASSERT(ALTQ_IS_ENABLED(&ifp->if_snd), ("%s without ALTQ", __func__)); 402 403 for(;;) { 404 IFQ_DRV_DEQUEUE(&ifp->if_snd, m); 405 if (m == NULL) 406 break; 407 sa = *mtod(m, sa_family_t *); 408 m_adj(m, sizeof(sa_family_t)); 409 ng_iface_send(ifp, m, sa); 410 } 411 } 412 413 /* 414 * Flash a packet by the BPF (requires prepending 4 byte AF header) 415 * Note the phoney mbuf; this is OK because BPF treats it read-only. 416 */ 417 static void 418 ng_iface_bpftap(struct ifnet *ifp, struct mbuf *m, sa_family_t family) 419 { 420 KASSERT(family != AF_UNSPEC, ("%s: family=AF_UNSPEC", __func__)); 421 if (bpf_peers_present(ifp->if_bpf)) { 422 int32_t family4 = (int32_t)family; 423 bpf_mtap2(ifp->if_bpf, &family4, sizeof(family4), m); 424 } 425 } 426 427 /* 428 * This routine does actual delivery of the packet into the 429 * netgraph(4). It is called from ng_iface_start() and 430 * ng_iface_output(). 431 */ 432 static int 433 ng_iface_send(struct ifnet *ifp, struct mbuf *m, sa_family_t sa) 434 { 435 struct rm_priotracker priv_tracker; 436 const priv_p priv = (priv_p) ifp->if_softc; 437 const iffam_p iffam = get_iffam_from_af(sa); 438 hook_p hook; 439 int error; 440 int len; 441 442 /* Check address family to determine hook (if known) */ 443 if (iffam == NULL) { 444 m_freem(m); 445 log(LOG_WARNING, "%s: can't handle af%d\n", ifp->if_xname, sa); 446 return (EAFNOSUPPORT); 447 } 448 449 /* Copy length before the mbuf gets invalidated. */ 450 len = m->m_pkthdr.len; 451 452 PRIV_RLOCK(priv, &priv_tracker); 453 hook = *get_hook_from_iffam(priv, iffam); 454 if (hook == NULL) { 455 NG_FREE_M(m); 456 PRIV_RUNLOCK(priv, &priv_tracker); 457 return ENETDOWN; 458 } 459 NG_HOOK_REF(hook); 460 PRIV_RUNLOCK(priv, &priv_tracker); 461 462 NG_OUTBOUND_THREAD_REF(); 463 NG_SEND_DATA_ONLY(error, hook, m); 464 NG_OUTBOUND_THREAD_UNREF(); 465 NG_HOOK_UNREF(hook); 466 467 /* Update stats. */ 468 if (error == 0) { 469 if_inc_counter(ifp, IFCOUNTER_OBYTES, len); 470 if_inc_counter(ifp, IFCOUNTER_OPACKETS, 1); 471 } 472 473 return (error); 474 } 475 476 #ifdef DEBUG 477 /* 478 * Display an ioctl to the virtual interface 479 */ 480 481 static void 482 ng_iface_print_ioctl(struct ifnet *ifp, int command, caddr_t data) 483 { 484 char *str; 485 486 switch (command & IOC_DIRMASK) { 487 case IOC_VOID: 488 str = "IO"; 489 break; 490 case IOC_OUT: 491 str = "IOR"; 492 break; 493 case IOC_IN: 494 str = "IOW"; 495 break; 496 case IOC_INOUT: 497 str = "IORW"; 498 break; 499 default: 500 str = "IO??"; 501 } 502 log(LOG_DEBUG, "%s: %s('%c', %d, char[%d])\n", 503 ifp->if_xname, 504 str, 505 IOCGROUP(command), 506 command & 0xff, 507 IOCPARM_LEN(command)); 508 } 509 #endif /* DEBUG */ 510 511 /************************************************************************ 512 NETGRAPH NODE STUFF 513 ************************************************************************/ 514 515 /* 516 * Constructor for a node 517 */ 518 static int 519 ng_iface_constructor(node_p node) 520 { 521 struct ifnet *ifp; 522 priv_p priv; 523 524 /* Allocate node and interface private structures */ 525 priv = malloc(sizeof(*priv), M_NETGRAPH_IFACE, M_WAITOK | M_ZERO); 526 ifp = if_alloc(IFT_PROPVIRTUAL); 527 if (ifp == NULL) { 528 free(priv, M_NETGRAPH_IFACE); 529 return (ENOMEM); 530 } 531 532 rm_init(&priv->lock, "ng_iface private rmlock"); 533 534 /* Link them together */ 535 ifp->if_softc = priv; 536 priv->ifp = ifp; 537 538 /* Get an interface unit number */ 539 priv->unit = alloc_unr(V_ng_iface_unit); 540 541 /* Link together node and private info */ 542 NG_NODE_SET_PRIVATE(node, priv); 543 priv->node = node; 544 545 /* Initialize interface structure */ 546 if_initname(ifp, NG_IFACE_IFACE_NAME, priv->unit); 547 ifp->if_output = ng_iface_output; 548 ifp->if_start = ng_iface_start; 549 ifp->if_ioctl = ng_iface_ioctl; 550 ifp->if_mtu = NG_IFACE_MTU_DEFAULT; 551 ifp->if_flags = (IFF_SIMPLEX|IFF_POINTOPOINT|IFF_NOARP|IFF_MULTICAST); 552 ifp->if_type = IFT_PROPVIRTUAL; /* XXX */ 553 ifp->if_addrlen = 0; /* XXX */ 554 ifp->if_hdrlen = 0; /* XXX */ 555 ifp->if_baudrate = 64000; /* XXX */ 556 IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 557 ifp->if_snd.ifq_drv_maxlen = ifqmaxlen; 558 IFQ_SET_READY(&ifp->if_snd); 559 560 /* Give this node the same name as the interface (if possible) */ 561 if (ng_name_node(node, ifp->if_xname) != 0) 562 log(LOG_WARNING, "%s: can't acquire netgraph name\n", 563 ifp->if_xname); 564 565 /* Attach the interface */ 566 if_attach(ifp); 567 bpfattach(ifp, DLT_NULL, sizeof(u_int32_t)); 568 569 /* Done */ 570 return (0); 571 } 572 573 /* 574 * Give our ok for a hook to be added 575 */ 576 static int 577 ng_iface_newhook(node_p node, hook_p hook, const char *name) 578 { 579 const iffam_p iffam = get_iffam_from_name(name); 580 const priv_p priv = NG_NODE_PRIVATE(node); 581 hook_p *hookptr; 582 583 if (iffam == NULL) 584 return (EPFNOSUPPORT); 585 PRIV_WLOCK(priv); 586 hookptr = get_hook_from_iffam(priv, iffam); 587 if (*hookptr != NULL) { 588 PRIV_WUNLOCK(priv); 589 return (EISCONN); 590 } 591 *hookptr = hook; 592 NG_HOOK_HI_STACK(hook); 593 NG_HOOK_SET_TO_INBOUND(hook); 594 PRIV_WUNLOCK(priv); 595 return (0); 596 } 597 598 /* 599 * Receive a control message 600 */ 601 static int 602 ng_iface_rcvmsg(node_p node, item_p item, hook_p lasthook) 603 { 604 const priv_p priv = NG_NODE_PRIVATE(node); 605 struct ifnet *const ifp = priv->ifp; 606 struct ng_mesg *resp = NULL; 607 int error = 0; 608 struct ng_mesg *msg; 609 610 NGI_GET_MSG(item, msg); 611 switch (msg->header.typecookie) { 612 case NGM_IFACE_COOKIE: 613 switch (msg->header.cmd) { 614 case NGM_IFACE_GET_IFNAME: 615 NG_MKRESPONSE(resp, msg, IFNAMSIZ, M_NOWAIT); 616 if (resp == NULL) { 617 error = ENOMEM; 618 break; 619 } 620 strlcpy(resp->data, ifp->if_xname, IFNAMSIZ); 621 break; 622 623 case NGM_IFACE_POINT2POINT: 624 case NGM_IFACE_BROADCAST: 625 { 626 /* Deny request if interface is UP */ 627 if ((ifp->if_flags & IFF_UP) != 0) 628 return (EBUSY); 629 630 /* Change flags */ 631 switch (msg->header.cmd) { 632 case NGM_IFACE_POINT2POINT: 633 ifp->if_flags |= IFF_POINTOPOINT; 634 ifp->if_flags &= ~IFF_BROADCAST; 635 break; 636 case NGM_IFACE_BROADCAST: 637 ifp->if_flags &= ~IFF_POINTOPOINT; 638 ifp->if_flags |= IFF_BROADCAST; 639 break; 640 } 641 break; 642 } 643 644 case NGM_IFACE_GET_IFINDEX: 645 NG_MKRESPONSE(resp, msg, sizeof(uint32_t), M_NOWAIT); 646 if (resp == NULL) { 647 error = ENOMEM; 648 break; 649 } 650 *((uint32_t *)resp->data) = priv->ifp->if_index; 651 break; 652 653 default: 654 error = EINVAL; 655 break; 656 } 657 break; 658 case NGM_FLOW_COOKIE: 659 switch (msg->header.cmd) { 660 case NGM_LINK_IS_UP: 661 if_link_state_change(ifp, LINK_STATE_UP); 662 break; 663 case NGM_LINK_IS_DOWN: 664 if_link_state_change(ifp, LINK_STATE_DOWN); 665 break; 666 default: 667 break; 668 } 669 break; 670 default: 671 error = EINVAL; 672 break; 673 } 674 NG_RESPOND_MSG(error, node, item, resp); 675 NG_FREE_MSG(msg); 676 return (error); 677 } 678 679 /* 680 * Recive data from a hook. Pass the packet to the correct input routine. 681 */ 682 static int 683 ng_iface_rcvdata(hook_p hook, item_p item) 684 { 685 const priv_p priv = NG_NODE_PRIVATE(NG_HOOK_NODE(hook)); 686 const iffam_p iffam = get_iffam_from_hook(priv, hook); 687 struct ifnet *const ifp = priv->ifp; 688 struct epoch_tracker et; 689 struct mbuf *m; 690 int isr; 691 692 NGI_GET_M(item, m); 693 NG_FREE_ITEM(item); 694 /* Sanity checks */ 695 KASSERT(iffam != NULL, ("%s: iffam", __func__)); 696 M_ASSERTPKTHDR(m); 697 if ((ifp->if_flags & IFF_UP) == 0) { 698 NG_FREE_M(m); 699 return (ENETDOWN); 700 } 701 702 /* Update interface stats */ 703 if_inc_counter(ifp, IFCOUNTER_IPACKETS, 1); 704 if_inc_counter(ifp, IFCOUNTER_IBYTES, m->m_pkthdr.len); 705 706 /* Note receiving interface */ 707 m->m_pkthdr.rcvif = ifp; 708 709 /* Berkeley packet filter */ 710 ng_iface_bpftap(ifp, m, iffam->family); 711 712 /* Send packet */ 713 switch (iffam->family) { 714 #ifdef INET 715 case AF_INET: 716 isr = NETISR_IP; 717 break; 718 #endif 719 #ifdef INET6 720 case AF_INET6: 721 isr = NETISR_IPV6; 722 break; 723 #endif 724 default: 725 m_freem(m); 726 return (EAFNOSUPPORT); 727 } 728 random_harvest_queue(m, sizeof(*m), RANDOM_NET_NG); 729 M_SETFIB(m, ifp->if_fib); 730 CURVNET_SET(ifp->if_vnet); 731 NET_EPOCH_ENTER(et); 732 netisr_dispatch(isr, m); 733 NET_EPOCH_EXIT(et); 734 CURVNET_RESTORE(); 735 return (0); 736 } 737 738 /* 739 * Shutdown and remove the node and its associated interface. 740 */ 741 static int 742 ng_iface_shutdown(node_p node) 743 { 744 const priv_p priv = NG_NODE_PRIVATE(node); 745 746 /* 747 * The ifnet may be in a different vnet than the netgraph node, 748 * hence we have to change the current vnet context here. 749 */ 750 CURVNET_SET_QUIET(priv->ifp->if_vnet); 751 bpfdetach(priv->ifp); 752 if_detach(priv->ifp); 753 if_free(priv->ifp); 754 CURVNET_RESTORE(); 755 priv->ifp = NULL; 756 free_unr(V_ng_iface_unit, priv->unit); 757 rm_destroy(&priv->lock); 758 free(priv, M_NETGRAPH_IFACE); 759 NG_NODE_SET_PRIVATE(node, NULL); 760 NG_NODE_UNREF(node); 761 return (0); 762 } 763 764 /* 765 * Hook disconnection. Note that we do *not* shutdown when all 766 * hooks have been disconnected. 767 */ 768 static int 769 ng_iface_disconnect(hook_p hook) 770 { 771 const priv_p priv = NG_NODE_PRIVATE(NG_HOOK_NODE(hook)); 772 const iffam_p iffam = get_iffam_from_hook(priv, hook); 773 774 if (iffam == NULL) 775 panic("%s", __func__); 776 PRIV_WLOCK(priv); 777 *get_hook_from_iffam(priv, iffam) = NULL; 778 PRIV_WUNLOCK(priv); 779 return (0); 780 } 781 782 /* 783 * Handle loading and unloading for this node type. 784 */ 785 static int 786 ng_iface_mod_event(module_t mod, int event, void *data) 787 { 788 int error = 0; 789 790 switch (event) { 791 case MOD_LOAD: 792 case MOD_UNLOAD: 793 break; 794 default: 795 error = EOPNOTSUPP; 796 break; 797 } 798 return (error); 799 } 800 801 static void 802 vnet_ng_iface_init(const void *unused) 803 { 804 805 V_ng_iface_unit = new_unrhdr(0, 0xffff, NULL); 806 } 807 VNET_SYSINIT(vnet_ng_iface_init, SI_SUB_PSEUDO, SI_ORDER_ANY, 808 vnet_ng_iface_init, NULL); 809 810 static void 811 vnet_ng_iface_uninit(const void *unused) 812 { 813 814 delete_unrhdr(V_ng_iface_unit); 815 } 816 VNET_SYSUNINIT(vnet_ng_iface_uninit, SI_SUB_INIT_IF, SI_ORDER_ANY, 817 vnet_ng_iface_uninit, NULL); 818