14cf49a43SJulian Elischer 24cf49a43SJulian Elischer /* 34cf49a43SJulian Elischer * ng_tee.c 44cf49a43SJulian Elischer * 54cf49a43SJulian Elischer * Copyright (c) 1996-1999 Whistle Communications, Inc. 64cf49a43SJulian Elischer * All rights reserved. 74cf49a43SJulian Elischer * 84cf49a43SJulian Elischer * Subject to the following obligations and disclaimer of warranty, use and 94cf49a43SJulian Elischer * redistribution of this software, in source or object code forms, with or 104cf49a43SJulian Elischer * without modifications are expressly permitted by Whistle Communications; 114cf49a43SJulian Elischer * provided, however, that: 124cf49a43SJulian Elischer * 1. Any and all reproductions of the source or object code must include the 134cf49a43SJulian Elischer * copyright notice above and the following disclaimer of warranties; and 144cf49a43SJulian Elischer * 2. No rights are granted, in any manner or form, to use Whistle 154cf49a43SJulian Elischer * Communications, Inc. trademarks, including the mark "WHISTLE 164cf49a43SJulian Elischer * COMMUNICATIONS" on advertising, endorsements, or otherwise except as 174cf49a43SJulian Elischer * such appears in the above copyright notice or in the software. 184cf49a43SJulian Elischer * 194cf49a43SJulian Elischer * THIS SOFTWARE IS BEING PROVIDED BY WHISTLE COMMUNICATIONS "AS IS", AND 204cf49a43SJulian Elischer * TO THE MAXIMUM EXTENT PERMITTED BY LAW, WHISTLE COMMUNICATIONS MAKES NO 214cf49a43SJulian Elischer * REPRESENTATIONS OR WARRANTIES, EXPRESS OR IMPLIED, REGARDING THIS SOFTWARE, 224cf49a43SJulian Elischer * INCLUDING WITHOUT LIMITATION, ANY AND ALL IMPLIED WARRANTIES OF 234cf49a43SJulian Elischer * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT. 244cf49a43SJulian Elischer * WHISTLE COMMUNICATIONS DOES NOT WARRANT, GUARANTEE, OR MAKE ANY 254cf49a43SJulian Elischer * REPRESENTATIONS REGARDING THE USE OF, OR THE RESULTS OF THE USE OF THIS 264cf49a43SJulian Elischer * SOFTWARE IN TERMS OF ITS CORRECTNESS, ACCURACY, RELIABILITY OR OTHERWISE. 274cf49a43SJulian Elischer * IN NO EVENT SHALL WHISTLE COMMUNICATIONS BE LIABLE FOR ANY DAMAGES 284cf49a43SJulian Elischer * RESULTING FROM OR ARISING OUT OF ANY USE OF THIS SOFTWARE, INCLUDING 294cf49a43SJulian Elischer * WITHOUT LIMITATION, ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, 304cf49a43SJulian Elischer * PUNITIVE, OR CONSEQUENTIAL DAMAGES, PROCUREMENT OF SUBSTITUTE GOODS OR 314cf49a43SJulian Elischer * SERVICES, LOSS OF USE, DATA OR PROFITS, HOWEVER CAUSED AND UNDER ANY 324cf49a43SJulian Elischer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 334cf49a43SJulian Elischer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 344cf49a43SJulian Elischer * THIS SOFTWARE, EVEN IF WHISTLE COMMUNICATIONS IS ADVISED OF THE POSSIBILITY 354cf49a43SJulian Elischer * OF SUCH DAMAGE. 364cf49a43SJulian Elischer * 374cf49a43SJulian Elischer * Author: Julian Elischer <julian@whistle.com> 384cf49a43SJulian Elischer * 394cf49a43SJulian Elischer * $FreeBSD$ 404cf49a43SJulian Elischer * $Whistle: ng_tee.c,v 1.16 1999/01/28 23:54:54 julian Exp $ 414cf49a43SJulian Elischer */ 424cf49a43SJulian Elischer 434cf49a43SJulian Elischer /* 444cf49a43SJulian Elischer * This node is like the tee(1) command and is useful for ``snooping.'' 454cf49a43SJulian Elischer * It has 4 hooks: left, right, left2right, and right2left. Data 464cf49a43SJulian Elischer * entering from the right is passed to the left and duplicated on 474cf49a43SJulian Elischer * right2left, and data entering from the left is passed to the right 484cf49a43SJulian Elischer * and duplicated on left2right. Data entering from left2right is 494cf49a43SJulian Elischer * sent to right, and data from right2left to left. 504cf49a43SJulian Elischer */ 514cf49a43SJulian Elischer 524cf49a43SJulian Elischer #include <sys/param.h> 534cf49a43SJulian Elischer #include <sys/systm.h> 544cf49a43SJulian Elischer #include <sys/errno.h> 554cf49a43SJulian Elischer #include <sys/kernel.h> 564cf49a43SJulian Elischer #include <sys/malloc.h> 574cf49a43SJulian Elischer #include <sys/mbuf.h> 584cf49a43SJulian Elischer #include <netgraph/ng_message.h> 594cf49a43SJulian Elischer #include <netgraph/netgraph.h> 604cf49a43SJulian Elischer #include <netgraph/ng_tee.h> 614cf49a43SJulian Elischer 624cf49a43SJulian Elischer /* Per hook info */ 634cf49a43SJulian Elischer struct hookinfo { 644cf49a43SJulian Elischer hook_p hook; 654cf49a43SJulian Elischer int bytes; 664cf49a43SJulian Elischer int packets; 674cf49a43SJulian Elischer int flags; 684cf49a43SJulian Elischer }; 694cf49a43SJulian Elischer 704cf49a43SJulian Elischer /* Per node info */ 714cf49a43SJulian Elischer struct privdata { 724cf49a43SJulian Elischer node_p node; 734cf49a43SJulian Elischer int flags; 744cf49a43SJulian Elischer struct hookinfo left; 754cf49a43SJulian Elischer struct hookinfo right; 764cf49a43SJulian Elischer struct hookinfo left2right; 774cf49a43SJulian Elischer struct hookinfo right2left; 784cf49a43SJulian Elischer }; 794cf49a43SJulian Elischer typedef struct privdata *sc_p; 804cf49a43SJulian Elischer 814cf49a43SJulian Elischer /* Netgraph methods */ 824cf49a43SJulian Elischer static int ngt_constructor(node_p *node); 834cf49a43SJulian Elischer static int ngt_rcvmsg(node_p node, struct ng_mesg *msg, 844cf49a43SJulian Elischer const char *retaddr, struct ng_mesg **resp); 854cf49a43SJulian Elischer static int ngt_rmnode(node_p node); 864cf49a43SJulian Elischer static int ngt_newhook(node_p node, hook_p hook, const char *name); 874cf49a43SJulian Elischer static int ngt_rcvdata(hook_p hook, struct mbuf *m, meta_p meta); 884cf49a43SJulian Elischer static int ngt_disconnect(hook_p hook); 894cf49a43SJulian Elischer 904cf49a43SJulian Elischer /* Netgraph type descriptor */ 914cf49a43SJulian Elischer static struct ng_type typestruct = { 924cf49a43SJulian Elischer NG_VERSION, 934cf49a43SJulian Elischer NG_TEE_NODE_TYPE, 944cf49a43SJulian Elischer NULL, 954cf49a43SJulian Elischer ngt_constructor, 964cf49a43SJulian Elischer ngt_rcvmsg, 974cf49a43SJulian Elischer ngt_rmnode, 984cf49a43SJulian Elischer ngt_newhook, 994cf49a43SJulian Elischer NULL, 1004cf49a43SJulian Elischer NULL, 1014cf49a43SJulian Elischer ngt_rcvdata, 1024cf49a43SJulian Elischer ngt_rcvdata, 1034cf49a43SJulian Elischer ngt_disconnect 1044cf49a43SJulian Elischer }; 1054cf49a43SJulian Elischer NETGRAPH_INIT(tee, &typestruct); 1064cf49a43SJulian Elischer 1074cf49a43SJulian Elischer /* 1084cf49a43SJulian Elischer * Node constructor 1094cf49a43SJulian Elischer */ 1104cf49a43SJulian Elischer static int 1114cf49a43SJulian Elischer ngt_constructor(node_p *nodep) 1124cf49a43SJulian Elischer { 1134cf49a43SJulian Elischer sc_p privdata; 1144cf49a43SJulian Elischer int error = 0; 1154cf49a43SJulian Elischer 1164cf49a43SJulian Elischer MALLOC(privdata, sc_p, sizeof(*privdata), M_NETGRAPH, M_WAITOK); 1174cf49a43SJulian Elischer if (privdata == NULL) 1184cf49a43SJulian Elischer return (ENOMEM); 1194cf49a43SJulian Elischer bzero(privdata, sizeof(*privdata)); 1204cf49a43SJulian Elischer 1214cf49a43SJulian Elischer if ((error = ng_make_node_common(&typestruct, nodep))) { 1224cf49a43SJulian Elischer FREE(privdata, M_NETGRAPH); 1234cf49a43SJulian Elischer return (error); 1244cf49a43SJulian Elischer } 1254cf49a43SJulian Elischer (*nodep)->private = privdata; 1264cf49a43SJulian Elischer privdata->node = *nodep; 1274cf49a43SJulian Elischer return (0); 1284cf49a43SJulian Elischer } 1294cf49a43SJulian Elischer 1304cf49a43SJulian Elischer /* 1314cf49a43SJulian Elischer * Add a hook 1324cf49a43SJulian Elischer */ 1334cf49a43SJulian Elischer static int 1344cf49a43SJulian Elischer ngt_newhook(node_p node, hook_p hook, const char *name) 1354cf49a43SJulian Elischer { 1364cf49a43SJulian Elischer const sc_p sc = node->private; 1374cf49a43SJulian Elischer 1384cf49a43SJulian Elischer if (strcmp(name, NG_TEE_HOOK_RIGHT) == 0) { 1394cf49a43SJulian Elischer sc->right.hook = hook; 1404cf49a43SJulian Elischer sc->right.bytes = 0; 1414cf49a43SJulian Elischer sc->right.packets = 0; 1424cf49a43SJulian Elischer hook->private = &sc->right; 1434cf49a43SJulian Elischer } else if (strcmp(name, NG_TEE_HOOK_LEFT) == 0) { 1444cf49a43SJulian Elischer sc->left.hook = hook; 1454cf49a43SJulian Elischer sc->left.bytes = 0; 1464cf49a43SJulian Elischer sc->left.packets = 0; 1474cf49a43SJulian Elischer hook->private = &sc->left; 1484cf49a43SJulian Elischer } else if (strcmp(name, NG_TEE_HOOK_RIGHT2LEFT) == 0) { 1494cf49a43SJulian Elischer sc->right2left.hook = hook; 1504cf49a43SJulian Elischer sc->right2left.bytes = 0; 1514cf49a43SJulian Elischer sc->right2left.packets = 0; 1524cf49a43SJulian Elischer hook->private = &sc->right2left; 1534cf49a43SJulian Elischer } else if (strcmp(name, NG_TEE_HOOK_LEFT2RIGHT) == 0) { 1544cf49a43SJulian Elischer sc->left2right.hook = hook; 1554cf49a43SJulian Elischer sc->left2right.bytes = 0; 1564cf49a43SJulian Elischer sc->left2right.packets = 0; 1574cf49a43SJulian Elischer hook->private = &sc->left2right; 1584cf49a43SJulian Elischer } else 1594cf49a43SJulian Elischer return (EINVAL); 1604cf49a43SJulian Elischer return (0); 1614cf49a43SJulian Elischer } 1624cf49a43SJulian Elischer 1634cf49a43SJulian Elischer /* 1644cf49a43SJulian Elischer * We don't support any type-specific messages 1654cf49a43SJulian Elischer */ 1664cf49a43SJulian Elischer static int 1674cf49a43SJulian Elischer ngt_rcvmsg(node_p node, struct ng_mesg *msg, const char *retaddr, 1684cf49a43SJulian Elischer struct ng_mesg **resp) 1694cf49a43SJulian Elischer { 1704cf49a43SJulian Elischer FREE(msg, M_NETGRAPH); 1714cf49a43SJulian Elischer return (EINVAL); 1724cf49a43SJulian Elischer } 1734cf49a43SJulian Elischer 1744cf49a43SJulian Elischer /* 1754cf49a43SJulian Elischer * Receive data on a hook 1764cf49a43SJulian Elischer * 1774cf49a43SJulian Elischer * If data comes in the right link send a copy out right2left, and then 1784cf49a43SJulian Elischer * send the original onwards out through the left link. 1794cf49a43SJulian Elischer * Do the opposite for data coming in from the left link. 1804cf49a43SJulian Elischer * Data coming in right2left or left2right is forwarded 1814cf49a43SJulian Elischer * on through the appropriate destination hook as if it had come 1824cf49a43SJulian Elischer * from the other side. 1834cf49a43SJulian Elischer */ 1844cf49a43SJulian Elischer static int 1854cf49a43SJulian Elischer ngt_rcvdata(hook_p hook, struct mbuf *m, meta_p meta) 1864cf49a43SJulian Elischer { 1874cf49a43SJulian Elischer const sc_p sc = hook->node->private; 1884cf49a43SJulian Elischer struct hookinfo *hi; 1894cf49a43SJulian Elischer struct hookinfo *dest; 1904cf49a43SJulian Elischer struct hookinfo *dup; 1914cf49a43SJulian Elischer struct mbuf *mdup; 1924cf49a43SJulian Elischer int error = 0; 1934cf49a43SJulian Elischer 1944cf49a43SJulian Elischer if ((hi = hook->private) != NULL) { 1954cf49a43SJulian Elischer if (hi == &sc->left) { 1964cf49a43SJulian Elischer dup = &sc->left2right; 1974cf49a43SJulian Elischer dest = &sc->right; 1984cf49a43SJulian Elischer } else if (hi == &sc->right) { 1994cf49a43SJulian Elischer dup = &sc->right2left; 2004cf49a43SJulian Elischer dest = &sc->left; 2014cf49a43SJulian Elischer } else if (hi == &sc->right2left) { 2024cf49a43SJulian Elischer dup = NULL; 2034cf49a43SJulian Elischer dest = &sc->left; 2044cf49a43SJulian Elischer } else if (hi == &sc->left2right) { 2054cf49a43SJulian Elischer dup = NULL; 2064cf49a43SJulian Elischer dest = &sc->right; 2074cf49a43SJulian Elischer } else 2084cf49a43SJulian Elischer goto out; 2094cf49a43SJulian Elischer if (dup) { 2104cf49a43SJulian Elischer mdup = m_copypacket(m, M_NOWAIT); 2114cf49a43SJulian Elischer if (mdup) { 2124cf49a43SJulian Elischer /* XXX should we duplicate meta? */ 2134cf49a43SJulian Elischer /* for now no. */ 2144cf49a43SJulian Elischer void *x = NULL; 2154cf49a43SJulian Elischer 2164cf49a43SJulian Elischer NG_SEND_DATA(error, dup->hook, mdup, x); 2174cf49a43SJulian Elischer } 2184cf49a43SJulian Elischer } 2194cf49a43SJulian Elischer NG_SEND_DATA(error, dest->hook, m, meta); 2204cf49a43SJulian Elischer } 2214cf49a43SJulian Elischer 2224cf49a43SJulian Elischer out: 2234cf49a43SJulian Elischer NG_FREE_DATA(m, meta); 2244cf49a43SJulian Elischer return (error); 2254cf49a43SJulian Elischer } 2264cf49a43SJulian Elischer 2274cf49a43SJulian Elischer /* 2284cf49a43SJulian Elischer * Shutdown processing 2294cf49a43SJulian Elischer * 2304cf49a43SJulian Elischer * This is tricky. If we have both a left and right hook, then we 2314cf49a43SJulian Elischer * probably want to extricate ourselves and leave the two peers 2324cf49a43SJulian Elischer * still linked to each other. Otherwise we should just shut down as 2334cf49a43SJulian Elischer * a normal node would. 2344cf49a43SJulian Elischer * 2354cf49a43SJulian Elischer * To keep the scope of info correct the routine to "extract" a node 2364cf49a43SJulian Elischer * from two links is in ng_base.c. 2374cf49a43SJulian Elischer */ 2384cf49a43SJulian Elischer static int 2394cf49a43SJulian Elischer ngt_rmnode(node_p node) 2404cf49a43SJulian Elischer { 2414cf49a43SJulian Elischer const sc_p privdata = node->private; 2424cf49a43SJulian Elischer 2434cf49a43SJulian Elischer node->flags |= NG_INVALID; 2444cf49a43SJulian Elischer if (privdata->left.hook && privdata->right.hook) 2454cf49a43SJulian Elischer ng_bypass(privdata->left.hook, privdata->right.hook); 2464cf49a43SJulian Elischer ng_cutlinks(node); 2474cf49a43SJulian Elischer ng_unname(node); 2484cf49a43SJulian Elischer node->private = NULL; 2494cf49a43SJulian Elischer ng_unref(privdata->node); 2504cf49a43SJulian Elischer FREE(privdata, M_NETGRAPH); 2514cf49a43SJulian Elischer return (0); 2524cf49a43SJulian Elischer } 2534cf49a43SJulian Elischer 2544cf49a43SJulian Elischer /* 2554cf49a43SJulian Elischer * Hook disconnection 2564cf49a43SJulian Elischer */ 2574cf49a43SJulian Elischer static int 2584cf49a43SJulian Elischer ngt_disconnect(hook_p hook) 2594cf49a43SJulian Elischer { 2604cf49a43SJulian Elischer struct hookinfo *hi; 2614cf49a43SJulian Elischer 2624cf49a43SJulian Elischer if ((hi = hook->private) != NULL) 2634cf49a43SJulian Elischer hi->hook = NULL; 2644cf49a43SJulian Elischer if (hook->node->numhooks == 0) 2654cf49a43SJulian Elischer ng_rmnode(hook->node); 2664cf49a43SJulian Elischer return (0); 2674cf49a43SJulian Elischer } 2684cf49a43SJulian Elischer 269