xref: /csrg-svn/sys/netiso/esis.c (revision 68541)
149268Sbostic /*-
263222Sbostic  * Copyright (c) 1991, 1993
363222Sbostic  *	The Regents of the University of California.  All rights reserved.
449268Sbostic  *
549268Sbostic  * %sccs.include.redist.c%
649268Sbostic  *
7*68541Ssklower  *	@(#)esis.c	8.3 (Berkeley) 03/20/95
849268Sbostic  */
949268Sbostic 
1036379Ssklower /***********************************************************
1136379Ssklower 		Copyright IBM Corporation 1987
1236379Ssklower 
1336379Ssklower                       All Rights Reserved
1436379Ssklower 
1536379Ssklower Permission to use, copy, modify, and distribute this software and its
1636379Ssklower documentation for any purpose and without fee is hereby granted,
1736379Ssklower provided that the above copyright notice appear in all copies and that
1836379Ssklower both that copyright notice and this permission notice appear in
1936379Ssklower supporting documentation, and that the name of IBM not be
2036379Ssklower used in advertising or publicity pertaining to distribution of the
2136379Ssklower software without specific, written prior permission.
2236379Ssklower 
2336379Ssklower IBM DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, INCLUDING
2436379Ssklower ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO EVENT SHALL
2536379Ssklower IBM BE LIABLE FOR ANY SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR
2636379Ssklower ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,
2736379Ssklower WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,
2836379Ssklower ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS
2936379Ssklower SOFTWARE.
3036379Ssklower 
3136379Ssklower ******************************************************************/
3236379Ssklower 
3336379Ssklower /*
3436379Ssklower  * ARGO Project, Computer Sciences Dept., University of Wisconsin - Madison
3536379Ssklower  */
3636379Ssklower 
3736379Ssklower #ifdef ISO
3836379Ssklower 
3956533Sbostic #include <sys/param.h>
4056533Sbostic #include <sys/systm.h>
4156533Sbostic #include <sys/mbuf.h>
4256533Sbostic #include <sys/domain.h>
4356533Sbostic #include <sys/protosw.h>
4456533Sbostic #include <sys/socket.h>
4556533Sbostic #include <sys/socketvar.h>
4656533Sbostic #include <sys/errno.h>
4756533Sbostic #include <sys/kernel.h>
4836379Ssklower 
4956533Sbostic #include <net/if.h>
5056533Sbostic #include <net/if_dl.h>
5156533Sbostic #include <net/route.h>
5256533Sbostic #include <net/raw_cb.h>
5336379Ssklower 
5456533Sbostic #include <netiso/iso.h>
5556533Sbostic #include <netiso/iso_pcb.h>
5656533Sbostic #include <netiso/iso_var.h>
5756533Sbostic #include <netiso/iso_snpac.h>
5856533Sbostic #include <netiso/clnl.h>
5956533Sbostic #include <netiso/clnp.h>
6056533Sbostic #include <netiso/clnp_stat.h>
6156533Sbostic #include <netiso/esis.h>
6256533Sbostic #include <netiso/argo_debug.h>
6336379Ssklower 
6436379Ssklower /*
6536379Ssklower  *	Global variables to esis implementation
6636379Ssklower  *
6736379Ssklower  *	esis_holding_time - the holding time (sec) parameter for outgoing pdus
6836379Ssklower  *	esis_config_time  - the frequency (sec) that hellos are generated
6943421Ssklower  *	esis_esconfig_time - suggested es configuration time placed in the
7043421Ssklower  *						ish.
7136379Ssklower  *
7236379Ssklower  */
7343421Ssklower struct rawcb	esis_pcb;
7458988Ssklower void				esis_config(), snpac_age();
7536379Ssklower int				esis_sendspace = 2048;
7636379Ssklower int				esis_recvspace = 2048;
7736379Ssklower short			esis_holding_time = ESIS_HT;
7836379Ssklower short			esis_config_time = ESIS_CONFIG;
7943421Ssklower short			esis_esconfig_time = ESIS_CONFIG;
8036379Ssklower extern int		iso_systype;
8143421Ssklower struct sockaddr_dl	esis_dl = { sizeof(esis_dl), AF_LINK };
8243332Ssklower extern char		all_es_snpa[], all_is_snpa[];
8336379Ssklower 
8437469Ssklower #define EXTEND_PACKET(m, mhdr, cp)\
8536379Ssklower 	if (((m)->m_next = m_getclr(M_DONTWAIT, MT_HEADER)) == NULL) {\
8636379Ssklower 		esis_stat.es_nomem++;\
8736379Ssklower 		m_freem(mhdr);\
8836379Ssklower 		return;\
8936379Ssklower 	} else {\
9036379Ssklower 		(m) = (m)->m_next;\
9136379Ssklower 		(cp) = mtod((m), caddr_t);\
92*68541Ssklower 		(m)->m_len = 0;\
9336379Ssklower 	}
9436379Ssklower /*
9536379Ssklower  * FUNCTION:		esis_init
9636379Ssklower  *
9736379Ssklower  * PURPOSE:			Initialize the kernel portion of esis protocol
9836379Ssklower  *
9936379Ssklower  * RETURNS:			nothing
10036379Ssklower  *
10136379Ssklower  * SIDE EFFECTS:
10236379Ssklower  *
10336379Ssklower  * NOTES:
10436379Ssklower  */
esis_init()10536379Ssklower esis_init()
10636379Ssklower {
10736379Ssklower 	extern struct clnl_protosw clnl_protox[256];
10843892Ssklower 	int	esis_input(), isis_input();
10936379Ssklower #ifdef	ISO_X25ESIS
11043892Ssklower 	int	x25esis_input();
11161300Ssklower #endif	/* ISO_X25ESIS */
11236379Ssklower 
11343421Ssklower 	esis_pcb.rcb_next = esis_pcb.rcb_prev = &esis_pcb;
11443421Ssklower 	llinfo_llc.lc_next = llinfo_llc.lc_prev = &llinfo_llc;
11536379Ssklower 
11636379Ssklower 	timeout(snpac_age, (caddr_t)0, hz);
11736379Ssklower 	timeout(esis_config, (caddr_t)0, hz);
11836379Ssklower 
11943892Ssklower 	clnl_protox[ISO9542_ESIS].clnl_input = esis_input;
12043892Ssklower 	clnl_protox[ISO10589_ISIS].clnl_input = isis_input;
12136379Ssklower #ifdef	ISO_X25ESIS
12236379Ssklower 	clnl_protox[ISO9542X25_ESIS].clnl_input = x25esis_input;
12361300Ssklower #endif	/* ISO_X25ESIS */
12436379Ssklower }
12536379Ssklower 
12636379Ssklower /*
12736379Ssklower  * FUNCTION:		esis_usrreq
12836379Ssklower  *
12936379Ssklower  * PURPOSE:			Handle user level esis requests
13036379Ssklower  *
13136379Ssklower  * RETURNS:			0 or appropriate errno
13236379Ssklower  *
13336379Ssklower  * SIDE EFFECTS:
13436379Ssklower  *
13536379Ssklower  */
13637469Ssklower /*ARGSUSED*/
13740775Ssklower esis_usrreq(so, req, m, nam, control)
13836379Ssklower struct socket	*so;		/* socket: used only to get to this code */
13936379Ssklower int				req;		/* request */
14036379Ssklower struct mbuf		*m;			/* data for request */
14136379Ssklower struct mbuf		*nam;		/* optional name */
14240775Ssklower struct mbuf		*control;	/* optional control */
14336379Ssklower {
14443421Ssklower 	struct rawcb *rp = sotorawcb(so);
14543421Ssklower 	int error = 0;
14643421Ssklower 
14750234Ssklower 	if ((so->so_state & SS_PRIV) == 0) {
14843421Ssklower 		error = EACCES;
14943421Ssklower 		goto release;
15043421Ssklower 	}
15143421Ssklower 	if (rp == NULL && req != PRU_ATTACH) {
15243421Ssklower 		error = EINVAL;
15343421Ssklower 		goto release;
15443421Ssklower 	}
15543421Ssklower 
15643421Ssklower 	switch (req) {
15743421Ssklower 	case PRU_ATTACH:
15843421Ssklower 		if (rp != NULL) {
15943421Ssklower 			error = EINVAL;
16043421Ssklower 			break;
16143421Ssklower 		}
16243421Ssklower 		MALLOC(rp, struct rawcb *, sizeof(*rp), M_PCB, M_WAITOK);
16343421Ssklower 		if (so->so_pcb = (caddr_t)rp) {
16443421Ssklower 			bzero(so->so_pcb, sizeof(*rp));
16543421Ssklower 			insque(rp, &esis_pcb);
16644946Ssklower 			rp->rcb_socket = so;
16743421Ssklower 			error = soreserve(so, esis_sendspace, esis_recvspace);
16843421Ssklower 		} else
16943421Ssklower 			error = ENOBUFS;
17043421Ssklower 		break;
17143421Ssklower 
17243421Ssklower 	case PRU_SEND:
17343421Ssklower 		if (nam == NULL) {
17443421Ssklower 			error = EINVAL;
17543421Ssklower 			break;
17643421Ssklower 		}
17743421Ssklower 		/* error checking here */
17843421Ssklower 		error = isis_output(mtod(nam,struct sockaddr_dl *), m);
17943421Ssklower 		m = NULL;
18043421Ssklower 		break;
18143421Ssklower 
18243421Ssklower 	case PRU_DETACH:
18343421Ssklower 		raw_detach(rp);
18443421Ssklower 		break;
18543421Ssklower 
18643421Ssklower 	case PRU_SHUTDOWN:
18743421Ssklower 		socantsendmore(so);
18843421Ssklower 		break;
18943421Ssklower 
19043421Ssklower 	case PRU_ABORT:
19143421Ssklower 		soisdisconnected(so);
19243421Ssklower 		raw_detach(rp);
19343421Ssklower 		break;
19443421Ssklower 
19543421Ssklower 	case PRU_SENSE:
19643421Ssklower 		return (0);
19743421Ssklower 
19843421Ssklower 	default:
19943421Ssklower 		return (EOPNOTSUPP);
20043421Ssklower 	}
20143421Ssklower release:
20236379Ssklower 	if (m != NULL)
20336379Ssklower 		m_freem(m);
20436379Ssklower 
20543421Ssklower 	return (error);
20636379Ssklower }
20736379Ssklower 
20836379Ssklower /*
20936379Ssklower  * FUNCTION:		esis_input
21036379Ssklower  *
21136379Ssklower  * PURPOSE:			Process an incoming esis packet
21236379Ssklower  *
21336379Ssklower  * RETURNS:			nothing
21436379Ssklower  *
21536379Ssklower  * SIDE EFFECTS:
21636379Ssklower  *
21736379Ssklower  * NOTES:
21836379Ssklower  */
21936379Ssklower esis_input(m0, shp)
22036379Ssklower struct mbuf		*m0;		/* ptr to first mbuf of pkt */
22136379Ssklower struct snpa_hdr	*shp;	/* subnetwork header */
22236379Ssklower {
22343421Ssklower 	register struct esis_fixed	*pdu = mtod(m0, struct esis_fixed *);
22437469Ssklower 	register int type;
22536379Ssklower 
22636379Ssklower 	/*
22736379Ssklower 	 *	check checksum if necessary
22836379Ssklower 	 */
22937469Ssklower 	if (ESIS_CKSUM_REQUIRED(pdu) && iso_check_csum(m0, (int)pdu->esis_hdr_len)) {
23036379Ssklower 		esis_stat.es_badcsum++;
23136379Ssklower 		goto bad;
23236379Ssklower 	}
23336379Ssklower 
23436379Ssklower 	/* check version */
23536379Ssklower 	if (pdu->esis_vers != ESIS_VERSION) {
23636379Ssklower 		esis_stat.es_badvers++;
23736379Ssklower 		goto bad;
23836379Ssklower 	}
23937469Ssklower 	type = pdu->esis_type & 0x1f;
24037469Ssklower 	switch (type) {
24136379Ssklower 		case ESIS_ESH:
24236379Ssklower 			esis_eshinput(m0, shp);
24343421Ssklower 			break;
24436379Ssklower 
24536379Ssklower 		case ESIS_ISH:
24636379Ssklower 			esis_ishinput(m0, shp);
24743421Ssklower 			break;
24836379Ssklower 
24936379Ssklower 		case ESIS_RD:
25036379Ssklower 			esis_rdinput(m0, shp);
25143421Ssklower 			break;
25236379Ssklower 
25343421Ssklower 		default:
25436379Ssklower 			esis_stat.es_badtype++;
25536379Ssklower 	}
25636379Ssklower 
25736379Ssklower bad:
25843421Ssklower 	if (esis_pcb.rcb_next != &esis_pcb)
25943421Ssklower 		isis_input(m0, shp);
26043421Ssklower 	else
26143421Ssklower 		m_freem(m0);
26236379Ssklower }
26336379Ssklower 
26436379Ssklower /*
26536379Ssklower  * FUNCTION:		esis_rdoutput
26636379Ssklower  *
26736379Ssklower  * PURPOSE:			Transmit a redirect pdu
26836379Ssklower  *
26936379Ssklower  * RETURNS:			nothing
27036379Ssklower  *
27136379Ssklower  * SIDE EFFECTS:
27236379Ssklower  *
27336379Ssklower  * NOTES:			Assumes there is enough space for fixed part of header,
27436379Ssklower  *					DA, BSNPA and NET in first mbuf.
27536379Ssklower  */
27643332Ssklower esis_rdoutput(inbound_shp, inbound_m, inbound_oidx, rd_dstnsap, rt)
27736379Ssklower struct snpa_hdr		*inbound_shp;	/* snpa hdr from incoming packet */
27836379Ssklower struct mbuf			*inbound_m;		/* incoming pkt itself */
27936379Ssklower struct clnp_optidx	*inbound_oidx;	/* clnp options assoc with incoming pkt */
28036379Ssklower struct iso_addr		*rd_dstnsap;	/* ultimate destination of pkt */
28143332Ssklower struct rtentry		*rt;			/* snpa cache info regarding next hop of
28236379Ssklower 										pkt */
28336379Ssklower {
28436379Ssklower 	struct mbuf			*m, *m0;
28536379Ssklower 	caddr_t				cp;
28636379Ssklower 	struct esis_fixed	*pdu;
28736379Ssklower 	int					len, total_len = 0;
28836379Ssklower 	struct sockaddr_iso	siso;
28936379Ssklower 	struct ifnet 		*ifp = inbound_shp->snh_ifp;
29043332Ssklower 	struct sockaddr_dl *sdl;
29143332Ssklower 	struct iso_addr *rd_gwnsap;
29236379Ssklower 
29343332Ssklower 	if (rt->rt_flags & RTF_GATEWAY) {
29443332Ssklower 		rd_gwnsap = &((struct sockaddr_iso *)rt->rt_gateway)->siso_addr;
29543332Ssklower 		rt = rtalloc1(rt->rt_gateway, 0);
29643332Ssklower 	} else
29743332Ssklower 		rd_gwnsap = &((struct sockaddr_iso *)rt_key(rt))->siso_addr;
29843332Ssklower 	if (rt == 0 || (sdl = (struct sockaddr_dl *)rt->rt_gateway) == 0 ||
29943332Ssklower 		sdl->sdl_family != AF_LINK) {
30043332Ssklower 		/* maybe we should have a function that you
30143332Ssklower 		   could put in the iso_ifaddr structure
30243332Ssklower 		   which could translate iso_addrs into snpa's
30343332Ssklower 		   where there is a known mapping for that address type */
30443332Ssklower 		esis_stat.es_badtype++;
30543332Ssklower 		return;
30643332Ssklower 	}
30736379Ssklower 	esis_stat.es_rdsent++;
30836379Ssklower 	IFDEBUG(D_ESISOUTPUT)
30936379Ssklower 		printf("esis_rdoutput: ifp x%x (%s%d), ht %d, m x%x, oidx x%x\n",
31036379Ssklower 			ifp, ifp->if_name, ifp->if_unit, esis_holding_time, inbound_m,
31136379Ssklower 			inbound_oidx);
31236379Ssklower 		printf("\tdestination: %s\n", clnp_iso_addrp(rd_dstnsap));
31343332Ssklower 		printf("\tredirected toward:%s\n", clnp_iso_addrp(rd_gwnsap));
31436379Ssklower 	ENDDEBUG
31536379Ssklower 
31637469Ssklower 	if ((m0 = m = m_gethdr(M_DONTWAIT, MT_HEADER)) == NULL) {
31736379Ssklower 		esis_stat.es_nomem++;
31836379Ssklower 		return;
31936379Ssklower 	}
32037469Ssklower 	bzero(mtod(m, caddr_t), MHLEN);
32136379Ssklower 
32236379Ssklower 	pdu = mtod(m, struct esis_fixed *);
32337469Ssklower 	cp = (caddr_t)(pdu + 1); /*pointer arith.; 1st byte after header */
32436379Ssklower 	len = sizeof(struct esis_fixed);
32536379Ssklower 
32636379Ssklower 	/*
32736379Ssklower 	 *	Build fixed part of header
32836379Ssklower 	 */
32936379Ssklower 	pdu->esis_proto_id = ISO9542_ESIS;
33036379Ssklower 	pdu->esis_vers = ESIS_VERSION;
33136379Ssklower 	pdu->esis_type = ESIS_RD;
33236379Ssklower 	HTOC(pdu->esis_ht_msb, pdu->esis_ht_lsb, esis_holding_time);
33336379Ssklower 
33436379Ssklower 	/* Insert destination address */
33543072Ssklower 	(void) esis_insert_addr(&cp, &len, rd_dstnsap, m, 0);
33636379Ssklower 
33736379Ssklower 	/* Insert the snpa of better next hop */
33843332Ssklower 	*cp++ = sdl->sdl_alen;
33943332Ssklower 	bcopy(LLADDR(sdl), cp, sdl->sdl_alen);
34043332Ssklower 	cp += sdl->sdl_alen;
34143332Ssklower 	len += (sdl->sdl_alen + 1);
34236379Ssklower 
34336379Ssklower 	/*
34436379Ssklower 	 *	If the next hop is not the destination, then it ought to be
34536379Ssklower 	 *	an IS and it should be inserted next. Else, set the
34636379Ssklower 	 *	NETL to 0
34736379Ssklower 	 */
34836379Ssklower 	/* PHASE2 use mask from ifp of outgoing interface */
34943332Ssklower 	if (!iso_addrmatch1(rd_dstnsap, rd_gwnsap)) {
35043332Ssklower 		/* this should not happen:
35136379Ssklower 		if ((nhop_sc->sc_flags & SNPA_IS) == 0) {
35236379Ssklower 			printf("esis_rdoutput: next hop is not dst and not an IS\n");
35336379Ssklower 			m_freem(m0);
35436379Ssklower 			return;
35543332Ssklower 		} */
35643332Ssklower 		(void) esis_insert_addr(&cp, &len, rd_gwnsap, m, 0);
35736379Ssklower 	} else {
35836379Ssklower 		*cp++ = 0;	/* NETL */
35936379Ssklower 		len++;
36036379Ssklower 	}
36137469Ssklower 	m->m_len = len;
36236379Ssklower 
36336379Ssklower 	/*
36436379Ssklower 	 *	PHASE2
36536379Ssklower 	 *	If redirect is to an IS, add an address mask. The mask to be
36636379Ssklower 	 *	used should be the mask present in the routing entry used to
36736379Ssklower 	 *	forward the original data packet.
36836379Ssklower 	 */
36936379Ssklower 
37036379Ssklower 	/*
37136379Ssklower 	 *	Copy Qos, priority, or security options present in original npdu
37236379Ssklower 	 */
37336379Ssklower 	if (inbound_oidx) {
37443332Ssklower 		/* THIS CODE IS CURRENTLY (mostly) UNTESTED */
37536379Ssklower 		int optlen = 0;
37636379Ssklower 		if (inbound_oidx->cni_qos_formatp)
37736379Ssklower 			optlen += (inbound_oidx->cni_qos_len + 2);
37836379Ssklower 		if (inbound_oidx->cni_priorp)	/* priority option is 1 byte long */
37936379Ssklower 			optlen += 3;
38036379Ssklower 		if (inbound_oidx->cni_securep)
38136379Ssklower 			optlen += (inbound_oidx->cni_secure_len + 2);
38237469Ssklower 		if (M_TRAILINGSPACE(m) < optlen) {
38337469Ssklower 			EXTEND_PACKET(m, m0, cp);
38437469Ssklower 			m->m_len = 0;
38536379Ssklower 			/* assumes MLEN > optlen */
38636379Ssklower 		}
38736379Ssklower 		/* assume MLEN-len > optlen */
38836379Ssklower 		/*
38936379Ssklower 		 *	When copying options, copy from ptr - 2 in order to grab
39036379Ssklower 		 *	the option code and length
39136379Ssklower 		 */
39236379Ssklower 		if (inbound_oidx->cni_qos_formatp) {
39343332Ssklower 			bcopy(mtod(inbound_m, caddr_t) + inbound_oidx->cni_qos_formatp - 2,
39443332Ssklower 				cp, (unsigned)(inbound_oidx->cni_qos_len + 2));
39543332Ssklower 			cp += inbound_oidx->cni_qos_len + 2;
39636379Ssklower 		}
39736379Ssklower 		if (inbound_oidx->cni_priorp) {
39843332Ssklower 			bcopy(mtod(inbound_m, caddr_t) + inbound_oidx->cni_priorp - 2,
39943332Ssklower 					cp, 3);
40043332Ssklower 			cp += 3;
40136379Ssklower 		}
40236379Ssklower 		if (inbound_oidx->cni_securep) {
40343332Ssklower 			bcopy(mtod(inbound_m, caddr_t) + inbound_oidx->cni_securep - 2, cp,
40437469Ssklower 				(unsigned)(inbound_oidx->cni_secure_len + 2));
40543332Ssklower 			cp += inbound_oidx->cni_secure_len + 2;
40636379Ssklower 		}
40737469Ssklower 		m->m_len += optlen;
40843332Ssklower 		len += optlen;
40936379Ssklower 	}
41036379Ssklower 
41137469Ssklower 	pdu->esis_hdr_len = m0->m_pkthdr.len = len;
41236379Ssklower 	iso_gen_csum(m0, ESIS_CKSUM_OFF, (int)pdu->esis_hdr_len);
41336379Ssklower 
41437469Ssklower 	bzero((caddr_t)&siso, sizeof(siso));
41536379Ssklower 	siso.siso_family = AF_ISO;
41637469Ssklower 	siso.siso_data[0] = AFI_SNA;
41737469Ssklower 	siso.siso_nlen = 6 + 1;	/* should be taken from snpa_hdr */
41836379Ssklower 										/* +1 is for AFI */
41937469Ssklower 	bcopy(inbound_shp->snh_shost, siso.siso_data + 1, 6);
42052625Ssklower 	(ifp->if_output)(ifp, m0, (struct sockaddr *)&siso, 0);
42136379Ssklower }
42236379Ssklower 
42336379Ssklower /*
42436379Ssklower  * FUNCTION:		esis_insert_addr
42536379Ssklower  *
42636379Ssklower  * PURPOSE:			Insert an iso_addr into a buffer
42736379Ssklower  *
42836379Ssklower  * RETURNS:			true if buffer was big enough, else false
42936379Ssklower  *
43036379Ssklower  * SIDE EFFECTS:	Increment buf & len according to size of iso_addr
43136379Ssklower  *
43236379Ssklower  * NOTES:			Plus 1 here is for length byte
43336379Ssklower  */
esis_insert_addr(buf,len,isoa,m,nsellen)43443072Ssklower esis_insert_addr(buf, len, isoa, m, nsellen)
43543332Ssklower register caddr_t			*buf;		/* ptr to buffer to put address into */
43643332Ssklower int							*len;		/* ptr to length of buffer so far */
43743332Ssklower register struct iso_addr	*isoa;		/* ptr to address */
43843332Ssklower register struct mbuf		*m;			/* determine if there remains space */
43943332Ssklower int							nsellen;
44036379Ssklower {
44143332Ssklower 	register int newlen, result = 0;
44236379Ssklower 
44343332Ssklower 	isoa->isoa_len -= nsellen;
44443332Ssklower 	newlen = isoa->isoa_len + 1;
44543332Ssklower 	if (newlen <=  M_TRAILINGSPACE(m)) {
44643332Ssklower 		bcopy((caddr_t)isoa, *buf, newlen);
44743332Ssklower 		*len += newlen;
44843332Ssklower 		*buf += newlen;
44943332Ssklower 		m->m_len += newlen;
45043332Ssklower 		result = 1;
45143332Ssklower 	}
45243332Ssklower 	isoa->isoa_len += nsellen;
45343332Ssklower 	return (result);
45436379Ssklower }
45536379Ssklower 
45639950Ssklower #define ESIS_EXTRACT_ADDR(d, b) { d = (struct iso_addr *)(b); b += (1 + *b); \
45739950Ssklower 	    if (b > buflim) {esis_stat.es_toosmall++; goto bad;}}
45839950Ssklower #define ESIS_NEXT_OPTION(b)	{ b += (2 + b[1]); \
45939950Ssklower 	    if (b > buflim) {esis_stat.es_toosmall++; goto bad;}}
46043430Ssklower int ESHonly = 0;
46136379Ssklower /*
46236379Ssklower 
46336379Ssklower /*
46436379Ssklower  * FUNCTION:		esis_eshinput
46536379Ssklower  *
46636379Ssklower  * PURPOSE:			Process an incoming ESH pdu
46736379Ssklower  *
46836379Ssklower  * RETURNS:			nothing
46936379Ssklower  *
47036379Ssklower  * SIDE EFFECTS:
47136379Ssklower  *
47236379Ssklower  * NOTES:
47336379Ssklower  */
47436379Ssklower esis_eshinput(m, shp)
47536379Ssklower struct mbuf		*m;	/* esh pdu */
47636379Ssklower struct snpa_hdr	*shp;	/* subnetwork header */
47736379Ssklower {
47843072Ssklower 	struct	esis_fixed	*pdu = mtod(m, struct esis_fixed *);
47936379Ssklower 	u_short				ht;		/* holding time */
48043072Ssklower 	struct	iso_addr	*nsap;
48139950Ssklower 	int					naddr;
48237469Ssklower 	u_char				*buf = (u_char *)(pdu + 1);
48339950Ssklower 	u_char				*buflim = pdu->esis_hdr_len + (u_char *)pdu;
48443332Ssklower 	int					new_entry = 0;
48536379Ssklower 
48636379Ssklower 	esis_stat.es_eshrcvd++;
48736379Ssklower 
48836379Ssklower 	CTOH(pdu->esis_ht_msb, pdu->esis_ht_lsb, ht);
48936379Ssklower 
49039950Ssklower 	naddr = *buf++;
49139950Ssklower 	if (buf >= buflim)
49236379Ssklower 		goto bad;
49343332Ssklower 	if (naddr == 1) {
49439950Ssklower 		ESIS_EXTRACT_ADDR(nsap, buf);
49543332Ssklower 		new_entry = snpac_add(shp->snh_ifp,
49643332Ssklower 								 nsap, shp->snh_shost, SNPA_ES, ht, 0);
49743332Ssklower 	} else {
49843332Ssklower 		int nsellength = 0, nlen = 0;
49943332Ssklower 		{
50043332Ssklower 		/* See if we want to compress out multiple nsaps differing
50143332Ssklower 		   only by nsel */
50243332Ssklower 			register struct ifaddr *ifa = shp->snh_ifp->if_addrlist;
50343332Ssklower 			for (; ifa; ifa = ifa->ifa_next)
50443332Ssklower 				if (ifa->ifa_addr->sa_family == AF_ISO) {
50543332Ssklower 					nsellength = ((struct iso_ifaddr *)ifa)->ia_addr.siso_tlen;
50643332Ssklower 					break;
50743332Ssklower 			}
50843332Ssklower 		}
50939950Ssklower 		IFDEBUG(D_ESISINPUT)
51043332Ssklower 			printf("esis_eshinput: esh: ht %d, naddr %d nsellength %d\n",
51143332Ssklower 					ht, naddr, nsellength);
51239950Ssklower 		ENDDEBUG
51343332Ssklower 		while (naddr-- > 0) {
51443332Ssklower 			struct iso_addr *nsap2; u_char *buf2;
51543332Ssklower 			ESIS_EXTRACT_ADDR(nsap, buf);
51643332Ssklower 			/* see if there is at least one more nsap in ESH differing
51743332Ssklower 			   only by nsel */
51843332Ssklower 			if (nsellength != 0) for (buf2 = buf; buf2 < buflim;) {
51943332Ssklower 				ESIS_EXTRACT_ADDR(nsap2, buf2);
52043332Ssklower 				IFDEBUG(D_ESISINPUT)
52143332Ssklower 					printf("esis_eshinput: comparing %s ",
52243332Ssklower 						clnp_iso_addrp(nsap));
52343332Ssklower 					printf("and %s\n", clnp_iso_addrp(nsap2));
52443332Ssklower 				ENDDEBUG
52543332Ssklower 				if (Bcmp(nsap->isoa_genaddr, nsap2->isoa_genaddr,
52643332Ssklower 						 nsap->isoa_len - nsellength) == 0) {
52743332Ssklower 					nlen = nsellength;
52843332Ssklower 					break;
52943332Ssklower 				}
53043332Ssklower 			}
53143332Ssklower 			new_entry |= snpac_add(shp->snh_ifp,
53243332Ssklower 									nsap, shp->snh_shost, SNPA_ES, ht, nlen);
53343332Ssklower 			nlen = 0;
53443332Ssklower 		}
53539950Ssklower 	}
53643332Ssklower 	IFDEBUG(D_ESISINPUT)
53743332Ssklower 		printf("esis_eshinput: nsap %s is %s\n",
53843332Ssklower 			clnp_iso_addrp(nsap), new_entry ? "new" : "old");
53943332Ssklower 	ENDDEBUG
54043332Ssklower 	if (new_entry && (iso_systype & SNPA_IS))
54143332Ssklower 		esis_shoutput(shp->snh_ifp, ESIS_ISH, esis_holding_time,
54243332Ssklower 						shp->snh_shost, 6, (struct iso_addr *)0);
54337469Ssklower bad:
54439950Ssklower 	return;
54536379Ssklower }
54636379Ssklower 
54736379Ssklower /*
54836379Ssklower  * FUNCTION:		esis_ishinput
54936379Ssklower  *
55036379Ssklower  * PURPOSE:			process an incoming ISH pdu
55136379Ssklower  *
55236379Ssklower  * RETURNS:
55336379Ssklower  *
55436379Ssklower  * SIDE EFFECTS:
55536379Ssklower  *
55636379Ssklower  * NOTES:
55736379Ssklower  */
55836379Ssklower esis_ishinput(m, shp)
55936379Ssklower struct mbuf		*m;	/* esh pdu */
56036379Ssklower struct snpa_hdr	*shp;	/* subnetwork header */
56136379Ssklower {
56236379Ssklower 	struct esis_fixed	*pdu = mtod(m, struct esis_fixed *);
56343430Ssklower 	u_short				ht, newct;			/* holding time */
56439950Ssklower 	struct iso_addr		*nsap; 				/* Network Entity Title */
56539950Ssklower 	register u_char		*buf = (u_char *) (pdu + 1);
56639950Ssklower 	register u_char		*buflim = pdu->esis_hdr_len + (u_char *)pdu;
56739950Ssklower 	int					new_entry;
56836379Ssklower 
56936379Ssklower 	esis_stat.es_ishrcvd++;
57036379Ssklower 	CTOH(pdu->esis_ht_msb, pdu->esis_ht_lsb, ht);
57136379Ssklower 
57236379Ssklower 	IFDEBUG(D_ESISINPUT)
57336379Ssklower 		printf("esis_ishinput: ish: ht %d\n", ht);
57436379Ssklower 	ENDDEBUG
57539950Ssklower 	if (ESHonly)
57637469Ssklower 		goto bad;
57736379Ssklower 
57839950Ssklower 	ESIS_EXTRACT_ADDR(nsap, buf);
57939950Ssklower 
58039950Ssklower 	while (buf < buflim) {
58139950Ssklower 		switch (*buf) {
58237469Ssklower 		case ESISOVAL_ESCT:
58344946Ssklower 			if (iso_systype & SNPA_IS)
58444946Ssklower 				break;
58539950Ssklower 			if (buf[1] != 2)
58637469Ssklower 				goto bad;
58743430Ssklower 			CTOH(buf[2], buf[3], newct);
58843430Ssklower 			if (esis_config_time != newct) {
58943430Ssklower 				untimeout(esis_config,0);
59043430Ssklower 				esis_config_time = newct;
59143430Ssklower 				esis_config();
59243430Ssklower 			}
59339950Ssklower 			break;
59439950Ssklower 
59539950Ssklower 		default:
59639950Ssklower 			printf("Unknown ISH option: %x\n", *buf);
59737469Ssklower 		}
59839950Ssklower 		ESIS_NEXT_OPTION(buf);
59937469Ssklower 	}
60043332Ssklower 	new_entry = snpac_add(shp->snh_ifp, nsap, shp->snh_shost, SNPA_IS, ht, 0);
60137469Ssklower 	IFDEBUG(D_ESISINPUT)
60237469Ssklower 		printf("esis_ishinput: nsap %s is %s\n",
60337469Ssklower 			clnp_iso_addrp(nsap), new_entry ? "new" : "old");
60437469Ssklower 	ENDDEBUG
60537469Ssklower 
60637469Ssklower 	if (new_entry)
60737469Ssklower 		esis_shoutput(shp->snh_ifp,
60837469Ssklower 			iso_systype & SNPA_ES ? ESIS_ESH : ESIS_ISH,
60943332Ssklower 			esis_holding_time, shp->snh_shost, 6, (struct iso_addr *)0);
61039950Ssklower bad:
61139950Ssklower 	return;
61236379Ssklower }
61336379Ssklower 
61436379Ssklower /*
61536379Ssklower  * FUNCTION:		esis_rdinput
61636379Ssklower  *
61736379Ssklower  * PURPOSE:			Process an incoming RD pdu
61836379Ssklower  *
61936379Ssklower  * RETURNS:
62036379Ssklower  *
62136379Ssklower  * SIDE EFFECTS:
62236379Ssklower  *
62336379Ssklower  * NOTES:
62436379Ssklower  */
62536379Ssklower esis_rdinput(m0, shp)
62636379Ssklower struct mbuf		*m0;	/* esh pdu */
62736379Ssklower struct snpa_hdr	*shp;	/* subnetwork header */
62836379Ssklower {
62936379Ssklower 	struct esis_fixed	*pdu = mtod(m0, struct esis_fixed *);
63036379Ssklower 	u_short				ht;		/* holding time */
63139950Ssklower 	struct iso_addr		*da, *net = 0, *netmask = 0, *snpamask = 0;
63239950Ssklower 	register struct iso_addr *bsnpa;
63339950Ssklower 	register u_char		*buf = (u_char *)(pdu + 1);
63439950Ssklower 	register u_char		*buflim = pdu->esis_hdr_len + (u_char *)pdu;
63536379Ssklower 
63636379Ssklower 	esis_stat.es_rdrcvd++;
63736379Ssklower 
63836379Ssklower 	/* intermediate systems ignore redirects */
63936379Ssklower 	if (iso_systype & SNPA_IS)
64043421Ssklower 		return;
64139950Ssklower 	if (ESHonly)
64243421Ssklower 		return;
64336379Ssklower 
64436379Ssklower 	CTOH(pdu->esis_ht_msb, pdu->esis_ht_lsb, ht);
64539950Ssklower 	if (buf >= buflim)
64643421Ssklower 		return;
64736379Ssklower 
64836379Ssklower 	/* Extract DA */
64939950Ssklower 	ESIS_EXTRACT_ADDR(da, buf);
65037469Ssklower 
65136379Ssklower 	/* Extract better snpa */
65239950Ssklower 	ESIS_EXTRACT_ADDR(bsnpa, buf);
65339950Ssklower 
65437469Ssklower 	/* Extract NET if present */
65539950Ssklower 	if (buf < buflim) {
65643332Ssklower 		if (*buf == 0)
65743332Ssklower 			buf++; /* no NET present, skip NETL anyway */
65843332Ssklower 		else
65943332Ssklower 			ESIS_EXTRACT_ADDR(net, buf);
66036379Ssklower 	}
66136379Ssklower 
66237469Ssklower 	/* process options */
66339950Ssklower 	while (buf < buflim) {
66439950Ssklower 		switch (*buf) {
66537469Ssklower 		case ESISOVAL_SNPAMASK:
66637469Ssklower 			if (snpamask) /* duplicate */
66743421Ssklower 				return;
66839950Ssklower 			snpamask = (struct iso_addr *)(buf + 1);
66937469Ssklower 			break;
67037469Ssklower 
67137469Ssklower 		case ESISOVAL_NETMASK:
67237469Ssklower 			if (netmask) /* duplicate */
67343421Ssklower 				return;
67439950Ssklower 			netmask = (struct iso_addr *)(buf + 1);
67539950Ssklower 			break;
67639950Ssklower 
67739950Ssklower 		default:
67839950Ssklower 			printf("Unknown option in ESIS RD (0x%x)\n", buf[-1]);
67937469Ssklower 		}
68039950Ssklower 		ESIS_NEXT_OPTION(buf);
68136379Ssklower 	}
68236379Ssklower 
68336379Ssklower 	IFDEBUG(D_ESISINPUT)
68437469Ssklower 		printf("esis_rdinput: rd: ht %d, da %s\n", ht, clnp_iso_addrp(da));
68537469Ssklower 		if (net)
68637469Ssklower 			printf("\t: net %s\n", clnp_iso_addrp(net));
68736379Ssklower 	ENDDEBUG
68836379Ssklower 	/*
68936379Ssklower 	 *	If netl is zero, then redirect is to an ES. We need to add an entry
69036379Ssklower 	 *	to the snpa cache for (destination, better snpa).
69136379Ssklower 	 *	If netl is not zero, then the redirect is to an IS. In this
69236379Ssklower 	 *	case, add an snpa cache entry for (net, better snpa).
69336379Ssklower 	 *
69436379Ssklower 	 *	If the redirect is to an IS, add a route entry towards that
69536379Ssklower 	 *	IS.
69636379Ssklower 	 */
69739950Ssklower 	if (net == 0 || net->isoa_len == 0 || snpamask) {
69836379Ssklower 		/* redirect to an ES */
69939950Ssklower 		snpac_add(shp->snh_ifp, da,
70043332Ssklower 				bsnpa->isoa_genaddr, SNPA_ES, ht, 0);
70136379Ssklower 	} else {
70239950Ssklower 		snpac_add(shp->snh_ifp, net,
70343332Ssklower 				bsnpa->isoa_genaddr, SNPA_IS, ht, 0);
70439950Ssklower 		snpac_addrt(shp->snh_ifp, da, net, netmask);
70536379Ssklower 	}
70643421Ssklower bad: ;    /* Needed by ESIS_NEXT_OPTION */
70736379Ssklower }
70836379Ssklower 
70936379Ssklower /*
71036379Ssklower  * FUNCTION:		esis_config
71136379Ssklower  *
71236379Ssklower  * PURPOSE:			Report configuration
71336379Ssklower  *
71436379Ssklower  * RETURNS:
71536379Ssklower  *
71636379Ssklower  * SIDE EFFECTS:
71736379Ssklower  *
71836379Ssklower  * NOTES:			Called every esis_config_time seconds
71936379Ssklower  */
72058988Ssklower void
esis_config()72136379Ssklower esis_config()
72236379Ssklower {
72336379Ssklower 	register struct ifnet	*ifp;
72436379Ssklower 
72536379Ssklower 	timeout(esis_config, (caddr_t)0, hz * esis_config_time);
72636379Ssklower 
72736379Ssklower 	/*
72836379Ssklower 	 *	Report configuration for each interface that
72936379Ssklower 	 *	- is UP
73048963Ssklower 	 *	- has BROADCAST capability
73136379Ssklower 	 *	- has an ISO address
73236379Ssklower 	 */
73348963Ssklower 	/* Todo: a better way would be to construct the esh or ish
73448963Ssklower 	 * once and copy it out for all devices, possibly calling
73548963Ssklower 	 * a method in the iso_ifaddr structure to encapsulate and
73648963Ssklower 	 * transmit it.  This could work to advantage for non-broadcast media
73748963Ssklower 	 */
73836379Ssklower 
73936379Ssklower 	for (ifp = ifnet; ifp; ifp = ifp->if_next) {
74036379Ssklower 		if ((ifp->if_flags & IFF_UP) &&
74148963Ssklower 		    (ifp->if_flags & IFF_BROADCAST)) {
74236379Ssklower 			/* search for an ISO address family */
74336379Ssklower 			struct ifaddr	*ia;
74436379Ssklower 
74536379Ssklower 			for (ia = ifp->if_addrlist; ia; ia = ia->ifa_next) {
74637469Ssklower 				if (ia->ifa_addr->sa_family == AF_ISO) {
74736379Ssklower 					esis_shoutput(ifp,
74836379Ssklower 						iso_systype & SNPA_ES ? ESIS_ESH : ESIS_ISH,
74936379Ssklower 						esis_holding_time,
75043332Ssklower 						(caddr_t)(iso_systype & SNPA_ES ? all_is_snpa :
75143332Ssklower 						all_es_snpa), 6, (struct iso_addr *)0);
75236379Ssklower 					break;
75336379Ssklower 				}
75436379Ssklower 			}
75536379Ssklower 		}
75636379Ssklower 	}
75736379Ssklower }
75836379Ssklower 
75936379Ssklower /*
76036379Ssklower  * FUNCTION:		esis_shoutput
76136379Ssklower  *
76236379Ssklower  * PURPOSE:			Transmit an esh or ish pdu
76336379Ssklower  *
76436379Ssklower  * RETURNS:			nothing
76536379Ssklower  *
76636379Ssklower  * SIDE EFFECTS:
76736379Ssklower  *
76836379Ssklower  * NOTES:
76936379Ssklower  */
77043332Ssklower esis_shoutput(ifp, type, ht, sn_addr, sn_len, isoa)
77136379Ssklower struct ifnet	*ifp;
77236379Ssklower int				type;
77336379Ssklower short			ht;
77436379Ssklower caddr_t 		sn_addr;
77536379Ssklower int				sn_len;
77643332Ssklower struct	iso_addr *isoa;
77736379Ssklower {
77836379Ssklower 	struct mbuf			*m, *m0;
77936379Ssklower 	caddr_t				cp, naddrp;
78036379Ssklower 	int					naddr = 0;
78136379Ssklower 	struct esis_fixed	*pdu;
78243332Ssklower 	struct iso_ifaddr	*ia;
78337469Ssklower 	int					len;
78436379Ssklower 	struct sockaddr_iso	siso;
78536379Ssklower 
78636379Ssklower 	if (type == ESIS_ESH)
78736379Ssklower 		esis_stat.es_eshsent++;
78836379Ssklower 	else if (type == ESIS_ISH)
78936379Ssklower 		esis_stat.es_ishsent++;
79036379Ssklower 	else {
79136379Ssklower 		printf("esis_shoutput: bad pdu type\n");
79236379Ssklower 		return;
79336379Ssklower 	}
79436379Ssklower 
79536379Ssklower 	IFDEBUG(D_ESISOUTPUT)
79636379Ssklower 		int	i;
79736379Ssklower 		printf("esis_shoutput: ifp x%x (%s%d), %s, ht %d, to: [%d] ",
79836379Ssklower 			ifp, ifp->if_name, ifp->if_unit, type == ESIS_ESH ? "esh" : "ish",
79936379Ssklower 			ht, sn_len);
80036379Ssklower 		for (i=0; i<sn_len; i++)
80136379Ssklower 			printf("%x%c", *(sn_addr+i), i < (sn_len-1) ? ':' : ' ');
80236379Ssklower 		printf("\n");
80336379Ssklower 	ENDDEBUG
80436379Ssklower 
80537469Ssklower 	if ((m0 = m = m_gethdr(M_DONTWAIT, MT_HEADER)) == NULL) {
80636379Ssklower 		esis_stat.es_nomem++;
80736379Ssklower 		return;
80836379Ssklower 	}
80937469Ssklower 	bzero(mtod(m, caddr_t), MHLEN);
81036379Ssklower 
81136379Ssklower 	pdu = mtod(m, struct esis_fixed *);
81237469Ssklower 	naddrp = cp = (caddr_t)(pdu + 1);
81336379Ssklower 	len = sizeof(struct esis_fixed);
81436379Ssklower 
81536379Ssklower 	/*
81636379Ssklower 	 *	Build fixed part of header
81736379Ssklower 	 */
81836379Ssklower 	pdu->esis_proto_id = ISO9542_ESIS;
81936379Ssklower 	pdu->esis_vers = ESIS_VERSION;
82036379Ssklower 	pdu->esis_type = type;
82136379Ssklower 	HTOC(pdu->esis_ht_msb, pdu->esis_ht_lsb, ht);
82236379Ssklower 
82336379Ssklower 	if (type == ESIS_ESH) {
82436379Ssklower 		cp++;
82536379Ssklower 		len++;
82636379Ssklower 	}
82736379Ssklower 
82837469Ssklower 	m->m_len = len;
82943332Ssklower 	if (isoa) {
83043332Ssklower 		/*
83143332Ssklower 		 * Here we are responding to a clnp packet sent to an NSAP
83243332Ssklower 		 * that is ours which was sent to the MAC addr all_es's.
83343332Ssklower 		 * It is possible that we did not specifically advertise this
83443332Ssklower 		 * NSAP, even though it is ours, so we will respond
83543332Ssklower 		 * directly to the sender that we are here.  If we do have
83643332Ssklower 		 * multiple NSEL's we'll tack them on so he can compress them out.
83743332Ssklower 		 */
83843332Ssklower 		(void) esis_insert_addr(&cp, &len, isoa, m, 0);
83943332Ssklower 		naddr = 1;
84043332Ssklower 	}
84143332Ssklower 	for (ia = iso_ifaddr; ia; ia = ia->ia_next) {
84243332Ssklower 		int nsellen = (type == ESIS_ISH ? ia->ia_addr.siso_tlen : 0);
84343332Ssklower 		int n = ia->ia_addr.siso_nlen;
84443332Ssklower 		register struct iso_ifaddr *ia2;
84543332Ssklower 
84643332Ssklower 		if (type == ESIS_ISH && naddr > 0)
84743332Ssklower 			break;
84843332Ssklower 		for (ia2 = iso_ifaddr; ia2 != ia; ia2 = ia2->ia_next)
84943332Ssklower 			if (Bcmp(ia->ia_addr.siso_data, ia2->ia_addr.siso_data, n) == 0)
85043332Ssklower 					break;
85143332Ssklower 		if (ia2 != ia)
85243332Ssklower 			continue;	/* Means we have previously copied this nsap */
85343332Ssklower 		if (isoa && Bcmp(ia->ia_addr.siso_data, isoa->isoa_genaddr, n) == 0) {
85443332Ssklower 			isoa = 0;
85543332Ssklower 			continue;	/* Ditto */
85636379Ssklower 		}
85743332Ssklower 		IFDEBUG(D_ESISOUTPUT)
85843332Ssklower 			printf("esis_shoutput: adding NSAP %s\n",
85943332Ssklower 				clnp_iso_addrp(&ia->ia_addr.siso_addr));
86043332Ssklower 		ENDDEBUG
86143332Ssklower 		if (!esis_insert_addr(&cp, &len,
86243332Ssklower 							  &ia->ia_addr.siso_addr, m, nsellen)) {
86343332Ssklower 			EXTEND_PACKET(m, m0, cp);
86443332Ssklower 			(void) esis_insert_addr(&cp, &len, &ia->ia_addr.siso_addr, m,
86543332Ssklower 									nsellen);
86643332Ssklower 		}
86743332Ssklower 		naddr++;
86836379Ssklower 	}
86936379Ssklower 
87036379Ssklower 	if (type == ESIS_ESH)
87136379Ssklower 		*naddrp = naddr;
87244254Ssklower 	else {
87344254Ssklower 		/* add suggested es config timer option to ISH */
87444254Ssklower 		if (M_TRAILINGSPACE(m) < 4) {
87544254Ssklower 			printf("esis_shoutput: extending packet\n");
87644254Ssklower 			EXTEND_PACKET(m, m0, cp);
87744254Ssklower 		}
87844254Ssklower 		*cp++ = ESISOVAL_ESCT;
87944254Ssklower 		*cp++ = 2;
88044254Ssklower 		HTOC(*cp, *(cp+1), esis_esconfig_time);
88144254Ssklower 		len += 4;
88244254Ssklower 		m->m_len += 4;
88344254Ssklower 		IFDEBUG(D_ESISOUTPUT)
88444254Ssklower 			printf("m0 0x%x, m 0x%x, data 0x%x, len %d, cp 0x%x\n",
88544254Ssklower 			m0, m, m->m_data, m->m_len, cp);
88644254Ssklower 		ENDDEBUG
88744254Ssklower 	}
88836379Ssklower 
88937469Ssklower 	m0->m_pkthdr.len = len;
89037469Ssklower 	pdu->esis_hdr_len = len;
89136379Ssklower 	iso_gen_csum(m0, ESIS_CKSUM_OFF, (int)pdu->esis_hdr_len);
89236379Ssklower 
89337469Ssklower 	bzero((caddr_t)&siso, sizeof(siso));
89436379Ssklower 	siso.siso_family = AF_ISO;
89537469Ssklower 	siso.siso_data[0] = AFI_SNA;
89637469Ssklower 	siso.siso_nlen = sn_len + 1;
89737469Ssklower 	bcopy(sn_addr, siso.siso_data + 1, (unsigned)sn_len);
89852625Ssklower 	(ifp->if_output)(ifp, m0, (struct sockaddr *)&siso, 0);
89936379Ssklower }
90036379Ssklower 
90136379Ssklower /*
90243421Ssklower  * FUNCTION:		isis_input
90343421Ssklower  *
90443421Ssklower  * PURPOSE:			Process an incoming isis packet
90543421Ssklower  *
90643421Ssklower  * RETURNS:			nothing
90743421Ssklower  *
90843421Ssklower  * SIDE EFFECTS:
90943421Ssklower  *
91043421Ssklower  * NOTES:
91143421Ssklower  */
91243421Ssklower isis_input(m0, shp)
91343421Ssklower struct mbuf		*m0;		/* ptr to first mbuf of pkt */
91443421Ssklower struct snpa_hdr	*shp;	/* subnetwork header */
91543421Ssklower {
91643421Ssklower 	register int type;
91743961Ssklower 	register struct rawcb *rp, *first_rp = 0;
91843421Ssklower 	struct ifnet *ifp = shp->snh_ifp;
91943421Ssklower 	char workbuf[16];
92043421Ssklower 	struct mbuf *mm;
92143421Ssklower 
92243421Ssklower 	IFDEBUG(D_ISISINPUT)
92343421Ssklower 		int i;
92443421Ssklower 
92543421Ssklower 		printf("isis_input: pkt on ifp x%x (%s%d): from:", ifp,
92643421Ssklower 			ifp->if_name, ifp->if_unit);
92743421Ssklower 		for (i=0; i<6; i++)
92843421Ssklower 			printf("%x%c", shp->snh_shost[i]&0xff, (i<5) ? ':' : ' ');
92943421Ssklower 		printf(" to:");
93043421Ssklower 		for (i=0; i<6; i++)
93143421Ssklower 			printf("%x%c", shp->snh_dhost[i]&0xff, (i<5) ? ':' : ' ');
93243421Ssklower 		printf("\n");
93343421Ssklower 	ENDDEBUG
93443421Ssklower 	esis_dl.sdl_alen = ifp->if_addrlen;
93543421Ssklower 	esis_dl.sdl_index = ifp->if_index;
93643421Ssklower 	bcopy(shp->snh_shost, (caddr_t)esis_dl.sdl_data, esis_dl.sdl_alen);
93743421Ssklower 	for (rp = esis_pcb.rcb_next; rp != &esis_pcb; rp = rp->rcb_next) {
93843961Ssklower 		if (first_rp == 0) {
93943961Ssklower 			first_rp = rp;
94043421Ssklower 			continue;
94143421Ssklower 		}
94243421Ssklower 		if (mm = m_copy(m0, 0, M_COPYALL)) { /*can't block at interrupt level */
94343421Ssklower 			if (sbappendaddr(&rp->rcb_socket->so_rcv,
94468259Scgd 							  (struct sockaddr *)&esis_dl, mm,
94568259Scgd 							  (struct mbuf *)0) != 0) {
94643421Ssklower 				sorwakeup(rp->rcb_socket);
94752114Ssklower 			 } else {
94843421Ssklower 				IFDEBUG(D_ISISINPUT)
94943421Ssklower 					printf("Error in sbappenaddr, mm = 0x%x\n", mm);
95043421Ssklower 				ENDDEBUG
95143421Ssklower 				m_freem(mm);
95243421Ssklower 			}
95343421Ssklower 		}
95443421Ssklower 	}
95543961Ssklower 	if (first_rp && sbappendaddr(&first_rp->rcb_socket->so_rcv,
95668259Scgd 							  (struct sockaddr *)&esis_dl, m0,
95768259Scgd 							  (struct mbuf *)0) != 0) {
95843961Ssklower 		sorwakeup(first_rp->rcb_socket);
95943961Ssklower 		return;
96043421Ssklower 	}
96143961Ssklower 	m_freem(m0);
96243421Ssklower }
96343421Ssklower 
isis_output(sdl,m)96443421Ssklower isis_output(sdl, m)
96543421Ssklower register struct sockaddr_dl	*sdl;
96643421Ssklower struct mbuf *m;
96743421Ssklower {
96843421Ssklower 	register struct ifnet *ifp;
96943421Ssklower 	struct ifaddr *ifa, *ifa_ifwithnet();
97043421Ssklower 	struct sockaddr_iso siso;
97143421Ssklower 	int error = 0;
97243421Ssklower 	unsigned sn_len;
97343421Ssklower 
97452625Ssklower 	ifa = ifa_ifwithnet((struct sockaddr *)sdl);	/* get ifp from sdl */
97543421Ssklower 	if (ifa == 0) {
97643421Ssklower 		IFDEBUG(D_ISISOUTPUT)
97743421Ssklower 			printf("isis_output: interface not found\n");
97843421Ssklower 		ENDDEBUG
97943421Ssklower 		error = EINVAL;
98043421Ssklower 		goto release;
98143421Ssklower 	}
98243421Ssklower 	ifp = ifa->ifa_ifp;
98345896Ssklower 	sn_len = sdl->sdl_alen;
98443421Ssklower 	IFDEBUG(D_ISISOUTPUT)
98543421Ssklower 		u_char *cp = (u_char *)LLADDR(sdl), *cplim = cp + sn_len;
98643421Ssklower 		printf("isis_output: ifp 0x%x (%s%d), to: ",
98743421Ssklower 			ifp, ifp->if_name, ifp->if_unit);
98843421Ssklower 		while (cp < cplim) {
98943421Ssklower 			printf("%x", *cp++);
99043421Ssklower 			printf("%c", (cp < cplim) ? ':' : ' ');
99143421Ssklower 		}
99243421Ssklower 		printf("\n");
99343421Ssklower 	ENDDEBUG
99443421Ssklower 	bzero((caddr_t)&siso, sizeof(siso));
99543421Ssklower 	siso.siso_family = AF_ISO; /* This convention may be useful for X.25 */
99643421Ssklower 	siso.siso_data[0] = AFI_SNA;
99743421Ssklower 	siso.siso_nlen = sn_len + 1;
99843421Ssklower 	bcopy(LLADDR(sdl), siso.siso_data + 1, sn_len);
99943421Ssklower 	error = (ifp->if_output)(ifp, m, (struct sockaddr *)&siso, 0);
100043421Ssklower 	if (error) {
100143421Ssklower 		IFDEBUG(D_ISISOUTPUT)
100243421Ssklower 			printf("isis_output: error from ether_output is %d\n", error);
100343421Ssklower 		ENDDEBUG
100443421Ssklower 	}
100543421Ssklower 	return (error);
100643421Ssklower 
100743421Ssklower release:
100843421Ssklower 	if (m != NULL)
100943421Ssklower 		m_freem(m);
101043421Ssklower 	return(error);
101143421Ssklower }
101243421Ssklower 
101343421Ssklower 
101443421Ssklower /*
101536379Ssklower  * FUNCTION:		esis_ctlinput
101636379Ssklower  *
101736379Ssklower  * PURPOSE:			Handle the PRC_IFDOWN transition
101836379Ssklower  *
101936379Ssklower  * RETURNS:			nothing
102036379Ssklower  *
102136379Ssklower  * SIDE EFFECTS:
102236379Ssklower  *
102336379Ssklower  * NOTES:			Calls snpac_flush for interface specified.
102436379Ssklower  *					The loop through iso_ifaddr is stupid because
102536379Ssklower  *					back in if_down, we knew the ifp...
102636379Ssklower  */
esis_ctlinput(req,siso)102736379Ssklower esis_ctlinput(req, siso)
102836379Ssklower int						req;		/* request: we handle only PRC_IFDOWN */
102936379Ssklower struct sockaddr_iso		*siso;		/* address of ifp */
103036379Ssklower {
103136379Ssklower 	register struct iso_ifaddr *ia;	/* scan through interface addresses */
103236379Ssklower 
103337469Ssklower 	if (req == PRC_IFDOWN)
103437469Ssklower 		for (ia = iso_ifaddr; ia; ia = ia->ia_next) {
103537469Ssklower 			if (iso_addrmatch(IA_SIS(ia), siso))
103637469Ssklower 				snpac_flushifp(ia->ia_ifp);
103737469Ssklower 		}
103836379Ssklower }
103936379Ssklower 
104061300Ssklower #endif	/* ISO */
1041