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