[unix-history] / usr / src / sys / netns / ns_pcb.c

/*
 * Copyright (c) 1984, 1985, 1986, 1987 Regents of the University of California.
 * All rights reserved.
 *
 * %sccs.include.redist.c%
 *
 *	@(#)ns_pcb.c	7.11 (Berkeley) %G%
 */

#include "param.h"
#include "systm.h"
#include "mbuf.h"
#include "errno.h"
#include "socket.h"
#include "socketvar.h"
#include "protosw.h"

#include "../net/if.h"
#include "../net/route.h"

#include "ns.h"
#include "ns_if.h"
#include "ns_pcb.h"

struct	ns_addr zerons_addr;

ns_pcballoc(so, head)
	struct socket *so;
	struct nspcb *head;
{
	struct mbuf *m;
	register struct nspcb *nsp;

	m = m_getclr(M_DONTWAIT, MT_PCB);
	if (m == NULL)
		return (ENOBUFS);
	nsp = mtod(m, struct nspcb *);
	nsp->nsp_socket = so;
	insque(nsp, head);
	so->so_pcb = (caddr_t)nsp;
	return (0);
}
	
ns_pcbbind(nsp, nam)
	register struct nspcb *nsp;
	struct mbuf *nam;
{
	register struct sockaddr_ns *sns;
	u_short lport = 0;

	if (nsp->nsp_lport || !ns_nullhost(nsp->nsp_laddr))
		return (EINVAL);
	if (nam == 0)
		goto noname;
	sns = mtod(nam, struct sockaddr_ns *);
	if (nam->m_len != sizeof (*sns))
		return (EINVAL);
	if (!ns_nullhost(sns->sns_addr)) {
		int tport = sns->sns_port;

		sns->sns_port = 0;		/* yech... */
		if (ifa_ifwithaddr((struct sockaddr *)sns) == 0)
			return (EADDRNOTAVAIL);
		sns->sns_port = tport;
	}
	lport = sns->sns_port;
	if (lport) {
		u_short aport = ntohs(lport);

		if (aport < NSPORT_RESERVED &&
		    (nsp->nsp_socket->so_state & SS_PRIV) == 0)
			return (EACCES);
		if (ns_pcblookup(&zerons_addr, lport, 0))
			return (EADDRINUSE);
	}
	nsp->nsp_laddr = sns->sns_addr;
noname:
	if (lport == 0)
		do {
			if (nspcb.nsp_lport++ < NSPORT_RESERVED)
				nspcb.nsp_lport = NSPORT_RESERVED;
			lport = htons(nspcb.nsp_lport);
		} while (ns_pcblookup(&zerons_addr, lport, 0));
	nsp->nsp_lport = lport;
	return (0);
}

/*
 * Connect from a socket to a specified address.
 * Both address and port must be specified in argument sns.
 * If don't have a local address for this socket yet,
 * then pick one.
 */
ns_pcbconnect(nsp, nam)
	struct nspcb *nsp;
	struct mbuf *nam;
{
	struct ns_ifaddr *ia;
	register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
	register struct ns_addr *dst;
	register struct route *ro;
	struct ifnet *ifp;

