sys/netgraph/ng_ether_echo.c

   1 /*
   2  * ng_ether_echo.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: Julian Elisher <julian@freebsd.org>
  39  *
  40  * $FreeBSD$
  41  * $Whistle: ng_echo.c,v 1.13 1999/11/01 09:24:51 julian Exp $
  42  */
  43
  44 /*
  45  * Netgraph "ether_echo" node
  46  *
  47  * This node simply bounces data and messages back to whence they came.
  48  * However it swaps the source and destination ether fields.
  49  * No testing is done!
  50  */
  51
  52 #include <sys/param.h>
  53 #include <sys/systm.h>
  54 #include <sys/kernel.h>
  55 #include <sys/malloc.h>
  56 #include <sys/mbuf.h>
  57 #include <netgraph/ng_message.h>
  58 #include <netgraph/netgraph.h>
  59 #include <netgraph/ng_ether_echo.h>
  60
  61 #include <net/ethernet.h>
  62
  63 /* Netgraph methods */
  64 static ng_constructor_t ngee_cons;
  65 static ng_rcvmsg_t      ngee_rcvmsg;
  66 static ng_rcvdata_t     ngee_rcvdata;
  67 static ng_disconnect_t  ngee_disconnect;
  68
  69 /* Netgraph type */
  70 static struct ng_type typestruct = {
  71         .version =      NG_ABI_VERSION,
  72         .name =         NG_ETHER_ECHO_NODE_TYPE,
  73         .constructor =  ngee_cons,
  74         .rcvmsg =       ngee_rcvmsg,
  75         .rcvdata =      ngee_rcvdata,
  76         .disconnect =   ngee_disconnect,
  77 };
  78 NETGRAPH_INIT(ether_echo, &typestruct);
  79
  80 static int
  81 ngee_cons(node_p node)
  82 {
  83         return (0);
  84 }
  85
  86 /*
  87  * Receive control message. We just bounce it back as a reply.
  88  */
  89 static int
  90 ngee_rcvmsg(node_p node, item_p item, hook_p lasthook)
  91 {
  92         struct ng_mesg *msg;
  93         int error = 0;
  94
  95         NGI_GET_MSG(item, msg);
  96         msg->header.flags |= NGF_RESP;
  97         NG_RESPOND_MSG(error, node, item, msg);
  98         return (error);
  99 }
 100
 101 /*
 102  * Receive data
 103  */
 104 static int
 105 ngee_rcvdata(hook_p hook, item_p item)
 106 {
 107         int error;
 108         struct mbuf *m;
 109
 110         struct ether_header *eh;
 111         struct ether_addr tmpaddr;
 112
 113         /* Make sure we have an entire header */
 114         NGI_GET_M(item, m);
 115         if (m->m_len < sizeof(*eh) ) {
 116                 m = m_pullup(m, sizeof(*eh));
 117                 if (m == NULL) {
 118                         NG_FREE_ITEM(item);
 119                         return(EINVAL);
 120                 }
 121         }
 122         eh = mtod(m, struct ether_header *);
 123
 124         /* swap the source and destination fields */
 125         bcopy(eh->ether_dhost, &tmpaddr, ETHER_ADDR_LEN);
 126         bcopy(eh->ether_shost, eh->ether_dhost, ETHER_ADDR_LEN);
 127         bcopy(&tmpaddr, eh->ether_shost, ETHER_ADDR_LEN);
 128
 129         NG_FWD_NEW_DATA(error, item, hook, m);
 130         return (error);
 131 }
 132
 133 /*
 134  * Removal of the last link destroys the nodeo
 135  */
 136 static int
 137 ngee_disconnect(hook_p hook)
 138 {
 139         if ((NG_NODE_NUMHOOKS(NG_HOOK_NODE(hook)) == 0)
 140         && (NG_NODE_IS_VALID(NG_HOOK_NODE(hook)))) {
 141                 ng_rmnode_self(NG_HOOK_NODE(hook));
 142         }
 143         return (0);
 144 }
 145