xref: /freebsd/sys/net/route.c (revision f0068c4a701b5465bf29ebd9913a457d3bc5f2a1)
1df8bae1dSRodney W. Grimes /*
2df8bae1dSRodney W. Grimes  * Copyright (c) 1980, 1986, 1991, 1993
3df8bae1dSRodney W. Grimes  *	The Regents of the University of California.  All rights reserved.
4df8bae1dSRodney W. Grimes  *
5df8bae1dSRodney W. Grimes  * Redistribution and use in source and binary forms, with or without
6df8bae1dSRodney W. Grimes  * modification, are permitted provided that the following conditions
7df8bae1dSRodney W. Grimes  * are met:
8df8bae1dSRodney W. Grimes  * 1. Redistributions of source code must retain the above copyright
9df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer.
10df8bae1dSRodney W. Grimes  * 2. Redistributions in binary form must reproduce the above copyright
11df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer in the
12df8bae1dSRodney W. Grimes  *    documentation and/or other materials provided with the distribution.
13df8bae1dSRodney W. Grimes  * 3. All advertising materials mentioning features or use of this software
14df8bae1dSRodney W. Grimes  *    must display the following acknowledgement:
15df8bae1dSRodney W. Grimes  *	This product includes software developed by the University of
16df8bae1dSRodney W. Grimes  *	California, Berkeley and its contributors.
17df8bae1dSRodney W. Grimes  * 4. Neither the name of the University nor the names of its contributors
18df8bae1dSRodney W. Grimes  *    may be used to endorse or promote products derived from this software
19df8bae1dSRodney W. Grimes  *    without specific prior written permission.
20df8bae1dSRodney W. Grimes  *
21df8bae1dSRodney W. Grimes  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22df8bae1dSRodney W. Grimes  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23df8bae1dSRodney W. Grimes  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24df8bae1dSRodney W. Grimes  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25df8bae1dSRodney W. Grimes  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26df8bae1dSRodney W. Grimes  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27df8bae1dSRodney W. Grimes  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28df8bae1dSRodney W. Grimes  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29df8bae1dSRodney W. Grimes  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30df8bae1dSRodney W. Grimes  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31df8bae1dSRodney W. Grimes  * SUCH DAMAGE.
32df8bae1dSRodney W. Grimes  *
33df8bae1dSRodney W. Grimes  *	@(#)route.c	8.2 (Berkeley) 11/15/93
34f0068c4aSGarrett Wollman  * $Id: route.c,v 1.3 1994/08/02 07:46:40 davidg Exp $
35df8bae1dSRodney W. Grimes  */
36df8bae1dSRodney W. Grimes 
37df8bae1dSRodney W. Grimes #include <sys/param.h>
38df8bae1dSRodney W. Grimes #include <sys/systm.h>
39df8bae1dSRodney W. Grimes #include <sys/proc.h>
40df8bae1dSRodney W. Grimes #include <sys/mbuf.h>
41df8bae1dSRodney W. Grimes #include <sys/socket.h>
42df8bae1dSRodney W. Grimes #include <sys/socketvar.h>
43df8bae1dSRodney W. Grimes #include <sys/domain.h>
44df8bae1dSRodney W. Grimes #include <sys/protosw.h>
45df8bae1dSRodney W. Grimes #include <sys/ioctl.h>
46df8bae1dSRodney W. Grimes 
47df8bae1dSRodney W. Grimes #include <net/if.h>
48df8bae1dSRodney W. Grimes #include <net/route.h>
49df8bae1dSRodney W. Grimes #include <net/raw_cb.h>
50df8bae1dSRodney W. Grimes 
51df8bae1dSRodney W. Grimes #include <netinet/in.h>
52df8bae1dSRodney W. Grimes #include <netinet/in_var.h>
53df8bae1dSRodney W. Grimes 
54df8bae1dSRodney W. Grimes #ifdef NS
55df8bae1dSRodney W. Grimes #include <netns/ns.h>
56df8bae1dSRodney W. Grimes #endif
57df8bae1dSRodney W. Grimes 
58df8bae1dSRodney W. Grimes #define	SA(p) ((struct sockaddr *)(p))
59df8bae1dSRodney W. Grimes 
60df8bae1dSRodney W. Grimes int	rttrash;		/* routes not in table but not freed */
61df8bae1dSRodney W. Grimes struct	sockaddr wildcard;	/* zero valued cookie for wildcard searches */
62df8bae1dSRodney W. Grimes 
63df8bae1dSRodney W. Grimes void
64df8bae1dSRodney W. Grimes rtable_init(table)
65df8bae1dSRodney W. Grimes 	void **table;
66df8bae1dSRodney W. Grimes {
67df8bae1dSRodney W. Grimes 	struct domain *dom;
68df8bae1dSRodney W. Grimes 	for (dom = domains; dom; dom = dom->dom_next)
69df8bae1dSRodney W. Grimes 		if (dom->dom_rtattach)
70df8bae1dSRodney W. Grimes 			dom->dom_rtattach(&table[dom->dom_family],
71df8bae1dSRodney W. Grimes 			    dom->dom_rtoffset);
72df8bae1dSRodney W. Grimes }
73df8bae1dSRodney W. Grimes 
74df8bae1dSRodney W. Grimes void
75df8bae1dSRodney W. Grimes route_init()
76df8bae1dSRodney W. Grimes {
77df8bae1dSRodney W. Grimes 	rn_init();	/* initialize all zeroes, all ones, mask table */
78df8bae1dSRodney W. Grimes 	rtable_init((void **)rt_tables);
79df8bae1dSRodney W. Grimes }
80df8bae1dSRodney W. Grimes 
81df8bae1dSRodney W. Grimes /*
82df8bae1dSRodney W. Grimes  * Packet routing routines.
83df8bae1dSRodney W. Grimes  */
84df8bae1dSRodney W. Grimes void
85df8bae1dSRodney W. Grimes rtalloc(ro)
86df8bae1dSRodney W. Grimes 	register struct route *ro;
87df8bae1dSRodney W. Grimes {
88df8bae1dSRodney W. Grimes 	if (ro->ro_rt && ro->ro_rt->rt_ifp && (ro->ro_rt->rt_flags & RTF_UP))
89df8bae1dSRodney W. Grimes 		return;				 /* XXX */
90df8bae1dSRodney W. Grimes 	ro->ro_rt = rtalloc1(&ro->ro_dst, 1);
91df8bae1dSRodney W. Grimes }
92df8bae1dSRodney W. Grimes 
93df8bae1dSRodney W. Grimes struct rtentry *
94df8bae1dSRodney W. Grimes rtalloc1(dst, report)
95df8bae1dSRodney W. Grimes 	register struct sockaddr *dst;
96df8bae1dSRodney W. Grimes 	int report;
97df8bae1dSRodney W. Grimes {
98df8bae1dSRodney W. Grimes 	register struct radix_node_head *rnh = rt_tables[dst->sa_family];
99df8bae1dSRodney W. Grimes 	register struct rtentry *rt;
100df8bae1dSRodney W. Grimes 	register struct radix_node *rn;
101df8bae1dSRodney W. Grimes 	struct rtentry *newrt = 0;
102df8bae1dSRodney W. Grimes 	struct rt_addrinfo info;
103df8bae1dSRodney W. Grimes 	int  s = splnet(), err = 0, msgtype = RTM_MISS;
104df8bae1dSRodney W. Grimes 
105df8bae1dSRodney W. Grimes 	if (rnh && (rn = rnh->rnh_matchaddr((caddr_t)dst, rnh)) &&
106df8bae1dSRodney W. Grimes 	    ((rn->rn_flags & RNF_ROOT) == 0)) {
107df8bae1dSRodney W. Grimes 		newrt = rt = (struct rtentry *)rn;
108df8bae1dSRodney W. Grimes 		if (report && (rt->rt_flags & RTF_CLONING)) {
109df8bae1dSRodney W. Grimes 			err = rtrequest(RTM_RESOLVE, dst, SA(0),
110df8bae1dSRodney W. Grimes 					      SA(0), 0, &newrt);
111df8bae1dSRodney W. Grimes 			if (err) {
112df8bae1dSRodney W. Grimes 				newrt = rt;
113df8bae1dSRodney W. Grimes 				rt->rt_refcnt++;
114df8bae1dSRodney W. Grimes 				goto miss;
115df8bae1dSRodney W. Grimes 			}
116df8bae1dSRodney W. Grimes 			if ((rt = newrt) && (rt->rt_flags & RTF_XRESOLVE)) {
117df8bae1dSRodney W. Grimes 				msgtype = RTM_RESOLVE;
118df8bae1dSRodney W. Grimes 				goto miss;
119df8bae1dSRodney W. Grimes 			}
120df8bae1dSRodney W. Grimes 		} else
121df8bae1dSRodney W. Grimes 			rt->rt_refcnt++;
122df8bae1dSRodney W. Grimes 	} else {
123df8bae1dSRodney W. Grimes 		rtstat.rts_unreach++;
124df8bae1dSRodney W. Grimes 	miss:	if (report) {
125df8bae1dSRodney W. Grimes 			bzero((caddr_t)&info, sizeof(info));
126df8bae1dSRodney W. Grimes 			info.rti_info[RTAX_DST] = dst;
127df8bae1dSRodney W. Grimes 			rt_missmsg(msgtype, &info, 0, err);
128df8bae1dSRodney W. Grimes 		}
129df8bae1dSRodney W. Grimes 	}
130df8bae1dSRodney W. Grimes 	splx(s);
131df8bae1dSRodney W. Grimes 	return (newrt);
132df8bae1dSRodney W. Grimes }
133df8bae1dSRodney W. Grimes 
134df8bae1dSRodney W. Grimes void
135df8bae1dSRodney W. Grimes rtfree(rt)
136df8bae1dSRodney W. Grimes 	register struct rtentry *rt;
137df8bae1dSRodney W. Grimes {
138df8bae1dSRodney W. Grimes 	register struct ifaddr *ifa;
139df8bae1dSRodney W. Grimes 
140df8bae1dSRodney W. Grimes 	if (rt == 0)
141df8bae1dSRodney W. Grimes 		panic("rtfree");
142df8bae1dSRodney W. Grimes 	rt->rt_refcnt--;
143df8bae1dSRodney W. Grimes 	if (rt->rt_refcnt <= 0 && (rt->rt_flags & RTF_UP) == 0) {
144df8bae1dSRodney W. Grimes 		if (rt->rt_nodes->rn_flags & (RNF_ACTIVE | RNF_ROOT))
145df8bae1dSRodney W. Grimes 			panic ("rtfree 2");
146df8bae1dSRodney W. Grimes 		rttrash--;
147df8bae1dSRodney W. Grimes 		if (rt->rt_refcnt < 0) {
148df8bae1dSRodney W. Grimes 			printf("rtfree: %x not freed (neg refs)\n", rt);
149df8bae1dSRodney W. Grimes 			return;
150df8bae1dSRodney W. Grimes 		}
151df8bae1dSRodney W. Grimes 		ifa = rt->rt_ifa;
152df8bae1dSRodney W. Grimes 		IFAFREE(ifa);
153df8bae1dSRodney W. Grimes 		Free(rt_key(rt));
154df8bae1dSRodney W. Grimes 		Free(rt);
155df8bae1dSRodney W. Grimes 	}
156df8bae1dSRodney W. Grimes }
157df8bae1dSRodney W. Grimes 
158df8bae1dSRodney W. Grimes void
159df8bae1dSRodney W. Grimes ifafree(ifa)
160df8bae1dSRodney W. Grimes 	register struct ifaddr *ifa;
161df8bae1dSRodney W. Grimes {
162df8bae1dSRodney W. Grimes 	if (ifa == NULL)
163df8bae1dSRodney W. Grimes 		panic("ifafree");
164df8bae1dSRodney W. Grimes 	if (ifa->ifa_refcnt == 0)
165df8bae1dSRodney W. Grimes 		free(ifa, M_IFADDR);
166df8bae1dSRodney W. Grimes 	else
167df8bae1dSRodney W. Grimes 		ifa->ifa_refcnt--;
168df8bae1dSRodney W. Grimes }
169df8bae1dSRodney W. Grimes 
170df8bae1dSRodney W. Grimes /*
171df8bae1dSRodney W. Grimes  * Force a routing table entry to the specified
172df8bae1dSRodney W. Grimes  * destination to go through the given gateway.
173df8bae1dSRodney W. Grimes  * Normally called as a result of a routing redirect
174df8bae1dSRodney W. Grimes  * message from the network layer.
175df8bae1dSRodney W. Grimes  *
176df8bae1dSRodney W. Grimes  * N.B.: must be called at splnet
177df8bae1dSRodney W. Grimes  *
178df8bae1dSRodney W. Grimes  */
17926f9a767SRodney W. Grimes void
180df8bae1dSRodney W. Grimes rtredirect(dst, gateway, netmask, flags, src, rtp)
181df8bae1dSRodney W. Grimes 	struct sockaddr *dst, *gateway, *netmask, *src;
182df8bae1dSRodney W. Grimes 	int flags;
183df8bae1dSRodney W. Grimes 	struct rtentry **rtp;
184df8bae1dSRodney W. Grimes {
185df8bae1dSRodney W. Grimes 	register struct rtentry *rt;
186df8bae1dSRodney W. Grimes 	int error = 0;
187df8bae1dSRodney W. Grimes 	short *stat = 0;
188df8bae1dSRodney W. Grimes 	struct rt_addrinfo info;
189df8bae1dSRodney W. Grimes 	struct ifaddr *ifa;
190df8bae1dSRodney W. Grimes 
191df8bae1dSRodney W. Grimes 	/* verify the gateway is directly reachable */
192df8bae1dSRodney W. Grimes 	if ((ifa = ifa_ifwithnet(gateway)) == 0) {
193df8bae1dSRodney W. Grimes 		error = ENETUNREACH;
194df8bae1dSRodney W. Grimes 		goto out;
195df8bae1dSRodney W. Grimes 	}
196df8bae1dSRodney W. Grimes 	rt = rtalloc1(dst, 0);
197df8bae1dSRodney W. Grimes 	/*
198df8bae1dSRodney W. Grimes 	 * If the redirect isn't from our current router for this dst,
199df8bae1dSRodney W. Grimes 	 * it's either old or wrong.  If it redirects us to ourselves,
200df8bae1dSRodney W. Grimes 	 * we have a routing loop, perhaps as a result of an interface
201df8bae1dSRodney W. Grimes 	 * going down recently.
202df8bae1dSRodney W. Grimes 	 */
203df8bae1dSRodney W. Grimes #define	equal(a1, a2) (bcmp((caddr_t)(a1), (caddr_t)(a2), (a1)->sa_len) == 0)
204df8bae1dSRodney W. Grimes 	if (!(flags & RTF_DONE) && rt &&
205df8bae1dSRodney W. Grimes 	     (!equal(src, rt->rt_gateway) || rt->rt_ifa != ifa))
206df8bae1dSRodney W. Grimes 		error = EINVAL;
207df8bae1dSRodney W. Grimes 	else if (ifa_ifwithaddr(gateway))
208df8bae1dSRodney W. Grimes 		error = EHOSTUNREACH;
209df8bae1dSRodney W. Grimes 	if (error)
210df8bae1dSRodney W. Grimes 		goto done;
211df8bae1dSRodney W. Grimes 	/*
212df8bae1dSRodney W. Grimes 	 * Create a new entry if we just got back a wildcard entry
213df8bae1dSRodney W. Grimes 	 * or the the lookup failed.  This is necessary for hosts
214df8bae1dSRodney W. Grimes 	 * which use routing redirects generated by smart gateways
215df8bae1dSRodney W. Grimes 	 * to dynamically build the routing tables.
216df8bae1dSRodney W. Grimes 	 */
217df8bae1dSRodney W. Grimes 	if ((rt == 0) || (rt_mask(rt) && rt_mask(rt)->sa_len < 2))
218df8bae1dSRodney W. Grimes 		goto create;
219df8bae1dSRodney W. Grimes 	/*
220df8bae1dSRodney W. Grimes 	 * Don't listen to the redirect if it's
221df8bae1dSRodney W. Grimes 	 * for a route to an interface.
222df8bae1dSRodney W. Grimes 	 */
223df8bae1dSRodney W. Grimes 	if (rt->rt_flags & RTF_GATEWAY) {
224df8bae1dSRodney W. Grimes 		if (((rt->rt_flags & RTF_HOST) == 0) && (flags & RTF_HOST)) {
225df8bae1dSRodney W. Grimes 			/*
226df8bae1dSRodney W. Grimes 			 * Changing from route to net => route to host.
227df8bae1dSRodney W. Grimes 			 * Create new route, rather than smashing route to net.
228df8bae1dSRodney W. Grimes 			 */
229df8bae1dSRodney W. Grimes 		create:
230df8bae1dSRodney W. Grimes 			flags |=  RTF_GATEWAY | RTF_DYNAMIC;
231df8bae1dSRodney W. Grimes 			error = rtrequest((int)RTM_ADD, dst, gateway,
232df8bae1dSRodney W. Grimes 				    netmask, flags,
233df8bae1dSRodney W. Grimes 				    (struct rtentry **)0);
234df8bae1dSRodney W. Grimes 			stat = &rtstat.rts_dynamic;
235df8bae1dSRodney W. Grimes 		} else {
236df8bae1dSRodney W. Grimes 			/*
237df8bae1dSRodney W. Grimes 			 * Smash the current notion of the gateway to
238df8bae1dSRodney W. Grimes 			 * this destination.  Should check about netmask!!!
239df8bae1dSRodney W. Grimes 			 */
240df8bae1dSRodney W. Grimes 			rt->rt_flags |= RTF_MODIFIED;
241df8bae1dSRodney W. Grimes 			flags |= RTF_MODIFIED;
242df8bae1dSRodney W. Grimes 			stat = &rtstat.rts_newgateway;
243df8bae1dSRodney W. Grimes 			rt_setgate(rt, rt_key(rt), gateway);
244df8bae1dSRodney W. Grimes 		}
245df8bae1dSRodney W. Grimes 	} else
246df8bae1dSRodney W. Grimes 		error = EHOSTUNREACH;
247df8bae1dSRodney W. Grimes done:
248df8bae1dSRodney W. Grimes 	if (rt) {
249df8bae1dSRodney W. Grimes 		if (rtp && !error)
250df8bae1dSRodney W. Grimes 			*rtp = rt;
251df8bae1dSRodney W. Grimes 		else
252df8bae1dSRodney W. Grimes 			rtfree(rt);
253df8bae1dSRodney W. Grimes 	}
254df8bae1dSRodney W. Grimes out:
255df8bae1dSRodney W. Grimes 	if (error)
256df8bae1dSRodney W. Grimes 		rtstat.rts_badredirect++;
257df8bae1dSRodney W. Grimes 	else if (stat != NULL)
258df8bae1dSRodney W. Grimes 		(*stat)++;
259df8bae1dSRodney W. Grimes 	bzero((caddr_t)&info, sizeof(info));
260df8bae1dSRodney W. Grimes 	info.rti_info[RTAX_DST] = dst;
261df8bae1dSRodney W. Grimes 	info.rti_info[RTAX_GATEWAY] = gateway;
262df8bae1dSRodney W. Grimes 	info.rti_info[RTAX_NETMASK] = netmask;
263df8bae1dSRodney W. Grimes 	info.rti_info[RTAX_AUTHOR] = src;
264df8bae1dSRodney W. Grimes 	rt_missmsg(RTM_REDIRECT, &info, flags, error);
265df8bae1dSRodney W. Grimes }
266df8bae1dSRodney W. Grimes 
267df8bae1dSRodney W. Grimes /*
268df8bae1dSRodney W. Grimes * Routing table ioctl interface.
269df8bae1dSRodney W. Grimes */
270df8bae1dSRodney W. Grimes int
271df8bae1dSRodney W. Grimes rtioctl(req, data, p)
272df8bae1dSRodney W. Grimes 	int req;
273df8bae1dSRodney W. Grimes 	caddr_t data;
274df8bae1dSRodney W. Grimes 	struct proc *p;
275df8bae1dSRodney W. Grimes {
276f0068c4aSGarrett Wollman #ifdef MULTICAST
277f0068c4aSGarrett Wollman 	/* Multicast goop, grrr... */
278f0068c4aSGarrett Wollman 	return mrt_ioctl(cmd, data, p);
279f0068c4aSGarrett Wollman #else
280df8bae1dSRodney W. Grimes 	return (EOPNOTSUPP);
281f0068c4aSGarrett Wollman #endif
282df8bae1dSRodney W. Grimes }
283df8bae1dSRodney W. Grimes 
284df8bae1dSRodney W. Grimes struct ifaddr *
285df8bae1dSRodney W. Grimes ifa_ifwithroute(flags, dst, gateway)
286df8bae1dSRodney W. Grimes 	int flags;
287df8bae1dSRodney W. Grimes 	struct sockaddr	*dst, *gateway;
288df8bae1dSRodney W. Grimes {
289df8bae1dSRodney W. Grimes 	register struct ifaddr *ifa;
290df8bae1dSRodney W. Grimes 	if ((flags & RTF_GATEWAY) == 0) {
291df8bae1dSRodney W. Grimes 		/*
292df8bae1dSRodney W. Grimes 		 * If we are adding a route to an interface,
293df8bae1dSRodney W. Grimes 		 * and the interface is a pt to pt link
294df8bae1dSRodney W. Grimes 		 * we should search for the destination
295df8bae1dSRodney W. Grimes 		 * as our clue to the interface.  Otherwise
296df8bae1dSRodney W. Grimes 		 * we can use the local address.
297df8bae1dSRodney W. Grimes 		 */
298df8bae1dSRodney W. Grimes 		ifa = 0;
299df8bae1dSRodney W. Grimes 		if (flags & RTF_HOST)
300df8bae1dSRodney W. Grimes 			ifa = ifa_ifwithdstaddr(dst);
301df8bae1dSRodney W. Grimes 		if (ifa == 0)
302df8bae1dSRodney W. Grimes 			ifa = ifa_ifwithaddr(gateway);
303df8bae1dSRodney W. Grimes 	} else {
304df8bae1dSRodney W. Grimes 		/*
305df8bae1dSRodney W. Grimes 		 * If we are adding a route to a remote net
306df8bae1dSRodney W. Grimes 		 * or host, the gateway may still be on the
307df8bae1dSRodney W. Grimes 		 * other end of a pt to pt link.
308df8bae1dSRodney W. Grimes 		 */
309df8bae1dSRodney W. Grimes 		ifa = ifa_ifwithdstaddr(gateway);
310df8bae1dSRodney W. Grimes 	}
311df8bae1dSRodney W. Grimes 	if (ifa == 0)
312df8bae1dSRodney W. Grimes 		ifa = ifa_ifwithnet(gateway);
313df8bae1dSRodney W. Grimes 	if (ifa == 0) {
314df8bae1dSRodney W. Grimes 		struct rtentry *rt = rtalloc1(dst, 0);
315df8bae1dSRodney W. Grimes 		if (rt == 0)
316df8bae1dSRodney W. Grimes 			return (0);
317df8bae1dSRodney W. Grimes 		rt->rt_refcnt--;
318df8bae1dSRodney W. Grimes 		if ((ifa = rt->rt_ifa) == 0)
319df8bae1dSRodney W. Grimes 			return (0);
320df8bae1dSRodney W. Grimes 	}
321df8bae1dSRodney W. Grimes 	if (ifa->ifa_addr->sa_family != dst->sa_family) {
322df8bae1dSRodney W. Grimes 		struct ifaddr *oifa = ifa;
323df8bae1dSRodney W. Grimes 		ifa = ifaof_ifpforaddr(dst, ifa->ifa_ifp);
324df8bae1dSRodney W. Grimes 		if (ifa == 0)
325df8bae1dSRodney W. Grimes 			ifa = oifa;
326df8bae1dSRodney W. Grimes 	}
327df8bae1dSRodney W. Grimes 	return (ifa);
328df8bae1dSRodney W. Grimes }
329df8bae1dSRodney W. Grimes 
330df8bae1dSRodney W. Grimes #define ROUNDUP(a) (a>0 ? (1 + (((a) - 1) | (sizeof(long) - 1))) : sizeof(long))
331df8bae1dSRodney W. Grimes 
332df8bae1dSRodney W. Grimes int
333df8bae1dSRodney W. Grimes rtrequest(req, dst, gateway, netmask, flags, ret_nrt)
334df8bae1dSRodney W. Grimes 	int req, flags;
335df8bae1dSRodney W. Grimes 	struct sockaddr *dst, *gateway, *netmask;
336df8bae1dSRodney W. Grimes 	struct rtentry **ret_nrt;
337df8bae1dSRodney W. Grimes {
338df8bae1dSRodney W. Grimes 	int s = splnet(); int error = 0;
339df8bae1dSRodney W. Grimes 	register struct rtentry *rt;
340df8bae1dSRodney W. Grimes 	register struct radix_node *rn;
341df8bae1dSRodney W. Grimes 	register struct radix_node_head *rnh;
342df8bae1dSRodney W. Grimes 	struct ifaddr *ifa;
343df8bae1dSRodney W. Grimes 	struct sockaddr *ndst;
344df8bae1dSRodney W. Grimes #define senderr(x) { error = x ; goto bad; }
345df8bae1dSRodney W. Grimes 
346df8bae1dSRodney W. Grimes 	if ((rnh = rt_tables[dst->sa_family]) == 0)
347df8bae1dSRodney W. Grimes 		senderr(ESRCH);
348df8bae1dSRodney W. Grimes 	if (flags & RTF_HOST)
349df8bae1dSRodney W. Grimes 		netmask = 0;
350df8bae1dSRodney W. Grimes 	switch (req) {
351df8bae1dSRodney W. Grimes 	case RTM_DELETE:
352df8bae1dSRodney W. Grimes 		if ((rn = rnh->rnh_deladdr(dst, netmask, rnh)) == 0)
353df8bae1dSRodney W. Grimes 			senderr(ESRCH);
354df8bae1dSRodney W. Grimes 		if (rn->rn_flags & (RNF_ACTIVE | RNF_ROOT))
355df8bae1dSRodney W. Grimes 			panic ("rtrequest delete");
356df8bae1dSRodney W. Grimes 		rt = (struct rtentry *)rn;
357df8bae1dSRodney W. Grimes 		rt->rt_flags &= ~RTF_UP;
358df8bae1dSRodney W. Grimes 		if (rt->rt_gwroute) {
359df8bae1dSRodney W. Grimes 			rt = rt->rt_gwroute; RTFREE(rt);
360df8bae1dSRodney W. Grimes 			(rt = (struct rtentry *)rn)->rt_gwroute = 0;
361df8bae1dSRodney W. Grimes 		}
362df8bae1dSRodney W. Grimes 		if ((ifa = rt->rt_ifa) && ifa->ifa_rtrequest)
363df8bae1dSRodney W. Grimes 			ifa->ifa_rtrequest(RTM_DELETE, rt, SA(0));
364df8bae1dSRodney W. Grimes 		rttrash++;
365df8bae1dSRodney W. Grimes 		if (ret_nrt)
366df8bae1dSRodney W. Grimes 			*ret_nrt = rt;
367df8bae1dSRodney W. Grimes 		else if (rt->rt_refcnt <= 0) {
368df8bae1dSRodney W. Grimes 			rt->rt_refcnt++;
369df8bae1dSRodney W. Grimes 			rtfree(rt);
370df8bae1dSRodney W. Grimes 		}
371df8bae1dSRodney W. Grimes 		break;
372df8bae1dSRodney W. Grimes 
373df8bae1dSRodney W. Grimes 	case RTM_RESOLVE:
374df8bae1dSRodney W. Grimes 		if (ret_nrt == 0 || (rt = *ret_nrt) == 0)
375df8bae1dSRodney W. Grimes 			senderr(EINVAL);
376df8bae1dSRodney W. Grimes 		ifa = rt->rt_ifa;
377df8bae1dSRodney W. Grimes 		flags = rt->rt_flags & ~RTF_CLONING;
378df8bae1dSRodney W. Grimes 		gateway = rt->rt_gateway;
379df8bae1dSRodney W. Grimes 		if ((netmask = rt->rt_genmask) == 0)
380df8bae1dSRodney W. Grimes 			flags |= RTF_HOST;
381df8bae1dSRodney W. Grimes 		goto makeroute;
382df8bae1dSRodney W. Grimes 
383df8bae1dSRodney W. Grimes 	case RTM_ADD:
384df8bae1dSRodney W. Grimes 		if ((ifa = ifa_ifwithroute(flags, dst, gateway)) == 0)
385df8bae1dSRodney W. Grimes 			senderr(ENETUNREACH);
386df8bae1dSRodney W. Grimes 	makeroute:
387df8bae1dSRodney W. Grimes 		R_Malloc(rt, struct rtentry *, sizeof(*rt));
388df8bae1dSRodney W. Grimes 		if (rt == 0)
389df8bae1dSRodney W. Grimes 			senderr(ENOBUFS);
390df8bae1dSRodney W. Grimes 		Bzero(rt, sizeof(*rt));
391df8bae1dSRodney W. Grimes 		rt->rt_flags = RTF_UP | flags;
392df8bae1dSRodney W. Grimes 		if (rt_setgate(rt, dst, gateway)) {
393df8bae1dSRodney W. Grimes 			Free(rt);
394df8bae1dSRodney W. Grimes 			senderr(ENOBUFS);
395df8bae1dSRodney W. Grimes 		}
396df8bae1dSRodney W. Grimes 		ndst = rt_key(rt);
397df8bae1dSRodney W. Grimes 		if (netmask) {
398df8bae1dSRodney W. Grimes 			rt_maskedcopy(dst, ndst, netmask);
399df8bae1dSRodney W. Grimes 		} else
400df8bae1dSRodney W. Grimes 			Bcopy(dst, ndst, dst->sa_len);
401df8bae1dSRodney W. Grimes 		rn = rnh->rnh_addaddr((caddr_t)ndst, (caddr_t)netmask,
402df8bae1dSRodney W. Grimes 					rnh, rt->rt_nodes);
403df8bae1dSRodney W. Grimes 		if (rn == 0) {
404df8bae1dSRodney W. Grimes 			if (rt->rt_gwroute)
405df8bae1dSRodney W. Grimes 				rtfree(rt->rt_gwroute);
406df8bae1dSRodney W. Grimes 			Free(rt_key(rt));
407df8bae1dSRodney W. Grimes 			Free(rt);
408df8bae1dSRodney W. Grimes 			senderr(EEXIST);
409df8bae1dSRodney W. Grimes 		}
410df8bae1dSRodney W. Grimes 		ifa->ifa_refcnt++;
411df8bae1dSRodney W. Grimes 		rt->rt_ifa = ifa;
412df8bae1dSRodney W. Grimes 		rt->rt_ifp = ifa->ifa_ifp;
413df8bae1dSRodney W. Grimes 		if (req == RTM_RESOLVE)
414df8bae1dSRodney W. Grimes 			rt->rt_rmx = (*ret_nrt)->rt_rmx; /* copy metrics */
415df8bae1dSRodney W. Grimes 		if (ifa->ifa_rtrequest)
416df8bae1dSRodney W. Grimes 			ifa->ifa_rtrequest(req, rt, SA(ret_nrt ? *ret_nrt : 0));
417df8bae1dSRodney W. Grimes 		if (ret_nrt) {
418df8bae1dSRodney W. Grimes 			*ret_nrt = rt;
419df8bae1dSRodney W. Grimes 			rt->rt_refcnt++;
420df8bae1dSRodney W. Grimes 		}
421df8bae1dSRodney W. Grimes 		break;
422df8bae1dSRodney W. Grimes 	}
423df8bae1dSRodney W. Grimes bad:
424df8bae1dSRodney W. Grimes 	splx(s);
425df8bae1dSRodney W. Grimes 	return (error);
426df8bae1dSRodney W. Grimes }
427df8bae1dSRodney W. Grimes 
428df8bae1dSRodney W. Grimes int
429df8bae1dSRodney W. Grimes rt_setgate(rt0, dst, gate)
430df8bae1dSRodney W. Grimes 	struct rtentry *rt0;
431df8bae1dSRodney W. Grimes 	struct sockaddr *dst, *gate;
432df8bae1dSRodney W. Grimes {
433df8bae1dSRodney W. Grimes 	caddr_t new, old;
434df8bae1dSRodney W. Grimes 	int dlen = ROUNDUP(dst->sa_len), glen = ROUNDUP(gate->sa_len);
435df8bae1dSRodney W. Grimes 	register struct rtentry *rt = rt0;
436df8bae1dSRodney W. Grimes 
437df8bae1dSRodney W. Grimes 	if (rt->rt_gateway == 0 || glen > ROUNDUP(rt->rt_gateway->sa_len)) {
438df8bae1dSRodney W. Grimes 		old = (caddr_t)rt_key(rt);
439df8bae1dSRodney W. Grimes 		R_Malloc(new, caddr_t, dlen + glen);
440df8bae1dSRodney W. Grimes 		if (new == 0)
441df8bae1dSRodney W. Grimes 			return 1;
442df8bae1dSRodney W. Grimes 		rt->rt_nodes->rn_key = new;
443df8bae1dSRodney W. Grimes 	} else {
444df8bae1dSRodney W. Grimes 		new = rt->rt_nodes->rn_key;
445df8bae1dSRodney W. Grimes 		old = 0;
446df8bae1dSRodney W. Grimes 	}
447df8bae1dSRodney W. Grimes 	Bcopy(gate, (rt->rt_gateway = (struct sockaddr *)(new + dlen)), glen);
448df8bae1dSRodney W. Grimes 	if (old) {
449df8bae1dSRodney W. Grimes 		Bcopy(dst, new, dlen);
450df8bae1dSRodney W. Grimes 		Free(old);
451df8bae1dSRodney W. Grimes 	}
452df8bae1dSRodney W. Grimes 	if (rt->rt_gwroute) {
453df8bae1dSRodney W. Grimes 		rt = rt->rt_gwroute; RTFREE(rt);
454df8bae1dSRodney W. Grimes 		rt = rt0; rt->rt_gwroute = 0;
455df8bae1dSRodney W. Grimes 	}
456df8bae1dSRodney W. Grimes 	if (rt->rt_flags & RTF_GATEWAY) {
457df8bae1dSRodney W. Grimes 		rt->rt_gwroute = rtalloc1(gate, 1);
458df8bae1dSRodney W. Grimes 	}
459df8bae1dSRodney W. Grimes 	return 0;
460df8bae1dSRodney W. Grimes }
461df8bae1dSRodney W. Grimes 
462df8bae1dSRodney W. Grimes void
463df8bae1dSRodney W. Grimes rt_maskedcopy(src, dst, netmask)
464df8bae1dSRodney W. Grimes 	struct sockaddr *src, *dst, *netmask;
465df8bae1dSRodney W. Grimes {
466df8bae1dSRodney W. Grimes 	register u_char *cp1 = (u_char *)src;
467df8bae1dSRodney W. Grimes 	register u_char *cp2 = (u_char *)dst;
468df8bae1dSRodney W. Grimes 	register u_char *cp3 = (u_char *)netmask;
469df8bae1dSRodney W. Grimes 	u_char *cplim = cp2 + *cp3;
470df8bae1dSRodney W. Grimes 	u_char *cplim2 = cp2 + *cp1;
471df8bae1dSRodney W. Grimes 
472df8bae1dSRodney W. Grimes 	*cp2++ = *cp1++; *cp2++ = *cp1++; /* copies sa_len & sa_family */
473df8bae1dSRodney W. Grimes 	cp3 += 2;
474df8bae1dSRodney W. Grimes 	if (cplim > cplim2)
475df8bae1dSRodney W. Grimes 		cplim = cplim2;
476df8bae1dSRodney W. Grimes 	while (cp2 < cplim)
477df8bae1dSRodney W. Grimes 		*cp2++ = *cp1++ & *cp3++;
478df8bae1dSRodney W. Grimes 	if (cp2 < cplim2)
479df8bae1dSRodney W. Grimes 		bzero((caddr_t)cp2, (unsigned)(cplim2 - cp2));
480df8bae1dSRodney W. Grimes }
481df8bae1dSRodney W. Grimes 
482df8bae1dSRodney W. Grimes /*
483df8bae1dSRodney W. Grimes  * Set up a routing table entry, normally
484df8bae1dSRodney W. Grimes  * for an interface.
485df8bae1dSRodney W. Grimes  */
486df8bae1dSRodney W. Grimes int
487df8bae1dSRodney W. Grimes rtinit(ifa, cmd, flags)
488df8bae1dSRodney W. Grimes 	register struct ifaddr *ifa;
489df8bae1dSRodney W. Grimes 	int cmd, flags;
490df8bae1dSRodney W. Grimes {
491df8bae1dSRodney W. Grimes 	register struct rtentry *rt;
492df8bae1dSRodney W. Grimes 	register struct sockaddr *dst;
493df8bae1dSRodney W. Grimes 	register struct sockaddr *deldst;
494df8bae1dSRodney W. Grimes 	struct mbuf *m = 0;
495df8bae1dSRodney W. Grimes 	struct rtentry *nrt = 0;
496df8bae1dSRodney W. Grimes 	int error;
497df8bae1dSRodney W. Grimes 
498df8bae1dSRodney W. Grimes 	dst = flags & RTF_HOST ? ifa->ifa_dstaddr : ifa->ifa_addr;
499df8bae1dSRodney W. Grimes 	if (cmd == RTM_DELETE) {
500df8bae1dSRodney W. Grimes 		if ((flags & RTF_HOST) == 0 && ifa->ifa_netmask) {
501df8bae1dSRodney W. Grimes 			m = m_get(M_WAIT, MT_SONAME);
502df8bae1dSRodney W. Grimes 			deldst = mtod(m, struct sockaddr *);
503df8bae1dSRodney W. Grimes 			rt_maskedcopy(dst, deldst, ifa->ifa_netmask);
504df8bae1dSRodney W. Grimes 			dst = deldst;
505df8bae1dSRodney W. Grimes 		}
506df8bae1dSRodney W. Grimes 		if (rt = rtalloc1(dst, 0)) {
507df8bae1dSRodney W. Grimes 			rt->rt_refcnt--;
508df8bae1dSRodney W. Grimes 			if (rt->rt_ifa != ifa) {
509df8bae1dSRodney W. Grimes 				if (m)
510df8bae1dSRodney W. Grimes 					(void) m_free(m);
511df8bae1dSRodney W. Grimes 				return (flags & RTF_HOST ? EHOSTUNREACH
512df8bae1dSRodney W. Grimes 							: ENETUNREACH);
513df8bae1dSRodney W. Grimes 			}
514df8bae1dSRodney W. Grimes 		}
515df8bae1dSRodney W. Grimes 	}
516df8bae1dSRodney W. Grimes 	error = rtrequest(cmd, dst, ifa->ifa_addr, ifa->ifa_netmask,
517df8bae1dSRodney W. Grimes 			flags | ifa->ifa_flags, &nrt);
518df8bae1dSRodney W. Grimes 	if (m)
519df8bae1dSRodney W. Grimes 		(void) m_free(m);
520df8bae1dSRodney W. Grimes 	if (cmd == RTM_DELETE && error == 0 && (rt = nrt)) {
521df8bae1dSRodney W. Grimes 		rt_newaddrmsg(cmd, ifa, error, nrt);
522df8bae1dSRodney W. Grimes 		if (rt->rt_refcnt <= 0) {
523df8bae1dSRodney W. Grimes 			rt->rt_refcnt++;
524df8bae1dSRodney W. Grimes 			rtfree(rt);
525df8bae1dSRodney W. Grimes 		}
526df8bae1dSRodney W. Grimes 	}
527df8bae1dSRodney W. Grimes 	if (cmd == RTM_ADD && error == 0 && (rt = nrt)) {
528df8bae1dSRodney W. Grimes 		rt->rt_refcnt--;
529df8bae1dSRodney W. Grimes 		if (rt->rt_ifa != ifa) {
530df8bae1dSRodney W. Grimes 			printf("rtinit: wrong ifa (%x) was (%x)\n", ifa,
531df8bae1dSRodney W. Grimes 				rt->rt_ifa);
532df8bae1dSRodney W. Grimes 			if (rt->rt_ifa->ifa_rtrequest)
533df8bae1dSRodney W. Grimes 			    rt->rt_ifa->ifa_rtrequest(RTM_DELETE, rt, SA(0));
534df8bae1dSRodney W. Grimes 			IFAFREE(rt->rt_ifa);
535df8bae1dSRodney W. Grimes 			rt->rt_ifa = ifa;
536df8bae1dSRodney W. Grimes 			rt->rt_ifp = ifa->ifa_ifp;
537df8bae1dSRodney W. Grimes 			ifa->ifa_refcnt++;
538df8bae1dSRodney W. Grimes 			if (ifa->ifa_rtrequest)
539df8bae1dSRodney W. Grimes 			    ifa->ifa_rtrequest(RTM_ADD, rt, SA(0));
540df8bae1dSRodney W. Grimes 		}
541df8bae1dSRodney W. Grimes 		rt_newaddrmsg(cmd, ifa, error, nrt);
542df8bae1dSRodney W. Grimes 	}
543df8bae1dSRodney W. Grimes 	return (error);
544df8bae1dSRodney W. Grimes }
545