	if (nam->m_len != sizeof (*sns))
		return (EINVAL);
	if (sns->sns_family != AF_NS)
		return (EAFNOSUPPORT);
	if (sns->sns_port==0 || ns_nullhost(sns->sns_addr))
		return (EADDRNOTAVAIL);
	/*
	 * If we haven't bound which network number to use as ours,
	 * we will use the number of the outgoing interface.
	 * This depends on having done a routing lookup, which
	 * we will probably have to do anyway, so we might
	 * as well do it now.  On the other hand if we are
	 * sending to multiple destinations we may have already
	 * done the lookup, so see if we can use the route
	 * from before.  In any case, we only
	 * chose a port number once, even if sending to multiple
	 * destinations.
	 */
	ro = &nsp->nsp_route;
	dst = &satons_addr(ro->ro_dst);
	if (nsp->nsp_socket->so_options & SO_DONTROUTE)
		goto flush;
	if (!ns_neteq(nsp->nsp_lastdst, sns->sns_addr))
		goto flush;
	if (!ns_hosteq(nsp->nsp_lastdst, sns->sns_addr)) {
		if (ro->ro_rt && ! (ro->ro_rt->rt_flags & RTF_HOST)) {
			/* can patch route to avoid rtalloc */
			*dst = sns->sns_addr;
		} else {
	flush:
			if (ro->ro_rt)
				RTFREE(ro->ro_rt);
			ro->ro_rt = (struct rtentry *)0;
			nsp->nsp_laddr.x_net = ns_zeronet;
		}
	}/* else cached route is ok; do nothing */
	nsp->nsp_lastdst = sns->sns_addr;
	if ((nsp->nsp_socket->so_options & SO_DONTROUTE) == 0 && /*XXX*/
	    (ro->ro_rt == (struct rtentry *)0 ||
	     ro->ro_rt->rt_ifp == (struct ifnet *)0)) {
		    /* No route yet, so try to acquire one */
		    ro->ro_dst.sa_family = AF_NS;
		    ro->ro_dst.sa_len = sizeof(ro->ro_dst);
		    *dst = sns->sns_addr;
		    dst->x_port = 0;
		    rtalloc(ro);
	}
	if (ns_neteqnn(nsp->nsp_laddr.x_net, ns_zeronet)) {
		/* 
		 * If route is known or can be allocated now,
		 * our src addr is taken from the i/f, else punt.
		 */

		ia = (struct ns_ifaddr *)0;
		/*
		 * If we found a route, use the address
		 * corresponding to the outgoing interface
		 */
		if (ro->ro_rt && (ifp = ro->ro_rt->rt_ifp))
			for (ia = ns_ifaddr; ia; ia = ia->ia_next)
				if (ia->ia_ifp == ifp)
					break;
		if (ia == 0) {
			u_short fport = sns->sns_addr.x_port;
			sns->sns_addr.x_port = 0;
			ia = (struct ns_ifaddr *)
				ifa_ifwithdstaddr((struct sockaddr *)sns);
			sns->sns_addr.x_port = fport;
			if (ia == 0)
				ia = ns_iaonnetof(&sns->sns_addr);
			if (ia == 0)
				ia = ns_ifaddr;
			if (ia == 0)
				return (EADDRNOTAVAIL);
		}
		nsp->nsp_laddr.x_net = satons_addr(ia->ia_addr).x_net;
	}
	if (ns_pcblookup(&sns->sns_addr, nsp->nsp_lport, 0))
		return (EADDRINUSE);
	if (ns_nullhost(nsp->nsp_laddr)) {
		if (nsp->nsp_lport == 0)
			(void) ns_pcbbind(nsp, (struct mbuf *)0);
		nsp->nsp_laddr.x_host = ns_thishost;
	}
	nsp->nsp_faddr = sns->sns_addr;
	/* Includes nsp->nsp_fport = sns->sns_port; */
	return (0);
}

ns_pcbdisconnect(nsp)
	struct nspcb *nsp;
{

	nsp->nsp_faddr = zerons_addr;
	if (nsp->nsp_socket->so_state & SS_NOFDREF)
		ns_pcbdetach(nsp);
}

ns_pcbdetach(nsp)
	struct nspcb *nsp;
{
	struct socket *so = nsp->nsp_socket;

	so->so_pcb = 0;
	sofree(so);
	if (nsp->nsp_route.ro_rt)
		rtfree(nsp->nsp_route.ro_rt);
	remque(nsp);
	(void) m_free(dtom(nsp));
}

ns_setsockaddr(nsp, nam)
	register struct nspcb *nsp;
	struct mbuf *nam;
{
	register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
	
	nam->m_len = sizeof (*sns);
	sns = mtod(nam, struct sockaddr_ns *);
	bzero((caddr_t)sns, sizeof (*sns));
	sns->sns_len = sizeof(*sns);
	sns->sns_family = AF_NS;
	sns->sns_addr = nsp->nsp_laddr;
}

ns_setpeeraddr(nsp, nam)
	register struct nspcb *nsp;
	struct mbuf *nam;
{
	register struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
	
	nam->m_len = sizeof (*sns);
	sns = mtod(nam, struct sockaddr_ns *);
	bzero((caddr_t)sns, sizeof (*sns));
	sns->sns_len = sizeof(*sns);
	sns->sns_family = AF_NS;
	sns->sns_addr  = nsp->nsp_faddr;
}

