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-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-2  -  FREEBSD-11-1  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-4  -  FREEBSD-10-3  -  FREEBSD-10-2  -  FREEBSD-10-1  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-3  -  FREEBSD-9-2  -  FREEBSD-9-1  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-4  -  FREEBSD-8-3  -  FREEBSD-8-2  -  FREEBSD-8-1  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-4  -  FREEBSD-7-3  -  FREEBSD-7-2  -  FREEBSD-7-1  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-4  -  FREEBSD-6-3  -  FREEBSD-6-2  -  FREEBSD-6-1  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-5  -  FREEBSD-5-4  -  FREEBSD-5-3  -  FREEBSD-5-2  -  FREEBSD-5-1  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  linux-2.6  -  linux-2.4.22  -  MK83  -  MK84  -  PLAN9  -  DFBSD  -  NETBSD  -  NETBSD5  -  NETBSD4  -  NETBSD3  -  NETBSD20  -  OPENBSD  -  xnu-517  -  xnu-792  -  xnu-792.6.70  -  xnu-1228  -  xnu-1456.1.26  -  xnu-1699.24.8  -  xnu-2050.18.24  -  OPENSOLARIS  -  minix-3-1-1 
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$
   43  */
   44 
   45 /*
   46  * ng_ether(4) netgraph node type
   47  */
   48 
   49 #include <sys/param.h>
   50 #include <sys/systm.h>
   51 #include <sys/kernel.h>
   52 #include <sys/malloc.h>
   53 #include <sys/mbuf.h>
   54 #include <sys/errno.h>
   55 #include <sys/syslog.h>
   56 #include <sys/socket.h>
   57 
   58 #include <net/if.h>
   59 #include <net/if_dl.h>
   60 #include <net/if_types.h>
   61 #include <net/if_arp.h>
   62 #include <net/if_var.h>
   63 #include <net/ethernet.h>
   64 #include <net/if_bridgevar.h>
   65 
   66 #include <netgraph/ng_message.h>
   67 #include <netgraph/netgraph.h>
   68 #include <netgraph/ng_parse.h>
   69 #include <netgraph/ng_ether.h>
   70 
   71 #define IFP2NG(ifp)  (IFP2AC((ifp))->ac_netgraph)
   72 
   73 /* Per-node private data */
   74 struct private {
   75         struct ifnet    *ifp;           /* associated interface */
   76         hook_p          upper;          /* upper hook connection */
   77         hook_p          lower;          /* lower hook connection */
   78         hook_p          orphan;         /* orphan hook connection */
   79         u_char          autoSrcAddr;    /* always overwrite source address */
   80         u_char          promisc;        /* promiscuous mode enabled */
   81         u_long          hwassist;       /* hardware checksum capabilities */
   82         u_int           flags;          /* flags e.g. really die */
   83 };
   84 typedef struct private *priv_p;
   85 
   86 /* Hook pointers used by if_ethersubr.c to callback to netgraph */
   87 extern  void    (*ng_ether_input_p)(struct ifnet *ifp, struct mbuf **mp);
   88 extern  void    (*ng_ether_input_orphan_p)(struct ifnet *ifp, struct mbuf *m);
   89 extern  int     (*ng_ether_output_p)(struct ifnet *ifp, struct mbuf **mp);
   90 extern  void    (*ng_ether_attach_p)(struct ifnet *ifp);
   91 extern  void    (*ng_ether_detach_p)(struct ifnet *ifp);
   92 extern  void    (*ng_ether_link_state_p)(struct ifnet *ifp, int state);
   93 
   94 /* Functional hooks called from if_ethersubr.c */
   95 static void     ng_ether_input(struct ifnet *ifp, struct mbuf **mp);
   96 static void     ng_ether_input_orphan(struct ifnet *ifp, struct mbuf *m);
   97 static int      ng_ether_output(struct ifnet *ifp, struct mbuf **mp);
   98 static void     ng_ether_attach(struct ifnet *ifp);
   99 static void     ng_ether_detach(struct ifnet *ifp); 
  100 static void     ng_ether_link_state(struct ifnet *ifp, int state); 
  101 
  102 /* Other functions */
  103 static int      ng_ether_rcv_lower(node_p node, struct mbuf *m);
  104 static int      ng_ether_rcv_upper(node_p node, struct mbuf *m);
  105 
  106 /* Netgraph node methods */
  107 static ng_constructor_t ng_ether_constructor;
  108 static ng_rcvmsg_t      ng_ether_rcvmsg;
  109 static ng_shutdown_t    ng_ether_shutdown;
  110 static ng_newhook_t     ng_ether_newhook;
  111 static ng_rcvdata_t     ng_ether_rcvdata;
  112 static ng_disconnect_t  ng_ether_disconnect;
  113 static int              ng_ether_mod_event(module_t mod, int event, void *data);
  114 
  115 /* List of commands and how to convert arguments to/from ASCII */
  116 static const struct ng_cmdlist ng_ether_cmdlist[] = {
  117         {
  118           NGM_ETHER_COOKIE,
  119           NGM_ETHER_GET_IFNAME,
  120           "getifname",
  121           NULL,
  122           &ng_parse_string_type
  123         },
  124         {
  125           NGM_ETHER_COOKIE,
  126           NGM_ETHER_GET_IFINDEX,
  127           "getifindex",
  128           NULL,
  129           &ng_parse_int32_type
  130         },
  131         {
  132           NGM_ETHER_COOKIE,
  133           NGM_ETHER_GET_ENADDR,
  134           "getenaddr",
  135           NULL,
  136           &ng_parse_enaddr_type
  137         },
  138         {
  139           NGM_ETHER_COOKIE,
  140           NGM_ETHER_SET_ENADDR,
  141           "setenaddr",
  142           &ng_parse_enaddr_type,
  143           NULL
  144         },
  145         {
  146           NGM_ETHER_COOKIE,
  147           NGM_ETHER_GET_PROMISC,
  148           "getpromisc",
  149           NULL,
  150           &ng_parse_int32_type
  151         },
  152         {
  153           NGM_ETHER_COOKIE,
  154           NGM_ETHER_SET_PROMISC,
  155           "setpromisc",
  156           &ng_parse_int32_type,
  157           NULL
  158         },
  159         {
  160           NGM_ETHER_COOKIE,
  161           NGM_ETHER_GET_AUTOSRC,
  162           "getautosrc",
  163           NULL,
  164           &ng_parse_int32_type
  165         },
  166         {
  167           NGM_ETHER_COOKIE,
  168           NGM_ETHER_SET_AUTOSRC,
  169           "setautosrc",
  170           &ng_parse_int32_type,
  171           NULL
  172         },
  173         {
  174           NGM_ETHER_COOKIE,
  175           NGM_ETHER_ADD_MULTI,
  176           "addmulti",
  177           &ng_parse_enaddr_type,
  178           NULL
  179         },
  180         {
  181           NGM_ETHER_COOKIE,
  182           NGM_ETHER_DEL_MULTI,
  183           "delmulti",
  184           &ng_parse_enaddr_type,
  185           NULL
  186         },
  187         {
  188           NGM_ETHER_COOKIE,
  189           NGM_ETHER_DETACH,
  190           "detach",
  191           NULL,
  192           NULL
  193         },
  194         { 0 }
  195 };
  196 
  197 static struct ng_type ng_ether_typestruct = {
  198         .version =      NG_ABI_VERSION,
  199         .name =         NG_ETHER_NODE_TYPE,
  200         .mod_event =    ng_ether_mod_event,
  201         .constructor =  ng_ether_constructor,
  202         .rcvmsg =       ng_ether_rcvmsg,
  203         .shutdown =     ng_ether_shutdown,
  204         .newhook =      ng_ether_newhook,
  205         .rcvdata =      ng_ether_rcvdata,
  206         .disconnect =   ng_ether_disconnect,
  207         .cmdlist =      ng_ether_cmdlist,
  208 };
  209 NETGRAPH_INIT(ether, &ng_ether_typestruct);
  210 
  211 /******************************************************************
  212                     ETHERNET FUNCTION HOOKS
  213 ******************************************************************/
  214 
  215 /*
  216  * Handle a packet that has come in on an interface. We get to
  217  * look at it here before any upper layer protocols do.
  218  *
  219  * NOTE: this function will get called at splimp()
  220  */
  221 static void
  222 ng_ether_input(struct ifnet *ifp, struct mbuf **mp)
  223 {
  224         const node_p node = IFP2NG(ifp);
  225         const priv_p priv = NG_NODE_PRIVATE(node);
  226         int error;
  227 
  228         /* If "lower" hook not connected, let packet continue */
  229         if (priv->lower == NULL)
  230                 return;
  231         NG_SEND_DATA_ONLY(error, priv->lower, *mp);     /* sets *mp = NULL */
  232 }
  233 
  234 /*
  235  * Handle a packet that has come in on an interface, and which
  236  * does not match any of our known protocols (an ``orphan'').
  237  *
  238  * NOTE: this function will get called at splimp()
  239  */
  240 static void
  241 ng_ether_input_orphan(struct ifnet *ifp, struct mbuf *m)
  242 {
  243         const node_p node = IFP2NG(ifp);
  244         const priv_p priv = NG_NODE_PRIVATE(node);
  245         int error;
  246 
  247         /* If "orphan" hook not connected, discard packet */
  248         if (priv->orphan == NULL) {
  249                 m_freem(m);
  250                 return;
  251         }
  252         NG_SEND_DATA_ONLY(error, priv->orphan, m);
  253 }
  254 
  255 /*
  256  * Handle a packet that is going out on an interface.
  257  * The Ethernet header is already attached to the mbuf.
  258  */
  259 static int
  260 ng_ether_output(struct ifnet *ifp, struct mbuf **mp)
  261 {
  262         const node_p node = IFP2NG(ifp);
  263         const priv_p priv = NG_NODE_PRIVATE(node);
  264         int error = 0;
  265 
  266         /* If "upper" hook not connected, let packet continue */
  267         if (priv->upper == NULL)
  268                 return (0);
  269 
  270         /* Send it out "upper" hook */
  271         NG_SEND_DATA_ONLY(error, priv->upper, *mp);
  272         return (error);
  273 }
  274 
  275 /*
  276  * A new Ethernet interface has been attached.
  277  * Create a new node for it, etc.
  278  */
  279 static void
  280 ng_ether_attach(struct ifnet *ifp)
  281 {
  282         priv_p priv;
  283         node_p node;
  284 
  285         /* Create node */
  286         KASSERT(!IFP2NG(ifp), ("%s: node already exists?", __func__));
  287         if (ng_make_node_common(&ng_ether_typestruct, &node) != 0) {
  288                 log(LOG_ERR, "%s: can't %s for %s\n",
  289                     __func__, "create node", ifp->if_xname);
  290                 return;
  291         }
  292 
  293         /* Allocate private data */
  294         MALLOC(priv, priv_p, sizeof(*priv), M_NETGRAPH, M_NOWAIT | M_ZERO);
  295         if (priv == NULL) {
  296                 log(LOG_ERR, "%s: can't %s for %s\n",
  297                     __func__, "allocate memory", ifp->if_xname);
  298                 NG_NODE_UNREF(node);
  299                 return;
  300         }
  301         NG_NODE_SET_PRIVATE(node, priv);
  302         priv->ifp = ifp;
  303         IFP2NG(ifp) = node;
  304         priv->hwassist = ifp->if_hwassist;
  305 
  306         /* Try to give the node the same name as the interface */
  307         if (ng_name_node(node, ifp->if_xname) != 0) {
  308                 log(LOG_WARNING, "%s: can't name node %s\n",
  309                     __func__, ifp->if_xname);
  310         }
  311 }
  312 
  313 /*
  314  * An Ethernet interface is being detached.
  315  * REALLY Destroy its node.
  316  */
  317 static void
  318 ng_ether_detach(struct ifnet *ifp)
  319 {
  320         const node_p node = IFP2NG(ifp);
  321         const priv_p priv = NG_NODE_PRIVATE(node);
  322 
  323         NG_NODE_REALLY_DIE(node);       /* Force real removal of node */
  324         /*
  325          * We can't assume the ifnet is still around when we run shutdown
  326          * So zap it now. XXX We HOPE that anything running at this time
  327          * handles it (as it should in the non netgraph case).
  328          */
  329         IFP2NG(ifp) = NULL;
  330         priv->ifp = NULL;       /* XXX race if interrupted an output packet */
  331         ng_rmnode_self(node);           /* remove all netgraph parts */
  332 }
  333 
  334 /*
  335  * Notify graph about link event.
  336  * if_link_state_change() has already checked that the state has changed.
  337  */
  338 static void
  339 ng_ether_link_state(struct ifnet *ifp, int state)
  340 {
  341         const node_p node = IFP2NG(ifp);
  342         const priv_p priv = NG_NODE_PRIVATE(node);
  343         struct ng_mesg *msg;
  344         int cmd, dummy_error = 0;
  345 
  346         if (priv->lower == NULL)
  347                 return;
  348 
  349         if (state == LINK_STATE_UP)
  350                 cmd = NGM_LINK_IS_UP;
  351         else if (state == LINK_STATE_DOWN)
  352                 cmd = NGM_LINK_IS_DOWN;
  353         else
  354                 return;
  355 
  356         NG_MKMESSAGE(msg, NGM_FLOW_COOKIE, cmd, 0, M_NOWAIT);
  357         if (msg != NULL)
  358                 NG_SEND_MSG_HOOK(dummy_error, node, msg, priv->lower, 0);
  359 }
  360 
  361 /******************************************************************
  362                     NETGRAPH NODE METHODS
  363 ******************************************************************/
  364 
  365 /*
  366  * It is not possible or allowable to create a node of this type.
  367  * Nodes get created when the interface is attached (or, when
  368  * this node type's KLD is loaded).
  369  */
  370 static int
  371 ng_ether_constructor(node_p node)
  372 {
  373         return (EINVAL);
  374 }
  375 
  376 /*
  377  * Check for attaching a new hook.
  378  */
  379 static  int
  380 ng_ether_newhook(node_p node, hook_p hook, const char *name)
  381 {
  382         const priv_p priv = NG_NODE_PRIVATE(node);
  383         hook_p *hookptr;
  384 
  385         /* Divert hook is an alias for lower */
  386         if (strcmp(name, NG_ETHER_HOOK_DIVERT) == 0)
  387                 name = NG_ETHER_HOOK_LOWER;
  388 
  389         /* Which hook? */
  390         if (strcmp(name, NG_ETHER_HOOK_UPPER) == 0)
  391                 hookptr = &priv->upper;
  392         else if (strcmp(name, NG_ETHER_HOOK_LOWER) == 0)
  393                 hookptr = &priv->lower;
  394         else if (strcmp(name, NG_ETHER_HOOK_ORPHAN) == 0)
  395                 hookptr = &priv->orphan;
  396         else
  397                 return (EINVAL);
  398 
  399         /* Check if already connected (shouldn't be, but doesn't hurt) */
  400         if (*hookptr != NULL)
  401                 return (EISCONN);
  402 
  403         /* Disable hardware checksums while 'upper' hook is connected */
  404         if (hookptr == &priv->upper)
  405                 priv->ifp->if_hwassist = 0;
  406 
  407         /* OK */
  408         *hookptr = hook;
  409         return (0);
  410 }
  411 
  412 /*
  413  * Receive an incoming control message.
  414  */
  415 static int
  416 ng_ether_rcvmsg(node_p node, item_p item, hook_p lasthook)
  417 {
  418         const priv_p priv = NG_NODE_PRIVATE(node);
  419         struct ng_mesg *resp = NULL;
  420         int error = 0;
  421         struct ng_mesg *msg;
  422 
  423         NGI_GET_MSG(item, msg);
  424         switch (msg->header.typecookie) {
  425         case NGM_ETHER_COOKIE:
  426                 switch (msg->header.cmd) {
  427                 case NGM_ETHER_GET_IFNAME:
  428                         NG_MKRESPONSE(resp, msg, IFNAMSIZ, M_NOWAIT);
  429                         if (resp == NULL) {
  430                                 error = ENOMEM;
  431                                 break;
  432                         }
  433                         strlcpy(resp->data, priv->ifp->if_xname, IFNAMSIZ);
  434                         break;
  435                 case NGM_ETHER_GET_IFINDEX:
  436                         NG_MKRESPONSE(resp, msg, sizeof(u_int32_t), M_NOWAIT);
  437                         if (resp == NULL) {
  438                                 error = ENOMEM;
  439                                 break;
  440                         }
  441                         *((u_int32_t *)resp->data) = priv->ifp->if_index;
  442                         break;
  443                 case NGM_ETHER_GET_ENADDR:
  444                         NG_MKRESPONSE(resp, msg, ETHER_ADDR_LEN, M_NOWAIT);
  445                         if (resp == NULL) {
  446                                 error = ENOMEM;
  447                                 break;
  448                         }
  449                         bcopy(IF_LLADDR(priv->ifp),
  450                             resp->data, ETHER_ADDR_LEN);
  451                         break;
  452                 case NGM_ETHER_SET_ENADDR:
  453                     {
  454                         if (msg->header.arglen != ETHER_ADDR_LEN) {
  455                                 error = EINVAL;
  456                                 break;
  457                         }
  458                         error = if_setlladdr(priv->ifp,
  459                             (u_char *)msg->data, ETHER_ADDR_LEN);
  460                         break;
  461                     }
  462                 case NGM_ETHER_GET_PROMISC:
  463                         NG_MKRESPONSE(resp, msg, sizeof(u_int32_t), M_NOWAIT);
  464                         if (resp == NULL) {
  465                                 error = ENOMEM;
  466                                 break;
  467                         }
  468                         *((u_int32_t *)resp->data) = priv->promisc;
  469                         break;
  470                 case NGM_ETHER_SET_PROMISC:
  471                     {
  472                         u_char want;
  473 
  474                         if (msg->header.arglen != sizeof(u_int32_t)) {
  475                                 error = EINVAL;
  476                                 break;
  477                         }
  478                         want = !!*((u_int32_t *)msg->data);
  479                         if (want ^ priv->promisc) {
  480                                 if ((error = ifpromisc(priv->ifp, want)) != 0)
  481                                         break;
  482                                 priv->promisc = want;
  483                         }
  484                         break;
  485                     }
  486                 case NGM_ETHER_GET_AUTOSRC:
  487                         NG_MKRESPONSE(resp, msg, sizeof(u_int32_t), M_NOWAIT);
  488                         if (resp == NULL) {
  489                                 error = ENOMEM;
  490                                 break;
  491                         }
  492                         *((u_int32_t *)resp->data) = priv->autoSrcAddr;
  493                         break;
  494                 case NGM_ETHER_SET_AUTOSRC:
  495                         if (msg->header.arglen != sizeof(u_int32_t)) {
  496                                 error = EINVAL;
  497                                 break;
  498                         }
  499                         priv->autoSrcAddr = !!*((u_int32_t *)msg->data);
  500                         break;
  501                 case NGM_ETHER_ADD_MULTI:
  502                     {
  503                         struct sockaddr_dl sa_dl;
  504                         struct ifmultiaddr *ifma;
  505 
  506                         if (msg->header.arglen != ETHER_ADDR_LEN) {
  507                                 error = EINVAL;
  508                                 break;
  509                         }
  510                         bzero(&sa_dl, sizeof(struct sockaddr_dl));
  511                         sa_dl.sdl_len = sizeof(struct sockaddr_dl);
  512                         sa_dl.sdl_family = AF_LINK;
  513                         sa_dl.sdl_alen = ETHER_ADDR_LEN;
  514                         bcopy((void *)msg->data, LLADDR(&sa_dl),
  515                             ETHER_ADDR_LEN);
  516                         /*
  517                          * Netgraph is only permitted to join groups once
  518                          * via the if_addmulti() KPI, because it cannot hold
  519                          * struct ifmultiaddr * between calls. It may also
  520                          * lose a race while we check if the membership
  521                          * already exists.
  522                          */
  523                         IF_ADDR_LOCK(priv->ifp);
  524                         ifma = if_findmulti(priv->ifp,
  525                             (struct sockaddr *)&sa_dl);
  526                         IF_ADDR_UNLOCK(priv->ifp);
  527                         if (ifma != NULL) {
  528                                 error = EADDRINUSE;
  529                         } else {
  530                                 error = if_addmulti(priv->ifp,
  531                                     (struct sockaddr *)&sa_dl, &ifma);
  532                         }
  533                         break;
  534                     }
  535                 case NGM_ETHER_DEL_MULTI:
  536                     {
  537                         struct sockaddr_dl sa_dl;
  538 
  539                         if (msg->header.arglen != ETHER_ADDR_LEN) {
  540                                 error = EINVAL;
  541                                 break;
  542                         }
  543                         bzero(&sa_dl, sizeof(struct sockaddr_dl));
  544                         sa_dl.sdl_len = sizeof(struct sockaddr_dl);
  545                         sa_dl.sdl_family = AF_LINK;
  546                         sa_dl.sdl_alen = ETHER_ADDR_LEN;
  547                         bcopy((void *)msg->data, LLADDR(&sa_dl),
  548                             ETHER_ADDR_LEN);
  549                         error = if_delmulti(priv->ifp,
  550                             (struct sockaddr *)&sa_dl);
  551                         break;
  552                     }
  553                 case NGM_ETHER_DETACH:
  554                         ng_ether_detach(priv->ifp);
  555                         break;
  556                 default:
  557                         error = EINVAL;
  558                         break;
  559                 }
  560                 break;
  561         default:
  562                 error = EINVAL;
  563                 break;
  564         }
  565         NG_RESPOND_MSG(error, node, item, resp);
  566         NG_FREE_MSG(msg);
  567         return (error);
  568 }
  569 
  570 /*
  571  * Receive data on a hook.
  572  */
  573 static int
  574 ng_ether_rcvdata(hook_p hook, item_p item)
  575 {
  576         const node_p node = NG_HOOK_NODE(hook);
  577         const priv_p priv = NG_NODE_PRIVATE(node);
  578         struct mbuf *m;
  579 
  580         NGI_GET_M(item, m);
  581         NG_FREE_ITEM(item);
  582 
  583         if (hook == priv->lower || hook == priv->orphan)
  584                 return ng_ether_rcv_lower(node, m);
  585         if (hook == priv->upper)
  586                 return ng_ether_rcv_upper(node, m);
  587         panic("%s: weird hook", __func__);
  588 #ifdef RESTARTABLE_PANICS /* so we don't get an error msg in LINT */
  589         return (0);
  590 #endif
  591 }
  592 
  593 /*
  594  * Handle an mbuf received on the "lower" or "orphan" hook.
  595  */
  596 static int
  597 ng_ether_rcv_lower(node_p node, struct mbuf *m)
  598 {
  599         const priv_p priv = NG_NODE_PRIVATE(node);
  600         struct ifnet *const ifp = priv->ifp;
  601 
  602         /* Check whether interface is ready for packets */
  603         if (!((ifp->if_flags & IFF_UP) &&
  604             (ifp->if_drv_flags & IFF_DRV_RUNNING))) {
  605                 NG_FREE_M(m);
  606                 return (ENETDOWN);
  607         }
  608 
  609         /* Make sure header is fully pulled up */
  610         if (m->m_pkthdr.len < sizeof(struct ether_header)) {
  611                 NG_FREE_M(m);
  612                 return (EINVAL);
  613         }
  614         if (m->m_len < sizeof(struct ether_header)
  615             && (m = m_pullup(m, sizeof(struct ether_header))) == NULL)
  616                 return (ENOBUFS);
  617 
  618         /* Drop in the MAC address if desired */
  619         if (priv->autoSrcAddr) {
  620 
  621                 /* Make the mbuf writable if it's not already */
  622                 if (!M_WRITABLE(m)
  623                     && (m = m_pullup(m, sizeof(struct ether_header))) == NULL)
  624                         return (ENOBUFS);
  625 
  626                 /* Overwrite source MAC address */
  627                 bcopy(IF_LLADDR(ifp),
  628                     mtod(m, struct ether_header *)->ether_shost,
  629                     ETHER_ADDR_LEN);
  630         }
  631 
  632         /* Send it on its way */
  633         return ether_output_frame(ifp, m);
  634 }
  635 
  636 /*
  637  * Handle an mbuf received on the "upper" hook.
  638  */
  639 static int
  640 ng_ether_rcv_upper(node_p node, struct mbuf *m)
  641 {
  642         const priv_p priv = NG_NODE_PRIVATE(node);
  643         struct ifnet *ifp = priv->ifp;
  644 
  645         /* Check length and pull off header */
  646         if (m->m_pkthdr.len < sizeof(struct ether_header)) {
  647                 NG_FREE_M(m);
  648                 return (EINVAL);
  649         }
  650         if (m->m_len < sizeof(struct ether_header) &&
  651             (m = m_pullup(m, sizeof(struct ether_header))) == NULL)
  652                 return (ENOBUFS);
  653 
  654         m->m_pkthdr.rcvif = ifp;
  655 
  656         /* Pass the packet to the bridge, it may come back to us */
  657         if (ifp->if_bridge) {
  658                 BRIDGE_INPUT(ifp, m);
  659                 if (m == NULL)
  660                         return (0);
  661         }
  662 
  663         /* Route packet back in */
  664         ether_demux(ifp, m);
  665         return (0);
  666 }
  667 
  668 /*
  669  * Shutdown node. This resets the node but does not remove it
  670  * unless the REALLY_DIE flag is set.
  671  */
  672 static int
  673 ng_ether_shutdown(node_p node)
  674 {
  675         const priv_p priv = NG_NODE_PRIVATE(node);
  676 
  677         if (node->nd_flags & NGF_REALLY_DIE) {
  678                 /*
  679                  * WE came here because the ethernet card is being unloaded,
  680                  * so stop being persistant.
  681                  * Actually undo all the things we did on creation.
  682                  * Assume the ifp has already been freed.
  683                  */
  684                 NG_NODE_SET_PRIVATE(node, NULL);
  685                 FREE(priv, M_NETGRAPH);         
  686                 NG_NODE_UNREF(node);    /* free node itself */
  687                 return (0);
  688         }
  689         if (priv->promisc) {            /* disable promiscuous mode */
  690                 (void)ifpromisc(priv->ifp, 0);
  691                 priv->promisc = 0;
  692         }
  693         priv->autoSrcAddr = 1;          /* reset auto-src-addr flag */
  694         NG_NODE_REVIVE(node);           /* Signal ng_rmnode we are persisant */
  695 
  696         return (0);
  697 }
  698 
  699 /*
  700  * Hook disconnection.
  701  */
  702 static int
  703 ng_ether_disconnect(hook_p hook)
  704 {
  705         const priv_p priv = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
  706 
  707         if (hook == priv->upper) {
  708                 priv->upper = NULL;
  709                 if (priv->ifp != NULL)          /* restore h/w csum */
  710                         priv->ifp->if_hwassist = priv->hwassist;
  711         } else if (hook == priv->lower)
  712                 priv->lower = NULL;
  713         else if (hook == priv->orphan)
  714                 priv->orphan = NULL;
  715         else
  716                 panic("%s: weird hook", __func__);
  717         if ((NG_NODE_NUMHOOKS(NG_HOOK_NODE(hook)) == 0)
  718         && (NG_NODE_IS_VALID(NG_HOOK_NODE(hook))))
  719                 ng_rmnode_self(NG_HOOK_NODE(hook));     /* reset node */
  720         return (0);
  721 }
  722 
  723 /******************************************************************
  724                         INITIALIZATION
  725 ******************************************************************/
  726 
  727 /*
  728  * Handle loading and unloading for this node type.
  729  */
  730 static int
  731 ng_ether_mod_event(module_t mod, int event, void *data)
  732 {
  733         struct ifnet *ifp;
  734         int error = 0;
  735         int s;
  736 
  737         s = splnet();
  738         switch (event) {
  739         case MOD_LOAD:
  740 
  741                 /* Register function hooks */
  742                 if (ng_ether_attach_p != NULL) {
  743                         error = EEXIST;
  744                         break;
  745                 }
  746                 ng_ether_attach_p = ng_ether_attach;
  747                 ng_ether_detach_p = ng_ether_detach;
  748                 ng_ether_output_p = ng_ether_output;
  749                 ng_ether_input_p = ng_ether_input;
  750                 ng_ether_input_orphan_p = ng_ether_input_orphan;
  751                 ng_ether_link_state_p = ng_ether_link_state;
  752 
  753                 /* Create nodes for any already-existing Ethernet interfaces */
  754                 IFNET_RLOCK();
  755                 TAILQ_FOREACH(ifp, &ifnet, if_link) {
  756                         if (ifp->if_type == IFT_ETHER
  757                             || ifp->if_type == IFT_L2VLAN)
  758                                 ng_ether_attach(ifp);
  759                 }
  760                 IFNET_RUNLOCK();
  761                 break;
  762 
  763         case MOD_UNLOAD:
  764 
  765                 /*
  766                  * Note that the base code won't try to unload us until
  767                  * all nodes have been removed, and that can't happen
  768                  * until all Ethernet interfaces are removed. In any
  769                  * case, we know there are no nodes left if the action
  770                  * is MOD_UNLOAD, so there's no need to detach any nodes.
  771                  */
  772 
  773                 /* Unregister function hooks */
  774                 ng_ether_attach_p = NULL;
  775                 ng_ether_detach_p = NULL;
  776                 ng_ether_output_p = NULL;
  777                 ng_ether_input_p = NULL;
  778                 ng_ether_input_orphan_p = NULL;
  779                 ng_ether_link_state_p = NULL;
  780                 break;
  781 
  782         default:
  783                 error = EOPNOTSUPP;
  784                 break;
  785         }
  786         splx(s);
  787         return (error);
  788 }
  789 

Cache object: 6534594aa5f0e2824f2a8c443adbb0fc


[ 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.