The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/netgraph/ng_ether.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 
    2 /*
    3  * ng_ether.c
    4  */
    5 
    6 /*-
    7  * Copyright (c) 1996-2000 Whistle Communications, Inc.
    8  * All rights reserved.
    9  * 
   10  * Subject to the following obligations and disclaimer of warranty, use and
   11  * redistribution of this software, in source or object code forms, with or
   12  * without modifications are expressly permitted by Whistle Communications;
   13  * provided, however, that:
   14  * 1. Any and all reproductions of the source or object code must include the
   15  *    copyright notice above and the following disclaimer of warranties; and
   16  * 2. No rights are granted, in any manner or form, to use Whistle
   17  *    Communications, Inc. trademarks, including the mark "WHISTLE
   18  *    COMMUNICATIONS" on advertising, endorsements, or otherwise except as
   19  *    such appears in the above copyright notice or in the software.
   20  * 
   21  * THIS SOFTWARE IS BEING PROVIDED BY WHISTLE COMMUNICATIONS "AS IS", AND
   22  * TO THE MAXIMUM EXTENT PERMITTED BY LAW, WHISTLE COMMUNICATIONS MAKES NO
   23  * REPRESENTATIONS OR WARRANTIES, EXPRESS OR IMPLIED, REGARDING THIS SOFTWARE,
   24  * INCLUDING WITHOUT LIMITATION, ANY AND ALL IMPLIED WARRANTIES OF
   25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT.
   26  * WHISTLE COMMUNICATIONS DOES NOT WARRANT, GUARANTEE, OR MAKE ANY
   27  * REPRESENTATIONS REGARDING THE USE OF, OR THE RESULTS OF THE USE OF THIS
   28  * SOFTWARE IN TERMS OF ITS CORRECTNESS, ACCURACY, RELIABILITY OR OTHERWISE.
   29  * IN NO EVENT SHALL WHISTLE COMMUNICATIONS BE LIABLE FOR ANY DAMAGES
   30  * RESULTING FROM OR ARISING OUT OF ANY USE OF THIS SOFTWARE, INCLUDING
   31  * WITHOUT LIMITATION, ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
   32  * PUNITIVE, OR CONSEQUENTIAL DAMAGES, PROCUREMENT OF SUBSTITUTE GOODS OR
   33  * SERVICES, LOSS OF USE, DATA OR PROFITS, HOWEVER CAUSED AND UNDER ANY
   34  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
   35  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
   36  * THIS SOFTWARE, EVEN IF WHISTLE COMMUNICATIONS IS ADVISED OF THE POSSIBILITY
   37  * OF SUCH DAMAGE.
   38  *
   39  * Authors: Archie Cobbs <archie@freebsd.org>
   40  *          Julian Elischer <julian@freebsd.org>
   41  *
   42  * $FreeBSD: releng/11.1/sys/netgraph/ng_ether.c 298813 2016-04-29 21:25:05Z pfg $
   43  */
   44 
   45 /*
   46  * ng_ether(4) netgraph node type
   47  */
   48 
   49 #include <sys/param.h>
   50 #include <sys/eventhandler.h>
   51 #include <sys/systm.h>
   52 #include <sys/kernel.h>
   53 #include <sys/malloc.h>
   54 #include <sys/mbuf.h>
   55 #include <sys/errno.h>
   56 #include <sys/proc.h>
   57 #include <sys/syslog.h>
   58 #include <sys/socket.h>
   59 #include <sys/taskqueue.h>
   60 
   61 #include <net/if.h>
   62 #include <net/if_dl.h>
   63 #include <net/if_types.h>
   64 #include <net/if_arp.h>
   65 #include <net/if_var.h>
   66 #include <net/ethernet.h>
   67 #include <net/if_bridgevar.h>
   68 #include <net/vnet.h>
   69 
   70 #include <netgraph/ng_message.h>
   71 #include <netgraph/netgraph.h>
   72 #include <netgraph/ng_parse.h>
   73 #include <netgraph/ng_ether.h>
   74 
   75 MODULE_VERSION(ng_ether, 1);
   76 
   77 #define IFP2NG(ifp)  ((ifp)->if_l2com)
   78 
   79 /* Per-node private data */
   80 struct private {
   81         struct ifnet    *ifp;           /* associated interface */
   82         hook_p          upper;          /* upper hook connection */
   83         hook_p          lower;          /* lower hook connection */
   84         hook_p          orphan;         /* orphan hook connection */
   85         u_char          autoSrcAddr;    /* always overwrite source address */
   86         u_char          promisc;        /* promiscuous mode enabled */
   87         u_long          hwassist;       /* hardware checksum capabilities */
   88         u_int           flags;          /* flags e.g. really die */
   89 };
   90 typedef struct private *priv_p;
   91 
   92 /* Hook pointers used by if_ethersubr.c to callback to netgraph */
   93 extern  void    (*ng_ether_input_p)(struct ifnet *ifp, struct mbuf **mp);
   94 extern  void    (*ng_ether_input_orphan_p)(struct ifnet *ifp, struct mbuf *m);
   95 extern  int     (*ng_ether_output_p)(struct ifnet *ifp, struct mbuf **mp);
   96 extern  void    (*ng_ether_attach_p)(struct ifnet *ifp);
   97 extern  void    (*ng_ether_detach_p)(struct ifnet *ifp);
   98 extern  void    (*ng_ether_link_state_p)(struct ifnet *ifp, int state);
   99 
  100 /* Functional hooks called from if_ethersubr.c */
  101 static void     ng_ether_input(struct ifnet *ifp, struct mbuf **mp);
  102 static void     ng_ether_input_orphan(struct ifnet *ifp, struct mbuf *m);
  103 static int      ng_ether_output(struct ifnet *ifp, struct mbuf **mp);
  104 static void     ng_ether_attach(struct ifnet *ifp);
  105 static void     ng_ether_detach(struct ifnet *ifp); 
  106 static void     ng_ether_link_state(struct ifnet *ifp, int state); 
  107 
  108 /* Other functions */
  109 static int      ng_ether_rcv_lower(hook_p node, item_p item);
  110 static int      ng_ether_rcv_upper(hook_p node, item_p item);
  111 
  112 /* Netgraph node methods */
  113 static ng_constructor_t ng_ether_constructor;
  114 static ng_rcvmsg_t      ng_ether_rcvmsg;
  115 static ng_shutdown_t    ng_ether_shutdown;
  116 static ng_newhook_t     ng_ether_newhook;
  117 static ng_rcvdata_t     ng_ether_rcvdata;
  118 static ng_disconnect_t  ng_ether_disconnect;
  119 static int              ng_ether_mod_event(module_t mod, int event, void *data);
  120 
  121 static eventhandler_tag ng_ether_ifnet_arrival_cookie;
  122 
  123 /* List of commands and how to convert arguments to/from ASCII */
  124 static const struct ng_cmdlist ng_ether_cmdlist[] = {
  125         {
  126           NGM_ETHER_COOKIE,
  127           NGM_ETHER_GET_IFNAME,
  128           "getifname",
  129           NULL,
  130           &ng_parse_string_type
  131         },
  132         {
  133           NGM_ETHER_COOKIE,
  134           NGM_ETHER_GET_IFINDEX,
  135           "getifindex",
  136           NULL,
  137           &ng_parse_int32_type
  138         },
  139         {
  140           NGM_ETHER_COOKIE,
  141           NGM_ETHER_GET_ENADDR,
  142           "getenaddr",
  143           NULL,
  144           &ng_parse_enaddr_type
  145         },
  146         {
  147           NGM_ETHER_COOKIE,
  148           NGM_ETHER_SET_ENADDR,
  149           "setenaddr",
  150           &ng_parse_enaddr_type,
  151           NULL
  152         },
  153         {
  154           NGM_ETHER_COOKIE,
  155           NGM_ETHER_GET_PROMISC,
  156           "getpromisc",
  157           NULL,
  158           &ng_parse_int32_type
  159         },
  160         {
  161           NGM_ETHER_COOKIE,
  162           NGM_ETHER_SET_PROMISC,
  163           "setpromisc",
  164           &ng_parse_int32_type,
  165           NULL
  166         },
  167         {
  168           NGM_ETHER_COOKIE,
  169           NGM_ETHER_GET_AUTOSRC,
  170           "getautosrc",
  171           NULL,
  172           &ng_parse_int32_type
  173         },
  174         {
  175           NGM_ETHER_COOKIE,
  176           NGM_ETHER_SET_AUTOSRC,
  177           "setautosrc",
  178           &ng_parse_int32_type,
  179           NULL
  180         },
  181         {
  182           NGM_ETHER_COOKIE,
  183           NGM_ETHER_ADD_MULTI,
  184           "addmulti",
  185           &ng_parse_enaddr_type,
  186           NULL
  187         },
  188         {
  189           NGM_ETHER_COOKIE,
  190           NGM_ETHER_DEL_MULTI,
  191           "delmulti",
  192           &ng_parse_enaddr_type,
  193           NULL
  194         },
  195         {
  196           NGM_ETHER_COOKIE,
  197           NGM_ETHER_DETACH,
  198           "detach",
  199           NULL,
  200           NULL
  201         },
  202         { 0 }
  203 };
  204 
  205 static struct ng_type ng_ether_typestruct = {
  206         .version =      NG_ABI_VERSION,
  207         .name =         NG_ETHER_NODE_TYPE,
  208         .mod_event =    ng_ether_mod_event,
  209         .constructor =  ng_ether_constructor,
  210         .rcvmsg =       ng_ether_rcvmsg,
  211         .shutdown =     ng_ether_shutdown,
  212         .newhook =      ng_ether_newhook,
  213         .rcvdata =      ng_ether_rcvdata,
  214         .disconnect =   ng_ether_disconnect,
  215         .cmdlist =      ng_ether_cmdlist,
  216 };
  217 NETGRAPH_INIT(ether, &ng_ether_typestruct);
  218 
  219 /******************************************************************
  220                     UTILITY FUNCTIONS
  221 ******************************************************************/
  222 static void
  223 ng_ether_sanitize_ifname(const char *ifname, char *name)
  224 {
  225         int i;
  226 
  227         for (i = 0; i < IFNAMSIZ; i++) {
  228                 if (ifname[i] == '.' || ifname[i] == ':')
  229                         name[i] = '_';
  230                 else
  231                         name[i] = ifname[i];
  232                 if (name[i] == '\0')
  233                         break;
  234         }
  235 }
  236 
  237 /******************************************************************
  238                     ETHERNET FUNCTION HOOKS
  239 ******************************************************************/
  240 
  241 /*
  242  * Handle a packet that has come in on an interface. We get to
  243  * look at it here before any upper layer protocols do.
  244  */
  245 static void
  246 ng_ether_input(struct ifnet *ifp, struct mbuf **mp)
  247 {
  248         const node_p node = IFP2NG(ifp);
  249         const priv_p priv = NG_NODE_PRIVATE(node);
  250         int error;
  251 
  252         /* If "lower" hook not connected, let packet continue */
  253         if (priv->lower == NULL)
  254                 return;
  255         NG_SEND_DATA_ONLY(error, priv->lower, *mp);     /* sets *mp = NULL */
  256 }
  257 
  258 /*
  259  * Handle a packet that has come in on an interface, and which
  260  * does not match any of our known protocols (an ``orphan'').
  261  */
  262 static void
  263 ng_ether_input_orphan(struct ifnet *ifp, struct mbuf *m)
  264 {
  265         const node_p node = IFP2NG(ifp);
  266         const priv_p priv = NG_NODE_PRIVATE(node);
  267         int error;
  268 
  269         /* If "orphan" hook not connected, discard packet */
  270         if (priv->orphan == NULL) {
  271                 m_freem(m);
  272                 return;
  273         }
  274         NG_SEND_DATA_ONLY(error, priv->orphan, m);
  275 }
  276 
  277 /*
  278  * Handle a packet that is going out on an interface.
  279  * The Ethernet header is already attached to the mbuf.
  280  */
  281 static int
  282 ng_ether_output(struct ifnet *ifp, struct mbuf **mp)
  283 {
  284         const node_p node = IFP2NG(ifp);
  285         const priv_p priv = NG_NODE_PRIVATE(node);
  286         int error = 0;
  287 
  288         /* If "upper" hook not connected, let packet continue */
  289         if (priv->upper == NULL)
  290                 return (0);
  291 
  292         /* Send it out "upper" hook */
  293         NG_OUTBOUND_THREAD_REF();
  294         NG_SEND_DATA_ONLY(error, priv->upper, *mp);
  295         NG_OUTBOUND_THREAD_UNREF();
  296         return (error);
  297 }
  298 
  299 /*
  300  * A new Ethernet interface has been attached.
  301  * Create a new node for it, etc.
  302  */
  303 static void
  304 ng_ether_attach(struct ifnet *ifp)
  305 {
  306         char name[IFNAMSIZ];
  307         priv_p priv;
  308         node_p node;
  309 
  310         /*
  311          * Do not create / attach an ether node to this ifnet if
  312          * a netgraph node with the same name already exists.
  313          * This should prevent ether nodes to become attached to
  314          * eiface nodes, which may be problematic due to naming
  315          * clashes.
  316          */
  317         if ((node = ng_name2noderef(NULL, ifp->if_xname)) != NULL) {
  318                 NG_NODE_UNREF(node);
  319                 return;
  320         }
  321 
  322         /* Create node */
  323         KASSERT(!IFP2NG(ifp), ("%s: node already exists?", __func__));
  324         if (ng_make_node_common(&ng_ether_typestruct, &node) != 0) {
  325                 log(LOG_ERR, "%s: can't %s for %s\n",
  326                     __func__, "create node", ifp->if_xname);
  327                 return;
  328         }
  329 
  330         /* Allocate private data */
  331         priv = malloc(sizeof(*priv), M_NETGRAPH, M_NOWAIT | M_ZERO);
  332         if (priv == NULL) {
  333                 log(LOG_ERR, "%s: can't %s for %s\n",
  334                     __func__, "allocate memory", ifp->if_xname);
  335                 NG_NODE_UNREF(node);
  336                 return;
  337         }
  338         NG_NODE_SET_PRIVATE(node, priv);
  339         priv->ifp = ifp;
  340         IFP2NG(ifp) = node;
  341         priv->hwassist = ifp->if_hwassist;
  342 
  343         /* Try to give the node the same name as the interface */
  344         ng_ether_sanitize_ifname(ifp->if_xname, name);
  345         if (ng_name_node(node, name) != 0)
  346                 log(LOG_WARNING, "%s: can't name node %s\n", __func__, name);
  347 }
  348 
  349 /*
  350  * An Ethernet interface is being detached.
  351  * REALLY Destroy its node.
  352  */
  353 static void
  354 ng_ether_detach(struct ifnet *ifp)
  355 {
  356         const node_p node = IFP2NG(ifp);
  357         const priv_p priv = NG_NODE_PRIVATE(node);
  358 
  359         taskqueue_drain(taskqueue_swi, &ifp->if_linktask);
  360         NG_NODE_REALLY_DIE(node);       /* Force real removal of node */
  361         /*
  362          * We can't assume the ifnet is still around when we run shutdown
  363          * So zap it now. XXX We HOPE that anything running at this time
  364          * handles it (as it should in the non netgraph case).
  365          */
  366         IFP2NG(ifp) = NULL;
  367         priv->ifp = NULL;       /* XXX race if interrupted an output packet */
  368         ng_rmnode_self(node);           /* remove all netgraph parts */
  369 }
  370 
  371 /*
  372  * Notify graph about link event.
  373  * if_link_state_change() has already checked that the state has changed.
  374  */
  375 static void
  376 ng_ether_link_state(struct ifnet *ifp, int state)
  377 {
  378         const node_p node = IFP2NG(ifp);
  379         const priv_p priv = NG_NODE_PRIVATE(node);
  380         struct ng_mesg *msg;
  381         int cmd, dummy_error = 0;
  382 
  383         if (state == LINK_STATE_UP)
  384                 cmd = NGM_LINK_IS_UP;
  385         else if (state == LINK_STATE_DOWN)
  386                 cmd = NGM_LINK_IS_DOWN;
  387         else
  388                 return;
  389 
  390         if (priv->lower != NULL) {
  391                 NG_MKMESSAGE(msg, NGM_FLOW_COOKIE, cmd, 0, M_NOWAIT);
  392                 if (msg != NULL)
  393                         NG_SEND_MSG_HOOK(dummy_error, node, msg, priv->lower, 0);
  394         }
  395         if (priv->orphan != NULL) {
  396                 NG_MKMESSAGE(msg, NGM_FLOW_COOKIE, cmd, 0, M_NOWAIT);
  397                 if (msg != NULL)
  398                         NG_SEND_MSG_HOOK(dummy_error, node, msg, priv->orphan, 0);
  399         }
  400 }
  401 
  402 /*
  403  * Interface arrival notification handler.
  404  * The notification is produced in two cases:
  405  *  o a new interface arrives
  406  *  o an existing interface got renamed
  407  * Currently the first case is handled by ng_ether_attach via special
  408  * hook ng_ether_attach_p.
  409  */
  410 static void
  411 ng_ether_ifnet_arrival_event(void *arg __unused, struct ifnet *ifp)
  412 {
  413         char name[IFNAMSIZ];
  414         node_p node;
  415 
  416         /* Only ethernet interfaces are of interest. */
  417         if (ifp->if_type != IFT_ETHER
  418             && ifp->if_type != IFT_L2VLAN)
  419                 return;
  420 
  421         /*
  422          * Just return if it's a new interface without an ng_ether companion.
  423          */
  424         node = IFP2NG(ifp);
  425         if (node == NULL)
  426                 return;
  427 
  428         /* Try to give the node the same name as the new interface name */
  429         ng_ether_sanitize_ifname(ifp->if_xname, name);
  430         if (ng_name_node(node, name) != 0)
  431                 log(LOG_WARNING, "%s: can't re-name node %s\n", __func__, name);
  432 }
  433 
  434 /******************************************************************
  435                     NETGRAPH NODE METHODS
  436 ******************************************************************/
  437 
  438 /*
  439  * It is not possible or allowable to create a node of this type.
  440  * Nodes get created when the interface is attached (or, when
  441  * this node type's KLD is loaded).
  442  */
  443 static int
  444 ng_ether_constructor(node_p node)
  445 {
  446         return (EINVAL);
  447 }
  448 
  449 /*
  450  * Check for attaching a new hook.
  451  */
  452 static  int
  453 ng_ether_newhook(node_p node, hook_p hook, const char *name)
  454 {
  455         const priv_p priv = NG_NODE_PRIVATE(node);
  456         hook_p *hookptr;
  457 
  458         /* Divert hook is an alias for lower */
  459         if (strcmp(name, NG_ETHER_HOOK_DIVERT) == 0)
  460                 name = NG_ETHER_HOOK_LOWER;
  461 
  462         /* Which hook? */
  463         if (strcmp(name, NG_ETHER_HOOK_UPPER) == 0) {
  464                 hookptr = &priv->upper;
  465                 NG_HOOK_SET_RCVDATA(hook, ng_ether_rcv_upper);
  466                 NG_HOOK_SET_TO_INBOUND(hook);
  467         } else if (strcmp(name, NG_ETHER_HOOK_LOWER) == 0) {
  468                 hookptr = &priv->lower;
  469                 NG_HOOK_SET_RCVDATA(hook, ng_ether_rcv_lower);
  470         } else if (strcmp(name, NG_ETHER_HOOK_ORPHAN) == 0) {
  471                 hookptr = &priv->orphan;
  472                 NG_HOOK_SET_RCVDATA(hook, ng_ether_rcv_lower);
  473         } else
  474                 return (EINVAL);
  475 
  476         /* Check if already connected (shouldn't be, but doesn't hurt) */
  477         if (*hookptr != NULL)
  478                 return (EISCONN);
  479 
  480         /* Disable hardware checksums while 'upper' hook is connected */
  481         if (hookptr == &priv->upper)
  482                 priv->ifp->if_hwassist = 0;
  483         NG_HOOK_HI_STACK(hook);
  484         /* OK */
  485         *hookptr = hook;
  486         return (0);
  487 }
  488 
  489 /*
  490  * Receive an incoming control message.
  491  */
  492 static int
  493 ng_ether_rcvmsg(node_p node, item_p item, hook_p lasthook)
  494 {
  495         const priv_p priv = NG_NODE_PRIVATE(node);
  496         struct ng_mesg *resp = NULL;
  497         int error = 0;
  498         struct ng_mesg *msg;
  499 
  500         NGI_GET_MSG(item, msg);
  501         switch (msg->header.typecookie) {
  502         case NGM_ETHER_COOKIE:
  503                 switch (msg->header.cmd) {
  504                 case NGM_ETHER_GET_IFNAME:
  505                         NG_MKRESPONSE(resp, msg, IFNAMSIZ, M_NOWAIT);
  506                         if (resp == NULL) {
  507                                 error = ENOMEM;
  508                                 break;
  509                         }
  510                         strlcpy(resp->data, priv->ifp->if_xname, IFNAMSIZ);
  511                         break;
  512                 case NGM_ETHER_GET_IFINDEX:
  513                         NG_MKRESPONSE(resp, msg, sizeof(u_int32_t), M_NOWAIT);
  514                         if (resp == NULL) {
  515                                 error = ENOMEM;
  516                                 break;
  517                         }
  518                         *((u_int32_t *)resp->data) = priv->ifp->if_index;
  519                         break;
  520                 case NGM_ETHER_GET_ENADDR:
  521                         NG_MKRESPONSE(resp, msg, ETHER_ADDR_LEN, M_NOWAIT);
  522                         if (resp == NULL) {
  523                                 error = ENOMEM;
  524                                 break;
  525                         }
  526                         bcopy(IF_LLADDR(priv->ifp),
  527                             resp->data, ETHER_ADDR_LEN);
  528                         break;
  529                 case NGM_ETHER_SET_ENADDR:
  530                     {
  531                         if (msg->header.arglen != ETHER_ADDR_LEN) {
  532                                 error = EINVAL;
  533                                 break;
  534                         }
  535                         error = if_setlladdr(priv->ifp,
  536                             (u_char *)msg->data, ETHER_ADDR_LEN);
  537                         break;
  538                     }
  539                 case NGM_ETHER_GET_PROMISC:
  540                         NG_MKRESPONSE(resp, msg, sizeof(u_int32_t), M_NOWAIT);
  541                         if (resp == NULL) {
  542                                 error = ENOMEM;
  543                                 break;
  544                         }
  545                         *((u_int32_t *)resp->data) = priv->promisc;
  546                         break;
  547                 case NGM_ETHER_SET_PROMISC:
  548                     {
  549                         u_char want;
  550 
  551                         if (msg->header.arglen != sizeof(u_int32_t)) {
  552                                 error = EINVAL;
  553                                 break;
  554                         }
  555                         want = !!*((u_int32_t *)msg->data);
  556                         if (want ^ priv->promisc) {
  557                                 if ((error = ifpromisc(priv->ifp, want)) != 0)
  558                                         break;
  559                                 priv->promisc = want;
  560                         }
  561                         break;
  562                     }
  563                 case NGM_ETHER_GET_AUTOSRC:
  564                         NG_MKRESPONSE(resp, msg, sizeof(u_int32_t), M_NOWAIT);
  565                         if (resp == NULL) {
  566                                 error = ENOMEM;
  567                                 break;
  568                         }
  569                         *((u_int32_t *)resp->data) = priv->autoSrcAddr;
  570                         break;
  571                 case NGM_ETHER_SET_AUTOSRC:
  572                         if (msg->header.arglen != sizeof(u_int32_t)) {
  573                                 error = EINVAL;
  574                                 break;
  575                         }
  576                         priv->autoSrcAddr = !!*((u_int32_t *)msg->data);
  577                         break;
  578                 case NGM_ETHER_ADD_MULTI:
  579                     {
  580                         struct sockaddr_dl sa_dl;
  581                         struct ifmultiaddr *ifma;
  582 
  583                         if (msg->header.arglen != ETHER_ADDR_LEN) {
  584                                 error = EINVAL;
  585                                 break;
  586                         }
  587                         bzero(&sa_dl, sizeof(struct sockaddr_dl));
  588                         sa_dl.sdl_len = sizeof(struct sockaddr_dl);
  589                         sa_dl.sdl_family = AF_LINK;
  590                         sa_dl.sdl_alen = ETHER_ADDR_LEN;
  591                         bcopy((void *)msg->data, LLADDR(&sa_dl),
  592                             ETHER_ADDR_LEN);
  593                         /*
  594                          * Netgraph is only permitted to join groups once
  595                          * via the if_addmulti() KPI, because it cannot hold
  596                          * struct ifmultiaddr * between calls. It may also
  597                          * lose a race while we check if the membership
  598                          * already exists.
  599                          */
  600                         if_maddr_rlock(priv->ifp);
  601                         ifma = if_findmulti(priv->ifp,
  602                             (struct sockaddr *)&sa_dl);
  603                         if_maddr_runlock(priv->ifp);
  604                         if (ifma != NULL) {
  605                                 error = EADDRINUSE;
  606                         } else {
  607                                 error = if_addmulti(priv->ifp,
  608                                     (struct sockaddr *)&sa_dl, &ifma);
  609                         }
  610                         break;
  611                     }
  612                 case NGM_ETHER_DEL_MULTI:
  613                     {
  614                         struct sockaddr_dl sa_dl;
  615 
  616                         if (msg->header.arglen != ETHER_ADDR_LEN) {
  617                                 error = EINVAL;
  618                                 break;
  619                         }
  620                         bzero(&sa_dl, sizeof(struct sockaddr_dl));
  621                         sa_dl.sdl_len = sizeof(struct sockaddr_dl);
  622                         sa_dl.sdl_family = AF_LINK;
  623                         sa_dl.sdl_alen = ETHER_ADDR_LEN;
  624                         bcopy((void *)msg->data, LLADDR(&sa_dl),
  625                             ETHER_ADDR_LEN);
  626                         error = if_delmulti(priv->ifp,
  627                             (struct sockaddr *)&sa_dl);
  628                         break;
  629                     }
  630                 case NGM_ETHER_DETACH:
  631                         ng_ether_detach(priv->ifp);
  632                         break;
  633                 default:
  634                         error = EINVAL;
  635                         break;
  636                 }
  637                 break;
  638         default:
  639                 error = EINVAL;
  640                 break;
  641         }
  642         NG_RESPOND_MSG(error, node, item, resp);
  643         NG_FREE_MSG(msg);
  644         return (error);
  645 }
  646 
  647 /*
  648  * Receive data on a hook.
  649  * Since we use per-hook recveive methods this should never be called.
  650  */
  651 static int
  652 ng_ether_rcvdata(hook_p hook, item_p item)
  653 {
  654         NG_FREE_ITEM(item);
  655 
  656         panic("%s: weird hook", __func__);
  657 }
  658 
  659 /*
  660  * Handle an mbuf received on the "lower" or "orphan" hook.
  661  */
  662 static int
  663 ng_ether_rcv_lower(hook_p hook, item_p item)
  664 {
  665         struct mbuf *m;
  666         const node_p node = NG_HOOK_NODE(hook);
  667         const priv_p priv = NG_NODE_PRIVATE(node);
  668         struct ifnet *const ifp = priv->ifp;
  669 
  670         NGI_GET_M(item, m);
  671         NG_FREE_ITEM(item);
  672 
  673         /* Check whether interface is ready for packets */
  674 
  675         if (!((ifp->if_flags & IFF_UP) &&
  676             (ifp->if_drv_flags & IFF_DRV_RUNNING))) {
  677                 NG_FREE_M(m);
  678                 return (ENETDOWN);
  679         }
  680 
  681         /* Make sure header is fully pulled up */
  682         if (m->m_pkthdr.len < sizeof(struct ether_header)) {
  683                 NG_FREE_M(m);
  684                 return (EINVAL);
  685         }
  686         if (m->m_len < sizeof(struct ether_header)
  687             && (m = m_pullup(m, sizeof(struct ether_header))) == NULL)
  688                 return (ENOBUFS);
  689 
  690         /* Drop in the MAC address if desired */
  691         if (priv->autoSrcAddr) {
  692 
  693                 /* Make the mbuf writable if it's not already */
  694                 if (!M_WRITABLE(m)
  695                     && (m = m_pullup(m, sizeof(struct ether_header))) == NULL)
  696                         return (ENOBUFS);
  697 
  698                 /* Overwrite source MAC address */
  699                 bcopy(IF_LLADDR(ifp),
  700                     mtod(m, struct ether_header *)->ether_shost,
  701                     ETHER_ADDR_LEN);
  702         }
  703 
  704         /* Send it on its way */
  705         return ether_output_frame(ifp, m);
  706 }
  707 
  708 /*
  709  * Handle an mbuf received on the "upper" hook.
  710  */
  711 static int
  712 ng_ether_rcv_upper(hook_p hook, item_p item)
  713 {
  714         struct mbuf *m;
  715         const node_p node = NG_HOOK_NODE(hook);
  716         const priv_p priv = NG_NODE_PRIVATE(node);
  717         struct ifnet *ifp = priv->ifp;
  718 
  719         NGI_GET_M(item, m);
  720         NG_FREE_ITEM(item);
  721 
  722         /* Check length and pull off header */
  723         if (m->m_pkthdr.len < sizeof(struct ether_header)) {
  724                 NG_FREE_M(m);
  725                 return (EINVAL);
  726         }
  727         if (m->m_len < sizeof(struct ether_header) &&
  728             (m = m_pullup(m, sizeof(struct ether_header))) == NULL)
  729                 return (ENOBUFS);
  730 
  731         m->m_pkthdr.rcvif = ifp;
  732 
  733         /* Pass the packet to the bridge, it may come back to us */
  734         if (ifp->if_bridge) {
  735                 BRIDGE_INPUT(ifp, m);
  736                 if (m == NULL)
  737                         return (0);
  738         }
  739 
  740         /* Route packet back in */
  741         ether_demux(ifp, m);
  742         return (0);
  743 }
  744 
  745 /*
  746  * Shutdown node. This resets the node but does not remove it
  747  * unless the REALLY_DIE flag is set.
  748  */
  749 static int
  750 ng_ether_shutdown(node_p node)
  751 {
  752         const priv_p priv = NG_NODE_PRIVATE(node);
  753 
  754         if (node->nd_flags & NGF_REALLY_DIE) {
  755                 /*
  756                  * WE came here because the ethernet card is being unloaded,
  757                  * so stop being persistent.
  758                  * Actually undo all the things we did on creation.
  759                  * Assume the ifp has already been freed.
  760                  */
  761                 NG_NODE_SET_PRIVATE(node, NULL);
  762                 free(priv, M_NETGRAPH);         
  763                 NG_NODE_UNREF(node);    /* free node itself */
  764                 return (0);
  765         }
  766         if (priv->promisc) {            /* disable promiscuous mode */
  767                 (void)ifpromisc(priv->ifp, 0);
  768                 priv->promisc = 0;
  769         }
  770         NG_NODE_REVIVE(node);           /* Signal ng_rmnode we are persisant */
  771 
  772         return (0);
  773 }
  774 
  775 /*
  776  * Hook disconnection.
  777  */
  778 static int
  779 ng_ether_disconnect(hook_p hook)
  780 {
  781         const priv_p priv = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
  782 
  783         if (hook == priv->upper) {
  784                 priv->upper = NULL;
  785                 if (priv->ifp != NULL)          /* restore h/w csum */
  786                         priv->ifp->if_hwassist = priv->hwassist;
  787         } else if (hook == priv->lower)
  788                 priv->lower = NULL;
  789         else if (hook == priv->orphan)
  790                 priv->orphan = NULL;
  791         else
  792                 panic("%s: weird hook", __func__);
  793         if ((NG_NODE_NUMHOOKS(NG_HOOK_NODE(hook)) == 0)
  794         && (NG_NODE_IS_VALID(NG_HOOK_NODE(hook))))
  795                 ng_rmnode_self(NG_HOOK_NODE(hook));     /* reset node */
  796         return (0);
  797 }
  798 
  799 /******************************************************************
  800                         INITIALIZATION
  801 ******************************************************************/
  802 
  803 /*
  804  * Handle loading and unloading for this node type.
  805  */
  806 static int
  807 ng_ether_mod_event(module_t mod, int event, void *data)
  808 {
  809         int error = 0;
  810 
  811         switch (event) {
  812         case MOD_LOAD:
  813 
  814                 /* Register function hooks */
  815                 if (ng_ether_attach_p != NULL) {
  816                         error = EEXIST;
  817                         break;
  818                 }
  819                 ng_ether_attach_p = ng_ether_attach;
  820                 ng_ether_detach_p = ng_ether_detach;
  821                 ng_ether_output_p = ng_ether_output;
  822                 ng_ether_input_p = ng_ether_input;
  823                 ng_ether_input_orphan_p = ng_ether_input_orphan;
  824                 ng_ether_link_state_p = ng_ether_link_state;
  825 
  826                 ng_ether_ifnet_arrival_cookie =
  827                     EVENTHANDLER_REGISTER(ifnet_arrival_event,
  828                     ng_ether_ifnet_arrival_event, NULL, EVENTHANDLER_PRI_ANY);
  829                 break;
  830 
  831         case MOD_UNLOAD:
  832 
  833                 /*
  834                  * Note that the base code won't try to unload us until
  835                  * all nodes have been removed, and that can't happen
  836                  * until all Ethernet interfaces are removed. In any
  837                  * case, we know there are no nodes left if the action
  838                  * is MOD_UNLOAD, so there's no need to detach any nodes.
  839                  */
  840 
  841                 EVENTHANDLER_DEREGISTER(ifnet_arrival_event,
  842                     ng_ether_ifnet_arrival_cookie);
  843 
  844                 /* Unregister function hooks */
  845                 ng_ether_attach_p = NULL;
  846                 ng_ether_detach_p = NULL;
  847                 ng_ether_output_p = NULL;
  848                 ng_ether_input_p = NULL;
  849                 ng_ether_input_orphan_p = NULL;
  850                 ng_ether_link_state_p = NULL;
  851                 break;
  852 
  853         default:
  854                 error = EOPNOTSUPP;
  855                 break;
  856         }
  857         return (error);
  858 }
  859 
  860 static void
  861 vnet_ng_ether_init(const void *unused)
  862 {
  863         struct ifnet *ifp;
  864 
  865         /* If module load was rejected, don't attach to vnets. */
  866         if (ng_ether_attach_p != ng_ether_attach)
  867                 return;
  868 
  869         /* Create nodes for any already-existing Ethernet interfaces. */
  870         IFNET_RLOCK();
  871         TAILQ_FOREACH(ifp, &V_ifnet, if_link) {
  872                 if (ifp->if_type == IFT_ETHER
  873                     || ifp->if_type == IFT_L2VLAN)
  874                         ng_ether_attach(ifp);
  875         }
  876         IFNET_RUNLOCK();
  877 }
  878 VNET_SYSINIT(vnet_ng_ether_init, SI_SUB_PSEUDO, SI_ORDER_ANY,
  879     vnet_ng_ether_init, NULL);

Cache object: 5f8b56f29b0eec4515d59856f96f1c35


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.