/*
 * Pass some notification to all connections of a protocol
 * associated with address dst.  Call the
 * protocol specific routine to handle each connection.
 * Also pass an extra paramter via the nspcb. (which may in fact
 * be a parameter list!)
 */
ns_pcbnotify(dst, errno, notify, param)
	register struct ns_addr *dst;
	long param;
	int errno, (*notify)();
{
	register struct nspcb *nsp, *oinp;
	int s = splimp();

	for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb);) {
		if (!ns_hosteq(*dst,nsp->nsp_faddr)) {
	next:
			nsp = nsp->nsp_next;
			continue;
		}
		if (nsp->nsp_socket == 0)
			goto next;
		if (errno) 
			nsp->nsp_socket->so_error = errno;
		oinp = nsp;
		nsp = nsp->nsp_next;
		oinp->nsp_notify_param = param;
		(*notify)(oinp);
	}
	splx(s);
}

#ifdef notdef
/*
 * After a routing change, flush old routing
 * and allocate a (hopefully) better one.
 */
ns_rtchange(nsp)
	struct nspcb *nsp;
{
	if (nsp->nsp_route.ro_rt) {
		rtfree(nsp->nsp_route.ro_rt);
		nsp->nsp_route.ro_rt = 0;
		/*
		 * A new route can be allocated the next time
		 * output is attempted.
		 */
	}
	/* SHOULD NOTIFY HIGHER-LEVEL PROTOCOLS */
}
#endif

struct nspcb *
ns_pcblookup(faddr, lport, wildp)
	struct ns_addr *faddr;
	u_short lport;
{
	register struct nspcb *nsp, *match = 0;
	int matchwild = 3, wildcard;
	u_short fport;

	fport = faddr->x_port;
	for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb); nsp = nsp->nsp_next) {
		if (nsp->nsp_lport != lport)
			continue;
		wildcard = 0;
		if (ns_nullhost(nsp->nsp_faddr)) {
			if (!ns_nullhost(*faddr))
				wildcard++;
		} else {
			if (ns_nullhost(*faddr))
				wildcard++;
			else {
				if (!ns_hosteq(nsp->nsp_faddr, *faddr))
					continue;
				if (nsp->nsp_fport != fport) {
					if (nsp->nsp_fport != 0)
						continue;
					else
						wildcard++;
				}
			}
		}
		if (wildcard && wildp==0)
			continue;
		if (wildcard < matchwild) {
			match = nsp;
			matchwild = wildcard;
			if (wildcard == 0)
				break;
		}
	}
	return (match);
}
Commit	Line	Data
8ae0e4b4	1	/*
240edf1f KS	2	* Copyright (c) 1984, 1985, 1986, 1987 Regents of the University of California.
240edf1f KS	3	* All rights reserved.
8ae0e4b4	4	*
dbf0c423	5	* %sccs.include.redist.c%
240edf1f	6	*
472ea6a9	7	* @(#)ns_pcb.c 7.11 (Berkeley) %G%
8ae0e4b4	8	*/
2d433de1 KS	9
	10	#include "param.h"
	11	#include "systm.h"
2d433de1	12	#include "mbuf.h"
f3841c44	13	#include "errno.h"
2d433de1 KS	14	#include "socket.h"
2d433de1 KS	15	#include "socketvar.h"
f3841c44 KS	16	#include "protosw.h"
f3841c44 KS	17
2d433de1 KS	18	#include "../net/if.h"
2d433de1 KS	19	#include "../net/route.h"
2d433de1 KS	20
	21	#include "ns.h"
	22	#include "ns_if.h"
	23	#include "ns_pcb.h"
	24
	25	struct ns_addr zerons_addr;
	26
	27	ns_pcballoc(so, head)
	28	struct socket *so;
