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