xref: /freebsd/sys/netgraph/ng_tee.c (revision 4cf49a43559ed9fdad601bdcccd2c55963008675)
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