f97be0c9	29	struct nspcb *head;
2d433de1 KS	30	{
	31	struct mbuf *m;
	32	register struct nspcb *nsp;
	33
	34	m = m_getclr(M_DONTWAIT, MT_PCB);
	35	if (m == NULL)
	36	return (ENOBUFS);
	37	nsp = mtod(m, struct nspcb *);
	38	nsp->nsp_socket = so;
	39	insque(nsp, head);
	40	so->so_pcb = (caddr_t)nsp;
	41	return (0);
	42	}
	43
	44	ns_pcbbind(nsp, nam)
	45	register struct nspcb *nsp;
	46	struct mbuf *nam;
	47	{
	48	register struct sockaddr_ns *sns;
	49	u_short lport = 0;
	50
4dcdd98e	51	if (nsp->nsp_lport \|\| !ns_nullhost(nsp->nsp_laddr))
2d433de1 KS	52	return (EINVAL);
	53	if (nam == 0)
	54	goto noname;
	55	sns = mtod(nam, struct sockaddr_ns *);
	56	if (nam->m_len != sizeof (*sns))
	57	return (EINVAL);
	58	if (!ns_nullhost(sns->sns_addr)) {
	59	int tport = sns->sns_port;
	60
	61	sns->sns_port = 0; /* yech... */
	62	if (ifa_ifwithaddr((struct sockaddr *)sns) == 0)
	63	return (EADDRNOTAVAIL);
	64	sns->sns_port = tport;
	65	}
	66	lport = sns->sns_port;
	67	if (lport) {
	68	u_short aport = ntohs(lport);
	69
f3841c44 KS	70	if (aport < NSPORT_RESERVED &&
f3841c44 KS	71	(nsp->nsp_socket->so_state & SS_PRIV) == 0)
2d433de1 KS	72	return (EACCES);
	73	if (ns_pcblookup(&zerons_addr, lport, 0))
	74	return (EADDRINUSE);
	75	}
	76	nsp->nsp_laddr = sns->sns_addr;
	77	noname:
	78	if (lport == 0)
	79	do {
	80	if (nspcb.nsp_lport++ < NSPORT_RESERVED)
	81	nspcb.nsp_lport = NSPORT_RESERVED;
	82	lport = htons(nspcb.nsp_lport);
	83	} while (ns_pcblookup(&zerons_addr, lport, 0));
	84	nsp->nsp_lport = lport;
	85	return (0);
	86	}
	87
	88	/*
	89	* Connect from a socket to a specified address.
	90	* Both address and port must be specified in argument sns.
	91	* If don't have a local address for this socket yet,
	92	* then pick one.
	93	*/
	94	ns_pcbconnect(nsp, nam)
	95	struct nspcb *nsp;
	96	struct mbuf *nam;
	97	{
	98	struct ns_ifaddr *ia;
2d433de1	99	register struct sockaddr_ns sns = mtod(nam, struct sockaddr_ns );
aa6e5222	100	register struct ns_addr *dst;
88b15994 KS	101	register struct route *ro;
88b15994 KS	102	struct ifnet *ifp;
2d433de1 KS	103
	104	if (nam->m_len != sizeof (*sns))
	105	return (EINVAL);
	106	if (sns->sns_family != AF_NS)
	107	return (EAFNOSUPPORT);
	108	if (sns->sns_port==0 \|\| ns_nullhost(sns->sns_addr))
	109	return (EADDRNOTAVAIL);
88b15994 KS	110	/*
	111	* If we haven't bound which network number to use as ours,
	112	* we will use the number of the outgoing interface.
	113	* This depends on having done a routing lookup, which
	114	* we will probably have to do anyway, so we might
	115	* as well do it now. On the other hand if we are
	116	* sending to multiple destinations we may have already
	117	* done the lookup, so see if we can use the route
	118	* from before. In any case, we only
	119	* chose a port number once, even if sending to multiple
	120	* destinations.
	121	*/
	122	ro = &nsp->nsp_route;
	123	dst = &satons_addr(ro->ro_dst);
40eaaff1 KS	124	if (nsp->nsp_socket->so_options & SO_DONTROUTE)
	125	goto flush;
	126	if (!ns_neteq(nsp->nsp_lastdst, sns->sns_addr))
	127	goto flush;
	128	if (!ns_hosteq(nsp->nsp_lastdst, sns->sns_addr)) {
	129	if (ro->ro_rt && ! (ro->ro_rt->rt_flags & RTF_HOST)) {
	130	/* can patch route to avoid rtalloc */
	131	*dst = sns->sns_addr;
	132	} else {
	133	flush:
	134	if (ro->ro_rt)
88b15994	135	RTFREE(ro->ro_rt);
40eaaff1 KS	136	ro->ro_rt = (struct rtentry *)0;
	137	nsp->nsp_laddr.x_net = ns_zeronet;
	138	}
	139	}/* else cached route is ok; do nothing */
88b15994 KS	140	nsp->nsp_lastdst = sns->sns_addr;
	141	if ((nsp->nsp_socket->so_options & SO_DONTROUTE) == 0 && /XXX/
	142	(ro->ro_rt == (struct rtentry *)0 \|\|
	143	ro->ro_rt->rt_ifp == (struct ifnet *)0)) {
	144	/* No route yet, so try to acquire one */
	145	ro->ro_dst.sa_family = AF_NS;
4dcdd98e	146	ro->ro_dst.sa_len = sizeof(ro->ro_dst);
88b15994 KS	147	*dst = sns->sns_addr;
	148	dst->x_port = 0;
	149	rtalloc(ro);
	150	}
	151	if (ns_neteqnn(nsp->nsp_laddr.x_net, ns_zeronet)) {
6d22baac MK	152	/*
	153	* If route is known or can be allocated now,
	154	* our src addr is taken from the i/f, else punt.
	155	*/
2d433de1	156
6d22baac	157	ia = (struct ns_ifaddr *)0;
6d22baac MK	158	/*
	159	* If we found a route, use the address
	160	* corresponding to the outgoing interface
	161	*/
	162	if (ro->ro_rt && (ifp = ro->ro_rt->rt_ifp))
	163	for (ia = ns_ifaddr; ia; ia = ia->ia_next)
	164	if (ia->ia_ifp == ifp)
	165	break;
	166	if (ia == 0) {
	167	u_short fport = sns->sns_addr.x_port;
	168	sns->sns_addr.x_port = 0;
	169	ia = (struct ns_ifaddr *)
	170	ifa_ifwithdstaddr((struct sockaddr *)sns);
	171	sns->sns_addr.x_port = fport;
	172	if (ia == 0)
	173	ia = ns_iaonnetof(&sns->sns_addr);
2d433de1 KS	174	if (ia == 0)
	175	ia = ns_ifaddr;
	176	if (ia == 0)
	177	return (EADDRNOTAVAIL);
	178	}
aa6e5222	179	nsp->nsp_laddr.x_net = satons_addr(ia->ia_addr).x_net;
2d433de1 KS	180	}
	181	if (ns_pcblookup(&sns->sns_addr, nsp->nsp_lport, 0))
	182	return (EADDRINUSE);
	183	if (ns_nullhost(nsp->nsp_laddr)) {
	184	if (nsp->nsp_lport == 0)
f97be0c9	185	(void) ns_pcbbind(nsp, (struct mbuf *)0);
2d433de1 KS	186	nsp->nsp_laddr.x_host = ns_thishost;
	187	}
	188	nsp->nsp_faddr = sns->sns_addr;
	189	/* Includes nsp->nsp_fport = sns->sns_port; */
	190	return (0);
	191	}
	192
	193	ns_pcbdisconnect(nsp)
	194	struct nspcb *nsp;
	195	{
	196
	197	nsp->nsp_faddr = zerons_addr;
	198	if (nsp->nsp_socket->so_state & SS_NOFDREF)
	199	ns_pcbdetach(nsp);
	200	}
	201
	202	ns_pcbdetach(nsp)
	203	struct nspcb *nsp;
	204	{
	205	struct socket *so = nsp->nsp_socket;
	206
	207	so->so_pcb = 0;
	208	sofree(so);
	209	if (nsp->nsp_route.ro_rt)
	210	rtfree(nsp->nsp_route.ro_rt);
	211	remque(nsp);
	212	(void) m_free(dtom(nsp));
	213	}
	214
	215	ns_setsockaddr(nsp, nam)
	216	register struct nspcb *nsp;
	217	struct mbuf *nam;
	218	{
	219	register struct sockaddr_ns sns = mtod(nam, struct sockaddr_ns );
	220
	221	nam->m_len = sizeof (*sns);
	222	sns = mtod(nam, struct sockaddr_ns *);
	223	bzero((caddr_t)sns, sizeof (*sns));
4dcdd98e	224	sns->sns_len = sizeof(*sns);
2d433de1 KS	225	sns->sns_family = AF_NS;
	226	sns->sns_addr = nsp->nsp_laddr;
	227	}
	228
	229	ns_setpeeraddr(nsp, nam)
	230	register struct nspcb *nsp;
	231	struct mbuf *nam;
	232	{
	233	register struct sockaddr_ns sns = mtod(nam, struct sockaddr_ns );
	234
	235	nam->m_len = sizeof (*sns);
	236	sns = mtod(nam, struct sockaddr_ns *);
	237	bzero((caddr_t)sns, sizeof (*sns));
4dcdd98e	238	sns->sns_len = sizeof(*sns);
2d433de1 KS	239	sns->sns_family = AF_NS;
	240	sns->sns_addr = nsp->nsp_faddr;
	241	}
	242
	243	/*
	244	* Pass some notification to all connections of a protocol
	245	* associated with address dst. Call the
	246	* protocol specific routine to handle each connection.
	247	* Also pass an extra paramter via the nspcb. (which may in fact
	248	* be a parameter list!)
	249	*/
	250	ns_pcbnotify(dst, errno, notify, param)
	251	register struct ns_addr *dst;
	252	long param;
	253	int errno, (*notify)();
	254	{
	255	register struct nspcb nsp, oinp;
	256	int s = splimp();
	257
	258	for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb);) {
	259	if (!ns_hosteq(*dst,nsp->nsp_faddr)) {
	260	next:
	261	nsp = nsp->nsp_next;
	262	continue;
	263	}
	264	if (nsp->nsp_socket == 0)
	265	goto next;
	266	if (errno)
	267	nsp->nsp_socket->so_error = errno;
	268	oinp = nsp;
	269	nsp = nsp->nsp_next;
	270	oinp->nsp_notify_param = param;
	271	(*notify)(oinp);
	272	}
	273	splx(s);
	274	}
	275
