1 /* 2 * Copyright (c) 2004, 2005 The DragonFly Project. All rights reserved. 3 * 4 * This code is derived from software contributed to The DragonFly Project 5 * by Jeffrey M. Hsu. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 3. Neither the name of The DragonFly Project nor the names of its 16 * contributors may be used to endorse or promote products derived 17 * from this software without specific, prior written permission. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 21 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 22 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE 23 * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 24 * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING, 25 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 26 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 27 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 28 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT 29 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30 * SUCH DAMAGE. 31 */ 32 33 /* 34 * Copyright (c) 1980, 1986, 1991, 1993 35 * The Regents of the University of California. All rights reserved. 36 * 37 * Redistribution and use in source and binary forms, with or without 38 * modification, are permitted provided that the following conditions 39 * are met: 40 * 1. Redistributions of source code must retain the above copyright 41 * notice, this list of conditions and the following disclaimer. 42 * 2. Redistributions in binary form must reproduce the above copyright 43 * notice, this list of conditions and the following disclaimer in the 44 * documentation and/or other materials provided with the distribution. 45 * 3. Neither the name of the University nor the names of its contributors 46 * may be used to endorse or promote products derived from this software 47 * without specific prior written permission. 48 * 49 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 50 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 51 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 52 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 53 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 54 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 55 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 56 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 57 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 58 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 59 * SUCH DAMAGE. 60 * 61 * @(#)route.c 8.3 (Berkeley) 1/9/95 62 * $FreeBSD: src/sys/net/route.c,v 1.59.2.10 2003/01/17 08:04:00 ru Exp $ 63 */ 64 65 #include "opt_inet.h" 66 #include "opt_mpls.h" 67 68 #include <sys/param.h> 69 #include <sys/systm.h> 70 #include <sys/malloc.h> 71 #include <sys/mbuf.h> 72 #include <sys/socket.h> 73 #include <sys/domain.h> 74 #include <sys/kernel.h> 75 #include <sys/sysctl.h> 76 #include <sys/globaldata.h> 77 #include <sys/thread.h> 78 79 #include <net/if.h> 80 #include <net/route.h> 81 #include <net/netisr.h> 82 83 #include <netinet/in.h> 84 #include <net/ip_mroute/ip_mroute.h> 85 86 #include <sys/thread2.h> 87 #include <sys/msgport2.h> 88 #include <net/netmsg2.h> 89 #include <net/netisr2.h> 90 91 #ifdef MPLS 92 #include <netproto/mpls/mpls.h> 93 #endif 94 95 static struct rtstatistics rtstatistics_percpu[MAXCPU]; 96 #define rtstat rtstatistics_percpu[mycpuid] 97 98 struct radix_node_head *rt_tables[MAXCPU][AF_MAX+1]; 99 100 static void rt_maskedcopy (struct sockaddr *, struct sockaddr *, 101 struct sockaddr *); 102 static void rtable_init(void); 103 static void rtinit_rtrequest_callback(int, int, struct rt_addrinfo *, 104 struct rtentry *, void *); 105 106 static void rtredirect_msghandler(netmsg_t msg); 107 static void rtrequest1_msghandler(netmsg_t msg); 108 static void rtsearch_msghandler(netmsg_t msg); 109 static void rtmask_add_msghandler(netmsg_t msg); 110 111 static int rt_setshims(struct rtentry *, struct sockaddr **); 112 113 SYSCTL_NODE(_net, OID_AUTO, route, CTLFLAG_RW, 0, "Routing"); 114 115 #ifdef ROUTE_DEBUG 116 static int route_debug = 1; 117 SYSCTL_INT(_net_route, OID_AUTO, route_debug, CTLFLAG_RW, 118 &route_debug, 0, ""); 119 #endif 120 121 int route_assert_owner_access = 1; 122 SYSCTL_INT(_net_route, OID_AUTO, assert_owner_access, CTLFLAG_RW, 123 &route_assert_owner_access, 0, ""); 124 125 u_long route_kmalloc_limit = 0; 126 TUNABLE_ULONG("net.route.kmalloc_limit", &route_kmalloc_limit); 127 128 /* 129 * Initialize the route table(s) for protocol domains and 130 * create a helper thread which will be responsible for updating 131 * route table entries on each cpu. 132 */ 133 void 134 route_init(void) 135 { 136 int cpu; 137 138 for (cpu = 0; cpu < ncpus; ++cpu) 139 bzero(&rtstatistics_percpu[cpu], sizeof(struct rtstatistics)); 140 rn_init(); /* initialize all zeroes, all ones, mask table */ 141 rtable_init(); /* call dom_rtattach() on each cpu */ 142 143 if (route_kmalloc_limit) 144 kmalloc_raise_limit(M_RTABLE, route_kmalloc_limit); 145 } 146 147 static void 148 rtable_init_oncpu(netmsg_t msg) 149 { 150 struct domain *dom; 151 int cpu = mycpuid; 152 153 SLIST_FOREACH(dom, &domains, dom_next) { 154 if (dom->dom_rtattach) { 155 dom->dom_rtattach( 156 (void **)&rt_tables[cpu][dom->dom_family], 157 dom->dom_rtoffset); 158 } 159 } 160 ifnet_forwardmsg(&msg->lmsg, cpu + 1); 161 } 162 163 static void 164 rtable_init(void) 165 { 166 struct netmsg_base msg; 167 168 netmsg_init(&msg, NULL, &curthread->td_msgport, 0, rtable_init_oncpu); 169 ifnet_domsg(&msg.lmsg, 0); 170 } 171 172 /* 173 * Routing statistics. 174 */ 175 static int 176 sysctl_rtstatistics(SYSCTL_HANDLER_ARGS) 177 { 178 int cpu, error = 0; 179 180 for (cpu = 0; cpu < ncpus; ++cpu) { 181 if ((error = SYSCTL_OUT(req, &rtstatistics_percpu[cpu], 182 sizeof(struct rtstatistics)))) 183 break; 184 if ((error = SYSCTL_IN(req, &rtstatistics_percpu[cpu], 185 sizeof(struct rtstatistics)))) 186 break; 187 } 188 189 return (error); 190 } 191 SYSCTL_PROC(_net_route, OID_AUTO, stats, (CTLTYPE_OPAQUE|CTLFLAG_RW), 192 0, 0, sysctl_rtstatistics, "S,rtstatistics", "Routing statistics"); 193 194 /* 195 * Packet routing routines. 196 */ 197 198 /* 199 * Look up and fill in the "ro_rt" rtentry field in a route structure given 200 * an address in the "ro_dst" field. Always send a report on a miss and 201 * always clone routes. 202 */ 203 void 204 rtalloc(struct route *ro) 205 { 206 rtalloc_ign(ro, 0UL); 207 } 208 209 /* 210 * Look up and fill in the "ro_rt" rtentry field in a route structure given 211 * an address in the "ro_dst" field. Always send a report on a miss and 212 * optionally clone routes when RTF_CLONING or RTF_PRCLONING are not being 213 * ignored. 214 */ 215 void 216 rtalloc_ign(struct route *ro, u_long ignoreflags) 217 { 218 if (ro->ro_rt != NULL) { 219 if (ro->ro_rt->rt_ifp != NULL && ro->ro_rt->rt_flags & RTF_UP) 220 return; 221 rtfree(ro->ro_rt); 222 ro->ro_rt = NULL; 223 } 224 ro->ro_rt = _rtlookup(&ro->ro_dst, RTL_REPORTMSG, ignoreflags); 225 } 226 227 /* 228 * Look up the route that matches the given "dst" address. 229 * 230 * Route lookup can have the side-effect of creating and returning 231 * a cloned route instead when "dst" matches a cloning route and the 232 * RTF_CLONING and RTF_PRCLONING flags are not being ignored. 233 * 234 * Any route returned has its reference count incremented. 235 */ 236 struct rtentry * 237 _rtlookup(struct sockaddr *dst, boolean_t generate_report, u_long ignore) 238 { 239 struct radix_node_head *rnh = rt_tables[mycpuid][dst->sa_family]; 240 struct rtentry *rt; 241 242 if (rnh == NULL) 243 goto unreach; 244 245 /* 246 * Look up route in the radix tree. 247 */ 248 rt = (struct rtentry *) rnh->rnh_matchaddr((char *)dst, rnh); 249 if (rt == NULL) 250 goto unreach; 251 252 /* 253 * Handle cloning routes. 254 */ 255 if ((rt->rt_flags & ~ignore & (RTF_CLONING | RTF_PRCLONING)) != 0) { 256 struct rtentry *clonedroute; 257 int error; 258 259 clonedroute = rt; /* copy in/copy out parameter */ 260 error = rtrequest(RTM_RESOLVE, dst, NULL, NULL, 0, 261 &clonedroute); /* clone the route */ 262 if (error != 0) { /* cloning failed */ 263 if (generate_report) 264 rt_dstmsg(RTM_MISS, dst, error); 265 rt->rt_refcnt++; 266 return (rt); /* return the uncloned route */ 267 } 268 if (generate_report) { 269 if (clonedroute->rt_flags & RTF_XRESOLVE) 270 rt_dstmsg(RTM_RESOLVE, dst, 0); 271 else 272 rt_rtmsg(RTM_ADD, clonedroute, 273 clonedroute->rt_ifp, 0); 274 } 275 return (clonedroute); /* return cloned route */ 276 } 277 278 /* 279 * Increment the reference count of the matched route and return. 280 */ 281 rt->rt_refcnt++; 282 return (rt); 283 284 unreach: 285 rtstat.rts_unreach++; 286 if (generate_report) 287 rt_dstmsg(RTM_MISS, dst, 0); 288 return (NULL); 289 } 290 291 void 292 rtfree(struct rtentry *rt) 293 { 294 if (rt->rt_cpuid == mycpuid) 295 rtfree_oncpu(rt); 296 else 297 rtfree_remote(rt); 298 } 299 300 void 301 rtfree_oncpu(struct rtentry *rt) 302 { 303 KKASSERT(rt->rt_cpuid == mycpuid); 304 KASSERT(rt->rt_refcnt > 0, ("rtfree: rt_refcnt %ld", rt->rt_refcnt)); 305 306 --rt->rt_refcnt; 307 if (rt->rt_refcnt == 0) { 308 struct radix_node_head *rnh = 309 rt_tables[mycpuid][rt_key(rt)->sa_family]; 310 311 if (rnh->rnh_close) 312 rnh->rnh_close((struct radix_node *)rt, rnh); 313 if (!(rt->rt_flags & RTF_UP)) { 314 /* deallocate route */ 315 if (rt->rt_ifa != NULL) 316 IFAFREE(rt->rt_ifa); 317 if (rt->rt_parent != NULL) 318 RTFREE(rt->rt_parent); /* recursive call! */ 319 Free(rt_key(rt)); 320 Free(rt); 321 } 322 } 323 } 324 325 static void 326 rtfree_remote_dispatch(netmsg_t msg) 327 { 328 struct lwkt_msg *lmsg = &msg->lmsg; 329 struct rtentry *rt = lmsg->u.ms_resultp; 330 331 rtfree_oncpu(rt); 332 lwkt_replymsg(lmsg, 0); 333 } 334 335 void 336 rtfree_remote(struct rtentry *rt) 337 { 338 struct netmsg_base *msg; 339 struct lwkt_msg *lmsg; 340 341 KKASSERT(rt->rt_cpuid != mycpuid); 342 343 if (route_assert_owner_access) { 344 panic("rt remote free rt_cpuid %d, mycpuid %d", 345 rt->rt_cpuid, mycpuid); 346 } else { 347 kprintf("rt remote free rt_cpuid %d, mycpuid %d\n", 348 rt->rt_cpuid, mycpuid); 349 print_backtrace(-1); 350 } 351 352 msg = kmalloc(sizeof(*msg), M_LWKTMSG, M_INTWAIT); 353 netmsg_init(msg, NULL, &netisr_afree_rport, 0, rtfree_remote_dispatch); 354 lmsg = &msg->lmsg; 355 lmsg->u.ms_resultp = rt; 356 357 lwkt_sendmsg(netisr_cpuport(rt->rt_cpuid), lmsg); 358 } 359 360 static int 361 rtredirect_oncpu(struct sockaddr *dst, struct sockaddr *gateway, 362 struct sockaddr *netmask, int flags, struct sockaddr *src) 363 { 364 struct rtentry *rt = NULL; 365 struct rt_addrinfo rtinfo; 366 struct ifaddr *ifa; 367 u_long *stat = NULL; 368 int error; 369 370 /* verify the gateway is directly reachable */ 371 if ((ifa = ifa_ifwithnet(gateway)) == NULL) { 372 error = ENETUNREACH; 373 goto out; 374 } 375 376 /* 377 * If the redirect isn't from our current router for this destination, 378 * it's either old or wrong. 379 */ 380 if (!(flags & RTF_DONE) && /* XXX JH */ 381 (rt = rtpurelookup(dst)) != NULL && 382 (!sa_equal(src, rt->rt_gateway) || rt->rt_ifa != ifa)) { 383 error = EINVAL; 384 goto done; 385 } 386 387 /* 388 * If it redirects us to ourselves, we have a routing loop, 389 * perhaps as a result of an interface going down recently. 390 */ 391 if (ifa_ifwithaddr(gateway)) { 392 error = EHOSTUNREACH; 393 goto done; 394 } 395 396 /* 397 * Create a new entry if the lookup failed or if we got back 398 * a wildcard entry for the default route. This is necessary 399 * for hosts which use routing redirects generated by smart 400 * gateways to dynamically build the routing tables. 401 */ 402 if (rt == NULL) 403 goto create; 404 if ((rt_mask(rt) != NULL && rt_mask(rt)->sa_len < 2)) { 405 rtfree(rt); 406 goto create; 407 } 408 409 /* Ignore redirects for directly connected hosts. */ 410 if (!(rt->rt_flags & RTF_GATEWAY)) { 411 error = EHOSTUNREACH; 412 goto done; 413 } 414 415 if (!(rt->rt_flags & RTF_HOST) && (flags & RTF_HOST)) { 416 /* 417 * Changing from a network route to a host route. 418 * Create a new host route rather than smashing the 419 * network route. 420 */ 421 create: 422 flags |= RTF_GATEWAY | RTF_DYNAMIC; 423 bzero(&rtinfo, sizeof(struct rt_addrinfo)); 424 rtinfo.rti_info[RTAX_DST] = dst; 425 rtinfo.rti_info[RTAX_GATEWAY] = gateway; 426 rtinfo.rti_info[RTAX_NETMASK] = netmask; 427 rtinfo.rti_flags = flags; 428 rtinfo.rti_ifa = ifa; 429 rt = NULL; /* copy-in/copy-out parameter */ 430 error = rtrequest1(RTM_ADD, &rtinfo, &rt); 431 if (rt != NULL) 432 flags = rt->rt_flags; 433 stat = &rtstat.rts_dynamic; 434 } else { 435 /* 436 * Smash the current notion of the gateway to this destination. 437 * Should check about netmask!!! 438 */ 439 rt->rt_flags |= RTF_MODIFIED; 440 flags |= RTF_MODIFIED; 441 442 /* We only need to report rtmsg on CPU0 */ 443 rt_setgate(rt, rt_key(rt), gateway, 444 mycpuid == 0 ? RTL_REPORTMSG : RTL_DONTREPORT); 445 error = 0; 446 stat = &rtstat.rts_newgateway; 447 } 448 449 done: 450 if (rt != NULL) 451 rtfree(rt); 452 out: 453 if (error != 0) 454 rtstat.rts_badredirect++; 455 else if (stat != NULL) 456 (*stat)++; 457 458 return error; 459 } 460 461 struct netmsg_rtredirect { 462 struct netmsg_base base; 463 struct sockaddr *dst; 464 struct sockaddr *gateway; 465 struct sockaddr *netmask; 466 int flags; 467 struct sockaddr *src; 468 }; 469 470 /* 471 * Force a routing table entry to the specified 472 * destination to go through the given gateway. 473 * Normally called as a result of a routing redirect 474 * message from the network layer. 475 * 476 * N.B.: must be called at splnet 477 */ 478 void 479 rtredirect(struct sockaddr *dst, struct sockaddr *gateway, 480 struct sockaddr *netmask, int flags, struct sockaddr *src) 481 { 482 struct rt_addrinfo rtinfo; 483 int error; 484 struct netmsg_rtredirect msg; 485 486 netmsg_init(&msg.base, NULL, &curthread->td_msgport, 487 0, rtredirect_msghandler); 488 msg.dst = dst; 489 msg.gateway = gateway; 490 msg.netmask = netmask; 491 msg.flags = flags; 492 msg.src = src; 493 error = rt_domsg_global(&msg.base); 494 bzero(&rtinfo, sizeof(struct rt_addrinfo)); 495 rtinfo.rti_info[RTAX_DST] = dst; 496 rtinfo.rti_info[RTAX_GATEWAY] = gateway; 497 rtinfo.rti_info[RTAX_NETMASK] = netmask; 498 rtinfo.rti_info[RTAX_AUTHOR] = src; 499 rt_missmsg(RTM_REDIRECT, &rtinfo, flags, error); 500 } 501 502 static void 503 rtredirect_msghandler(netmsg_t msg) 504 { 505 struct netmsg_rtredirect *rmsg = (void *)msg; 506 int nextcpu; 507 508 rtredirect_oncpu(rmsg->dst, rmsg->gateway, rmsg->netmask, 509 rmsg->flags, rmsg->src); 510 nextcpu = mycpuid + 1; 511 if (nextcpu < ncpus) 512 lwkt_forwardmsg(netisr_cpuport(nextcpu), &msg->lmsg); 513 else 514 lwkt_replymsg(&msg->lmsg, 0); 515 } 516 517 /* 518 * Routing table ioctl interface. 519 */ 520 int 521 rtioctl(u_long req, caddr_t data, struct ucred *cred) 522 { 523 #ifdef INET 524 /* Multicast goop, grrr... */ 525 return mrt_ioctl ? mrt_ioctl(req, data) : EOPNOTSUPP; 526 #else 527 return ENXIO; 528 #endif 529 } 530 531 struct ifaddr * 532 ifa_ifwithroute(int flags, struct sockaddr *dst, struct sockaddr *gateway) 533 { 534 struct ifaddr *ifa; 535 536 if (!(flags & RTF_GATEWAY)) { 537 /* 538 * If we are adding a route to an interface, 539 * and the interface is a point-to-point link, 540 * we should search for the destination 541 * as our clue to the interface. Otherwise 542 * we can use the local address. 543 */ 544 ifa = NULL; 545 if (flags & RTF_HOST) { 546 ifa = ifa_ifwithdstaddr(dst); 547 } 548 if (ifa == NULL) 549 ifa = ifa_ifwithaddr(gateway); 550 } else { 551 /* 552 * If we are adding a route to a remote net 553 * or host, the gateway may still be on the 554 * other end of a pt to pt link. 555 */ 556 ifa = ifa_ifwithdstaddr(gateway); 557 } 558 if (ifa == NULL) 559 ifa = ifa_ifwithnet(gateway); 560 if (ifa == NULL) { 561 struct rtentry *rt; 562 563 rt = rtpurelookup(gateway); 564 if (rt == NULL) 565 return (NULL); 566 rt->rt_refcnt--; 567 if ((ifa = rt->rt_ifa) == NULL) 568 return (NULL); 569 } 570 if (ifa->ifa_addr->sa_family != dst->sa_family) { 571 struct ifaddr *oldifa = ifa; 572 573 ifa = ifaof_ifpforaddr(dst, ifa->ifa_ifp); 574 if (ifa == NULL) 575 ifa = oldifa; 576 } 577 return (ifa); 578 } 579 580 static int rt_fixdelete (struct radix_node *, void *); 581 static int rt_fixchange (struct radix_node *, void *); 582 583 struct rtfc_arg { 584 struct rtentry *rt0; 585 struct radix_node_head *rnh; 586 }; 587 588 /* 589 * Set rtinfo->rti_ifa and rtinfo->rti_ifp. 590 */ 591 int 592 rt_getifa(struct rt_addrinfo *rtinfo) 593 { 594 struct sockaddr *gateway = rtinfo->rti_info[RTAX_GATEWAY]; 595 struct sockaddr *dst = rtinfo->rti_info[RTAX_DST]; 596 struct sockaddr *ifaaddr = rtinfo->rti_info[RTAX_IFA]; 597 int flags = rtinfo->rti_flags; 598 599 /* 600 * ifp may be specified by sockaddr_dl 601 * when protocol address is ambiguous. 602 */ 603 if (rtinfo->rti_ifp == NULL) { 604 struct sockaddr *ifpaddr; 605 606 ifpaddr = rtinfo->rti_info[RTAX_IFP]; 607 if (ifpaddr != NULL && ifpaddr->sa_family == AF_LINK) { 608 struct ifaddr *ifa; 609 610 ifa = ifa_ifwithnet(ifpaddr); 611 if (ifa != NULL) 612 rtinfo->rti_ifp = ifa->ifa_ifp; 613 } 614 } 615 616 if (rtinfo->rti_ifa == NULL && ifaaddr != NULL) 617 rtinfo->rti_ifa = ifa_ifwithaddr(ifaaddr); 618 if (rtinfo->rti_ifa == NULL) { 619 struct sockaddr *sa; 620 621 sa = ifaaddr != NULL ? ifaaddr : 622 (gateway != NULL ? gateway : dst); 623 if (sa != NULL && rtinfo->rti_ifp != NULL) 624 rtinfo->rti_ifa = ifaof_ifpforaddr(sa, rtinfo->rti_ifp); 625 else if (dst != NULL && gateway != NULL) 626 rtinfo->rti_ifa = ifa_ifwithroute(flags, dst, gateway); 627 else if (sa != NULL) 628 rtinfo->rti_ifa = ifa_ifwithroute(flags, sa, sa); 629 } 630 if (rtinfo->rti_ifa == NULL) 631 return (ENETUNREACH); 632 633 if (rtinfo->rti_ifp == NULL) 634 rtinfo->rti_ifp = rtinfo->rti_ifa->ifa_ifp; 635 return (0); 636 } 637 638 /* 639 * Do appropriate manipulations of a routing tree given 640 * all the bits of info needed 641 */ 642 int 643 rtrequest( 644 int req, 645 struct sockaddr *dst, 646 struct sockaddr *gateway, 647 struct sockaddr *netmask, 648 int flags, 649 struct rtentry **ret_nrt) 650 { 651 struct rt_addrinfo rtinfo; 652 653 bzero(&rtinfo, sizeof(struct rt_addrinfo)); 654 rtinfo.rti_info[RTAX_DST] = dst; 655 rtinfo.rti_info[RTAX_GATEWAY] = gateway; 656 rtinfo.rti_info[RTAX_NETMASK] = netmask; 657 rtinfo.rti_flags = flags; 658 return rtrequest1(req, &rtinfo, ret_nrt); 659 } 660 661 int 662 rtrequest_global( 663 int req, 664 struct sockaddr *dst, 665 struct sockaddr *gateway, 666 struct sockaddr *netmask, 667 int flags) 668 { 669 struct rt_addrinfo rtinfo; 670 671 bzero(&rtinfo, sizeof(struct rt_addrinfo)); 672 rtinfo.rti_info[RTAX_DST] = dst; 673 rtinfo.rti_info[RTAX_GATEWAY] = gateway; 674 rtinfo.rti_info[RTAX_NETMASK] = netmask; 675 rtinfo.rti_flags = flags; 676 return rtrequest1_global(req, &rtinfo, NULL, NULL, RTREQ_PRIO_NORM); 677 } 678 679 struct netmsg_rtq { 680 struct netmsg_base base; 681 int req; 682 struct rt_addrinfo *rtinfo; 683 rtrequest1_callback_func_t callback; 684 void *arg; 685 }; 686 687 int 688 rtrequest1_global(int req, struct rt_addrinfo *rtinfo, 689 rtrequest1_callback_func_t callback, void *arg, boolean_t req_prio) 690 { 691 int error, flags = 0; 692 struct netmsg_rtq msg; 693 694 if (req_prio) 695 flags = MSGF_PRIORITY; 696 netmsg_init(&msg.base, NULL, &curthread->td_msgport, flags, 697 rtrequest1_msghandler); 698 msg.base.lmsg.ms_error = -1; 699 msg.req = req; 700 msg.rtinfo = rtinfo; 701 msg.callback = callback; 702 msg.arg = arg; 703 error = rt_domsg_global(&msg.base); 704 return (error); 705 } 706 707 /* 708 * Handle a route table request on the current cpu. Since the route table's 709 * are supposed to be identical on each cpu, an error occuring later in the 710 * message chain is considered system-fatal. 711 */ 712 static void 713 rtrequest1_msghandler(netmsg_t msg) 714 { 715 struct netmsg_rtq *rmsg = (void *)msg; 716 struct rt_addrinfo rtinfo; 717 struct rtentry *rt = NULL; 718 int nextcpu; 719 int error; 720 721 /* 722 * Copy the rtinfo. We need to make sure that the original 723 * rtinfo, which is setup by the caller, in the netmsg will 724 * _not_ be changed; else the next CPU on the netmsg forwarding 725 * path will see a different rtinfo than what this CPU has seen. 726 */ 727 rtinfo = *rmsg->rtinfo; 728 729 error = rtrequest1(rmsg->req, &rtinfo, &rt); 730 if (rt) 731 --rt->rt_refcnt; 732 if (rmsg->callback) 733 rmsg->callback(rmsg->req, error, &rtinfo, rt, rmsg->arg); 734 735 /* 736 * RTM_DELETE's are propogated even if an error occurs, since a 737 * cloned route might be undergoing deletion and cloned routes 738 * are not necessarily replicated. An overall error is returned 739 * only if no cpus have the route in question. 740 */ 741 if (rmsg->base.lmsg.ms_error < 0 || error == 0) 742 rmsg->base.lmsg.ms_error = error; 743 744 nextcpu = mycpuid + 1; 745 if (error && rmsg->req != RTM_DELETE) { 746 if (mycpuid != 0) { 747 panic("rtrequest1_msghandler: rtrequest table " 748 "error was cpu%d, err %d\n", mycpuid, error); 749 } 750 lwkt_replymsg(&rmsg->base.lmsg, error); 751 } else if (nextcpu < ncpus) { 752 lwkt_forwardmsg(netisr_cpuport(nextcpu), &rmsg->base.lmsg); 753 } else { 754 lwkt_replymsg(&rmsg->base.lmsg, rmsg->base.lmsg.ms_error); 755 } 756 } 757 758 int 759 rtrequest1(int req, struct rt_addrinfo *rtinfo, struct rtentry **ret_nrt) 760 { 761 struct sockaddr *dst = rtinfo->rti_info[RTAX_DST]; 762 struct rtentry *rt; 763 struct radix_node *rn; 764 struct radix_node_head *rnh; 765 struct ifaddr *ifa; 766 struct sockaddr *ndst; 767 boolean_t reportmsg; 768 int error = 0; 769 770 #define gotoerr(x) { error = x ; goto bad; } 771 772 #ifdef ROUTE_DEBUG 773 if (route_debug) 774 rt_addrinfo_print(req, rtinfo); 775 #endif 776 777 crit_enter(); 778 /* 779 * Find the correct routing tree to use for this Address Family 780 */ 781 if ((rnh = rt_tables[mycpuid][dst->sa_family]) == NULL) 782 gotoerr(EAFNOSUPPORT); 783 784 /* 785 * If we are adding a host route then we don't want to put 786 * a netmask in the tree, nor do we want to clone it. 787 */ 788 if (rtinfo->rti_flags & RTF_HOST) { 789 rtinfo->rti_info[RTAX_NETMASK] = NULL; 790 rtinfo->rti_flags &= ~(RTF_CLONING | RTF_PRCLONING); 791 } 792 793 switch (req) { 794 case RTM_DELETE: 795 /* Remove the item from the tree. */ 796 rn = rnh->rnh_deladdr((char *)rtinfo->rti_info[RTAX_DST], 797 (char *)rtinfo->rti_info[RTAX_NETMASK], 798 rnh); 799 if (rn == NULL) 800 gotoerr(ESRCH); 801 KASSERT(!(rn->rn_flags & (RNF_ACTIVE | RNF_ROOT)), 802 ("rnh_deladdr returned flags 0x%x", rn->rn_flags)); 803 rt = (struct rtentry *)rn; 804 805 /* ref to prevent a deletion race */ 806 ++rt->rt_refcnt; 807 808 /* Free any routes cloned from this one. */ 809 if ((rt->rt_flags & (RTF_CLONING | RTF_PRCLONING)) && 810 rt_mask(rt) != NULL) { 811 rnh->rnh_walktree_from(rnh, (char *)rt_key(rt), 812 (char *)rt_mask(rt), 813 rt_fixdelete, rt); 814 } 815 816 if (rt->rt_gwroute != NULL) { 817 RTFREE(rt->rt_gwroute); 818 rt->rt_gwroute = NULL; 819 } 820 821 /* 822 * NB: RTF_UP must be set during the search above, 823 * because we might delete the last ref, causing 824 * rt to get freed prematurely. 825 */ 826 rt->rt_flags &= ~RTF_UP; 827 828 #ifdef ROUTE_DEBUG 829 if (route_debug) 830 rt_print(rtinfo, rt); 831 #endif 832 833 /* Give the protocol a chance to keep things in sync. */ 834 if ((ifa = rt->rt_ifa) && ifa->ifa_rtrequest) 835 ifa->ifa_rtrequest(RTM_DELETE, rt); 836 837 /* 838 * If the caller wants it, then it can have it, 839 * but it's up to it to free the rtentry as we won't be 840 * doing it. 841 */ 842 KASSERT(rt->rt_refcnt >= 0, 843 ("rtrequest1(DELETE): refcnt %ld", rt->rt_refcnt)); 844 if (ret_nrt != NULL) { 845 /* leave ref intact for return */ 846 *ret_nrt = rt; 847 } else { 848 /* deref / attempt to destroy */ 849 rtfree(rt); 850 } 851 break; 852 853 case RTM_RESOLVE: 854 if (ret_nrt == NULL || (rt = *ret_nrt) == NULL) 855 gotoerr(EINVAL); 856 857 KASSERT(rt->rt_cpuid == mycpuid, 858 ("rt resolve rt_cpuid %d, mycpuid %d", 859 rt->rt_cpuid, mycpuid)); 860 861 ifa = rt->rt_ifa; 862 rtinfo->rti_flags = 863 rt->rt_flags & ~(RTF_CLONING | RTF_PRCLONING | RTF_STATIC); 864 rtinfo->rti_flags |= RTF_WASCLONED; 865 rtinfo->rti_info[RTAX_GATEWAY] = rt->rt_gateway; 866 if ((rtinfo->rti_info[RTAX_NETMASK] = rt->rt_genmask) == NULL) 867 rtinfo->rti_flags |= RTF_HOST; 868 rtinfo->rti_info[RTAX_MPLS1] = rt->rt_shim[0]; 869 rtinfo->rti_info[RTAX_MPLS2] = rt->rt_shim[1]; 870 rtinfo->rti_info[RTAX_MPLS3] = rt->rt_shim[2]; 871 goto makeroute; 872 873 case RTM_ADD: 874 KASSERT(!(rtinfo->rti_flags & RTF_GATEWAY) || 875 rtinfo->rti_info[RTAX_GATEWAY] != NULL, 876 ("rtrequest: GATEWAY but no gateway")); 877 878 if (rtinfo->rti_ifa == NULL && (error = rt_getifa(rtinfo))) 879 gotoerr(error); 880 ifa = rtinfo->rti_ifa; 881 makeroute: 882 R_Malloc(rt, struct rtentry *, sizeof(struct rtentry)); 883 if (rt == NULL) { 884 if (req == RTM_ADD) { 885 kprintf("rtrequest1: alloc rtentry failed on " 886 "cpu%d\n", mycpuid); 887 } 888 gotoerr(ENOBUFS); 889 } 890 bzero(rt, sizeof(struct rtentry)); 891 rt->rt_flags = RTF_UP | rtinfo->rti_flags; 892 rt->rt_cpuid = mycpuid; 893 894 if (mycpuid != 0 && req == RTM_ADD) { 895 /* For RTM_ADD, we have already sent rtmsg on CPU0. */ 896 reportmsg = RTL_DONTREPORT; 897 } else { 898 /* 899 * For RTM_ADD, we only send rtmsg on CPU0. 900 * For RTM_RESOLVE, we always send rtmsg. XXX 901 */ 902 reportmsg = RTL_REPORTMSG; 903 } 904 error = rt_setgate(rt, dst, rtinfo->rti_info[RTAX_GATEWAY], 905 reportmsg); 906 if (error != 0) { 907 Free(rt); 908 gotoerr(error); 909 } 910 911 ndst = rt_key(rt); 912 if (rtinfo->rti_info[RTAX_NETMASK] != NULL) 913 rt_maskedcopy(dst, ndst, 914 rtinfo->rti_info[RTAX_NETMASK]); 915 else 916 bcopy(dst, ndst, dst->sa_len); 917 918 if (rtinfo->rti_info[RTAX_MPLS1] != NULL) 919 rt_setshims(rt, rtinfo->rti_info); 920 921 /* 922 * Note that we now have a reference to the ifa. 923 * This moved from below so that rnh->rnh_addaddr() can 924 * examine the ifa and ifa->ifa_ifp if it so desires. 925 */ 926 IFAREF(ifa); 927 rt->rt_ifa = ifa; 928 rt->rt_ifp = ifa->ifa_ifp; 929 /* XXX mtu manipulation will be done in rnh_addaddr -- itojun */ 930 931 rn = rnh->rnh_addaddr((char *)ndst, 932 (char *)rtinfo->rti_info[RTAX_NETMASK], 933 rnh, rt->rt_nodes); 934 if (rn == NULL) { 935 struct rtentry *oldrt; 936 937 /* 938 * We already have one of these in the tree. 939 * We do a special hack: if the old route was 940 * cloned, then we blow it away and try 941 * re-inserting the new one. 942 */ 943 oldrt = rtpurelookup(ndst); 944 if (oldrt != NULL) { 945 --oldrt->rt_refcnt; 946 if (oldrt->rt_flags & RTF_WASCLONED) { 947 rtrequest(RTM_DELETE, rt_key(oldrt), 948 oldrt->rt_gateway, 949 rt_mask(oldrt), 950 oldrt->rt_flags, NULL); 951 rn = rnh->rnh_addaddr((char *)ndst, 952 (char *) 953 rtinfo->rti_info[RTAX_NETMASK], 954 rnh, rt->rt_nodes); 955 } 956 } 957 } 958 959 /* 960 * If it still failed to go into the tree, 961 * then un-make it (this should be a function). 962 */ 963 if (rn == NULL) { 964 if (rt->rt_gwroute != NULL) 965 rtfree(rt->rt_gwroute); 966 IFAFREE(ifa); 967 Free(rt_key(rt)); 968 Free(rt); 969 gotoerr(EEXIST); 970 } 971 972 /* 973 * If we got here from RESOLVE, then we are cloning 974 * so clone the rest, and note that we 975 * are a clone (and increment the parent's references) 976 */ 977 if (req == RTM_RESOLVE) { 978 rt->rt_rmx = (*ret_nrt)->rt_rmx; /* copy metrics */ 979 rt->rt_rmx.rmx_pksent = 0; /* reset packet counter */ 980 if ((*ret_nrt)->rt_flags & 981 (RTF_CLONING | RTF_PRCLONING)) { 982 rt->rt_parent = *ret_nrt; 983 (*ret_nrt)->rt_refcnt++; 984 } 985 } 986 987 /* 988 * if this protocol has something to add to this then 989 * allow it to do that as well. 990 */ 991 if (ifa->ifa_rtrequest != NULL) 992 ifa->ifa_rtrequest(req, rt); 993 994 /* 995 * We repeat the same procedure from rt_setgate() here because 996 * it doesn't fire when we call it there because the node 997 * hasn't been added to the tree yet. 998 */ 999 if (req == RTM_ADD && !(rt->rt_flags & RTF_HOST) && 1000 rt_mask(rt) != NULL) { 1001 struct rtfc_arg arg = { rt, rnh }; 1002 1003 rnh->rnh_walktree_from(rnh, (char *)rt_key(rt), 1004 (char *)rt_mask(rt), 1005 rt_fixchange, &arg); 1006 } 1007 1008 #ifdef ROUTE_DEBUG 1009 if (route_debug) 1010 rt_print(rtinfo, rt); 1011 #endif 1012 /* 1013 * Return the resulting rtentry, 1014 * increasing the number of references by one. 1015 */ 1016 if (ret_nrt != NULL) { 1017 rt->rt_refcnt++; 1018 *ret_nrt = rt; 1019 } 1020 break; 1021 default: 1022 error = EOPNOTSUPP; 1023 } 1024 bad: 1025 #ifdef ROUTE_DEBUG 1026 if (route_debug) { 1027 if (error) 1028 kprintf("rti %p failed error %d\n", rtinfo, error); 1029 else 1030 kprintf("rti %p succeeded\n", rtinfo); 1031 } 1032 #endif 1033 crit_exit(); 1034 return (error); 1035 } 1036 1037 /* 1038 * Called from rtrequest(RTM_DELETE, ...) to fix up the route's ``family'' 1039 * (i.e., the routes related to it by the operation of cloning). This 1040 * routine is iterated over all potential former-child-routes by way of 1041 * rnh->rnh_walktree_from() above, and those that actually are children of 1042 * the late parent (passed in as VP here) are themselves deleted. 1043 */ 1044 static int 1045 rt_fixdelete(struct radix_node *rn, void *vp) 1046 { 1047 struct rtentry *rt = (struct rtentry *)rn; 1048 struct rtentry *rt0 = vp; 1049 1050 if (rt->rt_parent == rt0 && 1051 !(rt->rt_flags & (RTF_PINNED | RTF_CLONING | RTF_PRCLONING))) { 1052 return rtrequest(RTM_DELETE, rt_key(rt), NULL, rt_mask(rt), 1053 rt->rt_flags, NULL); 1054 } 1055 return 0; 1056 } 1057 1058 /* 1059 * This routine is called from rt_setgate() to do the analogous thing for 1060 * adds and changes. There is the added complication in this case of a 1061 * middle insert; i.e., insertion of a new network route between an older 1062 * network route and (cloned) host routes. For this reason, a simple check 1063 * of rt->rt_parent is insufficient; each candidate route must be tested 1064 * against the (mask, value) of the new route (passed as before in vp) 1065 * to see if the new route matches it. 1066 * 1067 * XXX - it may be possible to do fixdelete() for changes and reserve this 1068 * routine just for adds. I'm not sure why I thought it was necessary to do 1069 * changes this way. 1070 */ 1071 #ifdef DEBUG 1072 static int rtfcdebug = 0; 1073 #endif 1074 1075 static int 1076 rt_fixchange(struct radix_node *rn, void *vp) 1077 { 1078 struct rtentry *rt = (struct rtentry *)rn; 1079 struct rtfc_arg *ap = vp; 1080 struct rtentry *rt0 = ap->rt0; 1081 struct radix_node_head *rnh = ap->rnh; 1082 u_char *xk1, *xm1, *xk2, *xmp; 1083 int i, len, mlen; 1084 1085 #ifdef DEBUG 1086 if (rtfcdebug) 1087 kprintf("rt_fixchange: rt %p, rt0 %p\n", rt, rt0); 1088 #endif 1089 1090 if (rt->rt_parent == NULL || 1091 (rt->rt_flags & (RTF_PINNED | RTF_CLONING | RTF_PRCLONING))) { 1092 #ifdef DEBUG 1093 if (rtfcdebug) kprintf("no parent, pinned or cloning\n"); 1094 #endif 1095 return 0; 1096 } 1097 1098 if (rt->rt_parent == rt0) { 1099 #ifdef DEBUG 1100 if (rtfcdebug) kprintf("parent match\n"); 1101 #endif 1102 return rtrequest(RTM_DELETE, rt_key(rt), NULL, rt_mask(rt), 1103 rt->rt_flags, NULL); 1104 } 1105 1106 /* 1107 * There probably is a function somewhere which does this... 1108 * if not, there should be. 1109 */ 1110 len = imin(rt_key(rt0)->sa_len, rt_key(rt)->sa_len); 1111 1112 xk1 = (u_char *)rt_key(rt0); 1113 xm1 = (u_char *)rt_mask(rt0); 1114 xk2 = (u_char *)rt_key(rt); 1115 1116 /* avoid applying a less specific route */ 1117 xmp = (u_char *)rt_mask(rt->rt_parent); 1118 mlen = rt_key(rt->rt_parent)->sa_len; 1119 if (mlen > rt_key(rt0)->sa_len) { 1120 #ifdef DEBUG 1121 if (rtfcdebug) 1122 kprintf("rt_fixchange: inserting a less " 1123 "specific route\n"); 1124 #endif 1125 return 0; 1126 } 1127 for (i = rnh->rnh_treetop->rn_offset; i < mlen; i++) { 1128 if ((xmp[i] & ~(xmp[i] ^ xm1[i])) != xmp[i]) { 1129 #ifdef DEBUG 1130 if (rtfcdebug) 1131 kprintf("rt_fixchange: inserting a less " 1132 "specific route\n"); 1133 #endif 1134 return 0; 1135 } 1136 } 1137 1138 for (i = rnh->rnh_treetop->rn_offset; i < len; i++) { 1139 if ((xk2[i] & xm1[i]) != xk1[i]) { 1140 #ifdef DEBUG 1141 if (rtfcdebug) kprintf("no match\n"); 1142 #endif 1143 return 0; 1144 } 1145 } 1146 1147 /* 1148 * OK, this node is a clone, and matches the node currently being 1149 * changed/added under the node's mask. So, get rid of it. 1150 */ 1151 #ifdef DEBUG 1152 if (rtfcdebug) kprintf("deleting\n"); 1153 #endif 1154 return rtrequest(RTM_DELETE, rt_key(rt), NULL, rt_mask(rt), 1155 rt->rt_flags, NULL); 1156 } 1157 1158 #define ROUNDUP(a) (a>0 ? (1 + (((a) - 1) | (sizeof(long) - 1))) : sizeof(long)) 1159 1160 int 1161 rt_setgate(struct rtentry *rt0, struct sockaddr *dst, struct sockaddr *gate, 1162 boolean_t generate_report) 1163 { 1164 char *space, *oldspace; 1165 int dlen = ROUNDUP(dst->sa_len), glen = ROUNDUP(gate->sa_len); 1166 struct rtentry *rt = rt0; 1167 struct radix_node_head *rnh = rt_tables[mycpuid][dst->sa_family]; 1168 1169 /* 1170 * A host route with the destination equal to the gateway 1171 * will interfere with keeping LLINFO in the routing 1172 * table, so disallow it. 1173 */ 1174 if (((rt0->rt_flags & (RTF_HOST | RTF_GATEWAY | RTF_LLINFO)) == 1175 (RTF_HOST | RTF_GATEWAY)) && 1176 dst->sa_len == gate->sa_len && 1177 sa_equal(dst, gate)) { 1178 /* 1179 * The route might already exist if this is an RTM_CHANGE 1180 * or a routing redirect, so try to delete it. 1181 */ 1182 if (rt_key(rt0) != NULL) 1183 rtrequest(RTM_DELETE, rt_key(rt0), rt0->rt_gateway, 1184 rt_mask(rt0), rt0->rt_flags, NULL); 1185 return EADDRNOTAVAIL; 1186 } 1187 1188 /* 1189 * Both dst and gateway are stored in the same malloc'ed chunk 1190 * (If I ever get my hands on....) 1191 * if we need to malloc a new chunk, then keep the old one around 1192 * till we don't need it any more. 1193 */ 1194 if (rt->rt_gateway == NULL || glen > ROUNDUP(rt->rt_gateway->sa_len)) { 1195 oldspace = (char *)rt_key(rt); 1196 R_Malloc(space, char *, dlen + glen); 1197 if (space == NULL) 1198 return ENOBUFS; 1199 rt->rt_nodes->rn_key = space; 1200 } else { 1201 space = (char *)rt_key(rt); /* Just use the old space. */ 1202 oldspace = NULL; 1203 } 1204 1205 /* Set the gateway value. */ 1206 rt->rt_gateway = (struct sockaddr *)(space + dlen); 1207 bcopy(gate, rt->rt_gateway, glen); 1208 1209 if (oldspace != NULL) { 1210 /* 1211 * If we allocated a new chunk, preserve the original dst. 1212 * This way, rt_setgate() really just sets the gate 1213 * and leaves the dst field alone. 1214 */ 1215 bcopy(dst, space, dlen); 1216 Free(oldspace); 1217 } 1218 1219 /* 1220 * If there is already a gwroute, it's now almost definitely wrong 1221 * so drop it. 1222 */ 1223 if (rt->rt_gwroute != NULL) { 1224 RTFREE(rt->rt_gwroute); 1225 rt->rt_gwroute = NULL; 1226 } 1227 if (rt->rt_flags & RTF_GATEWAY) { 1228 /* 1229 * Cloning loop avoidance: In the presence of 1230 * protocol-cloning and bad configuration, it is 1231 * possible to get stuck in bottomless mutual recursion 1232 * (rtrequest rt_setgate rtlookup). We avoid this 1233 * by not allowing protocol-cloning to operate for 1234 * gateways (which is probably the correct choice 1235 * anyway), and avoid the resulting reference loops 1236 * by disallowing any route to run through itself as 1237 * a gateway. This is obviously mandatory when we 1238 * get rt->rt_output(). 1239 * 1240 * This breaks TTCP for hosts outside the gateway! XXX JH 1241 */ 1242 rt->rt_gwroute = _rtlookup(gate, generate_report, 1243 RTF_PRCLONING); 1244 if (rt->rt_gwroute == rt) { 1245 rt->rt_gwroute = NULL; 1246 --rt->rt_refcnt; 1247 return EDQUOT; /* failure */ 1248 } 1249 } 1250 1251 /* 1252 * This isn't going to do anything useful for host routes, so 1253 * don't bother. Also make sure we have a reasonable mask 1254 * (we don't yet have one during adds). 1255 */ 1256 if (!(rt->rt_flags & RTF_HOST) && rt_mask(rt) != NULL) { 1257 struct rtfc_arg arg = { rt, rnh }; 1258 1259 rnh->rnh_walktree_from(rnh, (char *)rt_key(rt), 1260 (char *)rt_mask(rt), 1261 rt_fixchange, &arg); 1262 } 1263 1264 return 0; 1265 } 1266 1267 static void 1268 rt_maskedcopy( 1269 struct sockaddr *src, 1270 struct sockaddr *dst, 1271 struct sockaddr *netmask) 1272 { 1273 u_char *cp1 = (u_char *)src; 1274 u_char *cp2 = (u_char *)dst; 1275 u_char *cp3 = (u_char *)netmask; 1276 u_char *cplim = cp2 + *cp3; 1277 u_char *cplim2 = cp2 + *cp1; 1278 1279 *cp2++ = *cp1++; *cp2++ = *cp1++; /* copies sa_len & sa_family */ 1280 cp3 += 2; 1281 if (cplim > cplim2) 1282 cplim = cplim2; 1283 while (cp2 < cplim) 1284 *cp2++ = *cp1++ & *cp3++; 1285 if (cp2 < cplim2) 1286 bzero(cp2, cplim2 - cp2); 1287 } 1288 1289 int 1290 rt_llroute(struct sockaddr *dst, struct rtentry *rt0, struct rtentry **drt) 1291 { 1292 struct rtentry *up_rt, *rt; 1293 1294 if (!(rt0->rt_flags & RTF_UP)) { 1295 up_rt = rtlookup(dst); 1296 if (up_rt == NULL) 1297 return (EHOSTUNREACH); 1298 up_rt->rt_refcnt--; 1299 } else 1300 up_rt = rt0; 1301 if (up_rt->rt_flags & RTF_GATEWAY) { 1302 if (up_rt->rt_gwroute == NULL) { 1303 up_rt->rt_gwroute = rtlookup(up_rt->rt_gateway); 1304 if (up_rt->rt_gwroute == NULL) 1305 return (EHOSTUNREACH); 1306 } else if (!(up_rt->rt_gwroute->rt_flags & RTF_UP)) { 1307 rtfree(up_rt->rt_gwroute); 1308 up_rt->rt_gwroute = rtlookup(up_rt->rt_gateway); 1309 if (up_rt->rt_gwroute == NULL) 1310 return (EHOSTUNREACH); 1311 } 1312 rt = up_rt->rt_gwroute; 1313 } else 1314 rt = up_rt; 1315 if (rt->rt_flags & RTF_REJECT && 1316 (rt->rt_rmx.rmx_expire == 0 || /* rt doesn't expire */ 1317 time_uptime < rt->rt_rmx.rmx_expire)) /* rt not expired */ 1318 return (rt->rt_flags & RTF_HOST ? EHOSTDOWN : EHOSTUNREACH); 1319 *drt = rt; 1320 return 0; 1321 } 1322 1323 static int 1324 rt_setshims(struct rtentry *rt, struct sockaddr **rt_shim){ 1325 int i; 1326 1327 for (i=0; i<3; i++) { 1328 struct sockaddr *shim = rt_shim[RTAX_MPLS1 + i]; 1329 int shimlen; 1330 1331 if (shim == NULL) 1332 break; 1333 1334 shimlen = ROUNDUP(shim->sa_len); 1335 R_Malloc(rt->rt_shim[i], struct sockaddr *, shimlen); 1336 bcopy(shim, rt->rt_shim[i], shimlen); 1337 } 1338 1339 return 0; 1340 } 1341 1342 #ifdef ROUTE_DEBUG 1343 1344 /* 1345 * Print out a route table entry 1346 */ 1347 void 1348 rt_print(struct rt_addrinfo *rtinfo, struct rtentry *rn) 1349 { 1350 kprintf("rti %p cpu %d route %p flags %08lx: ", 1351 rtinfo, mycpuid, rn, rn->rt_flags); 1352 sockaddr_print(rt_key(rn)); 1353 kprintf(" mask "); 1354 sockaddr_print(rt_mask(rn)); 1355 kprintf(" gw "); 1356 sockaddr_print(rn->rt_gateway); 1357 kprintf(" ifc \"%s\"", rn->rt_ifp ? rn->rt_ifp->if_dname : "?"); 1358 kprintf(" ifa %p\n", rn->rt_ifa); 1359 } 1360 1361 void 1362 rt_addrinfo_print(int cmd, struct rt_addrinfo *rti) 1363 { 1364 int didit = 0; 1365 int i; 1366 1367 #ifdef ROUTE_DEBUG 1368 if (cmd == RTM_DELETE && route_debug > 1) 1369 print_backtrace(-1); 1370 #endif 1371 1372 switch(cmd) { 1373 case RTM_ADD: 1374 kprintf("ADD "); 1375 break; 1376 case RTM_RESOLVE: 1377 kprintf("RES "); 1378 break; 1379 case RTM_DELETE: 1380 kprintf("DEL "); 1381 break; 1382 default: 1383 kprintf("C%02d ", cmd); 1384 break; 1385 } 1386 kprintf("rti %p cpu %d ", rti, mycpuid); 1387 for (i = 0; i < rti->rti_addrs; ++i) { 1388 if (rti->rti_info[i] == NULL) 1389 continue; 1390 if (didit) 1391 kprintf(" ,"); 1392 switch(i) { 1393 case RTAX_DST: 1394 kprintf("(DST "); 1395 break; 1396 case RTAX_GATEWAY: 1397 kprintf("(GWY "); 1398 break; 1399 case RTAX_NETMASK: 1400 kprintf("(MSK "); 1401 break; 1402 case RTAX_GENMASK: 1403 kprintf("(GEN "); 1404 break; 1405 case RTAX_IFP: 1406 kprintf("(IFP "); 1407 break; 1408 case RTAX_IFA: 1409 kprintf("(IFA "); 1410 break; 1411 case RTAX_AUTHOR: 1412 kprintf("(AUT "); 1413 break; 1414 case RTAX_BRD: 1415 kprintf("(BRD "); 1416 break; 1417 default: 1418 kprintf("(?%02d ", i); 1419 break; 1420 } 1421 sockaddr_print(rti->rti_info[i]); 1422 kprintf(")"); 1423 didit = 1; 1424 } 1425 kprintf("\n"); 1426 } 1427 1428 void 1429 sockaddr_print(struct sockaddr *sa) 1430 { 1431 struct sockaddr_in *sa4; 1432 struct sockaddr_in6 *sa6; 1433 int len; 1434 int i; 1435 1436 if (sa == NULL) { 1437 kprintf("NULL"); 1438 return; 1439 } 1440 1441 len = sa->sa_len - offsetof(struct sockaddr, sa_data[0]); 1442 1443 switch(sa->sa_family) { 1444 case AF_INET: 1445 case AF_INET6: 1446 default: 1447 switch(sa->sa_family) { 1448 case AF_INET: 1449 sa4 = (struct sockaddr_in *)sa; 1450 kprintf("INET %d %d.%d.%d.%d", 1451 ntohs(sa4->sin_port), 1452 (ntohl(sa4->sin_addr.s_addr) >> 24) & 255, 1453 (ntohl(sa4->sin_addr.s_addr) >> 16) & 255, 1454 (ntohl(sa4->sin_addr.s_addr) >> 8) & 255, 1455 (ntohl(sa4->sin_addr.s_addr) >> 0) & 255 1456 ); 1457 break; 1458 case AF_INET6: 1459 sa6 = (struct sockaddr_in6 *)sa; 1460 kprintf("INET6 %d %04x:%04x%04x:%04x:%04x:%04x:%04x:%04x", 1461 ntohs(sa6->sin6_port), 1462 sa6->sin6_addr.s6_addr16[0], 1463 sa6->sin6_addr.s6_addr16[1], 1464 sa6->sin6_addr.s6_addr16[2], 1465 sa6->sin6_addr.s6_addr16[3], 1466 sa6->sin6_addr.s6_addr16[4], 1467 sa6->sin6_addr.s6_addr16[5], 1468 sa6->sin6_addr.s6_addr16[6], 1469 sa6->sin6_addr.s6_addr16[7] 1470 ); 1471 break; 1472 default: 1473 kprintf("AF%d ", sa->sa_family); 1474 while (len > 0 && sa->sa_data[len-1] == 0) 1475 --len; 1476 1477 for (i = 0; i < len; ++i) { 1478 if (i) 1479 kprintf("."); 1480 kprintf("%d", (unsigned char)sa->sa_data[i]); 1481 } 1482 break; 1483 } 1484 } 1485 } 1486 1487 #endif 1488 1489 /* 1490 * Set up a routing table entry, normally for an interface. 1491 */ 1492 int 1493 rtinit(struct ifaddr *ifa, int cmd, int flags) 1494 { 1495 struct sockaddr *dst, *deldst, *netmask; 1496 struct mbuf *m = NULL; 1497 struct radix_node_head *rnh; 1498 struct radix_node *rn; 1499 struct rt_addrinfo rtinfo; 1500 int error; 1501 1502 if (flags & RTF_HOST) { 1503 dst = ifa->ifa_dstaddr; 1504 netmask = NULL; 1505 } else { 1506 dst = ifa->ifa_addr; 1507 netmask = ifa->ifa_netmask; 1508 } 1509 /* 1510 * If it's a delete, check that if it exists, it's on the correct 1511 * interface or we might scrub a route to another ifa which would 1512 * be confusing at best and possibly worse. 1513 */ 1514 if (cmd == RTM_DELETE) { 1515 /* 1516 * It's a delete, so it should already exist.. 1517 * If it's a net, mask off the host bits 1518 * (Assuming we have a mask) 1519 */ 1520 if (netmask != NULL) { 1521 m = m_get(MB_DONTWAIT, MT_SONAME); 1522 if (m == NULL) 1523 return (ENOBUFS); 1524 mbuftrackid(m, 34); 1525 deldst = mtod(m, struct sockaddr *); 1526 rt_maskedcopy(dst, deldst, netmask); 1527 dst = deldst; 1528 } 1529 /* 1530 * Look up an rtentry that is in the routing tree and 1531 * contains the correct info. 1532 */ 1533 if ((rnh = rt_tables[mycpuid][dst->sa_family]) == NULL || 1534 (rn = rnh->rnh_lookup((char *)dst, 1535 (char *)netmask, rnh)) == NULL || 1536 ((struct rtentry *)rn)->rt_ifa != ifa || 1537 !sa_equal((struct sockaddr *)rn->rn_key, dst)) { 1538 if (m != NULL) 1539 m_free(m); 1540 return (flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH); 1541 } 1542 /* XXX */ 1543 #if 0 1544 else { 1545 /* 1546 * One would think that as we are deleting, and we know 1547 * it doesn't exist, we could just return at this point 1548 * with an "ELSE" clause, but apparently not.. 1549 */ 1550 return (flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH); 1551 } 1552 #endif 1553 } 1554 /* 1555 * Do the actual request 1556 */ 1557 bzero(&rtinfo, sizeof(struct rt_addrinfo)); 1558 rtinfo.rti_info[RTAX_DST] = dst; 1559 rtinfo.rti_info[RTAX_GATEWAY] = ifa->ifa_addr; 1560 rtinfo.rti_info[RTAX_NETMASK] = netmask; 1561 rtinfo.rti_flags = flags | ifa->ifa_flags; 1562 rtinfo.rti_ifa = ifa; 1563 error = rtrequest1_global(cmd, &rtinfo, rtinit_rtrequest_callback, ifa, 1564 RTREQ_PRIO_HIGH); 1565 if (m != NULL) 1566 m_free(m); 1567 return (error); 1568 } 1569 1570 static void 1571 rtinit_rtrequest_callback(int cmd, int error, 1572 struct rt_addrinfo *rtinfo, struct rtentry *rt, 1573 void *arg) 1574 { 1575 struct ifaddr *ifa = arg; 1576 1577 if (error == 0 && rt) { 1578 if (mycpuid == 0) { 1579 ++rt->rt_refcnt; 1580 rt_newaddrmsg(cmd, ifa, error, rt); 1581 --rt->rt_refcnt; 1582 } 1583 if (cmd == RTM_DELETE) { 1584 if (rt->rt_refcnt == 0) { 1585 ++rt->rt_refcnt; 1586 rtfree(rt); 1587 } 1588 } 1589 } 1590 } 1591 1592 struct netmsg_rts { 1593 struct netmsg_base base; 1594 int req; 1595 struct rt_addrinfo *rtinfo; 1596 rtsearch_callback_func_t callback; 1597 void *arg; 1598 boolean_t exact_match; 1599 int found_cnt; 1600 }; 1601 1602 int 1603 rtsearch_global(int req, struct rt_addrinfo *rtinfo, 1604 rtsearch_callback_func_t callback, void *arg, boolean_t exact_match, 1605 boolean_t req_prio) 1606 { 1607 struct netmsg_rts msg; 1608 int flags = 0; 1609 1610 if (req_prio) 1611 flags = MSGF_PRIORITY; 1612 netmsg_init(&msg.base, NULL, &curthread->td_msgport, flags, 1613 rtsearch_msghandler); 1614 msg.req = req; 1615 msg.rtinfo = rtinfo; 1616 msg.callback = callback; 1617 msg.arg = arg; 1618 msg.exact_match = exact_match; 1619 msg.found_cnt = 0; 1620 return rt_domsg_global(&msg.base); 1621 } 1622 1623 static void 1624 rtsearch_msghandler(netmsg_t msg) 1625 { 1626 struct netmsg_rts *rmsg = (void *)msg; 1627 struct rt_addrinfo rtinfo; 1628 struct radix_node_head *rnh; 1629 struct rtentry *rt; 1630 int nextcpu, error; 1631 1632 /* 1633 * Copy the rtinfo. We need to make sure that the original 1634 * rtinfo, which is setup by the caller, in the netmsg will 1635 * _not_ be changed; else the next CPU on the netmsg forwarding 1636 * path will see a different rtinfo than what this CPU has seen. 1637 */ 1638 rtinfo = *rmsg->rtinfo; 1639 1640 /* 1641 * Find the correct routing tree to use for this Address Family 1642 */ 1643 if ((rnh = rt_tables[mycpuid][rtinfo.rti_dst->sa_family]) == NULL) { 1644 if (mycpuid != 0) 1645 panic("partially initialized routing tables"); 1646 lwkt_replymsg(&rmsg->base.lmsg, EAFNOSUPPORT); 1647 return; 1648 } 1649 1650 /* 1651 * Correct rtinfo for the host route searching. 1652 */ 1653 if (rtinfo.rti_flags & RTF_HOST) { 1654 rtinfo.rti_netmask = NULL; 1655 rtinfo.rti_flags &= ~(RTF_CLONING | RTF_PRCLONING); 1656 } 1657 1658 rt = (struct rtentry *) 1659 rnh->rnh_lookup((char *)rtinfo.rti_dst, 1660 (char *)rtinfo.rti_netmask, rnh); 1661 1662 /* 1663 * If we are asked to do the "exact match", we need to make sure 1664 * that host route searching got a host route while a network 1665 * route searching got a network route. 1666 */ 1667 if (rt != NULL && rmsg->exact_match && 1668 ((rt->rt_flags ^ rtinfo.rti_flags) & RTF_HOST)) 1669 rt = NULL; 1670 1671 if (rt == NULL) { 1672 /* 1673 * No matching routes have been found, don't count this 1674 * as a critical error (here, we set 'error' to 0), just 1675 * keep moving on, since at least prcloned routes are not 1676 * duplicated onto each CPU. 1677 */ 1678 error = 0; 1679 } else { 1680 rmsg->found_cnt++; 1681 1682 rt->rt_refcnt++; 1683 error = rmsg->callback(rmsg->req, &rtinfo, rt, rmsg->arg, 1684 rmsg->found_cnt); 1685 rt->rt_refcnt--; 1686 1687 if (error == EJUSTRETURN) { 1688 lwkt_replymsg(&rmsg->base.lmsg, 0); 1689 return; 1690 } 1691 } 1692 1693 nextcpu = mycpuid + 1; 1694 if (error) { 1695 KKASSERT(rmsg->found_cnt > 0); 1696 1697 /* 1698 * Under following cases, unrecoverable error has 1699 * not occured: 1700 * o Request is RTM_GET 1701 * o The first time that we find the route, but the 1702 * modification fails. 1703 */ 1704 if (rmsg->req != RTM_GET && rmsg->found_cnt > 1) { 1705 panic("rtsearch_msghandler: unrecoverable error " 1706 "cpu %d", mycpuid); 1707 } 1708 lwkt_replymsg(&rmsg->base.lmsg, error); 1709 } else if (nextcpu < ncpus) { 1710 lwkt_forwardmsg(netisr_cpuport(nextcpu), &rmsg->base.lmsg); 1711 } else { 1712 if (rmsg->found_cnt == 0) { 1713 /* The requested route was never seen ... */ 1714 error = ESRCH; 1715 } 1716 lwkt_replymsg(&rmsg->base.lmsg, error); 1717 } 1718 } 1719 1720 int 1721 rtmask_add_global(struct sockaddr *mask, boolean_t req_prio) 1722 { 1723 struct netmsg_base msg; 1724 int flags = 0; 1725 1726 if (req_prio) 1727 flags = MSGF_PRIORITY; 1728 netmsg_init(&msg, NULL, &curthread->td_msgport, flags, 1729 rtmask_add_msghandler); 1730 msg.lmsg.u.ms_resultp = mask; 1731 1732 return rt_domsg_global(&msg); 1733 } 1734 1735 struct sockaddr * 1736 _rtmask_lookup(struct sockaddr *mask, boolean_t search) 1737 { 1738 struct radix_node *n; 1739 1740 #define clen(s) (*(u_char *)(s)) 1741 n = rn_addmask((char *)mask, search, 1, rn_cpumaskhead(mycpuid)); 1742 if (n != NULL && 1743 mask->sa_len >= clen(n->rn_key) && 1744 bcmp((char *)mask + 1, 1745 (char *)n->rn_key + 1, clen(n->rn_key) - 1) == 0) { 1746 return (struct sockaddr *)n->rn_key; 1747 } else { 1748 return NULL; 1749 } 1750 #undef clen 1751 } 1752 1753 static void 1754 rtmask_add_msghandler(netmsg_t msg) 1755 { 1756 struct lwkt_msg *lmsg = &msg->lmsg; 1757 struct sockaddr *mask = lmsg->u.ms_resultp; 1758 int error = 0, nextcpu; 1759 1760 if (rtmask_lookup(mask) == NULL) 1761 error = ENOBUFS; 1762 1763 nextcpu = mycpuid + 1; 1764 if (!error && nextcpu < ncpus) 1765 lwkt_forwardmsg(netisr_cpuport(nextcpu), lmsg); 1766 else 1767 lwkt_replymsg(lmsg, error); 1768 } 1769 1770 /* This must be before ip6_init2(), which is now SI_ORDER_MIDDLE */ 1771 SYSINIT(route, SI_SUB_PROTO_DOMAIN, SI_ORDER_THIRD, route_init, 0); 1772 1773 struct rtchange_arg { 1774 struct ifaddr *old_ifa; 1775 struct ifaddr *new_ifa; 1776 struct rtentry *rt; 1777 int changed; 1778 }; 1779 1780 static void 1781 rtchange_ifa(struct rtentry *rt, struct rtchange_arg *ap) 1782 { 1783 if (rt->rt_ifa->ifa_rtrequest != NULL) 1784 rt->rt_ifa->ifa_rtrequest(RTM_DELETE, rt); 1785 IFAFREE(rt->rt_ifa); 1786 1787 IFAREF(ap->new_ifa); 1788 rt->rt_ifa = ap->new_ifa; 1789 rt->rt_ifp = ap->new_ifa->ifa_ifp; 1790 if (rt->rt_ifa->ifa_rtrequest != NULL) 1791 rt->rt_ifa->ifa_rtrequest(RTM_ADD, rt); 1792 1793 ap->changed = 1; 1794 } 1795 1796 static int 1797 rtchange_callback(struct radix_node *rn, void *xap) 1798 { 1799 struct rtchange_arg *ap = xap; 1800 struct rtentry *rt = (struct rtentry *)rn; 1801 1802 if (rt->rt_ifa == ap->old_ifa) { 1803 if (rt->rt_flags & (RTF_CLONING | RTF_PRCLONING)) { 1804 /* 1805 * We could saw the branch off when we are 1806 * still sitting on it, if the ifa_rtrequest 1807 * DEL/ADD are called directly from here. 1808 */ 1809 ap->rt = rt; 1810 return EJUSTRETURN; 1811 } 1812 rtchange_ifa(rt, ap); 1813 } 1814 return 0; 1815 } 1816 1817 struct netmsg_rtchange { 1818 struct netmsg_base base; 1819 struct ifaddr *old_ifa; 1820 struct ifaddr *new_ifa; 1821 int changed; 1822 }; 1823 1824 static void 1825 rtchange_dispatch(netmsg_t msg) 1826 { 1827 struct netmsg_rtchange *rmsg = (void *)msg; 1828 struct radix_node_head *rnh; 1829 struct rtchange_arg arg; 1830 int nextcpu, cpu; 1831 1832 cpu = mycpuid; 1833 1834 memset(&arg, 0, sizeof(arg)); 1835 arg.old_ifa = rmsg->old_ifa; 1836 arg.new_ifa = rmsg->new_ifa; 1837 1838 rnh = rt_tables[cpu][AF_INET]; 1839 for (;;) { 1840 int error; 1841 1842 KKASSERT(arg.rt == NULL); 1843 error = rnh->rnh_walktree(rnh, rtchange_callback, &arg); 1844 if (arg.rt != NULL) { 1845 struct rtentry *rt; 1846 1847 rt = arg.rt; 1848 arg.rt = NULL; 1849 rtchange_ifa(rt, &arg); 1850 } else { 1851 break; 1852 } 1853 } 1854 if (arg.changed) 1855 rmsg->changed = 1; 1856 1857 nextcpu = cpu + 1; 1858 if (nextcpu < ncpus) 1859 lwkt_forwardmsg(netisr_cpuport(nextcpu), &rmsg->base.lmsg); 1860 else 1861 lwkt_replymsg(&rmsg->base.lmsg, 0); 1862 } 1863 1864 int 1865 rtchange(struct ifaddr *old_ifa, struct ifaddr *new_ifa) 1866 { 1867 struct netmsg_rtchange msg; 1868 1869 /* 1870 * XXX individual requests are not independantly chained, 1871 * which means that the per-cpu route tables will not be 1872 * consistent in the middle of the operation. If routes 1873 * related to the interface are manipulated while we are 1874 * doing this the inconsistancy could trigger a panic. 1875 */ 1876 netmsg_init(&msg.base, NULL, &curthread->td_msgport, MSGF_PRIORITY, 1877 rtchange_dispatch); 1878 msg.old_ifa = old_ifa; 1879 msg.new_ifa = new_ifa; 1880 msg.changed = 0; 1881 rt_domsg_global(&msg.base); 1882 1883 if (msg.changed) { 1884 old_ifa->ifa_flags &= ~IFA_ROUTE; 1885 new_ifa->ifa_flags |= IFA_ROUTE; 1886 return 0; 1887 } else { 1888 return ENOENT; 1889 } 1890 } 1891 1892 int 1893 rt_domsg_global(struct netmsg_base *nmsg) 1894 { 1895 ASSERT_CANDOMSG_NETISR0(curthread); 1896 return lwkt_domsg(netisr_cpuport(0), &nmsg->lmsg, 0); 1897 } 1898