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