58bca61d	276	#ifdef notdef
2d433de1 KS	277	/*
	278	* After a routing change, flush old routing
	279	* and allocate a (hopefully) better one.
	280	*/
	281	ns_rtchange(nsp)
	282	struct nspcb *nsp;
	283	{
	284	if (nsp->nsp_route.ro_rt) {
	285	rtfree(nsp->nsp_route.ro_rt);
	286	nsp->nsp_route.ro_rt = 0;
	287	/*
	288	* A new route can be allocated the next time
	289	* output is attempted.
	290	*/
	291	}
	292	/* SHOULD NOTIFY HIGHER-LEVEL PROTOCOLS */
	293	}
58bca61d	294	#endif
2d433de1 KS	295
	296	struct nspcb *
	297	ns_pcblookup(faddr, lport, wildp)
	298	struct ns_addr *faddr;
	299	u_short lport;
	300	{
	301	register struct nspcb nsp, match = 0;
	302	int matchwild = 3, wildcard;
	303	u_short fport;
	304
	305	fport = faddr->x_port;
	306	for (nsp = (&nspcb)->nsp_next; nsp != (&nspcb); nsp = nsp->nsp_next) {
	307	if (nsp->nsp_lport != lport)
	308	continue;
	309	wildcard = 0;
	310	if (ns_nullhost(nsp->nsp_faddr)) {
	311	if (!ns_nullhost(*faddr))
	312	wildcard++;
	313	} else {
	314	if (ns_nullhost(*faddr))
	315	wildcard++;
	316	else {
	317	if (!ns_hosteq(nsp->nsp_faddr, *faddr))
	318	continue;
4dcdd98e KS	319	if (nsp->nsp_fport != fport) {
4dcdd98e KS	320	if (nsp->nsp_fport != 0)
2d433de1 KS	321	continue;
	322	else
	323	wildcard++;
	324	}
	325	}
	326	}
	327	if (wildcard && wildp==0)
	328	continue;
	329	if (wildcard < matchwild) {
	330	match = nsp;
	331	matchwild = wildcard;
	332	if (wildcard == 0)
	333	break;
	334	}
	335	}
	336	return (match);
	337	}