route.c revision 1.39 1 1.39 itojun /* $NetBSD: route.c,v 1.39 2001/01/17 04:05:42 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.10 mycroft void
141 1.10 mycroft rtable_init(table)
142 1.10 mycroft void **table;
143 1.10 mycroft {
144 1.10 mycroft struct domain *dom;
145 1.10 mycroft for (dom = domains; dom; dom = dom->dom_next)
146 1.10 mycroft if (dom->dom_rtattach)
147 1.10 mycroft dom->dom_rtattach(&table[dom->dom_family],
148 1.10 mycroft dom->dom_rtoffset);
149 1.10 mycroft }
150 1.1 cgd
151 1.9 mycroft void
152 1.10 mycroft route_init()
153 1.1 cgd {
154 1.22 thorpej
155 1.22 thorpej pool_init(&rtentry_pool, sizeof(struct rtentry), 0, 0, 0, "rtentpl",
156 1.22 thorpej 0, NULL, NULL, M_RTABLE);
157 1.22 thorpej
158 1.10 mycroft rn_init(); /* initialize all zeroes, all ones, mask table */
159 1.10 mycroft rtable_init((void **)rt_tables);
160 1.1 cgd }
161 1.1 cgd
162 1.1 cgd /*
163 1.1 cgd * Packet routing routines.
164 1.1 cgd */
165 1.9 mycroft void
166 1.1 cgd rtalloc(ro)
167 1.36 augustss struct route *ro;
168 1.1 cgd {
169 1.1 cgd if (ro->ro_rt && ro->ro_rt->rt_ifp && (ro->ro_rt->rt_flags & RTF_UP))
170 1.1 cgd return; /* XXX */
171 1.1 cgd ro->ro_rt = rtalloc1(&ro->ro_dst, 1);
172 1.1 cgd }
173 1.25 itojun
174 1.1 cgd struct rtentry *
175 1.1 cgd rtalloc1(dst, report)
176 1.36 augustss struct sockaddr *dst;
177 1.10 mycroft int report;
178 1.1 cgd {
179 1.36 augustss struct radix_node_head *rnh = rt_tables[dst->sa_family];
180 1.36 augustss struct rtentry *rt;
181 1.36 augustss struct radix_node *rn;
182 1.1 cgd struct rtentry *newrt = 0;
183 1.10 mycroft struct rt_addrinfo info;
184 1.13 mycroft int s = splsoftnet(), err = 0, msgtype = RTM_MISS;
185 1.1 cgd
186 1.10 mycroft if (rnh && (rn = rnh->rnh_matchaddr((caddr_t)dst, rnh)) &&
187 1.1 cgd ((rn->rn_flags & RNF_ROOT) == 0)) {
188 1.1 cgd newrt = rt = (struct rtentry *)rn;
189 1.1 cgd if (report && (rt->rt_flags & RTF_CLONING)) {
190 1.8 cgd err = rtrequest(RTM_RESOLVE, dst, SA(0),
191 1.10 mycroft SA(0), 0, &newrt);
192 1.8 cgd if (err) {
193 1.8 cgd newrt = rt;
194 1.8 cgd rt->rt_refcnt++;
195 1.8 cgd goto miss;
196 1.8 cgd }
197 1.8 cgd if ((rt = newrt) && (rt->rt_flags & RTF_XRESOLVE)) {
198 1.8 cgd msgtype = RTM_RESOLVE;
199 1.8 cgd goto miss;
200 1.8 cgd }
201 1.39 itojun /* Inform listeners of the new route */
202 1.39 itojun bzero(&info, sizeof(info));
203 1.39 itojun info.rti_info[RTAX_DST] = rt_key(rt);
204 1.39 itojun info.rti_info[RTAX_NETMASK] = rt_mask(rt);
205 1.39 itojun info.rti_info[RTAX_GATEWAY] = rt->rt_gateway;
206 1.39 itojun if (rt->rt_ifp != NULL) {
207 1.39 itojun info.rti_info[RTAX_IFP] =
208 1.39 itojun rt->rt_ifp->if_addrlist.tqh_first->ifa_addr;
209 1.39 itojun info.rti_info[RTAX_IFA] = rt->rt_ifa->ifa_addr;
210 1.39 itojun }
211 1.39 itojun rt_missmsg(RTM_ADD, &info, rt->rt_flags, 0);
212 1.1 cgd } else
213 1.1 cgd rt->rt_refcnt++;
214 1.1 cgd } else {
215 1.1 cgd rtstat.rts_unreach++;
216 1.10 mycroft miss: if (report) {
217 1.10 mycroft bzero((caddr_t)&info, sizeof(info));
218 1.10 mycroft info.rti_info[RTAX_DST] = dst;
219 1.10 mycroft rt_missmsg(msgtype, &info, 0, err);
220 1.10 mycroft }
221 1.1 cgd }
222 1.1 cgd splx(s);
223 1.1 cgd return (newrt);
224 1.1 cgd }
225 1.1 cgd
226 1.9 mycroft void
227 1.1 cgd rtfree(rt)
228 1.36 augustss struct rtentry *rt;
229 1.1 cgd {
230 1.36 augustss struct ifaddr *ifa;
231 1.10 mycroft
232 1.1 cgd if (rt == 0)
233 1.1 cgd panic("rtfree");
234 1.1 cgd rt->rt_refcnt--;
235 1.1 cgd if (rt->rt_refcnt <= 0 && (rt->rt_flags & RTF_UP) == 0) {
236 1.1 cgd if (rt->rt_nodes->rn_flags & (RNF_ACTIVE | RNF_ROOT))
237 1.1 cgd panic ("rtfree 2");
238 1.10 mycroft rttrash--;
239 1.10 mycroft if (rt->rt_refcnt < 0) {
240 1.16 christos printf("rtfree: %p not freed (neg refs)\n", rt);
241 1.10 mycroft return;
242 1.10 mycroft }
243 1.18 kml rt_timer_remove_all(rt);
244 1.10 mycroft ifa = rt->rt_ifa;
245 1.10 mycroft IFAFREE(ifa);
246 1.10 mycroft Free(rt_key(rt));
247 1.22 thorpej pool_put(&rtentry_pool, rt);
248 1.1 cgd }
249 1.1 cgd }
250 1.1 cgd
251 1.10 mycroft void
252 1.10 mycroft ifafree(ifa)
253 1.36 augustss struct ifaddr *ifa;
254 1.10 mycroft {
255 1.30 thorpej
256 1.30 thorpej #ifdef DIAGNOSTIC
257 1.10 mycroft if (ifa == NULL)
258 1.30 thorpej panic("ifafree: null ifa");
259 1.30 thorpej if (ifa->ifa_refcnt != 0)
260 1.30 thorpej panic("ifafree: ifa_refcnt != 0 (%d)", ifa->ifa_refcnt);
261 1.30 thorpej #endif
262 1.31 thorpej #ifdef IFAREF_DEBUG
263 1.31 thorpej printf("ifafree: freeing ifaddr %p\n", ifa);
264 1.31 thorpej #endif
265 1.30 thorpej free(ifa, M_IFADDR);
266 1.10 mycroft }
267 1.10 mycroft
268 1.1 cgd /*
269 1.1 cgd * Force a routing table entry to the specified
270 1.1 cgd * destination to go through the given gateway.
271 1.1 cgd * Normally called as a result of a routing redirect
272 1.1 cgd * message from the network layer.
273 1.1 cgd *
274 1.13 mycroft * N.B.: must be called at splsoftnet
275 1.1 cgd */
276 1.14 christos void
277 1.1 cgd rtredirect(dst, gateway, netmask, flags, src, rtp)
278 1.1 cgd struct sockaddr *dst, *gateway, *netmask, *src;
279 1.1 cgd int flags;
280 1.1 cgd struct rtentry **rtp;
281 1.1 cgd {
282 1.36 augustss struct rtentry *rt;
283 1.1 cgd int error = 0;
284 1.1 cgd short *stat = 0;
285 1.10 mycroft struct rt_addrinfo info;
286 1.10 mycroft struct ifaddr *ifa;
287 1.1 cgd
288 1.1 cgd /* verify the gateway is directly reachable */
289 1.10 mycroft if ((ifa = ifa_ifwithnet(gateway)) == 0) {
290 1.1 cgd error = ENETUNREACH;
291 1.8 cgd goto out;
292 1.1 cgd }
293 1.1 cgd rt = rtalloc1(dst, 0);
294 1.1 cgd /*
295 1.1 cgd * If the redirect isn't from our current router for this dst,
296 1.1 cgd * it's either old or wrong. If it redirects us to ourselves,
297 1.1 cgd * we have a routing loop, perhaps as a result of an interface
298 1.1 cgd * going down recently.
299 1.1 cgd */
300 1.1 cgd #define equal(a1, a2) (bcmp((caddr_t)(a1), (caddr_t)(a2), (a1)->sa_len) == 0)
301 1.10 mycroft if (!(flags & RTF_DONE) && rt &&
302 1.10 mycroft (!equal(src, rt->rt_gateway) || rt->rt_ifa != ifa))
303 1.1 cgd error = EINVAL;
304 1.1 cgd else if (ifa_ifwithaddr(gateway))
305 1.1 cgd error = EHOSTUNREACH;
306 1.1 cgd if (error)
307 1.1 cgd goto done;
308 1.1 cgd /*
309 1.1 cgd * Create a new entry if we just got back a wildcard entry
310 1.33 soren * or the lookup failed. This is necessary for hosts
311 1.1 cgd * which use routing redirects generated by smart gateways
312 1.1 cgd * to dynamically build the routing tables.
313 1.1 cgd */
314 1.1 cgd if ((rt == 0) || (rt_mask(rt) && rt_mask(rt)->sa_len < 2))
315 1.1 cgd goto create;
316 1.1 cgd /*
317 1.1 cgd * Don't listen to the redirect if it's
318 1.1 cgd * for a route to an interface.
319 1.1 cgd */
320 1.1 cgd if (rt->rt_flags & RTF_GATEWAY) {
321 1.1 cgd if (((rt->rt_flags & RTF_HOST) == 0) && (flags & RTF_HOST)) {
322 1.1 cgd /*
323 1.1 cgd * Changing from route to net => route to host.
324 1.1 cgd * Create new route, rather than smashing route to net.
325 1.1 cgd */
326 1.1 cgd create:
327 1.39 itojun if (rt)
328 1.39 itojun rtfree(rt);
329 1.1 cgd flags |= RTF_GATEWAY | RTF_DYNAMIC;
330 1.39 itojun info.rti_info[RTAX_DST] = dst;
331 1.39 itojun info.rti_info[RTAX_GATEWAY] = gateway;
332 1.39 itojun info.rti_info[RTAX_NETMASK] = netmask;
333 1.39 itojun info.rti_ifa = ifa;
334 1.39 itojun info.rti_flags = flags;
335 1.39 itojun rt = NULL;
336 1.39 itojun error = rtrequest1(RTM_ADD, &info, &rt);
337 1.39 itojun if (rt != NULL)
338 1.39 itojun flags = rt->rt_flags;
339 1.1 cgd stat = &rtstat.rts_dynamic;
340 1.1 cgd } else {
341 1.1 cgd /*
342 1.1 cgd * Smash the current notion of the gateway to
343 1.1 cgd * this destination. Should check about netmask!!!
344 1.1 cgd */
345 1.10 mycroft rt->rt_flags |= RTF_MODIFIED;
346 1.10 mycroft flags |= RTF_MODIFIED;
347 1.10 mycroft stat = &rtstat.rts_newgateway;
348 1.10 mycroft rt_setgate(rt, rt_key(rt), gateway);
349 1.1 cgd }
350 1.1 cgd } else
351 1.1 cgd error = EHOSTUNREACH;
352 1.1 cgd done:
353 1.1 cgd if (rt) {
354 1.1 cgd if (rtp && !error)
355 1.1 cgd *rtp = rt;
356 1.1 cgd else
357 1.1 cgd rtfree(rt);
358 1.1 cgd }
359 1.8 cgd out:
360 1.1 cgd if (error)
361 1.1 cgd rtstat.rts_badredirect++;
362 1.8 cgd else if (stat != NULL)
363 1.8 cgd (*stat)++;
364 1.10 mycroft bzero((caddr_t)&info, sizeof(info));
365 1.10 mycroft info.rti_info[RTAX_DST] = dst;
366 1.10 mycroft info.rti_info[RTAX_GATEWAY] = gateway;
367 1.10 mycroft info.rti_info[RTAX_NETMASK] = netmask;
368 1.10 mycroft info.rti_info[RTAX_AUTHOR] = src;
369 1.10 mycroft rt_missmsg(RTM_REDIRECT, &info, flags, error);
370 1.1 cgd }
371 1.1 cgd
372 1.1 cgd /*
373 1.22 thorpej * Routing table ioctl interface.
374 1.22 thorpej */
375 1.9 mycroft int
376 1.1 cgd rtioctl(req, data, p)
377 1.12 cgd u_long req;
378 1.1 cgd caddr_t data;
379 1.1 cgd struct proc *p;
380 1.1 cgd {
381 1.1 cgd return (EOPNOTSUPP);
382 1.1 cgd }
383 1.1 cgd
384 1.1 cgd struct ifaddr *
385 1.1 cgd ifa_ifwithroute(flags, dst, gateway)
386 1.10 mycroft int flags;
387 1.10 mycroft struct sockaddr *dst, *gateway;
388 1.1 cgd {
389 1.36 augustss struct ifaddr *ifa;
390 1.1 cgd if ((flags & RTF_GATEWAY) == 0) {
391 1.1 cgd /*
392 1.1 cgd * If we are adding a route to an interface,
393 1.1 cgd * and the interface is a pt to pt link
394 1.1 cgd * we should search for the destination
395 1.1 cgd * as our clue to the interface. Otherwise
396 1.1 cgd * we can use the local address.
397 1.1 cgd */
398 1.1 cgd ifa = 0;
399 1.1 cgd if (flags & RTF_HOST)
400 1.1 cgd ifa = ifa_ifwithdstaddr(dst);
401 1.1 cgd if (ifa == 0)
402 1.1 cgd ifa = ifa_ifwithaddr(gateway);
403 1.1 cgd } else {
404 1.1 cgd /*
405 1.1 cgd * If we are adding a route to a remote net
406 1.1 cgd * or host, the gateway may still be on the
407 1.1 cgd * other end of a pt to pt link.
408 1.1 cgd */
409 1.1 cgd ifa = ifa_ifwithdstaddr(gateway);
410 1.1 cgd }
411 1.1 cgd if (ifa == 0)
412 1.1 cgd ifa = ifa_ifwithnet(gateway);
413 1.1 cgd if (ifa == 0) {
414 1.1 cgd struct rtentry *rt = rtalloc1(dst, 0);
415 1.1 cgd if (rt == 0)
416 1.1 cgd return (0);
417 1.1 cgd rt->rt_refcnt--;
418 1.1 cgd if ((ifa = rt->rt_ifa) == 0)
419 1.1 cgd return (0);
420 1.1 cgd }
421 1.1 cgd if (ifa->ifa_addr->sa_family != dst->sa_family) {
422 1.10 mycroft struct ifaddr *oifa = ifa;
423 1.1 cgd ifa = ifaof_ifpforaddr(dst, ifa->ifa_ifp);
424 1.1 cgd if (ifa == 0)
425 1.1 cgd ifa = oifa;
426 1.1 cgd }
427 1.1 cgd return (ifa);
428 1.1 cgd }
429 1.1 cgd
430 1.1 cgd #define ROUNDUP(a) (a>0 ? (1 + (((a) - 1) | (sizeof(long) - 1))) : sizeof(long))
431 1.1 cgd
432 1.9 mycroft int
433 1.1 cgd rtrequest(req, dst, gateway, netmask, flags, ret_nrt)
434 1.1 cgd int req, flags;
435 1.1 cgd struct sockaddr *dst, *gateway, *netmask;
436 1.1 cgd struct rtentry **ret_nrt;
437 1.1 cgd {
438 1.39 itojun struct rt_addrinfo info;
439 1.39 itojun
440 1.39 itojun bzero(&info, sizeof(info));
441 1.39 itojun info.rti_flags = flags;
442 1.39 itojun info.rti_info[RTAX_DST] = dst;
443 1.39 itojun info.rti_info[RTAX_GATEWAY] = gateway;
444 1.39 itojun info.rti_info[RTAX_NETMASK] = netmask;
445 1.39 itojun return rtrequest1(req, &info, ret_nrt);
446 1.39 itojun }
447 1.39 itojun
448 1.39 itojun /*
449 1.39 itojun * These (questionable) definitions of apparent local variables apply
450 1.39 itojun * to the next function. XXXXXX!!!
451 1.39 itojun */
452 1.39 itojun #define dst info->rti_info[RTAX_DST]
453 1.39 itojun #define gateway info->rti_info[RTAX_GATEWAY]
454 1.39 itojun #define netmask info->rti_info[RTAX_NETMASK]
455 1.39 itojun #define ifaaddr info->rti_info[RTAX_IFA]
456 1.39 itojun #define ifpaddr info->rti_info[RTAX_IFP]
457 1.39 itojun #define flags info->rti_flags
458 1.39 itojun
459 1.39 itojun int
460 1.39 itojun rt_getifa(info)
461 1.39 itojun struct rt_addrinfo *info;
462 1.39 itojun {
463 1.39 itojun struct ifaddr *ifa;
464 1.39 itojun int error = 0;
465 1.39 itojun
466 1.39 itojun /*
467 1.39 itojun * ifp may be specified by sockaddr_dl when protocol address
468 1.39 itojun * is ambiguous
469 1.39 itojun */
470 1.39 itojun if (info->rti_ifp == NULL && ifpaddr != NULL
471 1.39 itojun && ifpaddr->sa_family == AF_LINK &&
472 1.39 itojun (ifa = ifa_ifwithnet((struct sockaddr *)ifpaddr)) != NULL)
473 1.39 itojun info->rti_ifp = ifa->ifa_ifp;
474 1.39 itojun if (info->rti_ifa == NULL && ifaaddr != NULL)
475 1.39 itojun info->rti_ifa = ifa_ifwithaddr(ifaaddr);
476 1.39 itojun if (info->rti_ifa == NULL) {
477 1.39 itojun struct sockaddr *sa;
478 1.39 itojun
479 1.39 itojun sa = ifaaddr != NULL ? ifaaddr :
480 1.39 itojun (gateway != NULL ? gateway : dst);
481 1.39 itojun if (sa != NULL && info->rti_ifp != NULL)
482 1.39 itojun info->rti_ifa = ifaof_ifpforaddr(sa, info->rti_ifp);
483 1.39 itojun else if (dst != NULL && gateway != NULL)
484 1.39 itojun info->rti_ifa = ifa_ifwithroute(flags, dst, gateway);
485 1.39 itojun else if (sa != NULL)
486 1.39 itojun info->rti_ifa = ifa_ifwithroute(flags, sa, sa);
487 1.39 itojun }
488 1.39 itojun if ((ifa = info->rti_ifa) != NULL) {
489 1.39 itojun if (info->rti_ifp == NULL)
490 1.39 itojun info->rti_ifp = ifa->ifa_ifp;
491 1.39 itojun } else
492 1.39 itojun error = ENETUNREACH;
493 1.39 itojun return (error);
494 1.39 itojun }
495 1.39 itojun
496 1.39 itojun int
497 1.39 itojun rtrequest1(req, info, ret_nrt)
498 1.39 itojun int req;
499 1.39 itojun struct rt_addrinfo *info;
500 1.39 itojun struct rtentry **ret_nrt;
501 1.39 itojun {
502 1.13 mycroft int s = splsoftnet(); int error = 0;
503 1.36 augustss struct rtentry *rt;
504 1.36 augustss struct radix_node *rn;
505 1.36 augustss struct radix_node_head *rnh;
506 1.10 mycroft struct ifaddr *ifa;
507 1.1 cgd struct sockaddr *ndst;
508 1.1 cgd #define senderr(x) { error = x ; goto bad; }
509 1.1 cgd
510 1.10 mycroft if ((rnh = rt_tables[dst->sa_family]) == 0)
511 1.1 cgd senderr(ESRCH);
512 1.1 cgd if (flags & RTF_HOST)
513 1.1 cgd netmask = 0;
514 1.1 cgd switch (req) {
515 1.1 cgd case RTM_DELETE:
516 1.10 mycroft if ((rn = rnh->rnh_deladdr(dst, netmask, rnh)) == 0)
517 1.1 cgd senderr(ESRCH);
518 1.1 cgd if (rn->rn_flags & (RNF_ACTIVE | RNF_ROOT))
519 1.1 cgd panic ("rtrequest delete");
520 1.1 cgd rt = (struct rtentry *)rn;
521 1.10 mycroft if (rt->rt_gwroute) {
522 1.10 mycroft rt = rt->rt_gwroute; RTFREE(rt);
523 1.10 mycroft (rt = (struct rtentry *)rn)->rt_gwroute = 0;
524 1.10 mycroft }
525 1.28 erh rt->rt_flags &= ~RTF_UP;
526 1.1 cgd if ((ifa = rt->rt_ifa) && ifa->ifa_rtrequest)
527 1.39 itojun ifa->ifa_rtrequest(RTM_DELETE, rt, info);
528 1.1 cgd rttrash++;
529 1.10 mycroft if (ret_nrt)
530 1.10 mycroft *ret_nrt = rt;
531 1.10 mycroft else if (rt->rt_refcnt <= 0) {
532 1.10 mycroft rt->rt_refcnt++;
533 1.1 cgd rtfree(rt);
534 1.10 mycroft }
535 1.1 cgd break;
536 1.1 cgd
537 1.1 cgd case RTM_RESOLVE:
538 1.1 cgd if (ret_nrt == 0 || (rt = *ret_nrt) == 0)
539 1.1 cgd senderr(EINVAL);
540 1.1 cgd ifa = rt->rt_ifa;
541 1.1 cgd flags = rt->rt_flags & ~RTF_CLONING;
542 1.1 cgd gateway = rt->rt_gateway;
543 1.1 cgd if ((netmask = rt->rt_genmask) == 0)
544 1.1 cgd flags |= RTF_HOST;
545 1.1 cgd goto makeroute;
546 1.1 cgd
547 1.1 cgd case RTM_ADD:
548 1.39 itojun if (info->rti_ifa == 0 && (error = rt_getifa(info)))
549 1.39 itojun senderr(error);
550 1.39 itojun ifa = info->rti_ifa;
551 1.1 cgd makeroute:
552 1.22 thorpej rt = pool_get(&rtentry_pool, PR_NOWAIT);
553 1.1 cgd if (rt == 0)
554 1.1 cgd senderr(ENOBUFS);
555 1.10 mycroft Bzero(rt, sizeof(*rt));
556 1.10 mycroft rt->rt_flags = RTF_UP | flags;
557 1.18 kml LIST_INIT(&rt->rt_timer);
558 1.10 mycroft if (rt_setgate(rt, dst, gateway)) {
559 1.22 thorpej pool_put(&rtentry_pool, rt);
560 1.10 mycroft senderr(ENOBUFS);
561 1.10 mycroft }
562 1.10 mycroft ndst = rt_key(rt);
563 1.1 cgd if (netmask) {
564 1.1 cgd rt_maskedcopy(dst, ndst, netmask);
565 1.1 cgd } else
566 1.1 cgd Bcopy(dst, ndst, dst->sa_len);
567 1.10 mycroft rn = rnh->rnh_addaddr((caddr_t)ndst, (caddr_t)netmask,
568 1.10 mycroft rnh, rt->rt_nodes);
569 1.1 cgd if (rn == 0) {
570 1.10 mycroft if (rt->rt_gwroute)
571 1.10 mycroft rtfree(rt->rt_gwroute);
572 1.10 mycroft Free(rt_key(rt));
573 1.22 thorpej pool_put(&rtentry_pool, rt);
574 1.1 cgd senderr(EEXIST);
575 1.1 cgd }
576 1.30 thorpej IFAREF(ifa);
577 1.1 cgd rt->rt_ifa = ifa;
578 1.1 cgd rt->rt_ifp = ifa->ifa_ifp;
579 1.27 matt if (req == RTM_RESOLVE) {
580 1.1 cgd rt->rt_rmx = (*ret_nrt)->rt_rmx; /* copy metrics */
581 1.27 matt } else if (rt->rt_rmx.rmx_mtu == 0
582 1.27 matt && !(rt->rt_rmx.rmx_locks & RTV_MTU)) { /* XXX */
583 1.27 matt if (rt->rt_gwroute != NULL) {
584 1.27 matt rt->rt_rmx.rmx_mtu = rt->rt_gwroute->rt_rmx.rmx_mtu;
585 1.27 matt } else {
586 1.27 matt rt->rt_rmx.rmx_mtu = ifa->ifa_ifp->if_mtu;
587 1.27 matt }
588 1.27 matt }
589 1.1 cgd if (ifa->ifa_rtrequest)
590 1.39 itojun ifa->ifa_rtrequest(req, rt, info);
591 1.1 cgd if (ret_nrt) {
592 1.1 cgd *ret_nrt = rt;
593 1.1 cgd rt->rt_refcnt++;
594 1.1 cgd }
595 1.1 cgd break;
596 1.1 cgd }
597 1.1 cgd bad:
598 1.1 cgd splx(s);
599 1.1 cgd return (error);
600 1.1 cgd }
601 1.1 cgd
602 1.39 itojun #undef dst
603 1.39 itojun #undef gateway
604 1.39 itojun #undef netmask
605 1.39 itojun #undef ifaaddr
606 1.39 itojun #undef ifpaddr
607 1.39 itojun #undef flags
608 1.39 itojun
609 1.10 mycroft int
610 1.10 mycroft rt_setgate(rt0, dst, gate)
611 1.10 mycroft struct rtentry *rt0;
612 1.10 mycroft struct sockaddr *dst, *gate;
613 1.10 mycroft {
614 1.10 mycroft caddr_t new, old;
615 1.10 mycroft int dlen = ROUNDUP(dst->sa_len), glen = ROUNDUP(gate->sa_len);
616 1.36 augustss struct rtentry *rt = rt0;
617 1.10 mycroft
618 1.10 mycroft if (rt->rt_gateway == 0 || glen > ROUNDUP(rt->rt_gateway->sa_len)) {
619 1.10 mycroft old = (caddr_t)rt_key(rt);
620 1.10 mycroft R_Malloc(new, caddr_t, dlen + glen);
621 1.10 mycroft if (new == 0)
622 1.10 mycroft return 1;
623 1.32 itojun Bzero(new, dlen + glen);
624 1.10 mycroft rt->rt_nodes->rn_key = new;
625 1.10 mycroft } else {
626 1.10 mycroft new = rt->rt_nodes->rn_key;
627 1.10 mycroft old = 0;
628 1.10 mycroft }
629 1.10 mycroft Bcopy(gate, (rt->rt_gateway = (struct sockaddr *)(new + dlen)), glen);
630 1.10 mycroft if (old) {
631 1.10 mycroft Bcopy(dst, new, dlen);
632 1.10 mycroft Free(old);
633 1.10 mycroft }
634 1.10 mycroft if (rt->rt_gwroute) {
635 1.10 mycroft rt = rt->rt_gwroute; RTFREE(rt);
636 1.10 mycroft rt = rt0; rt->rt_gwroute = 0;
637 1.10 mycroft }
638 1.10 mycroft if (rt->rt_flags & RTF_GATEWAY) {
639 1.10 mycroft rt->rt_gwroute = rtalloc1(gate, 1);
640 1.27 matt /*
641 1.27 matt * If we switched gateways, grab the MTU from the new
642 1.27 matt * gateway route if the current MTU is 0 or greater
643 1.27 matt * than the MTU of gateway.
644 1.27 matt */
645 1.27 matt if (rt->rt_gwroute
646 1.27 matt && !(rt->rt_rmx.rmx_locks & RTV_MTU)
647 1.27 matt && (rt->rt_rmx.rmx_mtu == 0
648 1.27 matt || rt->rt_rmx.rmx_mtu > rt->rt_gwroute->rt_rmx.rmx_mtu)) { /* XXX */
649 1.27 matt rt->rt_rmx.rmx_mtu = rt->rt_gwroute->rt_rmx.rmx_mtu;
650 1.27 matt }
651 1.10 mycroft }
652 1.10 mycroft return 0;
653 1.10 mycroft }
654 1.10 mycroft
655 1.9 mycroft void
656 1.1 cgd rt_maskedcopy(src, dst, netmask)
657 1.9 mycroft struct sockaddr *src, *dst, *netmask;
658 1.1 cgd {
659 1.36 augustss u_char *cp1 = (u_char *)src;
660 1.36 augustss u_char *cp2 = (u_char *)dst;
661 1.36 augustss u_char *cp3 = (u_char *)netmask;
662 1.1 cgd u_char *cplim = cp2 + *cp3;
663 1.1 cgd u_char *cplim2 = cp2 + *cp1;
664 1.1 cgd
665 1.1 cgd *cp2++ = *cp1++; *cp2++ = *cp1++; /* copies sa_len & sa_family */
666 1.1 cgd cp3 += 2;
667 1.1 cgd if (cplim > cplim2)
668 1.1 cgd cplim = cplim2;
669 1.1 cgd while (cp2 < cplim)
670 1.1 cgd *cp2++ = *cp1++ & *cp3++;
671 1.1 cgd if (cp2 < cplim2)
672 1.1 cgd bzero((caddr_t)cp2, (unsigned)(cplim2 - cp2));
673 1.1 cgd }
674 1.10 mycroft
675 1.1 cgd /*
676 1.29 sommerfe * Set up or tear down a routing table entry, normally
677 1.1 cgd * for an interface.
678 1.1 cgd */
679 1.9 mycroft int
680 1.1 cgd rtinit(ifa, cmd, flags)
681 1.36 augustss struct ifaddr *ifa;
682 1.1 cgd int cmd, flags;
683 1.1 cgd {
684 1.36 augustss struct rtentry *rt;
685 1.36 augustss struct sockaddr *dst, *odst;
686 1.29 sommerfe struct sockaddr_storage deldst;
687 1.10 mycroft struct rtentry *nrt = 0;
688 1.1 cgd int error;
689 1.39 itojun struct rt_addrinfo info;
690 1.1 cgd
691 1.1 cgd dst = flags & RTF_HOST ? ifa->ifa_dstaddr : ifa->ifa_addr;
692 1.1 cgd if (cmd == RTM_DELETE) {
693 1.1 cgd if ((flags & RTF_HOST) == 0 && ifa->ifa_netmask) {
694 1.29 sommerfe /* Delete subnet route for this interface */
695 1.29 sommerfe odst = dst;
696 1.29 sommerfe dst = (struct sockaddr *)&deldst;
697 1.29 sommerfe rt_maskedcopy(odst, dst, ifa->ifa_netmask);
698 1.1 cgd }
699 1.14 christos if ((rt = rtalloc1(dst, 0)) != NULL) {
700 1.1 cgd rt->rt_refcnt--;
701 1.29 sommerfe if (rt->rt_ifa != ifa)
702 1.1 cgd return (flags & RTF_HOST ? EHOSTUNREACH
703 1.1 cgd : ENETUNREACH);
704 1.1 cgd }
705 1.1 cgd }
706 1.39 itojun bzero(&info, sizeof(info));
707 1.39 itojun info.rti_ifa = ifa;
708 1.39 itojun info.rti_flags = flags | ifa->ifa_flags;
709 1.39 itojun info.rti_info[RTAX_DST] = dst;
710 1.39 itojun info.rti_info[RTAX_GATEWAY] = ifa->ifa_addr;
711 1.39 itojun /*
712 1.39 itojun * XXX here, it seems that we are assuming that ifa_netmask is NULL
713 1.39 itojun * for RTF_HOST. bsdi4 passes NULL explicitly (via intermediate
714 1.39 itojun * variable) when RTF_HOST is 1. still not sure if i can safely
715 1.39 itojun * change it to meet bsdi4 behavior.
716 1.39 itojun */
717 1.39 itojun info.rti_info[RTAX_NETMASK] = ifa->ifa_netmask;
718 1.39 itojun error = rtrequest1(cmd, &info, &nrt);
719 1.10 mycroft if (cmd == RTM_DELETE && error == 0 && (rt = nrt)) {
720 1.10 mycroft rt_newaddrmsg(cmd, ifa, error, nrt);
721 1.10 mycroft if (rt->rt_refcnt <= 0) {
722 1.10 mycroft rt->rt_refcnt++;
723 1.10 mycroft rtfree(rt);
724 1.10 mycroft }
725 1.10 mycroft }
726 1.10 mycroft if (cmd == RTM_ADD && error == 0 && (rt = nrt)) {
727 1.10 mycroft rt->rt_refcnt--;
728 1.10 mycroft if (rt->rt_ifa != ifa) {
729 1.17 christos printf("rtinit: wrong ifa (%p) was (%p)\n", ifa,
730 1.17 christos rt->rt_ifa);
731 1.10 mycroft if (rt->rt_ifa->ifa_rtrequest)
732 1.39 itojun rt->rt_ifa->ifa_rtrequest(RTM_DELETE, rt, NULL);
733 1.10 mycroft IFAFREE(rt->rt_ifa);
734 1.10 mycroft rt->rt_ifa = ifa;
735 1.10 mycroft rt->rt_ifp = ifa->ifa_ifp;
736 1.25 itojun rt->rt_rmx.rmx_mtu = ifa->ifa_ifp->if_mtu; /*XXX*/
737 1.30 thorpej IFAREF(ifa);
738 1.10 mycroft if (ifa->ifa_rtrequest)
739 1.39 itojun ifa->ifa_rtrequest(RTM_ADD, rt, NULL);
740 1.10 mycroft }
741 1.10 mycroft rt_newaddrmsg(cmd, ifa, error, nrt);
742 1.1 cgd }
743 1.1 cgd return (error);
744 1.18 kml }
745 1.18 kml
746 1.18 kml /*
747 1.18 kml * Route timer routines. These routes allow functions to be called
748 1.18 kml * for various routes at any time. This is useful in supporting
749 1.18 kml * path MTU discovery and redirect route deletion.
750 1.18 kml *
751 1.18 kml * This is similar to some BSDI internal functions, but it provides
752 1.18 kml * for multiple queues for efficiency's sake...
753 1.18 kml */
754 1.18 kml
755 1.18 kml LIST_HEAD(, rttimer_queue) rttimer_queue_head;
756 1.18 kml static int rt_init_done = 0;
757 1.18 kml
758 1.18 kml #define RTTIMER_CALLOUT(r) { \
759 1.18 kml if (r->rtt_func != NULL) { \
760 1.20 thorpej (*r->rtt_func)(r->rtt_rt, r); \
761 1.18 kml } else { \
762 1.18 kml rtrequest((int) RTM_DELETE, \
763 1.18 kml (struct sockaddr *)rt_key(r->rtt_rt), \
764 1.18 kml 0, 0, 0, 0); \
765 1.18 kml } \
766 1.18 kml }
767 1.18 kml
768 1.18 kml /*
769 1.18 kml * Some subtle order problems with domain initialization mean that
770 1.18 kml * we cannot count on this being run from rt_init before various
771 1.18 kml * protocol initializations are done. Therefore, we make sure
772 1.18 kml * that this is run when the first queue is added...
773 1.18 kml */
774 1.18 kml
775 1.18 kml void
776 1.18 kml rt_timer_init()
777 1.18 kml {
778 1.18 kml assert(rt_init_done == 0);
779 1.18 kml
780 1.23 veego pool_init(&rttimer_pool, sizeof(struct rttimer), 0, 0, 0, "rttmrpl",
781 1.22 thorpej 0, NULL, NULL, M_RTABLE);
782 1.22 thorpej
783 1.18 kml LIST_INIT(&rttimer_queue_head);
784 1.35 thorpej callout_init(&rt_timer_ch);
785 1.35 thorpej callout_reset(&rt_timer_ch, hz, rt_timer_timer, NULL);
786 1.18 kml rt_init_done = 1;
787 1.18 kml }
788 1.18 kml
789 1.18 kml struct rttimer_queue *
790 1.18 kml rt_timer_queue_create(timeout)
791 1.18 kml u_int timeout;
792 1.18 kml {
793 1.18 kml struct rttimer_queue *rtq;
794 1.18 kml
795 1.18 kml if (rt_init_done == 0)
796 1.18 kml rt_timer_init();
797 1.18 kml
798 1.18 kml R_Malloc(rtq, struct rttimer_queue *, sizeof *rtq);
799 1.18 kml if (rtq == NULL)
800 1.24 thorpej return (NULL);
801 1.32 itojun Bzero(rtq, sizeof *rtq);
802 1.18 kml
803 1.18 kml rtq->rtq_timeout = timeout;
804 1.37 itojun rtq->rtq_count = 0;
805 1.24 thorpej TAILQ_INIT(&rtq->rtq_head);
806 1.18 kml LIST_INSERT_HEAD(&rttimer_queue_head, rtq, rtq_link);
807 1.18 kml
808 1.24 thorpej return (rtq);
809 1.18 kml }
810 1.18 kml
811 1.18 kml void
812 1.18 kml rt_timer_queue_change(rtq, timeout)
813 1.18 kml struct rttimer_queue *rtq;
814 1.18 kml long timeout;
815 1.18 kml {
816 1.24 thorpej
817 1.18 kml rtq->rtq_timeout = timeout;
818 1.18 kml }
819 1.18 kml
820 1.18 kml void
821 1.18 kml rt_timer_queue_destroy(rtq, destroy)
822 1.18 kml struct rttimer_queue *rtq;
823 1.18 kml int destroy;
824 1.18 kml {
825 1.24 thorpej struct rttimer *r;
826 1.18 kml
827 1.24 thorpej while ((r = TAILQ_FIRST(&rtq->rtq_head)) != NULL) {
828 1.18 kml LIST_REMOVE(r, rtt_link);
829 1.24 thorpej TAILQ_REMOVE(&rtq->rtq_head, r, rtt_next);
830 1.24 thorpej if (destroy)
831 1.18 kml RTTIMER_CALLOUT(r);
832 1.22 thorpej pool_put(&rttimer_pool, r);
833 1.37 itojun if (rtq->rtq_count > 0)
834 1.37 itojun rtq->rtq_count--;
835 1.37 itojun else
836 1.37 itojun printf("rt_timer_queue_destroy: rtq_count reached 0\n");
837 1.18 kml }
838 1.18 kml
839 1.18 kml LIST_REMOVE(rtq, rtq_link);
840 1.22 thorpej
841 1.22 thorpej /*
842 1.22 thorpej * Caller is responsible for freeing the rttimer_queue structure.
843 1.22 thorpej */
844 1.18 kml }
845 1.18 kml
846 1.37 itojun unsigned long
847 1.37 itojun rt_timer_count(rtq)
848 1.37 itojun struct rttimer_queue *rtq;
849 1.37 itojun {
850 1.37 itojun
851 1.37 itojun return rtq->rtq_count;
852 1.37 itojun }
853 1.37 itojun
854 1.18 kml void
855 1.18 kml rt_timer_remove_all(rt)
856 1.18 kml struct rtentry *rt;
857 1.18 kml {
858 1.24 thorpej struct rttimer *r;
859 1.18 kml
860 1.24 thorpej while ((r = LIST_FIRST(&rt->rt_timer)) != NULL) {
861 1.18 kml LIST_REMOVE(r, rtt_link);
862 1.24 thorpej TAILQ_REMOVE(&r->rtt_queue->rtq_head, r, rtt_next);
863 1.37 itojun if (r->rtt_queue->rtq_count > 0)
864 1.37 itojun r->rtt_queue->rtq_count--;
865 1.37 itojun else
866 1.37 itojun printf("rt_timer_remove_all: rtq_count reached 0\n");
867 1.38 itojun pool_put(&rttimer_pool, r);
868 1.18 kml }
869 1.18 kml }
870 1.18 kml
871 1.18 kml int
872 1.18 kml rt_timer_add(rt, func, queue)
873 1.18 kml struct rtentry *rt;
874 1.18 kml void(*func) __P((struct rtentry *, struct rttimer *));
875 1.18 kml struct rttimer_queue *queue;
876 1.18 kml {
877 1.24 thorpej struct rttimer *r;
878 1.24 thorpej long current_time;
879 1.18 kml int s;
880 1.18 kml
881 1.18 kml s = splclock();
882 1.18 kml current_time = mono_time.tv_sec;
883 1.18 kml splx(s);
884 1.18 kml
885 1.24 thorpej /*
886 1.24 thorpej * If there's already a timer with this action, destroy it before
887 1.24 thorpej * we add a new one.
888 1.24 thorpej */
889 1.24 thorpej for (r = LIST_FIRST(&rt->rt_timer); r != NULL;
890 1.24 thorpej r = LIST_NEXT(r, rtt_link)) {
891 1.18 kml if (r->rtt_func == func) {
892 1.18 kml LIST_REMOVE(r, rtt_link);
893 1.24 thorpej TAILQ_REMOVE(&r->rtt_queue->rtq_head, r, rtt_next);
894 1.37 itojun if (r->rtt_queue->rtq_count > 0)
895 1.37 itojun r->rtt_queue->rtq_count--;
896 1.37 itojun else
897 1.37 itojun printf("rt_timer_add: rtq_count reached 0\n");
898 1.38 itojun pool_put(&rttimer_pool, r);
899 1.18 kml break; /* only one per list, so we can quit... */
900 1.18 kml }
901 1.18 kml }
902 1.18 kml
903 1.24 thorpej r = pool_get(&rttimer_pool, PR_NOWAIT);
904 1.24 thorpej if (r == NULL)
905 1.24 thorpej return (ENOBUFS);
906 1.32 itojun Bzero(r, sizeof(*r));
907 1.24 thorpej
908 1.24 thorpej r->rtt_rt = rt;
909 1.24 thorpej r->rtt_time = current_time;
910 1.24 thorpej r->rtt_func = func;
911 1.24 thorpej r->rtt_queue = queue;
912 1.24 thorpej LIST_INSERT_HEAD(&rt->rt_timer, r, rtt_link);
913 1.24 thorpej TAILQ_INSERT_TAIL(&queue->rtq_head, r, rtt_next);
914 1.37 itojun r->rtt_queue->rtq_count++;
915 1.24 thorpej
916 1.24 thorpej return (0);
917 1.18 kml }
918 1.18 kml
919 1.18 kml /* ARGSUSED */
920 1.18 kml void
921 1.18 kml rt_timer_timer(arg)
922 1.18 kml void *arg;
923 1.18 kml {
924 1.24 thorpej struct rttimer_queue *rtq;
925 1.24 thorpej struct rttimer *r;
926 1.18 kml long current_time;
927 1.24 thorpej int s;
928 1.21 kml
929 1.24 thorpej s = splclock();
930 1.18 kml current_time = mono_time.tv_sec;
931 1.24 thorpej splx(s);
932 1.18 kml
933 1.24 thorpej s = splsoftnet();
934 1.18 kml for (rtq = LIST_FIRST(&rttimer_queue_head); rtq != NULL;
935 1.18 kml rtq = LIST_NEXT(rtq, rtq_link)) {
936 1.24 thorpej while ((r = TAILQ_FIRST(&rtq->rtq_head)) != NULL &&
937 1.24 thorpej (r->rtt_time + rtq->rtq_timeout) < current_time) {
938 1.24 thorpej LIST_REMOVE(r, rtt_link);
939 1.24 thorpej TAILQ_REMOVE(&rtq->rtq_head, r, rtt_next);
940 1.24 thorpej RTTIMER_CALLOUT(r);
941 1.24 thorpej pool_put(&rttimer_pool, r);
942 1.37 itojun if (rtq->rtq_count > 0)
943 1.37 itojun rtq->rtq_count--;
944 1.37 itojun else
945 1.37 itojun printf("rt_timer_timer: rtq_count reached 0\n");
946 1.18 kml }
947 1.18 kml }
948 1.24 thorpej splx(s);
949 1.18 kml
950 1.35 thorpej callout_reset(&rt_timer_ch, hz, rt_timer_timer, NULL);
951 1.1 cgd }
952