xref: /freebsd/sys/netgraph/ng_cisco.c (revision 4cf49a43559ed9fdad601bdcccd2c55963008675)
14cf49a43SJulian Elischer 
24cf49a43SJulian Elischer /*
34cf49a43SJulian Elischer  * ng_cisco.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_cisco.c,v 1.23 1999/01/28 23:54:53 julian Exp $
414cf49a43SJulian Elischer  */
424cf49a43SJulian Elischer 
434cf49a43SJulian Elischer #include "opt_inet.h"
444cf49a43SJulian Elischer #include "opt_atalk.h"
454cf49a43SJulian Elischer #include "opt_ipx.h"
464cf49a43SJulian Elischer 
474cf49a43SJulian Elischer #include <sys/param.h>
484cf49a43SJulian Elischer #include <sys/systm.h>
494cf49a43SJulian Elischer #include <sys/errno.h>
504cf49a43SJulian Elischer #include <sys/kernel.h>
514cf49a43SJulian Elischer #include <sys/socket.h>
524cf49a43SJulian Elischer #include <sys/malloc.h>
534cf49a43SJulian Elischer #include <sys/mbuf.h>
544cf49a43SJulian Elischer #include <sys/syslog.h>
554cf49a43SJulian Elischer 
564cf49a43SJulian Elischer #include <net/if.h>
574cf49a43SJulian Elischer 
584cf49a43SJulian Elischer #include <netinet/in.h>
594cf49a43SJulian Elischer #include <netinet/if_ether.h>
604cf49a43SJulian Elischer 
614cf49a43SJulian Elischer #include <netatalk/at.h>
624cf49a43SJulian Elischer #include <netatalk/at_var.h>
634cf49a43SJulian Elischer #include <netatalk/at_extern.h>
644cf49a43SJulian Elischer 
654cf49a43SJulian Elischer #include <netipx/ipx.h>
664cf49a43SJulian Elischer #include <netipx/ipx_if.h>
674cf49a43SJulian Elischer 
684cf49a43SJulian Elischer #include <netgraph/ng_message.h>
694cf49a43SJulian Elischer #include <netgraph/netgraph.h>
704cf49a43SJulian Elischer #include <netgraph/ng_cisco.h>
714cf49a43SJulian Elischer 
724cf49a43SJulian Elischer #define CISCO_MULTICAST         0x8f	/* Cisco multicast address */
734cf49a43SJulian Elischer #define CISCO_UNICAST           0x0f	/* Cisco unicast address */
744cf49a43SJulian Elischer #define CISCO_KEEPALIVE         0x8035	/* Cisco keepalive protocol */
754cf49a43SJulian Elischer #define CISCO_ADDR_REQ          0	/* Cisco address request */
764cf49a43SJulian Elischer #define CISCO_ADDR_REPLY        1	/* Cisco address reply */
774cf49a43SJulian Elischer #define CISCO_KEEPALIVE_REQ     2	/* Cisco keepalive request */
784cf49a43SJulian Elischer 
794cf49a43SJulian Elischer #define KEEPALIVE_SECS		10
804cf49a43SJulian Elischer 
814cf49a43SJulian Elischer struct cisco_header {
824cf49a43SJulian Elischer 	u_char  address;
834cf49a43SJulian Elischer 	u_char  control;
844cf49a43SJulian Elischer 	u_short protocol;
854cf49a43SJulian Elischer };
864cf49a43SJulian Elischer 
874cf49a43SJulian Elischer #define CISCO_HEADER_LEN          sizeof (struct cisco_header)
884cf49a43SJulian Elischer 
894cf49a43SJulian Elischer struct cisco_packet {
904cf49a43SJulian Elischer 	u_long  type;
914cf49a43SJulian Elischer 	u_long  par1;
924cf49a43SJulian Elischer 	u_long  par2;
934cf49a43SJulian Elischer 	u_short rel;
944cf49a43SJulian Elischer 	u_short time0;
954cf49a43SJulian Elischer 	u_short time1;
964cf49a43SJulian Elischer };
974cf49a43SJulian Elischer 
984cf49a43SJulian Elischer #define CISCO_PACKET_LEN (sizeof(struct cisco_packet))
994cf49a43SJulian Elischer 
1004cf49a43SJulian Elischer struct protoent {
1014cf49a43SJulian Elischer 	hook_p  hook;		/* the hook for this proto */
1024cf49a43SJulian Elischer 	u_short af;		/* address family, -1 = downstream */
1034cf49a43SJulian Elischer };
1044cf49a43SJulian Elischer 
1054cf49a43SJulian Elischer struct cisco_priv {
1064cf49a43SJulian Elischer 	u_long  local_seq;
1074cf49a43SJulian Elischer 	u_long  remote_seq;
1084cf49a43SJulian Elischer 	u_long  seq_retries;	/* how many times we've been here throwing out
1094cf49a43SJulian Elischer 				 * the same sequence number without ack */
1104cf49a43SJulian Elischer 	node_p  node;
1114cf49a43SJulian Elischer 	struct callout_handle handle;
1124cf49a43SJulian Elischer 	struct protoent downstream;
1134cf49a43SJulian Elischer 	struct protoent inet;		/* IP information */
1144cf49a43SJulian Elischer 	struct in_addr localip;
1154cf49a43SJulian Elischer 	struct in_addr localmask;
1164cf49a43SJulian Elischer 	struct protoent atalk;		/* AppleTalk information */
1174cf49a43SJulian Elischer 	struct protoent ipx;		/* IPX information */
1184cf49a43SJulian Elischer };
1194cf49a43SJulian Elischer typedef struct cisco_priv *sc_p;
1204cf49a43SJulian Elischer 
1214cf49a43SJulian Elischer /* Netgraph methods */
1224cf49a43SJulian Elischer static int	cisco_constructor(node_p *node);
1234cf49a43SJulian Elischer static int	cisco_rcvmsg(node_p node, struct ng_mesg *msg,
1244cf49a43SJulian Elischer 		    const char *retaddr, struct ng_mesg **resp);
1254cf49a43SJulian Elischer static int	cisco_rmnode(node_p node);
1264cf49a43SJulian Elischer static int	cisco_newhook(node_p node, hook_p hook, const char *name);
1274cf49a43SJulian Elischer 
1284cf49a43SJulian Elischer static int	cisco_rcvdata(hook_p hook, struct mbuf *m, meta_p meta);
1294cf49a43SJulian Elischer static int	cisco_disconnect(hook_p hook);
1304cf49a43SJulian Elischer 
1314cf49a43SJulian Elischer /* Other functions */
1324cf49a43SJulian Elischer static int	cisco_input(sc_p sc, struct mbuf *m, meta_p meta);
1334cf49a43SJulian Elischer static void	cisco_keepalive(void *arg);
1344cf49a43SJulian Elischer static int	cisco_send(sc_p sc, int type, long par1, long par2);
1354cf49a43SJulian Elischer 
1364cf49a43SJulian Elischer /* Node type */
1374cf49a43SJulian Elischer static struct ng_type typestruct = {
1384cf49a43SJulian Elischer 	NG_VERSION,
1394cf49a43SJulian Elischer 	NG_CISCO_NODE_TYPE,
1404cf49a43SJulian Elischer 	NULL,
1414cf49a43SJulian Elischer 	cisco_constructor,
1424cf49a43SJulian Elischer 	cisco_rcvmsg,
1434cf49a43SJulian Elischer 	cisco_rmnode,
1444cf49a43SJulian Elischer 	cisco_newhook,
1454cf49a43SJulian Elischer 	NULL,
1464cf49a43SJulian Elischer 	NULL,
1474cf49a43SJulian Elischer 	cisco_rcvdata,
1484cf49a43SJulian Elischer 	cisco_rcvdata,
1494cf49a43SJulian Elischer 	cisco_disconnect
1504cf49a43SJulian Elischer };
1514cf49a43SJulian Elischer NETGRAPH_INIT(cisco, &typestruct);
1524cf49a43SJulian Elischer 
1534cf49a43SJulian Elischer /*
1544cf49a43SJulian Elischer  * Node constructor
1554cf49a43SJulian Elischer  */
1564cf49a43SJulian Elischer static int
1574cf49a43SJulian Elischer cisco_constructor(node_p *nodep)
1584cf49a43SJulian Elischer {
1594cf49a43SJulian Elischer 	sc_p sc;
1604cf49a43SJulian Elischer 	int error = 0;
1614cf49a43SJulian Elischer 
1624cf49a43SJulian Elischer 	MALLOC(sc, sc_p, sizeof(*sc), M_NETGRAPH, M_WAITOK);
1634cf49a43SJulian Elischer 	if (sc == NULL)
1644cf49a43SJulian Elischer 		return (ENOMEM);
1654cf49a43SJulian Elischer 	bzero(sc, sizeof(struct cisco_priv));
1664cf49a43SJulian Elischer 
1674cf49a43SJulian Elischer 	callout_handle_init(&sc->handle);
1684cf49a43SJulian Elischer 	if ((error = ng_make_node_common(&typestruct, nodep))) {
1694cf49a43SJulian Elischer 		FREE(sc, M_NETGRAPH);
1704cf49a43SJulian Elischer 		return (error);
1714cf49a43SJulian Elischer 	}
1724cf49a43SJulian Elischer 	(*nodep)->private = sc;
1734cf49a43SJulian Elischer 	sc->node = *nodep;
1744cf49a43SJulian Elischer 
1754cf49a43SJulian Elischer 	/* Initialise the varous protocol hook holders */
1764cf49a43SJulian Elischer 	sc->downstream.af = 0xffff;
1774cf49a43SJulian Elischer 	sc->inet.af = AF_INET;
1784cf49a43SJulian Elischer 	sc->atalk.af = AF_APPLETALK;
1794cf49a43SJulian Elischer 	sc->ipx.af = AF_IPX;
1804cf49a43SJulian Elischer 	return (0);
1814cf49a43SJulian Elischer }
1824cf49a43SJulian Elischer 
1834cf49a43SJulian Elischer /*
1844cf49a43SJulian Elischer  * Check new hook
1854cf49a43SJulian Elischer  */
1864cf49a43SJulian Elischer static int
1874cf49a43SJulian Elischer cisco_newhook(node_p node, hook_p hook, const char *name)
1884cf49a43SJulian Elischer {
1894cf49a43SJulian Elischer 	const sc_p sc = node->private;
1904cf49a43SJulian Elischer 
1914cf49a43SJulian Elischer 	if (strcmp(name, NG_CISCO_HOOK_DOWNSTREAM) == 0) {
1924cf49a43SJulian Elischer 		sc->downstream.hook = hook;
1934cf49a43SJulian Elischer 		hook->private = &sc->downstream;
1944cf49a43SJulian Elischer 
1954cf49a43SJulian Elischer 		/* Start keepalives */
1964cf49a43SJulian Elischer 		sc->handle = timeout(cisco_keepalive, sc, hz * KEEPALIVE_SECS);
1974cf49a43SJulian Elischer 	} else if (strcmp(name, NG_CISCO_HOOK_INET) == 0) {
1984cf49a43SJulian Elischer 		sc->inet.hook = hook;
1994cf49a43SJulian Elischer 		hook->private = &sc->inet;
2004cf49a43SJulian Elischer 	} else if (strcmp(name, NG_CISCO_HOOK_APPLETALK) == 0) {
2014cf49a43SJulian Elischer 		sc->atalk.hook = hook;
2024cf49a43SJulian Elischer 		hook->private = &sc->atalk;
2034cf49a43SJulian Elischer 	} else if (strcmp(name, NG_CISCO_HOOK_IPX) == 0) {
2044cf49a43SJulian Elischer 		sc->ipx.hook = hook;
2054cf49a43SJulian Elischer 		hook->private = &sc->ipx;
2064cf49a43SJulian Elischer 	} else if (strcmp(name, NG_CISCO_HOOK_DEBUG) == 0) {
2074cf49a43SJulian Elischer 		hook->private = NULL;	/* unimplemented */
2084cf49a43SJulian Elischer 	} else
2094cf49a43SJulian Elischer 		return (EINVAL);
2104cf49a43SJulian Elischer 	return 0;
2114cf49a43SJulian Elischer }
2124cf49a43SJulian Elischer 
2134cf49a43SJulian Elischer /*
2144cf49a43SJulian Elischer  * Receive control message.
2154cf49a43SJulian Elischer  */
2164cf49a43SJulian Elischer static int
2174cf49a43SJulian Elischer cisco_rcvmsg(node_p node, struct ng_mesg *msg,
2184cf49a43SJulian Elischer 	const char *retaddr, struct ng_mesg **rptr)
2194cf49a43SJulian Elischer {
2204cf49a43SJulian Elischer 	const sc_p sc = node->private;
2214cf49a43SJulian Elischer 	struct ng_mesg *resp = NULL;
2224cf49a43SJulian Elischer 	int error = 0;
2234cf49a43SJulian Elischer 
2244cf49a43SJulian Elischer 	switch (msg->header.typecookie) {
2254cf49a43SJulian Elischer 	case NGM_GENERIC_COOKIE:
2264cf49a43SJulian Elischer 		switch (msg->header.cmd) {
2274cf49a43SJulian Elischer 		case NGM_TEXT_STATUS:
2284cf49a43SJulian Elischer 		    {
2294cf49a43SJulian Elischer 			char *arg;
2304cf49a43SJulian Elischer 			int pos;
2314cf49a43SJulian Elischer 
2324cf49a43SJulian Elischer 			NG_MKRESPONSE(resp, msg, sizeof(struct ng_mesg)
2334cf49a43SJulian Elischer 			    + NG_TEXTRESPONSE, M_NOWAIT);
2344cf49a43SJulian Elischer 			if (resp == NULL) {
2354cf49a43SJulian Elischer 				error = ENOMEM;
2364cf49a43SJulian Elischer 				break;
2374cf49a43SJulian Elischer 			}
2384cf49a43SJulian Elischer 			arg = (char *) resp->data;
2394cf49a43SJulian Elischer 			pos = sprintf(arg,
2404cf49a43SJulian Elischer 			  "keepalive period: %d sec; ", KEEPALIVE_SECS);
2414cf49a43SJulian Elischer 			pos += sprintf(arg + pos,
2424cf49a43SJulian Elischer 			  "unacknowledged keepalives: %ld", sc->seq_retries);
2434cf49a43SJulian Elischer 			resp->header.arglen = pos + 1;
2444cf49a43SJulian Elischer 			break;
2454cf49a43SJulian Elischer 		    }
2464cf49a43SJulian Elischer 		default:
2474cf49a43SJulian Elischer 			error = EINVAL;
2484cf49a43SJulian Elischer 			break;
2494cf49a43SJulian Elischer 		}
2504cf49a43SJulian Elischer 		break;
2514cf49a43SJulian Elischer 	case NGM_CISCO_COOKIE:
2524cf49a43SJulian Elischer 		switch (msg->header.cmd) {
2534cf49a43SJulian Elischer 		case NGM_CISCO_GET_IPADDR:	/* could be a late reply! */
2544cf49a43SJulian Elischer 			if ((msg->header.flags & NGF_RESP) == 0) {
2554cf49a43SJulian Elischer 				struct in_addr *ips;
2564cf49a43SJulian Elischer 
2574cf49a43SJulian Elischer 				NG_MKRESPONSE(resp, msg,
2584cf49a43SJulian Elischer 				    2 * sizeof(*ips), M_NOWAIT);
2594cf49a43SJulian Elischer 				if (!resp) {
2604cf49a43SJulian Elischer 					error = ENOMEM;
2614cf49a43SJulian Elischer 					break;
2624cf49a43SJulian Elischer 				}
2634cf49a43SJulian Elischer 				ips = (struct in_addr *) resp->data;
2644cf49a43SJulian Elischer 				ips[0] = sc->localip;
2654cf49a43SJulian Elischer 				ips[1] = sc->localmask;
2664cf49a43SJulian Elischer 				break;
2674cf49a43SJulian Elischer 			}
2684cf49a43SJulian Elischer 			/* FALLTHROUGH */	/* ...if it's a reply */
2694cf49a43SJulian Elischer 		case NGM_CISCO_SET_IPADDR:
2704cf49a43SJulian Elischer 		    {
2714cf49a43SJulian Elischer 			struct in_addr *const ips = (struct in_addr *)msg->data;
2724cf49a43SJulian Elischer 
2734cf49a43SJulian Elischer 			if (msg->header.arglen < 2 * sizeof(*ips)) {
2744cf49a43SJulian Elischer 				error = EINVAL;
2754cf49a43SJulian Elischer 				break;
2764cf49a43SJulian Elischer 			}
2774cf49a43SJulian Elischer 			sc->localip = ips[0];
2784cf49a43SJulian Elischer 			sc->localmask = ips[1];
2794cf49a43SJulian Elischer 			break;
2804cf49a43SJulian Elischer 		    }
2814cf49a43SJulian Elischer 		case NGM_CISCO_GET_STATUS:
2824cf49a43SJulian Elischer 		    {
2834cf49a43SJulian Elischer 			struct ngciscostat *stat;
2844cf49a43SJulian Elischer 
2854cf49a43SJulian Elischer 			NG_MKRESPONSE(resp, msg, sizeof(*stat), M_NOWAIT);
2864cf49a43SJulian Elischer 			if (!resp) {
2874cf49a43SJulian Elischer 				error = ENOMEM;
2884cf49a43SJulian Elischer 				break;
2894cf49a43SJulian Elischer 			}
2904cf49a43SJulian Elischer 			stat = (struct ngciscostat *) resp->data;
2914cf49a43SJulian Elischer 			stat->seq_retries = sc->seq_retries;
2924cf49a43SJulian Elischer 			stat->keepalive_period = KEEPALIVE_SECS;
2934cf49a43SJulian Elischer 			break;
2944cf49a43SJulian Elischer 		    }
2954cf49a43SJulian Elischer 		default:
2964cf49a43SJulian Elischer 			error = EINVAL;
2974cf49a43SJulian Elischer 			break;
2984cf49a43SJulian Elischer 		}
2994cf49a43SJulian Elischer 		break;
3004cf49a43SJulian Elischer 	default:
3014cf49a43SJulian Elischer 		error = EINVAL;
3024cf49a43SJulian Elischer 		break;
3034cf49a43SJulian Elischer 	}
3044cf49a43SJulian Elischer 	if (rptr)
3054cf49a43SJulian Elischer 		*rptr = resp;
3064cf49a43SJulian Elischer 	else if (resp)
3074cf49a43SJulian Elischer 		FREE(resp, M_NETGRAPH);
3084cf49a43SJulian Elischer 	FREE(msg, M_NETGRAPH);
3094cf49a43SJulian Elischer 	return (error);
3104cf49a43SJulian Elischer }
3114cf49a43SJulian Elischer 
3124cf49a43SJulian Elischer /*
3134cf49a43SJulian Elischer  * Receive data
3144cf49a43SJulian Elischer  */
3154cf49a43SJulian Elischer static int
3164cf49a43SJulian Elischer cisco_rcvdata(hook_p hook, struct mbuf *m, meta_p meta)
3174cf49a43SJulian Elischer {
3184cf49a43SJulian Elischer 	const sc_p sc = hook->node->private;
3194cf49a43SJulian Elischer 	struct protoent *pep;
3204cf49a43SJulian Elischer 	struct cisco_header *h;
3214cf49a43SJulian Elischer 	int error = 0;
3224cf49a43SJulian Elischer 
3234cf49a43SJulian Elischer 	if ((pep = hook->private) == NULL)
3244cf49a43SJulian Elischer 		goto out;
3254cf49a43SJulian Elischer 
3264cf49a43SJulian Elischer 	/* If it came from our downlink, deal with it separately */
3274cf49a43SJulian Elischer 	if (pep->af == 0xffff)
3284cf49a43SJulian Elischer 		return (cisco_input(sc, m, meta));
3294cf49a43SJulian Elischer 
3304cf49a43SJulian Elischer 	/* OK so it came from a protocol, heading out. Prepend general data
3314cf49a43SJulian Elischer 	   packet header. For now, IP,IPX only  */
3324cf49a43SJulian Elischer 	M_PREPEND(m, CISCO_HEADER_LEN, M_DONTWAIT);
3334cf49a43SJulian Elischer 	if (!m) {
3344cf49a43SJulian Elischer 		error = ENOBUFS;
3354cf49a43SJulian Elischer 		goto out;
3364cf49a43SJulian Elischer 	}
3374cf49a43SJulian Elischer 	h = mtod(m, struct cisco_header *);
3384cf49a43SJulian Elischer 	h->address = CISCO_MULTICAST;		/* broadcast address */
3394cf49a43SJulian Elischer 	h->control = 0;
3404cf49a43SJulian Elischer 
3414cf49a43SJulian Elischer 	switch (pep->af) {
3424cf49a43SJulian Elischer 	case AF_INET:		/* Internet Protocol */
3434cf49a43SJulian Elischer 		h->protocol = htons(ETHERTYPE_IP);
3444cf49a43SJulian Elischer 		break;
3454cf49a43SJulian Elischer 	case AF_APPLETALK:	/* AppleTalk Protocol */
3464cf49a43SJulian Elischer 		h->protocol = htons(ETHERTYPE_AT);
3474cf49a43SJulian Elischer 		break;
3484cf49a43SJulian Elischer 	case AF_IPX:		/* Novell IPX Protocol */
3494cf49a43SJulian Elischer 		h->protocol = htons(ETHERTYPE_IPX);
3504cf49a43SJulian Elischer 		break;
3514cf49a43SJulian Elischer 	default:
3524cf49a43SJulian Elischer 		error = EAFNOSUPPORT;
3534cf49a43SJulian Elischer 		goto out;
3544cf49a43SJulian Elischer 	}
3554cf49a43SJulian Elischer 
3564cf49a43SJulian Elischer 	/* Send it */
3574cf49a43SJulian Elischer 	NG_SEND_DATA(error, sc->downstream.hook, m, meta);
3584cf49a43SJulian Elischer 	return (error);
3594cf49a43SJulian Elischer 
3604cf49a43SJulian Elischer out:
3614cf49a43SJulian Elischer 	NG_FREE_DATA(m, meta);
3624cf49a43SJulian Elischer 	return (error);
3634cf49a43SJulian Elischer }
3644cf49a43SJulian Elischer 
3654cf49a43SJulian Elischer /*
3664cf49a43SJulian Elischer  * Shutdown node
3674cf49a43SJulian Elischer  */
3684cf49a43SJulian Elischer static int
3694cf49a43SJulian Elischer cisco_rmnode(node_p node)
3704cf49a43SJulian Elischer {
3714cf49a43SJulian Elischer 	const sc_p sc = node->private;
3724cf49a43SJulian Elischer 
3734cf49a43SJulian Elischer 	node->flags |= NG_INVALID;
3744cf49a43SJulian Elischer 	ng_cutlinks(node);
3754cf49a43SJulian Elischer 	ng_unname(node);
3764cf49a43SJulian Elischer 	node->private = NULL;
3774cf49a43SJulian Elischer 	ng_unref(sc->node);
3784cf49a43SJulian Elischer 	FREE(sc, M_NETGRAPH);
3794cf49a43SJulian Elischer 	return (0);
3804cf49a43SJulian Elischer }
3814cf49a43SJulian Elischer 
3824cf49a43SJulian Elischer /*
3834cf49a43SJulian Elischer  * Disconnection of a hook
3844cf49a43SJulian Elischer  *
3854cf49a43SJulian Elischer  * For this type, removal of the last link destroys the node
3864cf49a43SJulian Elischer  */
3874cf49a43SJulian Elischer static int
3884cf49a43SJulian Elischer cisco_disconnect(hook_p hook)
3894cf49a43SJulian Elischer {
3904cf49a43SJulian Elischer 	const sc_p sc = hook->node->private;
3914cf49a43SJulian Elischer 	struct protoent *pep;
3924cf49a43SJulian Elischer 
3934cf49a43SJulian Elischer 	/* Check it's not the debug hook */
3944cf49a43SJulian Elischer 	if ((pep = hook->private)) {
3954cf49a43SJulian Elischer 		pep->hook = NULL;
3964cf49a43SJulian Elischer 		if (pep->af == 0xffff) {
3974cf49a43SJulian Elischer 			/* If it is the downstream hook, stop the timers */
3984cf49a43SJulian Elischer 			untimeout(cisco_keepalive, sc, sc->handle);
3994cf49a43SJulian Elischer 		}
4004cf49a43SJulian Elischer 	}
4014cf49a43SJulian Elischer 
4024cf49a43SJulian Elischer 	/* If no more hooks, remove the node */
4034cf49a43SJulian Elischer 	if (hook->node->numhooks == 0)
4044cf49a43SJulian Elischer 		ng_rmnode(hook->node);
4054cf49a43SJulian Elischer 	return (0);
4064cf49a43SJulian Elischer }
4074cf49a43SJulian Elischer 
4084cf49a43SJulian Elischer /*
4094cf49a43SJulian Elischer  * Receive data
4104cf49a43SJulian Elischer  */
4114cf49a43SJulian Elischer static int
4124cf49a43SJulian Elischer cisco_input(sc_p sc, struct mbuf *m, meta_p meta)
4134cf49a43SJulian Elischer {
4144cf49a43SJulian Elischer 	struct cisco_header *h;
4154cf49a43SJulian Elischer 	struct cisco_packet *p;
4164cf49a43SJulian Elischer 	struct protoent *pep;
4174cf49a43SJulian Elischer 	int error = 0;
4184cf49a43SJulian Elischer 
4194cf49a43SJulian Elischer 	if (m->m_pkthdr.len <= CISCO_HEADER_LEN)
4204cf49a43SJulian Elischer 		goto drop;
4214cf49a43SJulian Elischer 
4224cf49a43SJulian Elischer 	/* Strip off cisco header */
4234cf49a43SJulian Elischer 	h = mtod(m, struct cisco_header *);
4244cf49a43SJulian Elischer 	m_adj(m, CISCO_HEADER_LEN);
4254cf49a43SJulian Elischer 
4264cf49a43SJulian Elischer 	switch (h->address) {
4274cf49a43SJulian Elischer 	default:		/* Invalid Cisco packet. */
4284cf49a43SJulian Elischer 		goto drop;
4294cf49a43SJulian Elischer 	case CISCO_UNICAST:
4304cf49a43SJulian Elischer 	case CISCO_MULTICAST:
4314cf49a43SJulian Elischer 		/* Don't check the control field here (RFC 1547). */
4324cf49a43SJulian Elischer 		switch (ntohs(h->protocol)) {
4334cf49a43SJulian Elischer 		default:
4344cf49a43SJulian Elischer 			goto drop;
4354cf49a43SJulian Elischer 		case CISCO_KEEPALIVE:
4364cf49a43SJulian Elischer 			p = mtod(m, struct cisco_packet *);
4374cf49a43SJulian Elischer 			switch (ntohl(p->type)) {
4384cf49a43SJulian Elischer 			default:
4394cf49a43SJulian Elischer 				log(LOG_WARNING,
4404cf49a43SJulian Elischer 				    "cisco: unknown cisco packet type: 0x%lx\n",
4414cf49a43SJulian Elischer 				       ntohl(p->type));
4424cf49a43SJulian Elischer 				break;
4434cf49a43SJulian Elischer 			case CISCO_ADDR_REPLY:
4444cf49a43SJulian Elischer 				/* Reply on address request, ignore */
4454cf49a43SJulian Elischer 				break;
4464cf49a43SJulian Elischer 			case CISCO_KEEPALIVE_REQ:
4474cf49a43SJulian Elischer 				sc->remote_seq = ntohl(p->par1);
4484cf49a43SJulian Elischer 				if (sc->local_seq == ntohl(p->par2)) {
4494cf49a43SJulian Elischer 					sc->local_seq++;
4504cf49a43SJulian Elischer 					sc->seq_retries = 0;
4514cf49a43SJulian Elischer 				}
4524cf49a43SJulian Elischer 				break;
4534cf49a43SJulian Elischer 			case CISCO_ADDR_REQ:
4544cf49a43SJulian Elischer 			    {
4554cf49a43SJulian Elischer 				struct ng_mesg *msg, *resp;
4564cf49a43SJulian Elischer 
4574cf49a43SJulian Elischer 				/* Ask inet peer for IP address information */
4584cf49a43SJulian Elischer 				if (sc->inet.hook == NULL)
4594cf49a43SJulian Elischer 					goto nomsg;
4604cf49a43SJulian Elischer 				NG_MKMESSAGE(msg, NGM_CISCO_COOKIE,
4614cf49a43SJulian Elischer 				    NGM_CISCO_GET_IPADDR, 0, M_NOWAIT);
4624cf49a43SJulian Elischer 				if (msg == NULL)
4634cf49a43SJulian Elischer 					goto nomsg;
4644cf49a43SJulian Elischer 				ng_send_msg(sc->node, msg,
4654cf49a43SJulian Elischer 				    NG_CISCO_HOOK_INET, &resp);
4664cf49a43SJulian Elischer 				if (resp != NULL)
4674cf49a43SJulian Elischer 					cisco_rcvmsg(sc->node, resp, ".", NULL);
4684cf49a43SJulian Elischer 
4694cf49a43SJulian Elischer 		nomsg:
4704cf49a43SJulian Elischer 				/* Send reply to peer device */
4714cf49a43SJulian Elischer 				error = cisco_send(sc, CISCO_ADDR_REPLY,
4724cf49a43SJulian Elischer 					    ntohl(sc->localip.s_addr),
4734cf49a43SJulian Elischer 					    ntohl(sc->localmask.s_addr));
4744cf49a43SJulian Elischer 				break;
4754cf49a43SJulian Elischer 			    }
4764cf49a43SJulian Elischer 			}
4774cf49a43SJulian Elischer 			goto drop;
4784cf49a43SJulian Elischer 		case ETHERTYPE_IP:
4794cf49a43SJulian Elischer 			pep = &sc->inet;
4804cf49a43SJulian Elischer 			break;
4814cf49a43SJulian Elischer 		case ETHERTYPE_AT:
4824cf49a43SJulian Elischer 			pep = &sc->atalk;
4834cf49a43SJulian Elischer 			break;
4844cf49a43SJulian Elischer 		case ETHERTYPE_IPX:
4854cf49a43SJulian Elischer 			pep = &sc->ipx;
4864cf49a43SJulian Elischer 			break;
4874cf49a43SJulian Elischer 		}
4884cf49a43SJulian Elischer 		break;
4894cf49a43SJulian Elischer 	}
4904cf49a43SJulian Elischer 
4914cf49a43SJulian Elischer 	/* Send it on */
4924cf49a43SJulian Elischer 	if (pep->hook == NULL)
4934cf49a43SJulian Elischer 		goto drop;
4944cf49a43SJulian Elischer 	NG_SEND_DATA(error, pep->hook, m, meta);
4954cf49a43SJulian Elischer 	return (error);
4964cf49a43SJulian Elischer 
4974cf49a43SJulian Elischer drop:
4984cf49a43SJulian Elischer 	NG_FREE_DATA(m, meta);
4994cf49a43SJulian Elischer 	return (error);
5004cf49a43SJulian Elischer }
5014cf49a43SJulian Elischer 
5024cf49a43SJulian Elischer 
5034cf49a43SJulian Elischer /*
5044cf49a43SJulian Elischer  * Send keepalive packets, every 10 seconds.
5054cf49a43SJulian Elischer  */
5064cf49a43SJulian Elischer static void
5074cf49a43SJulian Elischer cisco_keepalive(void *arg)
5084cf49a43SJulian Elischer {
5094cf49a43SJulian Elischer 	const sc_p sc = arg;
5104cf49a43SJulian Elischer 	int s = splimp();
5114cf49a43SJulian Elischer 
5124cf49a43SJulian Elischer 	cisco_send(sc, CISCO_KEEPALIVE_REQ, sc->local_seq, sc->remote_seq);
5134cf49a43SJulian Elischer 	sc->seq_retries++;
5144cf49a43SJulian Elischer 	splx(s);
5154cf49a43SJulian Elischer 	sc->handle = timeout(cisco_keepalive, sc, hz * KEEPALIVE_SECS);
5164cf49a43SJulian Elischer }
5174cf49a43SJulian Elischer 
5184cf49a43SJulian Elischer /*
5194cf49a43SJulian Elischer  * Send Cisco keepalive packet.
5204cf49a43SJulian Elischer  */
5214cf49a43SJulian Elischer static int
5224cf49a43SJulian Elischer cisco_send(sc_p sc, int type, long par1, long par2)
5234cf49a43SJulian Elischer {
5244cf49a43SJulian Elischer 	struct cisco_header *h;
5254cf49a43SJulian Elischer 	struct cisco_packet *ch;
5264cf49a43SJulian Elischer 	struct mbuf *m;
5274cf49a43SJulian Elischer 	u_long  t;
5284cf49a43SJulian Elischer 	int     error = 0;
5294cf49a43SJulian Elischer 	meta_p  meta = NULL;
5304cf49a43SJulian Elischer 	struct timeval time;
5314cf49a43SJulian Elischer 
5324cf49a43SJulian Elischer 	getmicrotime(&time);
5334cf49a43SJulian Elischer 
5344cf49a43SJulian Elischer 	MGETHDR(m, M_DONTWAIT, MT_DATA);
5354cf49a43SJulian Elischer 	if (!m)
5364cf49a43SJulian Elischer 		return (ENOBUFS);
5374cf49a43SJulian Elischer 
5384cf49a43SJulian Elischer 	t = (time.tv_sec - boottime.tv_sec) * 1000;
5394cf49a43SJulian Elischer 	m->m_pkthdr.len = m->m_len = CISCO_HEADER_LEN + CISCO_PACKET_LEN;
5404cf49a43SJulian Elischer 	m->m_pkthdr.rcvif = 0;
5414cf49a43SJulian Elischer 
5424cf49a43SJulian Elischer 	h = mtod(m, struct cisco_header *);
5434cf49a43SJulian Elischer 	h->address = CISCO_MULTICAST;
5444cf49a43SJulian Elischer 	h->control = 0;
5454cf49a43SJulian Elischer 	h->protocol = htons(CISCO_KEEPALIVE);
5464cf49a43SJulian Elischer 
5474cf49a43SJulian Elischer 	ch = (struct cisco_packet *) (h + 1);
5484cf49a43SJulian Elischer 	ch->type = htonl(type);
5494cf49a43SJulian Elischer 	ch->par1 = htonl(par1);
5504cf49a43SJulian Elischer 	ch->par2 = htonl(par2);
5514cf49a43SJulian Elischer 	ch->rel = -1;
5524cf49a43SJulian Elischer 	ch->time0 = htons((u_short) (t >> 16));
5534cf49a43SJulian Elischer 	ch->time1 = htons((u_short) t);
5544cf49a43SJulian Elischer 
5554cf49a43SJulian Elischer 	NG_SEND_DATA(error, sc->downstream.hook, m, meta);
5564cf49a43SJulian Elischer 	return (error);
5574cf49a43SJulian Elischer }
558