xref: /freebsd/sys/netgraph/ng_async.c (revision 30400f03aa3c764fffcb7d3158634778a035a183)
14cf49a43SJulian Elischer 
24cf49a43SJulian Elischer /*
34cf49a43SJulian Elischer  * ng_async.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  *
37cc3bbd68SJulian Elischer  * Author: Archie Cobbs <archie@freebsd.org>
384cf49a43SJulian Elischer  *
394cf49a43SJulian Elischer  * $FreeBSD$
4074f5c6aaSJulian Elischer  * $Whistle: ng_async.c,v 1.17 1999/11/01 09:24:51 julian Exp $
414cf49a43SJulian Elischer  */
424cf49a43SJulian Elischer 
434cf49a43SJulian Elischer /*
444cf49a43SJulian Elischer  * This node type implements a PPP style sync <-> async converter.
454cf49a43SJulian Elischer  * See RFC 1661 for details of how asynchronous encoding works.
464cf49a43SJulian Elischer  */
474cf49a43SJulian Elischer 
484cf49a43SJulian Elischer #include <sys/param.h>
494cf49a43SJulian Elischer #include <sys/systm.h>
504cf49a43SJulian Elischer #include <sys/kernel.h>
514cf49a43SJulian Elischer #include <sys/mbuf.h>
524cf49a43SJulian Elischer #include <sys/malloc.h>
534cf49a43SJulian Elischer #include <sys/errno.h>
544cf49a43SJulian Elischer 
554cf49a43SJulian Elischer #include <netgraph/ng_message.h>
564cf49a43SJulian Elischer #include <netgraph/netgraph.h>
574cf49a43SJulian Elischer #include <netgraph/ng_async.h>
58f8307e12SArchie Cobbs #include <netgraph/ng_parse.h>
594cf49a43SJulian Elischer 
604cf49a43SJulian Elischer #include <net/ppp_defs.h>
614cf49a43SJulian Elischer 
624cf49a43SJulian Elischer /* Async decode state */
634cf49a43SJulian Elischer #define MODE_HUNT	0
644cf49a43SJulian Elischer #define MODE_NORMAL	1
654cf49a43SJulian Elischer #define MODE_ESC	2
664cf49a43SJulian Elischer 
674cf49a43SJulian Elischer /* Private data structure */
6819a52c59SArchie Cobbs struct ng_async_private {
694cf49a43SJulian Elischer 	node_p  	node;		/* Our node */
704cf49a43SJulian Elischer 	hook_p  	async;		/* Asynchronous side */
714cf49a43SJulian Elischer 	hook_p  	sync;		/* Synchronous side */
724cf49a43SJulian Elischer 	u_char  	amode;		/* Async hunt/esape mode */
734cf49a43SJulian Elischer 	u_int16_t	fcs;		/* Decoded async FCS (so far) */
744cf49a43SJulian Elischer 	u_char	       *abuf;		/* Buffer to encode sync into */
754cf49a43SJulian Elischer 	u_char	       *sbuf;		/* Buffer to decode async into */
764cf49a43SJulian Elischer 	u_int		slen;		/* Length of data in sbuf */
774cf49a43SJulian Elischer 	long		lasttime;	/* Time of last async packet sent */
784cf49a43SJulian Elischer 	struct		ng_async_cfg	cfg;	/* Configuration */
794cf49a43SJulian Elischer 	struct		ng_async_stat	stats;	/* Statistics */
804cf49a43SJulian Elischer };
8119a52c59SArchie Cobbs typedef struct ng_async_private *sc_p;
824cf49a43SJulian Elischer 
834cf49a43SJulian Elischer /* Useful macros */
844cf49a43SJulian Elischer #define ASYNC_BUF_SIZE(smru)	(2 * (smru) + 10)
854cf49a43SJulian Elischer #define SYNC_BUF_SIZE(amru)	((amru) + 10)
864cf49a43SJulian Elischer #define ERROUT(x)		do { error = (x); goto done; } while (0)
874cf49a43SJulian Elischer 
884cf49a43SJulian Elischer /* Netgraph methods */
8974f5c6aaSJulian Elischer static ng_constructor_t		nga_constructor;
9074f5c6aaSJulian Elischer static ng_rcvdata_t		nga_rcvdata;
9174f5c6aaSJulian Elischer static ng_rcvmsg_t		nga_rcvmsg;
9274f5c6aaSJulian Elischer static ng_shutdown_t		nga_shutdown;
9374f5c6aaSJulian Elischer static ng_newhook_t		nga_newhook;
9474f5c6aaSJulian Elischer static ng_disconnect_t		nga_disconnect;
954cf49a43SJulian Elischer 
964cf49a43SJulian Elischer /* Helper stuff */
97069154d5SJulian Elischer static int	nga_rcv_sync(const sc_p sc, item_p item);
98069154d5SJulian Elischer static int	nga_rcv_async(const sc_p sc, item_p item);
994cf49a43SJulian Elischer 
100f8307e12SArchie Cobbs /* Parse type for struct ng_async_cfg */
101f8307e12SArchie Cobbs static const struct ng_parse_struct_info
102f8307e12SArchie Cobbs 	nga_config_type_info = NG_ASYNC_CONFIG_TYPE_INFO;
103f8307e12SArchie Cobbs static const struct ng_parse_type nga_config_type = {
104f8307e12SArchie Cobbs 	&ng_parse_struct_type,
105f8307e12SArchie Cobbs 	&nga_config_type_info
106f8307e12SArchie Cobbs };
107f8307e12SArchie Cobbs 
108f8307e12SArchie Cobbs /* Parse type for struct ng_async_stat */
109f8307e12SArchie Cobbs static const struct ng_parse_struct_info
110f8307e12SArchie Cobbs 	nga_stats_type_info = NG_ASYNC_STATS_TYPE_INFO;
111f8307e12SArchie Cobbs static const struct ng_parse_type nga_stats_type = {
112f8307e12SArchie Cobbs 	&ng_parse_struct_type,
113f8307e12SArchie Cobbs 	&nga_stats_type_info,
114f8307e12SArchie Cobbs };
115f8307e12SArchie Cobbs 
116f8307e12SArchie Cobbs /* List of commands and how to convert arguments to/from ASCII */
117f8307e12SArchie Cobbs static const struct ng_cmdlist nga_cmdlist[] = {
118f8307e12SArchie Cobbs 	{
119f8307e12SArchie Cobbs 	  NGM_ASYNC_COOKIE,
120f8307e12SArchie Cobbs 	  NGM_ASYNC_CMD_SET_CONFIG,
121f8307e12SArchie Cobbs 	  "setconfig",
122f8307e12SArchie Cobbs 	  &nga_config_type,
123f8307e12SArchie Cobbs 	  NULL
124f8307e12SArchie Cobbs 	},
125f8307e12SArchie Cobbs 	{
126f8307e12SArchie Cobbs 	  NGM_ASYNC_COOKIE,
127f8307e12SArchie Cobbs 	  NGM_ASYNC_CMD_GET_CONFIG,
128f8307e12SArchie Cobbs 	  "getconfig",
129f8307e12SArchie Cobbs 	  NULL,
130f8307e12SArchie Cobbs 	  &nga_config_type
131f8307e12SArchie Cobbs 	},
132f8307e12SArchie Cobbs 	{
133f8307e12SArchie Cobbs 	  NGM_ASYNC_COOKIE,
134f8307e12SArchie Cobbs 	  NGM_ASYNC_CMD_GET_STATS,
135f8307e12SArchie Cobbs 	  "getstats",
136f8307e12SArchie Cobbs 	  NULL,
137f8307e12SArchie Cobbs 	  &nga_stats_type
138f8307e12SArchie Cobbs 	},
139f8307e12SArchie Cobbs 	{
140f8307e12SArchie Cobbs 	  NGM_ASYNC_COOKIE,
141f8307e12SArchie Cobbs 	  NGM_ASYNC_CMD_CLR_STATS,
142f8307e12SArchie Cobbs 	  "clrstats",
143f8307e12SArchie Cobbs 	  &nga_stats_type,
144f8307e12SArchie Cobbs 	  NULL
145f8307e12SArchie Cobbs 	},
146f8307e12SArchie Cobbs 	{ 0 }
147f8307e12SArchie Cobbs };
148f8307e12SArchie Cobbs 
1494cf49a43SJulian Elischer /* Define the netgraph node type */
1504cf49a43SJulian Elischer static struct ng_type typestruct = {
151589f6ed8SJulian Elischer 	NG_ABI_VERSION,
1524cf49a43SJulian Elischer 	NG_ASYNC_NODE_TYPE,
1534cf49a43SJulian Elischer 	NULL,
1544cf49a43SJulian Elischer 	nga_constructor,
1554cf49a43SJulian Elischer 	nga_rcvmsg,
1564cf49a43SJulian Elischer 	nga_shutdown,
1574cf49a43SJulian Elischer 	nga_newhook,
1584cf49a43SJulian Elischer 	NULL,
1594cf49a43SJulian Elischer 	NULL,
1604cf49a43SJulian Elischer 	nga_rcvdata,
161f8307e12SArchie Cobbs 	nga_disconnect,
162f8307e12SArchie Cobbs 	nga_cmdlist
1634cf49a43SJulian Elischer };
1644cf49a43SJulian Elischer NETGRAPH_INIT(async, &typestruct);
1654cf49a43SJulian Elischer 
1664cf49a43SJulian Elischer /* CRC table */
1674cf49a43SJulian Elischer static const u_int16_t fcstab[];
1684cf49a43SJulian Elischer 
1694cf49a43SJulian Elischer /******************************************************************
1704cf49a43SJulian Elischer 		    NETGRAPH NODE METHODS
1714cf49a43SJulian Elischer ******************************************************************/
1724cf49a43SJulian Elischer 
1734cf49a43SJulian Elischer /*
1744cf49a43SJulian Elischer  * Initialize a new node
1754cf49a43SJulian Elischer  */
1764cf49a43SJulian Elischer static int
177069154d5SJulian Elischer nga_constructor(node_p node)
1784cf49a43SJulian Elischer {
1794cf49a43SJulian Elischer 	sc_p sc;
1804cf49a43SJulian Elischer 
18199cdf4ccSDavid Malone 	MALLOC(sc, sc_p, sizeof(*sc), M_NETGRAPH, M_NOWAIT | M_ZERO);
1824cf49a43SJulian Elischer 	if (sc == NULL)
1834cf49a43SJulian Elischer 		return (ENOMEM);
1844cf49a43SJulian Elischer 	sc->amode = MODE_HUNT;
1854cf49a43SJulian Elischer 	sc->cfg.accm = ~0;
1864cf49a43SJulian Elischer 	sc->cfg.amru = NG_ASYNC_DEFAULT_MRU;
1874cf49a43SJulian Elischer 	sc->cfg.smru = NG_ASYNC_DEFAULT_MRU;
1884cf49a43SJulian Elischer 	MALLOC(sc->abuf, u_char *,
18965b9a0daSArchie Cobbs 	    ASYNC_BUF_SIZE(sc->cfg.smru), M_NETGRAPH, M_NOWAIT);
1904cf49a43SJulian Elischer 	if (sc->abuf == NULL)
1914cf49a43SJulian Elischer 		goto fail;
1924cf49a43SJulian Elischer 	MALLOC(sc->sbuf, u_char *,
19365b9a0daSArchie Cobbs 	    SYNC_BUF_SIZE(sc->cfg.amru), M_NETGRAPH, M_NOWAIT);
1944cf49a43SJulian Elischer 	if (sc->sbuf == NULL) {
1954cf49a43SJulian Elischer 		FREE(sc->abuf, M_NETGRAPH);
1964cf49a43SJulian Elischer fail:
1974cf49a43SJulian Elischer 		FREE(sc, M_NETGRAPH);
1984cf49a43SJulian Elischer 		return (ENOMEM);
1994cf49a43SJulian Elischer 	}
20030400f03SJulian Elischer 	NG_NODE_SET_PRIVATE(node, sc);
201069154d5SJulian Elischer 	sc->node = node;
2024cf49a43SJulian Elischer 	return (0);
2034cf49a43SJulian Elischer }
2044cf49a43SJulian Elischer 
2054cf49a43SJulian Elischer /*
2064cf49a43SJulian Elischer  * Reserve a hook for a pending connection
2074cf49a43SJulian Elischer  */
2084cf49a43SJulian Elischer static int
2094cf49a43SJulian Elischer nga_newhook(node_p node, hook_p hook, const char *name)
2104cf49a43SJulian Elischer {
21130400f03SJulian Elischer 	const sc_p sc = NG_NODE_PRIVATE(node);
2124cf49a43SJulian Elischer 	hook_p *hookp;
2134cf49a43SJulian Elischer 
214069154d5SJulian Elischer 	if (!strcmp(name, NG_ASYNC_HOOK_ASYNC)) {
215069154d5SJulian Elischer 		/*
216069154d5SJulian Elischer 		 * We use a static buffer here so only one packet
217069154d5SJulian Elischer 		 * at a time can be allowed to travel in this direction.
218069154d5SJulian Elischer 		 * Force Writer semantics.
219069154d5SJulian Elischer 		 */
22030400f03SJulian Elischer 		NG_HOOK_FORCE_WRITER(hook);
2214cf49a43SJulian Elischer 		hookp = &sc->async;
222069154d5SJulian Elischer 	} else if (!strcmp(name, NG_ASYNC_HOOK_SYNC)) {
223069154d5SJulian Elischer 		/*
224069154d5SJulian Elischer 		 * We use a static state here so only one packet
225069154d5SJulian Elischer 		 * at a time can be allowed to travel in this direction.
226069154d5SJulian Elischer 		 * Force Writer semantics.
227069154d5SJulian Elischer 		 * Since we set this for both directions
228069154d5SJulian Elischer 		 * we might as well set it for the whole node
229069154d5SJulian Elischer 		 * bit I haven;t done that (yet).
230069154d5SJulian Elischer 		 */
23130400f03SJulian Elischer 		NG_HOOK_FORCE_WRITER(hook);
2324cf49a43SJulian Elischer 		hookp = &sc->sync;
233069154d5SJulian Elischer 	} else {
2344cf49a43SJulian Elischer 		return (EINVAL);
235069154d5SJulian Elischer 	}
236069154d5SJulian Elischer 	if (*hookp) /* actually can't happen I think [JRE] */
2374cf49a43SJulian Elischer 		return (EISCONN);
2384cf49a43SJulian Elischer 	*hookp = hook;
2394cf49a43SJulian Elischer 	return (0);
2404cf49a43SJulian Elischer }
2414cf49a43SJulian Elischer 
2424cf49a43SJulian Elischer /*
2434cf49a43SJulian Elischer  * Receive incoming data
2444cf49a43SJulian Elischer  */
2454cf49a43SJulian Elischer static int
246069154d5SJulian Elischer nga_rcvdata(hook_p hook, item_p item)
2474cf49a43SJulian Elischer {
24830400f03SJulian Elischer 	const sc_p sc = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
2494cf49a43SJulian Elischer 
2504cf49a43SJulian Elischer 	if (hook == sc->sync)
251069154d5SJulian Elischer 		return (nga_rcv_sync(sc, item));
252a8e9726dSArchie Cobbs 	if (hook == sc->async)
253069154d5SJulian Elischer 		return (nga_rcv_async(sc, item));
2544cf49a43SJulian Elischer 	panic(__FUNCTION__);
2554cf49a43SJulian Elischer }
2564cf49a43SJulian Elischer 
2574cf49a43SJulian Elischer /*
2584cf49a43SJulian Elischer  * Receive incoming control message
2594cf49a43SJulian Elischer  */
2604cf49a43SJulian Elischer static int
261069154d5SJulian Elischer nga_rcvmsg(node_p node, item_p item, hook_p lasthook)
2624cf49a43SJulian Elischer {
26330400f03SJulian Elischer 	const sc_p sc = NG_NODE_PRIVATE(node);
2644cf49a43SJulian Elischer 	struct ng_mesg *resp = NULL;
2654cf49a43SJulian Elischer 	int error = 0;
266069154d5SJulian Elischer 	struct ng_mesg *msg;
2674cf49a43SJulian Elischer 
268069154d5SJulian Elischer 	NGI_GET_MSG(item, msg);
2694cf49a43SJulian Elischer 	switch (msg->header.typecookie) {
2704cf49a43SJulian Elischer 	case NGM_ASYNC_COOKIE:
2714cf49a43SJulian Elischer 		switch (msg->header.cmd) {
2724cf49a43SJulian Elischer 		case NGM_ASYNC_CMD_GET_STATS:
2734cf49a43SJulian Elischer 			NG_MKRESPONSE(resp, msg, sizeof(sc->stats), M_NOWAIT);
2744cf49a43SJulian Elischer 			if (resp == NULL)
2754cf49a43SJulian Elischer 				ERROUT(ENOMEM);
2764cf49a43SJulian Elischer 			*((struct ng_async_stat *) resp->data) = sc->stats;
2774cf49a43SJulian Elischer 			break;
2784cf49a43SJulian Elischer 		case NGM_ASYNC_CMD_CLR_STATS:
2794cf49a43SJulian Elischer 			bzero(&sc->stats, sizeof(sc->stats));
2804cf49a43SJulian Elischer 			break;
2814cf49a43SJulian Elischer 		case NGM_ASYNC_CMD_SET_CONFIG:
2824cf49a43SJulian Elischer 		    {
2834cf49a43SJulian Elischer 			struct ng_async_cfg *const cfg =
2844cf49a43SJulian Elischer 				(struct ng_async_cfg *) msg->data;
2854cf49a43SJulian Elischer 			u_char *buf;
2864cf49a43SJulian Elischer 
2874cf49a43SJulian Elischer 			if (msg->header.arglen != sizeof(*cfg))
2884cf49a43SJulian Elischer 				ERROUT(EINVAL);
2894cf49a43SJulian Elischer 			if (cfg->amru < NG_ASYNC_MIN_MRU
2904cf49a43SJulian Elischer 			    || cfg->amru > NG_ASYNC_MAX_MRU
2914cf49a43SJulian Elischer 			    || cfg->smru < NG_ASYNC_MIN_MRU
2924cf49a43SJulian Elischer 			    || cfg->smru > NG_ASYNC_MAX_MRU)
2934cf49a43SJulian Elischer 				ERROUT(EINVAL);
2944cf49a43SJulian Elischer 			cfg->enabled = !!cfg->enabled;	/* normalize */
2954cf49a43SJulian Elischer 			if (cfg->smru > sc->cfg.smru) {	/* reallocate buffer */
2964cf49a43SJulian Elischer 				MALLOC(buf, u_char *, ASYNC_BUF_SIZE(cfg->smru),
2974cf49a43SJulian Elischer 				    M_NETGRAPH, M_NOWAIT);
2984cf49a43SJulian Elischer 				if (!buf)
2994cf49a43SJulian Elischer 					ERROUT(ENOMEM);
3004cf49a43SJulian Elischer 				FREE(sc->abuf, M_NETGRAPH);
3014cf49a43SJulian Elischer 				sc->abuf = buf;
3024cf49a43SJulian Elischer 			}
3034cf49a43SJulian Elischer 			if (cfg->amru > sc->cfg.amru) {	/* reallocate buffer */
3044cf49a43SJulian Elischer 				MALLOC(buf, u_char *, SYNC_BUF_SIZE(cfg->amru),
3054cf49a43SJulian Elischer 				    M_NETGRAPH, M_NOWAIT);
3064cf49a43SJulian Elischer 				if (!buf)
3074cf49a43SJulian Elischer 					ERROUT(ENOMEM);
3084cf49a43SJulian Elischer 				FREE(sc->sbuf, M_NETGRAPH);
3094cf49a43SJulian Elischer 				sc->sbuf = buf;
3104cf49a43SJulian Elischer 				sc->amode = MODE_HUNT;
3114cf49a43SJulian Elischer 				sc->slen = 0;
3124cf49a43SJulian Elischer 			}
3134cf49a43SJulian Elischer 			if (!cfg->enabled) {
3144cf49a43SJulian Elischer 				sc->amode = MODE_HUNT;
3154cf49a43SJulian Elischer 				sc->slen = 0;
3164cf49a43SJulian Elischer 			}
3174cf49a43SJulian Elischer 			sc->cfg = *cfg;
3184cf49a43SJulian Elischer 			break;
3194cf49a43SJulian Elischer 		    }
3204cf49a43SJulian Elischer 		case NGM_ASYNC_CMD_GET_CONFIG:
3214cf49a43SJulian Elischer 			NG_MKRESPONSE(resp, msg, sizeof(sc->cfg), M_NOWAIT);
3224cf49a43SJulian Elischer 			if (!resp)
3234cf49a43SJulian Elischer 				ERROUT(ENOMEM);
3244cf49a43SJulian Elischer 			*((struct ng_async_cfg *) resp->data) = sc->cfg;
3254cf49a43SJulian Elischer 			break;
3264cf49a43SJulian Elischer 		default:
3274cf49a43SJulian Elischer 			ERROUT(EINVAL);
3284cf49a43SJulian Elischer 		}
3294cf49a43SJulian Elischer 		break;
3304cf49a43SJulian Elischer 	default:
3314cf49a43SJulian Elischer 		ERROUT(EINVAL);
3324cf49a43SJulian Elischer 	}
3334cf49a43SJulian Elischer done:
334069154d5SJulian Elischer 	NG_RESPOND_MSG(error, node, item, resp);
335069154d5SJulian Elischer 	NG_FREE_MSG(msg);
3364cf49a43SJulian Elischer 	return (error);
3374cf49a43SJulian Elischer }
3384cf49a43SJulian Elischer 
3394cf49a43SJulian Elischer /*
3404cf49a43SJulian Elischer  * Shutdown this node
3414cf49a43SJulian Elischer  */
3424cf49a43SJulian Elischer static int
3434cf49a43SJulian Elischer nga_shutdown(node_p node)
3444cf49a43SJulian Elischer {
34530400f03SJulian Elischer 	const sc_p sc = NG_NODE_PRIVATE(node);
3464cf49a43SJulian Elischer 
3474cf49a43SJulian Elischer 	FREE(sc->abuf, M_NETGRAPH);
3484cf49a43SJulian Elischer 	FREE(sc->sbuf, M_NETGRAPH);
3494cf49a43SJulian Elischer 	bzero(sc, sizeof(*sc));
3504cf49a43SJulian Elischer 	FREE(sc, M_NETGRAPH);
35130400f03SJulian Elischer 	NG_NODE_SET_PRIVATE(node, NULL);
35230400f03SJulian Elischer 	NG_NODE_UNREF(node);
3534cf49a43SJulian Elischer 	return (0);
3544cf49a43SJulian Elischer }
3554cf49a43SJulian Elischer 
3564cf49a43SJulian Elischer /*
3574cf49a43SJulian Elischer  * Lose a hook. When both hooks go away, we disappear.
3584cf49a43SJulian Elischer  */
3594cf49a43SJulian Elischer static int
3604cf49a43SJulian Elischer nga_disconnect(hook_p hook)
3614cf49a43SJulian Elischer {
36230400f03SJulian Elischer 	const sc_p sc = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
3634cf49a43SJulian Elischer 	hook_p *hookp;
3644cf49a43SJulian Elischer 
3654cf49a43SJulian Elischer 	if (hook == sc->async)
3664cf49a43SJulian Elischer 		hookp = &sc->async;
3674cf49a43SJulian Elischer 	else if (hook == sc->sync)
3684cf49a43SJulian Elischer 		hookp = &sc->sync;
3694cf49a43SJulian Elischer 	else
3704cf49a43SJulian Elischer 		panic(__FUNCTION__);
3714cf49a43SJulian Elischer 	if (!*hookp)
3724cf49a43SJulian Elischer 		panic(__FUNCTION__ "2");
3734cf49a43SJulian Elischer 	*hookp = NULL;
3744cf49a43SJulian Elischer 	bzero(&sc->stats, sizeof(sc->stats));
3754cf49a43SJulian Elischer 	sc->lasttime = 0;
37630400f03SJulian Elischer 	if ((NG_NODE_NUMHOOKS(NG_HOOK_NODE(hook)) == 0)
37730400f03SJulian Elischer 	&& (NG_NODE_IS_VALID(NG_HOOK_NODE(hook))))
37830400f03SJulian Elischer 		ng_rmnode_self(NG_HOOK_NODE(hook));
3794cf49a43SJulian Elischer 	return (0);
3804cf49a43SJulian Elischer }
3814cf49a43SJulian Elischer 
3824cf49a43SJulian Elischer /******************************************************************
3834cf49a43SJulian Elischer 		    INTERNAL HELPER STUFF
3844cf49a43SJulian Elischer ******************************************************************/
3854cf49a43SJulian Elischer 
3864cf49a43SJulian Elischer /*
3874cf49a43SJulian Elischer  * Encode a byte into the async buffer
3884cf49a43SJulian Elischer  */
3894cf49a43SJulian Elischer static __inline__ void
3904cf49a43SJulian Elischer nga_async_add(const sc_p sc, u_int16_t *fcs, u_int32_t accm, int *len, u_char x)
3914cf49a43SJulian Elischer {
3924cf49a43SJulian Elischer 	*fcs = PPP_FCS(*fcs, x);
3934cf49a43SJulian Elischer 	if ((x < 32 && ((1 << x) & accm))
3944cf49a43SJulian Elischer 	    || (x == PPP_ESCAPE)
3954cf49a43SJulian Elischer 	    || (x == PPP_FLAG)) {
3964cf49a43SJulian Elischer 		sc->abuf[(*len)++] = PPP_ESCAPE;
3974cf49a43SJulian Elischer 		x ^= PPP_TRANS;
3984cf49a43SJulian Elischer 	}
3994cf49a43SJulian Elischer 	sc->abuf[(*len)++] = x;
4004cf49a43SJulian Elischer }
4014cf49a43SJulian Elischer 
4024cf49a43SJulian Elischer /*
403a8e9726dSArchie Cobbs  * Receive incoming synchronous data.
4044cf49a43SJulian Elischer  */
4054cf49a43SJulian Elischer static int
406069154d5SJulian Elischer nga_rcv_sync(const sc_p sc, item_p item)
4074cf49a43SJulian Elischer {
408069154d5SJulian Elischer 	struct ifnet *rcvif;
40919a52c59SArchie Cobbs 	int alen, error = 0;
410a8e9726dSArchie Cobbs 	struct timeval time;
4114cf49a43SJulian Elischer 	u_int16_t fcs, fcs0;
412a8e9726dSArchie Cobbs 	u_int32_t accm;
413069154d5SJulian Elischer 	struct mbuf *m;
414069154d5SJulian Elischer 
4154cf49a43SJulian Elischer 
416a8e9726dSArchie Cobbs #define ADD_BYTE(x)	nga_async_add(sc, &fcs, accm, &alen, (x))
4174cf49a43SJulian Elischer 
418a8e9726dSArchie Cobbs 	/* Check for bypass mode */
4194cf49a43SJulian Elischer 	if (!sc->cfg.enabled) {
42030400f03SJulian Elischer 		NG_FWD_ITEM_HOOK(error, item, sc->async );
4214cf49a43SJulian Elischer 		return (error);
4224cf49a43SJulian Elischer 	}
423069154d5SJulian Elischer 	NGI_GET_M(item, m);
424069154d5SJulian Elischer 
425069154d5SJulian Elischer 	rcvif = m->m_pkthdr.rcvif;
426a8e9726dSArchie Cobbs 
42719a52c59SArchie Cobbs 	/* Get ACCM; special case LCP frames, which use full ACCM */
428a8e9726dSArchie Cobbs 	accm = sc->cfg.accm;
42919a52c59SArchie Cobbs 	if (m->m_pkthdr.len >= 4) {
43019a52c59SArchie Cobbs 		static const u_char lcphdr[4] = {
43119a52c59SArchie Cobbs 		    PPP_ALLSTATIONS,
43219a52c59SArchie Cobbs 		    PPP_UI,
43319a52c59SArchie Cobbs 		    (u_char)(PPP_LCP >> 8),
43419a52c59SArchie Cobbs 		    (u_char)(PPP_LCP & 0xff)
43519a52c59SArchie Cobbs 		};
43619a52c59SArchie Cobbs 		u_char buf[4];
437a8e9726dSArchie Cobbs 
43819a52c59SArchie Cobbs 		m_copydata(m, 0, 4, (caddr_t)buf);
43919a52c59SArchie Cobbs 		if (bcmp(buf, &lcphdr, 4) == 0)
440a8e9726dSArchie Cobbs 			accm = ~0;
441a8e9726dSArchie Cobbs 	}
442a8e9726dSArchie Cobbs 
443a8e9726dSArchie Cobbs 	/* Check for overflow */
4444cf49a43SJulian Elischer 	if (m->m_pkthdr.len > sc->cfg.smru) {
4454cf49a43SJulian Elischer 		sc->stats.syncOverflows++;
446069154d5SJulian Elischer 		NG_FREE_M(m);
447069154d5SJulian Elischer 		NG_FREE_ITEM(item);
4484cf49a43SJulian Elischer 		return (EMSGSIZE);
4494cf49a43SJulian Elischer 	}
450a8e9726dSArchie Cobbs 
451a8e9726dSArchie Cobbs 	/* Update stats */
4524cf49a43SJulian Elischer 	sc->stats.syncFrames++;
4534cf49a43SJulian Elischer 	sc->stats.syncOctets += m->m_pkthdr.len;
4544cf49a43SJulian Elischer 
4554cf49a43SJulian Elischer 	/* Initialize async encoded version of input mbuf */
4564cf49a43SJulian Elischer 	alen = 0;
4574cf49a43SJulian Elischer 	fcs = PPP_INITFCS;
4584cf49a43SJulian Elischer 
4594cf49a43SJulian Elischer 	/* Add beginning sync flag if it's been long enough to need one */
4604cf49a43SJulian Elischer 	getmicrotime(&time);
461a8e9726dSArchie Cobbs 	if (time.tv_sec >= sc->lasttime + 1) {
4624cf49a43SJulian Elischer 		sc->abuf[alen++] = PPP_FLAG;
4634cf49a43SJulian Elischer 		sc->lasttime = time.tv_sec;
4644cf49a43SJulian Elischer 	}
4654cf49a43SJulian Elischer 
46619a52c59SArchie Cobbs 	/* Add packet payload */
467a8e9726dSArchie Cobbs 	while (m != NULL) {
4684cf49a43SJulian Elischer 		struct mbuf *n;
4694cf49a43SJulian Elischer 
4704cf49a43SJulian Elischer 		while (m->m_len > 0) {
471a8e9726dSArchie Cobbs 			ADD_BYTE(*mtod(m, u_char *));
4724cf49a43SJulian Elischer 			m->m_data++;
4734cf49a43SJulian Elischer 			m->m_len--;
4744cf49a43SJulian Elischer 		}
4754cf49a43SJulian Elischer 		MFREE(m, n);
4764cf49a43SJulian Elischer 		m = n;
4774cf49a43SJulian Elischer 	}
4784cf49a43SJulian Elischer 
4794cf49a43SJulian Elischer 	/* Add checksum and final sync flag */
4804cf49a43SJulian Elischer 	fcs0 = fcs;
4814cf49a43SJulian Elischer 	ADD_BYTE(~fcs0 & 0xff);
4824cf49a43SJulian Elischer 	ADD_BYTE(~fcs0 >> 8);
4834cf49a43SJulian Elischer 	sc->abuf[alen++] = PPP_FLAG;
4844cf49a43SJulian Elischer 
4854cf49a43SJulian Elischer 	/* Put frame in an mbuf and ship it off */
486a8e9726dSArchie Cobbs 	if (!(m = m_devget(sc->abuf, alen, 0, rcvif, NULL))) {
487069154d5SJulian Elischer 		NG_FREE_ITEM(item);
4884cf49a43SJulian Elischer 		error = ENOBUFS;
489069154d5SJulian Elischer 	} else {
490069154d5SJulian Elischer 		NG_FWD_NEW_DATA(error, item, sc->async, m);
491069154d5SJulian Elischer 	}
4924cf49a43SJulian Elischer 	return (error);
4934cf49a43SJulian Elischer }
4944cf49a43SJulian Elischer 
4954cf49a43SJulian Elischer /*
4964cf49a43SJulian Elischer  * Receive incoming asynchronous data
497a8e9726dSArchie Cobbs  * XXX Technically, we should strip out incoming characters
498a8e9726dSArchie Cobbs  *     that are in our ACCM. Not sure if this is good or not.
4994cf49a43SJulian Elischer  */
5004cf49a43SJulian Elischer static int
501069154d5SJulian Elischer nga_rcv_async(const sc_p sc, item_p item)
5024cf49a43SJulian Elischer {
503069154d5SJulian Elischer 	struct ifnet *rcvif;
5044cf49a43SJulian Elischer 	int error;
505069154d5SJulian Elischer 	struct mbuf *m;
5064cf49a43SJulian Elischer 
5074cf49a43SJulian Elischer 	if (!sc->cfg.enabled) {
50830400f03SJulian Elischer 		NG_FWD_ITEM_HOOK(error, item,  sc->sync);
5094cf49a43SJulian Elischer 		return (error);
5104cf49a43SJulian Elischer 	}
511069154d5SJulian Elischer 	NGI_GET_M(item, m);
512069154d5SJulian Elischer 	rcvif = m->m_pkthdr.rcvif;
5134cf49a43SJulian Elischer 	while (m) {
5144cf49a43SJulian Elischer 		struct mbuf *n;
5154cf49a43SJulian Elischer 
5164cf49a43SJulian Elischer 		for (; m->m_len > 0; m->m_data++, m->m_len--) {
5174cf49a43SJulian Elischer 			u_char  ch = *mtod(m, u_char *);
5184cf49a43SJulian Elischer 
5194cf49a43SJulian Elischer 			sc->stats.asyncOctets++;
5204cf49a43SJulian Elischer 			if (ch == PPP_FLAG) {	/* Flag overrides everything */
5214cf49a43SJulian Elischer 				int     skip = 0;
5224cf49a43SJulian Elischer 
5234cf49a43SJulian Elischer 				/* Check for runts */
5244cf49a43SJulian Elischer 				if (sc->slen < 2) {
5254cf49a43SJulian Elischer 					if (sc->slen > 0)
5264cf49a43SJulian Elischer 						sc->stats.asyncRunts++;
5274cf49a43SJulian Elischer 					goto reset;
5284cf49a43SJulian Elischer 				}
5294cf49a43SJulian Elischer 
5304cf49a43SJulian Elischer 				/* Verify CRC */
5314cf49a43SJulian Elischer 				if (sc->fcs != PPP_GOODFCS) {
5324cf49a43SJulian Elischer 					sc->stats.asyncBadCheckSums++;
5334cf49a43SJulian Elischer 					goto reset;
5344cf49a43SJulian Elischer 				}
5354cf49a43SJulian Elischer 				sc->slen -= 2;
5364cf49a43SJulian Elischer 
5374cf49a43SJulian Elischer 				/* Strip address and control fields */
5384cf49a43SJulian Elischer 				if (sc->slen >= 2
5394cf49a43SJulian Elischer 				    && sc->sbuf[0] == PPP_ALLSTATIONS
5404cf49a43SJulian Elischer 				    && sc->sbuf[1] == PPP_UI)
5414cf49a43SJulian Elischer 					skip = 2;
5424cf49a43SJulian Elischer 
5434cf49a43SJulian Elischer 				/* Check for frame too big */
5444cf49a43SJulian Elischer 				if (sc->slen - skip > sc->cfg.amru) {
5454cf49a43SJulian Elischer 					sc->stats.asyncOverflows++;
5464cf49a43SJulian Elischer 					goto reset;
5474cf49a43SJulian Elischer 				}
5484cf49a43SJulian Elischer 
5494cf49a43SJulian Elischer 				/* OK, ship it out */
5504cf49a43SJulian Elischer 				if ((n = m_devget(sc->sbuf + skip,
551069154d5SJulian Elischer 					   sc->slen - skip, 0, rcvif, NULL))) {
552069154d5SJulian Elischer 					if (item) { /* sets NULL -> item */
553069154d5SJulian Elischer 						NG_FWD_NEW_DATA(error, item,
554069154d5SJulian Elischer 							sc->sync, n);
555069154d5SJulian Elischer 					} else {
556069154d5SJulian Elischer 						NG_SEND_DATA_ONLY(error,
557069154d5SJulian Elischer 							sc->sync ,n);
558069154d5SJulian Elischer 					}
559069154d5SJulian Elischer 				}
5604cf49a43SJulian Elischer 				sc->stats.asyncFrames++;
5614cf49a43SJulian Elischer reset:
5624cf49a43SJulian Elischer 				sc->amode = MODE_NORMAL;
5634cf49a43SJulian Elischer 				sc->fcs = PPP_INITFCS;
5644cf49a43SJulian Elischer 				sc->slen = 0;
5654cf49a43SJulian Elischer 				continue;
5664cf49a43SJulian Elischer 			}
5674cf49a43SJulian Elischer 			switch (sc->amode) {
5684cf49a43SJulian Elischer 			case MODE_NORMAL:
5694cf49a43SJulian Elischer 				if (ch == PPP_ESCAPE) {
5704cf49a43SJulian Elischer 					sc->amode = MODE_ESC;
5714cf49a43SJulian Elischer 					continue;
5724cf49a43SJulian Elischer 				}
5734cf49a43SJulian Elischer 				break;
5744cf49a43SJulian Elischer 			case MODE_ESC:
5754cf49a43SJulian Elischer 				ch ^= PPP_TRANS;
5764cf49a43SJulian Elischer 				sc->amode = MODE_NORMAL;
5774cf49a43SJulian Elischer 				break;
5784cf49a43SJulian Elischer 			case MODE_HUNT:
5794cf49a43SJulian Elischer 			default:
5804cf49a43SJulian Elischer 				continue;
5814cf49a43SJulian Elischer 			}
5824cf49a43SJulian Elischer 
5834cf49a43SJulian Elischer 			/* Add byte to frame */
5844cf49a43SJulian Elischer 			if (sc->slen >= SYNC_BUF_SIZE(sc->cfg.amru)) {
5854cf49a43SJulian Elischer 				sc->stats.asyncOverflows++;
5864cf49a43SJulian Elischer 				sc->amode = MODE_HUNT;
5874cf49a43SJulian Elischer 				sc->slen = 0;
5884cf49a43SJulian Elischer 			} else {
5894cf49a43SJulian Elischer 				sc->sbuf[sc->slen++] = ch;
5904cf49a43SJulian Elischer 				sc->fcs = PPP_FCS(sc->fcs, ch);
5914cf49a43SJulian Elischer 			}
5924cf49a43SJulian Elischer 		}
5934cf49a43SJulian Elischer 		MFREE(m, n);
5944cf49a43SJulian Elischer 		m = n;
5954cf49a43SJulian Elischer 	}
596069154d5SJulian Elischer 	if (item)
597069154d5SJulian Elischer 		NG_FREE_ITEM(item);
5984cf49a43SJulian Elischer 	return (0);
5994cf49a43SJulian Elischer }
6004cf49a43SJulian Elischer 
6014cf49a43SJulian Elischer /*
6024cf49a43SJulian Elischer  * CRC table
6034cf49a43SJulian Elischer  *
6044cf49a43SJulian Elischer  * Taken from RFC 1171 Appendix B
6054cf49a43SJulian Elischer  */
6064cf49a43SJulian Elischer static const u_int16_t fcstab[256] = {
6074cf49a43SJulian Elischer 	 0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
6084cf49a43SJulian Elischer 	 0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
6094cf49a43SJulian Elischer 	 0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, 0x75b7, 0x643e,
6104cf49a43SJulian Elischer 	 0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, 0xe876,
6114cf49a43SJulian Elischer 	 0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd,
6124cf49a43SJulian Elischer 	 0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5,
6134cf49a43SJulian Elischer 	 0x3183, 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c,
6144cf49a43SJulian Elischer 	 0xbdcb, 0xac42, 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974,
6154cf49a43SJulian Elischer 	 0x4204, 0x538d, 0x6116, 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb,
6164cf49a43SJulian Elischer 	 0xce4c, 0xdfc5, 0xed5e, 0xfcd7, 0x8868, 0x99e1, 0xab7a, 0xbaf3,
6174cf49a43SJulian Elischer 	 0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, 0x0528, 0x37b3, 0x263a,
6184cf49a43SJulian Elischer 	 0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, 0xbbfb, 0xaa72,
6194cf49a43SJulian Elischer 	 0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, 0x17b9,
6204cf49a43SJulian Elischer 	 0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1,
6214cf49a43SJulian Elischer 	 0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738,
6224cf49a43SJulian Elischer 	 0xffcf, 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70,
6234cf49a43SJulian Elischer 	 0x8408, 0x9581, 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7,
6244cf49a43SJulian Elischer 	 0x0840, 0x19c9, 0x2b52, 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff,
6254cf49a43SJulian Elischer 	 0x9489, 0x8500, 0xb79b, 0xa612, 0xd2ad, 0xc324, 0xf1bf, 0xe036,
6264cf49a43SJulian Elischer 	 0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, 0x4f6c, 0x7df7, 0x6c7e,
6274cf49a43SJulian Elischer 	 0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, 0xc03c, 0xd1b5,
6284cf49a43SJulian Elischer 	 0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, 0x5dfd,
6294cf49a43SJulian Elischer 	 0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134,
6304cf49a43SJulian Elischer 	 0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c,
6314cf49a43SJulian Elischer 	 0xc60c, 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3,
6324cf49a43SJulian Elischer 	 0x4a44, 0x5bcd, 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb,
6334cf49a43SJulian Elischer 	 0xd68d, 0xc704, 0xf59f, 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232,
6344cf49a43SJulian Elischer 	 0x5ac5, 0x4b4c, 0x79d7, 0x685e, 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a,
6354cf49a43SJulian Elischer 	 0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, 0xb0a3, 0x8238, 0x93b1,
6364cf49a43SJulian Elischer 	 0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, 0x0e70, 0x1ff9,
6374cf49a43SJulian Elischer 	 0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, 0x8330,
6384cf49a43SJulian Elischer 	 0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78
6394cf49a43SJulian Elischer };
640