route.c revision 1.40 1 1.40 itojun /* $NetBSD: route.c,v 1.40 2001/01/27 04:49:31 itojun Exp $ */
2 1.18 kml
3 1.18 kml /*-
4 1.18 kml * Copyright (c) 1998 The NetBSD Foundation, Inc.
5 1.18 kml * All rights reserved.
6 1.18 kml *
7 1.18 kml * This code is derived from software contributed to The NetBSD Foundation
8 1.18 kml * by Kevin M. Lahey of the Numerical Aerospace Simulation Facility,
9 1.18 kml * NASA Ames Research Center.
10 1.18 kml *
11 1.18 kml * Redistribution and use in source and binary forms, with or without
12 1.18 kml * modification, are permitted provided that the following conditions
13 1.18 kml * are met:
14 1.18 kml * 1. Redistributions of source code must retain the above copyright
15 1.18 kml * notice, this list of conditions and the following disclaimer.
16 1.18 kml * 2. Redistributions in binary form must reproduce the above copyright
17 1.18 kml * notice, this list of conditions and the following disclaimer in the
18 1.18 kml * documentation and/or other materials provided with the distribution.
19 1.18 kml * 3. All advertising materials mentioning features or use of this software
20 1.18 kml * must display the following acknowledgement:
21 1.18 kml * This product includes software developed by the NetBSD
22 1.18 kml * Foundation, Inc. and its contributors.
23 1.18 kml * 4. Neither the name of The NetBSD Foundation nor the names of its
24 1.18 kml * contributors may be used to endorse or promote products derived
25 1.18 kml * from this software without specific prior written permission.
26 1.18 kml *
27 1.18 kml * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28 1.18 kml * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29 1.18 kml * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30 1.18 kml * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31 1.18 kml * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32 1.18 kml * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33 1.18 kml * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34 1.18 kml * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35 1.18 kml * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36 1.18 kml * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 1.18 kml * POSSIBILITY OF SUCH DAMAGE.
38 1.18 kml */
39 1.11 cgd
40 1.1 cgd /*
41 1.25 itojun * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
42 1.25 itojun * All rights reserved.
43 1.25 itojun *
44 1.25 itojun * Redistribution and use in source and binary forms, with or without
45 1.25 itojun * modification, are permitted provided that the following conditions
46 1.25 itojun * are met:
47 1.25 itojun * 1. Redistributions of source code must retain the above copyright
48 1.25 itojun * notice, this list of conditions and the following disclaimer.
49 1.25 itojun * 2. Redistributions in binary form must reproduce the above copyright
50 1.25 itojun * notice, this list of conditions and the following disclaimer in the
51 1.25 itojun * documentation and/or other materials provided with the distribution.
52 1.25 itojun * 3. Neither the name of the project nor the names of its contributors
53 1.25 itojun * may be used to endorse or promote products derived from this software
54 1.25 itojun * without specific prior written permission.
55 1.25 itojun *
56 1.25 itojun * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
57 1.25 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
58 1.25 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
59 1.25 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
60 1.25 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
61 1.25 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
62 1.25 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
63 1.25 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
64 1.25 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
65 1.25 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
66 1.25 itojun * SUCH DAMAGE.
67 1.25 itojun */
68 1.25 itojun
69 1.25 itojun /*
70 1.10 mycroft * Copyright (c) 1980, 1986, 1991, 1993
71 1.10 mycroft * The Regents of the University of California. All rights reserved.
72 1.1 cgd *
73 1.1 cgd * Redistribution and use in source and binary forms, with or without
74 1.1 cgd * modification, are permitted provided that the following conditions
75 1.1 cgd * are met:
76 1.1 cgd * 1. Redistributions of source code must retain the above copyright
77 1.1 cgd * notice, this list of conditions and the following disclaimer.
78 1.1 cgd * 2. Redistributions in binary form must reproduce the above copyright
79 1.1 cgd * notice, this list of conditions and the following disclaimer in the
80 1.1 cgd * documentation and/or other materials provided with the distribution.
81 1.1 cgd * 3. All advertising materials mentioning features or use of this software
82 1.1 cgd * must display the following acknowledgement:
83 1.1 cgd * This product includes software developed by the University of
84 1.1 cgd * California, Berkeley and its contributors.
85 1.1 cgd * 4. Neither the name of the University nor the names of its contributors
86 1.1 cgd * may be used to endorse or promote products derived from this software
87 1.1 cgd * without specific prior written permission.
88 1.1 cgd *
89 1.1 cgd * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
90 1.1 cgd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
91 1.1 cgd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
92 1.1 cgd * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
93 1.1 cgd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
94 1.1 cgd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
95 1.1 cgd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
96 1.1 cgd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
97 1.1 cgd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
98 1.1 cgd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
99 1.1 cgd * SUCH DAMAGE.
100 1.1 cgd *
101 1.17 christos * @(#)route.c 8.3 (Berkeley) 1/9/95
102 1.1 cgd */
103 1.19 jonathan
104 1.19 jonathan #include "opt_ns.h"
105 1.2 cgd
106 1.5 mycroft #include <sys/param.h>
107 1.5 mycroft #include <sys/systm.h>
108 1.35 thorpej #include <sys/callout.h>
109 1.5 mycroft #include <sys/proc.h>
110 1.5 mycroft #include <sys/mbuf.h>
111 1.5 mycroft #include <sys/socket.h>
112 1.5 mycroft #include <sys/socketvar.h>
113 1.5 mycroft #include <sys/domain.h>
114 1.5 mycroft #include <sys/protosw.h>
115 1.18 kml #include <sys/kernel.h>
116 1.5 mycroft #include <sys/ioctl.h>
117 1.22 thorpej #include <sys/pool.h>
118 1.1 cgd
119 1.5 mycroft #include <net/if.h>
120 1.5 mycroft #include <net/route.h>
121 1.5 mycroft #include <net/raw_cb.h>
122 1.1 cgd
123 1.5 mycroft #include <netinet/in.h>
124 1.5 mycroft #include <netinet/in_var.h>
125 1.1 cgd
126 1.1 cgd #ifdef NS
127 1.5 mycroft #include <netns/ns.h>
128 1.1 cgd #endif
129 1.5 mycroft
130 1.1 cgd #define SA(p) ((struct sockaddr *)(p))
131 1.1 cgd
132 1.1 cgd int rttrash; /* routes not in table but not freed */
133 1.1 cgd struct sockaddr wildcard; /* zero valued cookie for wildcard searches */
134 1.1 cgd
135 1.22 thorpej struct pool rtentry_pool; /* pool for rtentry structures */
136 1.22 thorpej struct pool rttimer_pool; /* pool for rttimer structures */
137 1.22 thorpej
138 1.35 thorpej struct callout rt_timer_ch; /* callout for rt_timer_timer() */
139 1.35 thorpej
140 1.40 itojun static int rtdeletemsg __P((struct rtentry *));
141 1.40 itojun
142 1.10 mycroft void
143 1.10 mycroft rtable_init(table)
144 1.10 mycroft void **table;
145 1.10 mycroft {
146 1.10 mycroft struct domain *dom;
147 1.10 mycroft for (dom = domains; dom; dom = dom->dom_next)
148 1.10 mycroft if (dom->dom_rtattach)
149 1.10 mycroft dom->dom_rtattach(&table[dom->dom_family],
150 1.10 mycroft dom->dom_rtoffset);
151 1.10 mycroft }
152 1.1 cgd
153 1.9 mycroft void
154 1.10 mycroft route_init()
155 1.1 cgd {
156 1.22 thorpej
157 1.22 thorpej pool_init(&rtentry_pool, sizeof(struct rtentry), 0, 0, 0, "rtentpl",
158 1.22 thorpej 0, NULL, NULL, M_RTABLE);
159 1.22 thorpej
160 1.10 mycroft rn_init(); /* initialize all zeroes, all ones, mask table */
161 1.10 mycroft rtable_init((void **)rt_tables);
162 1.1 cgd }
163 1.1 cgd
164 1.1 cgd /*
165 1.1 cgd * Packet routing routines.
166 1.1 cgd */
167 1.9 mycroft void
168 1.1 cgd rtalloc(ro)
169 1.36 augustss struct route *ro;
170 1.1 cgd {
171 1.1 cgd if (ro->ro_rt && ro->ro_rt->rt_ifp && (ro->ro_rt->rt_flags & RTF_UP))
172 1.1 cgd return; /* XXX */
173 1.1 cgd ro->ro_rt = rtalloc1(&ro->ro_dst, 1);
174 1.1 cgd }
175 1.25 itojun
176 1.1 cgd struct rtentry *
177 1.1 cgd rtalloc1(dst, report)
178 1.36 augustss struct sockaddr *dst;
179 1.10 mycroft int report;
180 1.1 cgd {
181 1.36 augustss struct radix_node_head *rnh = rt_tables[dst->sa_family];
182 1.36 augustss struct rtentry *rt;
183 1.36 augustss struct radix_node *rn;
184 1.1 cgd struct rtentry *newrt = 0;
185 1.10 mycroft struct rt_addrinfo info;
186 1.13 mycroft int s = splsoftnet(), err = 0, msgtype = RTM_MISS;
187 1.1 cgd
188 1.10 mycroft if (rnh && (rn = rnh->rnh_matchaddr((caddr_t)dst, rnh)) &&
189 1.1 cgd ((rn->rn_flags & RNF_ROOT) == 0)) {
190 1.1 cgd newrt = rt = (struct rtentry *)rn;
191 1.1 cgd if (report && (rt->rt_flags & RTF_CLONING)) {
192 1.8 cgd err = rtrequest(RTM_RESOLVE, dst, SA(0),
193 1.10 mycroft SA(0), 0, &newrt);
194 1.8 cgd if (err) {
195 1.8 cgd newrt = rt;
196 1.8 cgd rt->rt_refcnt++;
197 1.8 cgd goto miss;
198 1.8 cgd }
199 1.8 cgd if ((rt = newrt) && (rt->rt_flags & RTF_XRESOLVE)) {
200 1.8 cgd msgtype = RTM_RESOLVE;
201 1.8 cgd goto miss;
202 1.8 cgd }
203 1.39 itojun /* Inform listeners of the new route */
204 1.39 itojun bzero(&info, sizeof(info));
205 1.39 itojun info.rti_info[RTAX_DST] = rt_key(rt);
206 1.39 itojun info.rti_info[RTAX_NETMASK] = rt_mask(rt);
207 1.39 itojun info.rti_info[RTAX_GATEWAY] = rt->rt_gateway;
208 1.39 itojun if (rt->rt_ifp != NULL) {
209 1.39 itojun info.rti_info[RTAX_IFP] =
210 1.39 itojun rt->rt_ifp->if_addrlist.tqh_first->ifa_addr;
211 1.39 itojun info.rti_info[RTAX_IFA] = rt->rt_ifa->ifa_addr;
212 1.39 itojun }
213 1.39 itojun rt_missmsg(RTM_ADD, &info, rt->rt_flags, 0);
214 1.1 cgd } else
215 1.1 cgd rt->rt_refcnt++;
216 1.1 cgd } else {
217 1.1 cgd rtstat.rts_unreach++;
218 1.10 mycroft miss: if (report) {
219 1.10 mycroft bzero((caddr_t)&info, sizeof(info));
220 1.10 mycroft info.rti_info[RTAX_DST] = dst;
221 1.10 mycroft rt_missmsg(msgtype, &info, 0, err);
222 1.10 mycroft }
223 1.1 cgd }
224 1.1 cgd splx(s);
225 1.1 cgd return (newrt);
226 1.1 cgd }
227 1.1 cgd
228 1.9 mycroft void
229 1.1 cgd rtfree(rt)
230 1.36 augustss struct rtentry *rt;
231 1.1 cgd {
232 1.36 augustss struct ifaddr *ifa;
233 1.10 mycroft
234 1.1 cgd if (rt == 0)
235 1.1 cgd panic("rtfree");
236 1.1 cgd rt->rt_refcnt--;
237 1.1 cgd if (rt->rt_refcnt <= 0 && (rt->rt_flags & RTF_UP) == 0) {
238 1.1 cgd if (rt->rt_nodes->rn_flags & (RNF_ACTIVE | RNF_ROOT))
239 1.1 cgd panic ("rtfree 2");
240 1.10 mycroft rttrash--;
241 1.10 mycroft if (rt->rt_refcnt < 0) {
242 1.16 christos printf("rtfree: %p not freed (neg refs)\n", rt);
243 1.10 mycroft return;
244 1.10 mycroft }
245 1.18 kml rt_timer_remove_all(rt);
246 1.10 mycroft ifa = rt->rt_ifa;
247 1.10 mycroft IFAFREE(ifa);
248 1.10 mycroft Free(rt_key(rt));
249 1.22 thorpej pool_put(&rtentry_pool, rt);
250 1.1 cgd }
251 1.1 cgd }
252 1.1 cgd
253 1.10 mycroft void
254 1.10 mycroft ifafree(ifa)
255 1.36 augustss struct ifaddr *ifa;
256 1.10 mycroft {
257 1.30 thorpej
258 1.30 thorpej #ifdef DIAGNOSTIC
259 1.10 mycroft if (ifa == NULL)
260 1.30 thorpej panic("ifafree: null ifa");
261 1.30 thorpej if (ifa->ifa_refcnt != 0)
262 1.30 thorpej panic("ifafree: ifa_refcnt != 0 (%d)", ifa->ifa_refcnt);
263 1.30 thorpej #endif
264 1.31 thorpej #ifdef IFAREF_DEBUG
265 1.31 thorpej printf("ifafree: freeing ifaddr %p\n", ifa);
266 1.31 thorpej #endif
267 1.30 thorpej free(ifa, M_IFADDR);
268 1.10 mycroft }
269 1.10 mycroft
270 1.1 cgd /*
271 1.1 cgd * Force a routing table entry to the specified
272 1.1 cgd * destination to go through the given gateway.
273 1.1 cgd * Normally called as a result of a routing redirect
274 1.1 cgd * message from the network layer.
275 1.1 cgd *
276 1.13 mycroft * N.B.: must be called at splsoftnet
277 1.1 cgd */
278 1.14 christos void
279 1.1 cgd rtredirect(dst, gateway, netmask, flags, src, rtp)
280 1.1 cgd struct sockaddr *dst, *gateway, *netmask, *src;
281 1.1 cgd int flags;
282 1.1 cgd struct rtentry **rtp;
283 1.1 cgd {
284 1.36 augustss struct rtentry *rt;
285 1.1 cgd int error = 0;
286 1.1 cgd short *stat = 0;
287 1.10 mycroft struct rt_addrinfo info;
288 1.10 mycroft struct ifaddr *ifa;
289 1.1 cgd
290 1.1 cgd /* verify the gateway is directly reachable */
291 1.10 mycroft if ((ifa = ifa_ifwithnet(gateway)) == 0) {
292 1.1 cgd error = ENETUNREACH;
293 1.8 cgd goto out;
294 1.1 cgd }
295 1.1 cgd rt = rtalloc1(dst, 0);
296 1.1 cgd /*
297 1.1 cgd * If the redirect isn't from our current router for this dst,
298 1.1 cgd * it's either old or wrong. If it redirects us to ourselves,
299 1.1 cgd * we have a routing loop, perhaps as a result of an interface
300 1.1 cgd * going down recently.
301 1.1 cgd */
302 1.1 cgd #define equal(a1, a2) (bcmp((caddr_t)(a1), (caddr_t)(a2), (a1)->sa_len) == 0)
303 1.10 mycroft if (!(flags & RTF_DONE) && rt &&
304 1.10 mycroft (!equal(src, rt->rt_gateway) || rt->rt_ifa != ifa))
305 1.1 cgd error = EINVAL;
306 1.1 cgd else if (ifa_ifwithaddr(gateway))
307 1.1 cgd error = EHOSTUNREACH;
308 1.1 cgd if (error)
309 1.1 cgd goto done;
310 1.1 cgd /*
311 1.1 cgd * Create a new entry if we just got back a wildcard entry
312 1.33 soren * or the lookup failed. This is necessary for hosts
313 1.1 cgd * which use routing redirects generated by smart gateways
314 1.1 cgd * to dynamically build the routing tables.
315 1.1 cgd */
316 1.1 cgd if ((rt == 0) || (rt_mask(rt) && rt_mask(rt)->sa_len < 2))
317 1.1 cgd goto create;
318 1.1 cgd /*
319 1.1 cgd * Don't listen to the redirect if it's
320 1.1 cgd * for a route to an interface.
321 1.1 cgd */
322 1.1 cgd if (rt->rt_flags & RTF_GATEWAY) {
323 1.1 cgd if (((rt->rt_flags & RTF_HOST) == 0) && (flags & RTF_HOST)) {
324 1.1 cgd /*
325 1.1 cgd * Changing from route to net => route to host.
326 1.1 cgd * Create new route, rather than smashing route to net.
327 1.1 cgd */
328 1.1 cgd create:
329 1.39 itojun if (rt)
330 1.39 itojun rtfree(rt);
331 1.1 cgd flags |= RTF_GATEWAY | RTF_DYNAMIC;
332 1.39 itojun info.rti_info[RTAX_DST] = dst;
333 1.39 itojun info.rti_info[RTAX_GATEWAY] = gateway;
334 1.39 itojun info.rti_info[RTAX_NETMASK] = netmask;
335 1.39 itojun info.rti_ifa = ifa;
336 1.39 itojun info.rti_flags = flags;
337 1.39 itojun rt = NULL;
338 1.39 itojun error = rtrequest1(RTM_ADD, &info, &rt);
339 1.39 itojun if (rt != NULL)
340 1.39 itojun flags = rt->rt_flags;
341 1.1 cgd stat = &rtstat.rts_dynamic;
342 1.1 cgd } else {
343 1.1 cgd /*
344 1.1 cgd * Smash the current notion of the gateway to
345 1.1 cgd * this destination. Should check about netmask!!!
346 1.1 cgd */
347 1.10 mycroft rt->rt_flags |= RTF_MODIFIED;
348 1.10 mycroft flags |= RTF_MODIFIED;
349 1.10 mycroft stat = &rtstat.rts_newgateway;
350 1.10 mycroft rt_setgate(rt, rt_key(rt), gateway);
351 1.1 cgd }
352 1.1 cgd } else
353 1.1 cgd error = EHOSTUNREACH;
354 1.1 cgd done:
355 1.1 cgd if (rt) {
356 1.1 cgd if (rtp && !error)
357 1.1 cgd *rtp = rt;
358 1.1 cgd else
359 1.1 cgd rtfree(rt);
360 1.1 cgd }
361 1.8 cgd out:
362 1.1 cgd if (error)
363 1.1 cgd rtstat.rts_badredirect++;
364 1.8 cgd else if (stat != NULL)
365 1.8 cgd (*stat)++;
366 1.10 mycroft bzero((caddr_t)&info, sizeof(info));
367 1.10 mycroft info.rti_info[RTAX_DST] = dst;
368 1.10 mycroft info.rti_info[RTAX_GATEWAY] = gateway;
369 1.10 mycroft info.rti_info[RTAX_NETMASK] = netmask;
370 1.10 mycroft info.rti_info[RTAX_AUTHOR] = src;
371 1.10 mycroft rt_missmsg(RTM_REDIRECT, &info, flags, error);
372 1.1 cgd }
373 1.1 cgd
374 1.1 cgd /*
375 1.40 itojun * Delete a route and generate a message
376 1.40 itojun */
377 1.40 itojun static int
378 1.40 itojun rtdeletemsg(rt)
379 1.40 itojun struct rtentry *rt;
380 1.40 itojun {
381 1.40 itojun int error;
382 1.40 itojun struct rt_addrinfo info;
383 1.40 itojun
384 1.40 itojun /*
385 1.40 itojun * Request the new route so that the entry is not actually
386 1.40 itojun * deleted. That will allow the information being reported to
387 1.40 itojun * be accurate (and consistent with route_output()).
388 1.40 itojun */
389 1.40 itojun bzero((caddr_t)&info, sizeof(info));
390 1.40 itojun info.rti_info[RTAX_DST] = rt_key(rt);
391 1.40 itojun info.rti_info[RTAX_NETMASK] = rt_mask(rt);
392 1.40 itojun info.rti_info[RTAX_GATEWAY] = rt->rt_gateway;
393 1.40 itojun info.rti_flags = rt->rt_flags;
394 1.40 itojun error = rtrequest1(RTM_DELETE, &info, &rt);
395 1.40 itojun
396 1.40 itojun rt_missmsg(RTM_DELETE, &info, info.rti_flags, error);
397 1.40 itojun
398 1.40 itojun /* Adjust the refcount */
399 1.40 itojun if (error == 0 && rt->rt_refcnt <= 0) {
400 1.40 itojun rt->rt_refcnt++;
401 1.40 itojun rtfree(rt);
402 1.40 itojun }
403 1.40 itojun return (error);
404 1.40 itojun }
405 1.40 itojun
406 1.40 itojun /*
407 1.22 thorpej * Routing table ioctl interface.
408 1.22 thorpej */
409 1.9 mycroft int
410 1.1 cgd rtioctl(req, data, p)
411 1.12 cgd u_long req;
412 1.1 cgd caddr_t data;
413 1.1 cgd struct proc *p;
414 1.1 cgd {
415 1.1 cgd return (EOPNOTSUPP);
416 1.1 cgd }
417 1.1 cgd
418 1.1 cgd struct ifaddr *
419 1.1 cgd ifa_ifwithroute(flags, dst, gateway)
420 1.10 mycroft int flags;
421 1.10 mycroft struct sockaddr *dst, *gateway;
422 1.1 cgd {
423 1.36 augustss struct ifaddr *ifa;
424 1.1 cgd if ((flags & RTF_GATEWAY) == 0) {
425 1.1 cgd /*
426 1.1 cgd * If we are adding a route to an interface,
427 1.1 cgd * and the interface is a pt to pt link
428 1.1 cgd * we should search for the destination
429 1.1 cgd * as our clue to the interface. Otherwise
430 1.1 cgd * we can use the local address.
431 1.1 cgd */
432 1.1 cgd ifa = 0;
433 1.1 cgd if (flags & RTF_HOST)
434 1.1 cgd ifa = ifa_ifwithdstaddr(dst);
435 1.1 cgd if (ifa == 0)
436 1.1 cgd ifa = ifa_ifwithaddr(gateway);
437 1.1 cgd } else {
438 1.1 cgd /*
439 1.1 cgd * If we are adding a route to a remote net
440 1.1 cgd * or host, the gateway may still be on the
441 1.1 cgd * other end of a pt to pt link.
442 1.1 cgd */
443 1.1 cgd ifa = ifa_ifwithdstaddr(gateway);
444 1.1 cgd }
445 1.1 cgd if (ifa == 0)
446 1.1 cgd ifa = ifa_ifwithnet(gateway);
447 1.1 cgd if (ifa == 0) {
448 1.1 cgd struct rtentry *rt = rtalloc1(dst, 0);
449 1.1 cgd if (rt == 0)
450 1.1 cgd return (0);
451 1.1 cgd rt->rt_refcnt--;
452 1.1 cgd if ((ifa = rt->rt_ifa) == 0)
453 1.1 cgd return (0);
454 1.1 cgd }
455 1.1 cgd if (ifa->ifa_addr->sa_family != dst->sa_family) {
456 1.10 mycroft struct ifaddr *oifa = ifa;
457 1.1 cgd ifa = ifaof_ifpforaddr(dst, ifa->ifa_ifp);
458 1.1 cgd if (ifa == 0)
459 1.1 cgd ifa = oifa;
460 1.1 cgd }
461 1.1 cgd return (ifa);
462 1.1 cgd }
463 1.1 cgd
464 1.1 cgd #define ROUNDUP(a) (a>0 ? (1 + (((a) - 1) | (sizeof(long) - 1))) : sizeof(long))
465 1.1 cgd
466 1.9 mycroft int
467 1.1 cgd rtrequest(req, dst, gateway, netmask, flags, ret_nrt)
468 1.1 cgd int req, flags;
469 1.1 cgd struct sockaddr *dst, *gateway, *netmask;
470 1.1 cgd struct rtentry **ret_nrt;
471 1.1 cgd {
472 1.39 itojun struct rt_addrinfo info;
473 1.39 itojun
474 1.39 itojun bzero(&info, sizeof(info));
475 1.39 itojun info.rti_flags = flags;
476 1.39 itojun info.rti_info[RTAX_DST] = dst;
477 1.39 itojun info.rti_info[RTAX_GATEWAY] = gateway;
478 1.39 itojun info.rti_info[RTAX_NETMASK] = netmask;
479 1.39 itojun return rtrequest1(req, &info, ret_nrt);
480 1.39 itojun }
481 1.39 itojun
482 1.39 itojun /*
483 1.39 itojun * These (questionable) definitions of apparent local variables apply
484 1.39 itojun * to the next function. XXXXXX!!!
485 1.39 itojun */
486 1.39 itojun #define dst info->rti_info[RTAX_DST]
487 1.39 itojun #define gateway info->rti_info[RTAX_GATEWAY]
488 1.39 itojun #define netmask info->rti_info[RTAX_NETMASK]
489 1.39 itojun #define ifaaddr info->rti_info[RTAX_IFA]
490 1.39 itojun #define ifpaddr info->rti_info[RTAX_IFP]
491 1.39 itojun #define flags info->rti_flags
492 1.39 itojun
493 1.39 itojun int
494 1.39 itojun rt_getifa(info)
495 1.39 itojun struct rt_addrinfo *info;
496 1.39 itojun {
497 1.39 itojun struct ifaddr *ifa;
498 1.39 itojun int error = 0;
499 1.39 itojun
500 1.39 itojun /*
501 1.39 itojun * ifp may be specified by sockaddr_dl when protocol address
502 1.39 itojun * is ambiguous
503 1.39 itojun */
504 1.39 itojun if (info->rti_ifp == NULL && ifpaddr != NULL
505 1.39 itojun && ifpaddr->sa_family == AF_LINK &&
506 1.39 itojun (ifa = ifa_ifwithnet((struct sockaddr *)ifpaddr)) != NULL)
507 1.39 itojun info->rti_ifp = ifa->ifa_ifp;
508 1.39 itojun if (info->rti_ifa == NULL && ifaaddr != NULL)
509 1.39 itojun info->rti_ifa = ifa_ifwithaddr(ifaaddr);
510 1.39 itojun if (info->rti_ifa == NULL) {
511 1.39 itojun struct sockaddr *sa;
512 1.39 itojun
513 1.39 itojun sa = ifaaddr != NULL ? ifaaddr :
514 1.39 itojun (gateway != NULL ? gateway : dst);
515 1.39 itojun if (sa != NULL && info->rti_ifp != NULL)
516 1.39 itojun info->rti_ifa = ifaof_ifpforaddr(sa, info->rti_ifp);
517 1.39 itojun else if (dst != NULL && gateway != NULL)
518 1.39 itojun info->rti_ifa = ifa_ifwithroute(flags, dst, gateway);
519 1.39 itojun else if (sa != NULL)
520 1.39 itojun info->rti_ifa = ifa_ifwithroute(flags, sa, sa);
521 1.39 itojun }
522 1.39 itojun if ((ifa = info->rti_ifa) != NULL) {
523 1.39 itojun if (info->rti_ifp == NULL)
524 1.39 itojun info->rti_ifp = ifa->ifa_ifp;
525 1.39 itojun } else
526 1.39 itojun error = ENETUNREACH;
527 1.39 itojun return (error);
528 1.39 itojun }
529 1.39 itojun
530 1.39 itojun int
531 1.39 itojun rtrequest1(req, info, ret_nrt)
532 1.39 itojun int req;
533 1.39 itojun struct rt_addrinfo *info;
534 1.39 itojun struct rtentry **ret_nrt;
535 1.39 itojun {
536 1.13 mycroft int s = splsoftnet(); int error = 0;
537 1.40 itojun struct rtentry *rt, *crt;
538 1.36 augustss struct radix_node *rn;
539 1.36 augustss struct radix_node_head *rnh;
540 1.10 mycroft struct ifaddr *ifa;
541 1.1 cgd struct sockaddr *ndst;
542 1.1 cgd #define senderr(x) { error = x ; goto bad; }
543 1.1 cgd
544 1.10 mycroft if ((rnh = rt_tables[dst->sa_family]) == 0)
545 1.1 cgd senderr(ESRCH);
546 1.1 cgd if (flags & RTF_HOST)
547 1.1 cgd netmask = 0;
548 1.1 cgd switch (req) {
549 1.1 cgd case RTM_DELETE:
550 1.10 mycroft if ((rn = rnh->rnh_deladdr(dst, netmask, rnh)) == 0)
551 1.1 cgd senderr(ESRCH);
552 1.1 cgd if (rn->rn_flags & (RNF_ACTIVE | RNF_ROOT))
553 1.1 cgd panic ("rtrequest delete");
554 1.1 cgd rt = (struct rtentry *)rn;
555 1.10 mycroft if (rt->rt_gwroute) {
556 1.10 mycroft rt = rt->rt_gwroute; RTFREE(rt);
557 1.10 mycroft (rt = (struct rtentry *)rn)->rt_gwroute = 0;
558 1.10 mycroft }
559 1.28 erh rt->rt_flags &= ~RTF_UP;
560 1.1 cgd if ((ifa = rt->rt_ifa) && ifa->ifa_rtrequest)
561 1.39 itojun ifa->ifa_rtrequest(RTM_DELETE, rt, info);
562 1.1 cgd rttrash++;
563 1.10 mycroft if (ret_nrt)
564 1.10 mycroft *ret_nrt = rt;
565 1.10 mycroft else if (rt->rt_refcnt <= 0) {
566 1.10 mycroft rt->rt_refcnt++;
567 1.1 cgd rtfree(rt);
568 1.10 mycroft }
569 1.1 cgd break;
570 1.1 cgd
571 1.1 cgd case RTM_RESOLVE:
572 1.1 cgd if (ret_nrt == 0 || (rt = *ret_nrt) == 0)
573 1.1 cgd senderr(EINVAL);
574 1.40 itojun if ((rt->rt_flags & RTF_CLONING) == 0)
575 1.40 itojun senderr(EINVAL);
576 1.1 cgd ifa = rt->rt_ifa;
577 1.40 itojun flags = rt->rt_flags & ~(RTF_CLONING | RTF_STATIC);
578 1.40 itojun flags |= RTF_CLONED;
579 1.1 cgd gateway = rt->rt_gateway;
580 1.1 cgd if ((netmask = rt->rt_genmask) == 0)
581 1.1 cgd flags |= RTF_HOST;
582 1.1 cgd goto makeroute;
583 1.1 cgd
584 1.1 cgd case RTM_ADD:
585 1.39 itojun if (info->rti_ifa == 0 && (error = rt_getifa(info)))
586 1.39 itojun senderr(error);
587 1.39 itojun ifa = info->rti_ifa;
588 1.1 cgd makeroute:
589 1.22 thorpej rt = pool_get(&rtentry_pool, PR_NOWAIT);
590 1.1 cgd if (rt == 0)
591 1.1 cgd senderr(ENOBUFS);
592 1.10 mycroft Bzero(rt, sizeof(*rt));
593 1.10 mycroft rt->rt_flags = RTF_UP | flags;
594 1.18 kml LIST_INIT(&rt->rt_timer);
595 1.10 mycroft if (rt_setgate(rt, dst, gateway)) {
596 1.22 thorpej pool_put(&rtentry_pool, rt);
597 1.10 mycroft senderr(ENOBUFS);
598 1.10 mycroft }
599 1.10 mycroft ndst = rt_key(rt);
600 1.1 cgd if (netmask) {
601 1.1 cgd rt_maskedcopy(dst, ndst, netmask);
602 1.1 cgd } else
603 1.1 cgd Bcopy(dst, ndst, dst->sa_len);
604 1.30 thorpej IFAREF(ifa);
605 1.1 cgd rt->rt_ifa = ifa;
606 1.1 cgd rt->rt_ifp = ifa->ifa_ifp;
607 1.27 matt if (req == RTM_RESOLVE) {
608 1.1 cgd rt->rt_rmx = (*ret_nrt)->rt_rmx; /* copy metrics */
609 1.27 matt } else if (rt->rt_rmx.rmx_mtu == 0
610 1.27 matt && !(rt->rt_rmx.rmx_locks & RTV_MTU)) { /* XXX */
611 1.27 matt if (rt->rt_gwroute != NULL) {
612 1.27 matt rt->rt_rmx.rmx_mtu = rt->rt_gwroute->rt_rmx.rmx_mtu;
613 1.27 matt } else {
614 1.27 matt rt->rt_rmx.rmx_mtu = ifa->ifa_ifp->if_mtu;
615 1.27 matt }
616 1.40 itojun }
617 1.40 itojun rn = rnh->rnh_addaddr((caddr_t)ndst, (caddr_t)netmask,
618 1.40 itojun rnh, rt->rt_nodes);
619 1.40 itojun if (rn == NULL && (crt = rtalloc1(ndst, 0)) != NULL) {
620 1.40 itojun /* overwrite cloned route */
621 1.40 itojun if ((crt->rt_flags & RTF_CLONED) != 0) {
622 1.40 itojun rtdeletemsg(crt);
623 1.40 itojun rn = rnh->rnh_addaddr((caddr_t)ndst,
624 1.40 itojun (caddr_t)netmask, rnh, rt->rt_nodes);
625 1.40 itojun }
626 1.40 itojun RTFREE(crt);
627 1.40 itojun }
628 1.40 itojun if (rn == 0) {
629 1.40 itojun IFAFREE(ifa);
630 1.40 itojun if (rt->rt_gwroute)
631 1.40 itojun rtfree(rt->rt_gwroute);
632 1.40 itojun Free(rt_key(rt));
633 1.40 itojun pool_put(&rtentry_pool, rt);
634 1.40 itojun senderr(EEXIST);
635 1.27 matt }
636 1.1 cgd if (ifa->ifa_rtrequest)
637 1.39 itojun ifa->ifa_rtrequest(req, rt, info);
638 1.1 cgd if (ret_nrt) {
639 1.1 cgd *ret_nrt = rt;
640 1.1 cgd rt->rt_refcnt++;
641 1.1 cgd }
642 1.1 cgd break;
643 1.1 cgd }
644 1.1 cgd bad:
645 1.1 cgd splx(s);
646 1.1 cgd return (error);
647 1.1 cgd }
648 1.1 cgd
649 1.39 itojun #undef dst
650 1.39 itojun #undef gateway
651 1.39 itojun #undef netmask
652 1.39 itojun #undef ifaaddr
653 1.39 itojun #undef ifpaddr
654 1.39 itojun #undef flags
655 1.39 itojun
656 1.10 mycroft int
657 1.10 mycroft rt_setgate(rt0, dst, gate)
658 1.10 mycroft struct rtentry *rt0;
659 1.10 mycroft struct sockaddr *dst, *gate;
660 1.10 mycroft {
661 1.10 mycroft caddr_t new, old;
662 1.10 mycroft int dlen = ROUNDUP(dst->sa_len), glen = ROUNDUP(gate->sa_len);
663 1.36 augustss struct rtentry *rt = rt0;
664 1.10 mycroft
665 1.10 mycroft if (rt->rt_gateway == 0 || glen > ROUNDUP(rt->rt_gateway->sa_len)) {
666 1.10 mycroft old = (caddr_t)rt_key(rt);
667 1.10 mycroft R_Malloc(new, caddr_t, dlen + glen);
668 1.10 mycroft if (new == 0)
669 1.10 mycroft return 1;
670 1.32 itojun Bzero(new, dlen + glen);
671 1.10 mycroft rt->rt_nodes->rn_key = new;
672 1.10 mycroft } else {
673 1.10 mycroft new = rt->rt_nodes->rn_key;
674 1.10 mycroft old = 0;
675 1.10 mycroft }
676 1.10 mycroft Bcopy(gate, (rt->rt_gateway = (struct sockaddr *)(new + dlen)), glen);
677 1.10 mycroft if (old) {
678 1.10 mycroft Bcopy(dst, new, dlen);
679 1.10 mycroft Free(old);
680 1.10 mycroft }
681 1.10 mycroft if (rt->rt_gwroute) {
682 1.10 mycroft rt = rt->rt_gwroute; RTFREE(rt);
683 1.10 mycroft rt = rt0; rt->rt_gwroute = 0;
684 1.10 mycroft }
685 1.10 mycroft if (rt->rt_flags & RTF_GATEWAY) {
686 1.10 mycroft rt->rt_gwroute = rtalloc1(gate, 1);
687 1.27 matt /*
688 1.27 matt * If we switched gateways, grab the MTU from the new
689 1.27 matt * gateway route if the current MTU is 0 or greater
690 1.27 matt * than the MTU of gateway.
691 1.27 matt */
692 1.27 matt if (rt->rt_gwroute
693 1.27 matt && !(rt->rt_rmx.rmx_locks & RTV_MTU)
694 1.27 matt && (rt->rt_rmx.rmx_mtu == 0
695 1.27 matt || rt->rt_rmx.rmx_mtu > rt->rt_gwroute->rt_rmx.rmx_mtu)) { /* XXX */
696 1.27 matt rt->rt_rmx.rmx_mtu = rt->rt_gwroute->rt_rmx.rmx_mtu;
697 1.27 matt }
698 1.10 mycroft }
699 1.10 mycroft return 0;
700 1.10 mycroft }
701 1.10 mycroft
702 1.9 mycroft void
703 1.1 cgd rt_maskedcopy(src, dst, netmask)
704 1.9 mycroft struct sockaddr *src, *dst, *netmask;
705 1.1 cgd {
706 1.36 augustss u_char *cp1 = (u_char *)src;
707 1.36 augustss u_char *cp2 = (u_char *)dst;
708 1.36 augustss u_char *cp3 = (u_char *)netmask;
709 1.1 cgd u_char *cplim = cp2 + *cp3;
710 1.1 cgd u_char *cplim2 = cp2 + *cp1;
711 1.1 cgd
712 1.1 cgd *cp2++ = *cp1++; *cp2++ = *cp1++; /* copies sa_len & sa_family */
713 1.1 cgd cp3 += 2;
714 1.1 cgd if (cplim > cplim2)
715 1.1 cgd cplim = cplim2;
716 1.1 cgd while (cp2 < cplim)
717 1.1 cgd *cp2++ = *cp1++ & *cp3++;
718 1.1 cgd if (cp2 < cplim2)
719 1.1 cgd bzero((caddr_t)cp2, (unsigned)(cplim2 - cp2));
720 1.1 cgd }
721 1.10 mycroft
722 1.1 cgd /*
723 1.29 sommerfe * Set up or tear down a routing table entry, normally
724 1.1 cgd * for an interface.
725 1.1 cgd */
726 1.9 mycroft int
727 1.1 cgd rtinit(ifa, cmd, flags)
728 1.36 augustss struct ifaddr *ifa;
729 1.1 cgd int cmd, flags;
730 1.1 cgd {
731 1.36 augustss struct rtentry *rt;
732 1.36 augustss struct sockaddr *dst, *odst;
733 1.29 sommerfe struct sockaddr_storage deldst;
734 1.10 mycroft struct rtentry *nrt = 0;
735 1.1 cgd int error;
736 1.39 itojun struct rt_addrinfo info;
737 1.1 cgd
738 1.1 cgd dst = flags & RTF_HOST ? ifa->ifa_dstaddr : ifa->ifa_addr;
739 1.1 cgd if (cmd == RTM_DELETE) {
740 1.1 cgd if ((flags & RTF_HOST) == 0 && ifa->ifa_netmask) {
741 1.29 sommerfe /* Delete subnet route for this interface */
742 1.29 sommerfe odst = dst;
743 1.29 sommerfe dst = (struct sockaddr *)&deldst;
744 1.29 sommerfe rt_maskedcopy(odst, dst, ifa->ifa_netmask);
745 1.1 cgd }
746 1.14 christos if ((rt = rtalloc1(dst, 0)) != NULL) {
747 1.1 cgd rt->rt_refcnt--;
748 1.29 sommerfe if (rt->rt_ifa != ifa)
749 1.1 cgd return (flags & RTF_HOST ? EHOSTUNREACH
750 1.1 cgd : ENETUNREACH);
751 1.1 cgd }
752 1.1 cgd }
753 1.39 itojun bzero(&info, sizeof(info));
754 1.39 itojun info.rti_ifa = ifa;
755 1.39 itojun info.rti_flags = flags | ifa->ifa_flags;
756 1.39 itojun info.rti_info[RTAX_DST] = dst;
757 1.39 itojun info.rti_info[RTAX_GATEWAY] = ifa->ifa_addr;
758 1.39 itojun /*
759 1.39 itojun * XXX here, it seems that we are assuming that ifa_netmask is NULL
760 1.39 itojun * for RTF_HOST. bsdi4 passes NULL explicitly (via intermediate
761 1.39 itojun * variable) when RTF_HOST is 1. still not sure if i can safely
762 1.39 itojun * change it to meet bsdi4 behavior.
763 1.39 itojun */
764 1.39 itojun info.rti_info[RTAX_NETMASK] = ifa->ifa_netmask;
765 1.39 itojun error = rtrequest1(cmd, &info, &nrt);
766 1.10 mycroft if (cmd == RTM_DELETE && error == 0 && (rt = nrt)) {
767 1.10 mycroft rt_newaddrmsg(cmd, ifa, error, nrt);
768 1.10 mycroft if (rt->rt_refcnt <= 0) {
769 1.10 mycroft rt->rt_refcnt++;
770 1.10 mycroft rtfree(rt);
771 1.10 mycroft }
772 1.10 mycroft }
773 1.10 mycroft if (cmd == RTM_ADD && error == 0 && (rt = nrt)) {
774 1.10 mycroft rt->rt_refcnt--;
775 1.10 mycroft if (rt->rt_ifa != ifa) {
776 1.17 christos printf("rtinit: wrong ifa (%p) was (%p)\n", ifa,
777 1.17 christos rt->rt_ifa);
778 1.10 mycroft if (rt->rt_ifa->ifa_rtrequest)
779 1.39 itojun rt->rt_ifa->ifa_rtrequest(RTM_DELETE, rt, NULL);
780 1.10 mycroft IFAFREE(rt->rt_ifa);
781 1.10 mycroft rt->rt_ifa = ifa;
782 1.10 mycroft rt->rt_ifp = ifa->ifa_ifp;
783 1.25 itojun rt->rt_rmx.rmx_mtu = ifa->ifa_ifp->if_mtu; /*XXX*/
784 1.30 thorpej IFAREF(ifa);
785 1.10 mycroft if (ifa->ifa_rtrequest)
786 1.39 itojun ifa->ifa_rtrequest(RTM_ADD, rt, NULL);
787 1.10 mycroft }
788 1.10 mycroft rt_newaddrmsg(cmd, ifa, error, nrt);
789 1.1 cgd }
790 1.1 cgd return (error);
791 1.18 kml }
792 1.18 kml
793 1.18 kml /*
794 1.18 kml * Route timer routines. These routes allow functions to be called
795 1.18 kml * for various routes at any time. This is useful in supporting
796 1.18 kml * path MTU discovery and redirect route deletion.
797 1.18 kml *
798 1.18 kml * This is similar to some BSDI internal functions, but it provides
799 1.18 kml * for multiple queues for efficiency's sake...
800 1.18 kml */
801 1.18 kml
802 1.18 kml LIST_HEAD(, rttimer_queue) rttimer_queue_head;
803 1.18 kml static int rt_init_done = 0;
804 1.18 kml
805 1.18 kml #define RTTIMER_CALLOUT(r) { \
806 1.18 kml if (r->rtt_func != NULL) { \
807 1.20 thorpej (*r->rtt_func)(r->rtt_rt, r); \
808 1.18 kml } else { \
809 1.18 kml rtrequest((int) RTM_DELETE, \
810 1.18 kml (struct sockaddr *)rt_key(r->rtt_rt), \
811 1.18 kml 0, 0, 0, 0); \
812 1.18 kml } \
813 1.18 kml }
814 1.18 kml
815 1.18 kml /*
816 1.18 kml * Some subtle order problems with domain initialization mean that
817 1.18 kml * we cannot count on this being run from rt_init before various
818 1.18 kml * protocol initializations are done. Therefore, we make sure
819 1.18 kml * that this is run when the first queue is added...
820 1.18 kml */
821 1.18 kml
822 1.18 kml void
823 1.18 kml rt_timer_init()
824 1.18 kml {
825 1.18 kml assert(rt_init_done == 0);
826 1.18 kml
827 1.23 veego pool_init(&rttimer_pool, sizeof(struct rttimer), 0, 0, 0, "rttmrpl",
828 1.22 thorpej 0, NULL, NULL, M_RTABLE);
829 1.22 thorpej
830 1.18 kml LIST_INIT(&rttimer_queue_head);
831 1.35 thorpej callout_init(&rt_timer_ch);
832 1.35 thorpej callout_reset(&rt_timer_ch, hz, rt_timer_timer, NULL);
833 1.18 kml rt_init_done = 1;
834 1.18 kml }
835 1.18 kml
836 1.18 kml struct rttimer_queue *
837 1.18 kml rt_timer_queue_create(timeout)
838 1.18 kml u_int timeout;
839 1.18 kml {
840 1.18 kml struct rttimer_queue *rtq;
841 1.18 kml
842 1.18 kml if (rt_init_done == 0)
843 1.18 kml rt_timer_init();
844 1.18 kml
845 1.18 kml R_Malloc(rtq, struct rttimer_queue *, sizeof *rtq);
846 1.18 kml if (rtq == NULL)
847 1.24 thorpej return (NULL);
848 1.32 itojun Bzero(rtq, sizeof *rtq);
849 1.18 kml
850 1.18 kml rtq->rtq_timeout = timeout;
851 1.37 itojun rtq->rtq_count = 0;
852 1.24 thorpej TAILQ_INIT(&rtq->rtq_head);
853 1.18 kml LIST_INSERT_HEAD(&rttimer_queue_head, rtq, rtq_link);
854 1.18 kml
855 1.24 thorpej return (rtq);
856 1.18 kml }
857 1.18 kml
858 1.18 kml void
859 1.18 kml rt_timer_queue_change(rtq, timeout)
860 1.18 kml struct rttimer_queue *rtq;
861 1.18 kml long timeout;
862 1.18 kml {
863 1.24 thorpej
864 1.18 kml rtq->rtq_timeout = timeout;
865 1.18 kml }
866 1.18 kml
867 1.18 kml void
868 1.18 kml rt_timer_queue_destroy(rtq, destroy)
869 1.18 kml struct rttimer_queue *rtq;
870 1.18 kml int destroy;
871 1.18 kml {
872 1.24 thorpej struct rttimer *r;
873 1.18 kml
874 1.24 thorpej while ((r = TAILQ_FIRST(&rtq->rtq_head)) != NULL) {
875 1.18 kml LIST_REMOVE(r, rtt_link);
876 1.24 thorpej TAILQ_REMOVE(&rtq->rtq_head, r, rtt_next);
877 1.24 thorpej if (destroy)
878 1.18 kml RTTIMER_CALLOUT(r);
879 1.22 thorpej pool_put(&rttimer_pool, r);
880 1.37 itojun if (rtq->rtq_count > 0)
881 1.37 itojun rtq->rtq_count--;
882 1.37 itojun else
883 1.37 itojun printf("rt_timer_queue_destroy: rtq_count reached 0\n");
884 1.18 kml }
885 1.18 kml
886 1.18 kml LIST_REMOVE(rtq, rtq_link);
887 1.22 thorpej
888 1.22 thorpej /*
889 1.22 thorpej * Caller is responsible for freeing the rttimer_queue structure.
890 1.22 thorpej */
891 1.18 kml }
892 1.18 kml
893 1.37 itojun unsigned long
894 1.37 itojun rt_timer_count(rtq)
895 1.37 itojun struct rttimer_queue *rtq;
896 1.37 itojun {
897 1.37 itojun
898 1.37 itojun return rtq->rtq_count;
899 1.37 itojun }
900 1.37 itojun
901 1.18 kml void
902 1.18 kml rt_timer_remove_all(rt)
903 1.18 kml struct rtentry *rt;
904 1.18 kml {
905 1.24 thorpej struct rttimer *r;
906 1.18 kml
907 1.24 thorpej while ((r = LIST_FIRST(&rt->rt_timer)) != NULL) {
908 1.18 kml LIST_REMOVE(r, rtt_link);
909 1.24 thorpej TAILQ_REMOVE(&r->rtt_queue->rtq_head, r, rtt_next);
910 1.37 itojun if (r->rtt_queue->rtq_count > 0)
911 1.37 itojun r->rtt_queue->rtq_count--;
912 1.37 itojun else
913 1.37 itojun printf("rt_timer_remove_all: rtq_count reached 0\n");
914 1.38 itojun pool_put(&rttimer_pool, r);
915 1.18 kml }
916 1.18 kml }
917 1.18 kml
918 1.18 kml int
919 1.18 kml rt_timer_add(rt, func, queue)
920 1.18 kml struct rtentry *rt;
921 1.18 kml void(*func) __P((struct rtentry *, struct rttimer *));
922 1.18 kml struct rttimer_queue *queue;
923 1.18 kml {
924 1.24 thorpej struct rttimer *r;
925 1.24 thorpej long current_time;
926 1.18 kml int s;
927 1.18 kml
928 1.18 kml s = splclock();
929 1.18 kml current_time = mono_time.tv_sec;
930 1.18 kml splx(s);
931 1.18 kml
932 1.24 thorpej /*
933 1.24 thorpej * If there's already a timer with this action, destroy it before
934 1.24 thorpej * we add a new one.
935 1.24 thorpej */
936 1.24 thorpej for (r = LIST_FIRST(&rt->rt_timer); r != NULL;
937 1.24 thorpej r = LIST_NEXT(r, rtt_link)) {
938 1.18 kml if (r->rtt_func == func) {
939 1.18 kml LIST_REMOVE(r, rtt_link);
940 1.24 thorpej TAILQ_REMOVE(&r->rtt_queue->rtq_head, r, rtt_next);
941 1.37 itojun if (r->rtt_queue->rtq_count > 0)
942 1.37 itojun r->rtt_queue->rtq_count--;
943 1.37 itojun else
944 1.37 itojun printf("rt_timer_add: rtq_count reached 0\n");
945 1.38 itojun pool_put(&rttimer_pool, r);
946 1.18 kml break; /* only one per list, so we can quit... */
947 1.18 kml }
948 1.18 kml }
949 1.18 kml
950 1.24 thorpej r = pool_get(&rttimer_pool, PR_NOWAIT);
951 1.24 thorpej if (r == NULL)
952 1.24 thorpej return (ENOBUFS);
953 1.32 itojun Bzero(r, sizeof(*r));
954 1.24 thorpej
955 1.24 thorpej r->rtt_rt = rt;
956 1.24 thorpej r->rtt_time = current_time;
957 1.24 thorpej r->rtt_func = func;
958 1.24 thorpej r->rtt_queue = queue;
959 1.24 thorpej LIST_INSERT_HEAD(&rt->rt_timer, r, rtt_link);
960 1.24 thorpej TAILQ_INSERT_TAIL(&queue->rtq_head, r, rtt_next);
961 1.37 itojun r->rtt_queue->rtq_count++;
962 1.24 thorpej
963 1.24 thorpej return (0);
964 1.18 kml }
965 1.18 kml
966 1.18 kml /* ARGSUSED */
967 1.18 kml void
968 1.18 kml rt_timer_timer(arg)
969 1.18 kml void *arg;
970 1.18 kml {
971 1.24 thorpej struct rttimer_queue *rtq;
972 1.24 thorpej struct rttimer *r;
973 1.18 kml long current_time;
974 1.24 thorpej int s;
975 1.21 kml
976 1.24 thorpej s = splclock();
977 1.18 kml current_time = mono_time.tv_sec;
978 1.24 thorpej splx(s);
979 1.18 kml
980 1.24 thorpej s = splsoftnet();
981 1.18 kml for (rtq = LIST_FIRST(&rttimer_queue_head); rtq != NULL;
982 1.18 kml rtq = LIST_NEXT(rtq, rtq_link)) {
983 1.24 thorpej while ((r = TAILQ_FIRST(&rtq->rtq_head)) != NULL &&
984 1.24 thorpej (r->rtt_time + rtq->rtq_timeout) < current_time) {
985 1.24 thorpej LIST_REMOVE(r, rtt_link);
986 1.24 thorpej TAILQ_REMOVE(&rtq->rtq_head, r, rtt_next);
987 1.24 thorpej RTTIMER_CALLOUT(r);
988 1.24 thorpej pool_put(&rttimer_pool, r);
989 1.37 itojun if (rtq->rtq_count > 0)
990 1.37 itojun rtq->rtq_count--;
991 1.37 itojun else
992 1.37 itojun printf("rt_timer_timer: rtq_count reached 0\n");
993 1.18 kml }
994 1.18 kml }
995 1.24 thorpej splx(s);
996 1.18 kml
997 1.35 thorpej callout_reset(&rt_timer_ch, hz, rt_timer_timer, NULL);
998 1.1 cgd }
999