1 /* $FreeBSD: src/sys/netinet6/in6_src.c,v 1.1.2.3 2002/02/26 18:02:06 ume Exp $ */ 2 /* $KAME: in6_src.c,v 1.37 2001/03/29 05:34:31 itojun Exp $ */ 3 4 /* 5 * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. Neither the name of the project nor the names of its contributors 17 * may be used to endorse or promote products derived from this software 18 * without specific prior written permission. 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30 * SUCH DAMAGE. 31 */ 32 33 /* 34 * Copyright (c) 1982, 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 * @(#)in_pcb.c 8.2 (Berkeley) 1/4/94 62 */ 63 64 #include "opt_inet.h" 65 #include "opt_inet6.h" 66 67 #include <sys/param.h> 68 #include <sys/systm.h> 69 #include <sys/jail.h> 70 #include <sys/kernel.h> 71 #include <sys/malloc.h> 72 #include <sys/mbuf.h> 73 #include <sys/protosw.h> 74 #include <sys/socket.h> 75 #include <sys/socketvar.h> 76 #include <sys/sockio.h> 77 #include <sys/sysctl.h> 78 #include <sys/errno.h> 79 #include <sys/time.h> 80 #include <sys/proc.h> 81 #include <sys/priv.h> 82 83 #include <net/if.h> 84 #include <net/route.h> 85 86 #include <netinet/in.h> 87 #include <netinet/in_var.h> 88 #include <netinet/in_systm.h> 89 #include <netinet/ip.h> 90 #include <netinet/in_pcb.h> 91 #include <netinet6/in6_var.h> 92 #include <netinet/ip6.h> 93 #include <netinet6/in6_pcb.h> 94 #include <netinet6/ip6_var.h> 95 #include <netinet6/nd6.h> 96 #ifdef ENABLE_DEFAULT_SCOPE 97 #include <netinet6/scope6_var.h> 98 #endif 99 100 #include <net/net_osdep.h> 101 102 #define ADDR_LABEL_NOTAPP (-1) 103 struct in6_addrpolicy defaultaddrpolicy; 104 105 static void init_policy_queue(void); 106 static int add_addrsel_policyent(struct in6_addrpolicy *); 107 static int delete_addrsel_policyent(struct in6_addrpolicy *); 108 static int walk_addrsel_policy(int (*)(struct in6_addrpolicy *, void *), 109 void *); 110 static int dump_addrsel_policyent(struct in6_addrpolicy *, void *); 111 112 113 /* 114 * Return an IPv6 address, which is the most appropriate for a given 115 * destination and user specified options. 116 * If necessary, this function lookups the routing table and returns 117 * an entry to the caller for later use. 118 */ 119 struct in6_addr * 120 in6_selectsrc(struct sockaddr_in6 *dstsock, struct ip6_pktopts *opts, 121 struct ip6_moptions *mopts, struct route_in6 *ro, 122 struct in6_addr *laddr, int *errorp, struct thread *td) 123 { 124 struct sockaddr_in6 jsin6; 125 struct ucred *cred = NULL; 126 struct in6_addr *dst; 127 struct in6_ifaddr *ia6 = NULL; 128 struct in6_pktinfo *pi = NULL; 129 int jailed = 0; 130 131 if (td && td->td_proc && td->td_proc->p_ucred) 132 cred = td->td_proc->p_ucred; 133 if (cred && cred->cr_prison) 134 jailed = 1; 135 jsin6.sin6_family = AF_INET6; 136 dst = &dstsock->sin6_addr; 137 *errorp = 0; 138 139 /* 140 * If the source address is explicitly specified by the caller, 141 * use it. 142 */ 143 if (opts && (pi = opts->ip6po_pktinfo) && 144 !IN6_IS_ADDR_UNSPECIFIED(&pi->ipi6_addr)) { 145 jsin6.sin6_addr = pi->ipi6_addr; 146 if (jailed && !jailed_ip(cred->cr_prison, 147 (struct sockaddr *)&jsin6)) { 148 return(0); 149 } else { 150 return (&pi->ipi6_addr); 151 } 152 } 153 154 /* 155 * If the source address is not specified but the socket(if any) 156 * is already bound, use the bound address. 157 */ 158 if (laddr && !IN6_IS_ADDR_UNSPECIFIED(laddr)) { 159 jsin6.sin6_addr = *laddr; 160 if (jailed && !jailed_ip(cred->cr_prison, 161 (struct sockaddr *)&jsin6)) { 162 return(0); 163 } else { 164 return (laddr); 165 } 166 } 167 168 /* 169 * If the caller doesn't specify the source address but 170 * the outgoing interface, use an address associated with 171 * the interface. 172 */ 173 if (pi && pi->ipi6_ifindex) { 174 /* XXX boundary check is assumed to be already done. */ 175 ia6 = in6_ifawithscope(ifindex2ifnet[pi->ipi6_ifindex], 176 dst, cred); 177 178 if (ia6 && jailed) { 179 jsin6.sin6_addr = (&ia6->ia_addr)->sin6_addr; 180 if (!jailed_ip(cred->cr_prison, 181 (struct sockaddr *)&jsin6)) 182 ia6 = NULL; 183 } 184 185 if (ia6 == NULL) { 186 *errorp = EADDRNOTAVAIL; 187 return (0); 188 } 189 return (&satosin6(&ia6->ia_addr)->sin6_addr); 190 } 191 192 /* 193 * If the destination address is a link-local unicast address or 194 * a multicast address, and if the outgoing interface is specified 195 * by the sin6_scope_id filed, use an address associated with the 196 * interface. 197 * XXX: We're now trying to define more specific semantics of 198 * sin6_scope_id field, so this part will be rewritten in 199 * the near future. 200 */ 201 if ((IN6_IS_ADDR_LINKLOCAL(dst) || IN6_IS_ADDR_MULTICAST(dst)) && 202 dstsock->sin6_scope_id) { 203 /* 204 * I'm not sure if boundary check for scope_id is done 205 * somewhere... 206 */ 207 if (dstsock->sin6_scope_id < 0 || 208 if_index < dstsock->sin6_scope_id) { 209 *errorp = ENXIO; /* XXX: better error? */ 210 return (0); 211 } 212 ia6 = in6_ifawithscope(ifindex2ifnet[dstsock->sin6_scope_id], 213 dst, cred); 214 215 if (ia6 && jailed) { 216 jsin6.sin6_addr = (&ia6->ia_addr)->sin6_addr; 217 if (!jailed_ip(cred->cr_prison, 218 (struct sockaddr *)&jsin6)) 219 ia6 = NULL; 220 } 221 222 if (ia6 == NULL) { 223 *errorp = EADDRNOTAVAIL; 224 return (0); 225 } 226 return (&satosin6(&ia6->ia_addr)->sin6_addr); 227 } 228 229 /* 230 * If the destination address is a multicast address and 231 * the outgoing interface for the address is specified 232 * by the caller, use an address associated with the interface. 233 * There is a sanity check here; if the destination has node-local 234 * scope, the outgoing interfacde should be a loopback address. 235 * Even if the outgoing interface is not specified, we also 236 * choose a loopback interface as the outgoing interface. 237 */ 238 if (!jailed && IN6_IS_ADDR_MULTICAST(dst)) { 239 struct ifnet *ifp = mopts ? mopts->im6o_multicast_ifp : NULL; 240 241 if (ifp == NULL && IN6_IS_ADDR_MC_NODELOCAL(dst)) { 242 ifp = &loif[0]; 243 } 244 245 if (ifp) { 246 ia6 = in6_ifawithscope(ifp, dst, cred); 247 if (ia6 == NULL) { 248 *errorp = EADDRNOTAVAIL; 249 return (0); 250 } 251 return (&satosin6(&ia6->ia_addr)->sin6_addr); 252 } 253 } 254 255 /* 256 * If the next hop address for the packet is specified 257 * by caller, use an address associated with the route 258 * to the next hop. 259 */ 260 { 261 struct sockaddr_in6 *sin6_next; 262 struct rtentry *rt; 263 264 if (opts && opts->ip6po_nexthop) { 265 sin6_next = satosin6(opts->ip6po_nexthop); 266 rt = nd6_lookup(&sin6_next->sin6_addr, 1, NULL); 267 if (rt) { 268 ia6 = in6_ifawithscope(rt->rt_ifp, dst, cred); 269 if (ia6 == NULL) 270 ia6 = ifatoia6(rt->rt_ifa); 271 } 272 if (ia6 && jailed) { 273 jsin6.sin6_addr = (&ia6->ia_addr)->sin6_addr; 274 if (!jailed_ip(cred->cr_prison, 275 (struct sockaddr *)&jsin6)) 276 ia6 = NULL; 277 } 278 279 if (ia6 == NULL) { 280 *errorp = EADDRNOTAVAIL; 281 return (0); 282 } 283 return (&satosin6(&ia6->ia_addr)->sin6_addr); 284 } 285 } 286 287 /* 288 * If route is known or can be allocated now, 289 * our src addr is taken from the i/f, else punt. 290 */ 291 if (ro) { 292 if (ro->ro_rt && 293 (!(ro->ro_rt->rt_flags & RTF_UP) || 294 satosin6(&ro->ro_dst)->sin6_family != AF_INET6 || 295 !IN6_ARE_ADDR_EQUAL(&satosin6(&ro->ro_dst)->sin6_addr, 296 dst))) { 297 RTFREE(ro->ro_rt); 298 ro->ro_rt = NULL; 299 } 300 if (ro->ro_rt == NULL || ro->ro_rt->rt_ifp == NULL) { 301 struct sockaddr_in6 *sa6; 302 303 /* No route yet, so try to acquire one */ 304 bzero(&ro->ro_dst, sizeof(struct sockaddr_in6)); 305 sa6 = &ro->ro_dst; 306 sa6->sin6_family = AF_INET6; 307 sa6->sin6_len = sizeof(struct sockaddr_in6); 308 sa6->sin6_addr = *dst; 309 sa6->sin6_scope_id = dstsock->sin6_scope_id; 310 if (!jailed && IN6_IS_ADDR_MULTICAST(dst)) { 311 ro->ro_rt = 312 rtpurelookup((struct sockaddr *)&ro->ro_dst); 313 } else { 314 rtalloc((struct route *)ro); 315 } 316 } 317 318 /* 319 * in_pcbconnect() checks out IFF_LOOPBACK to skip using 320 * the address. But we don't know why it does so. 321 * It is necessary to ensure the scope even for lo0 322 * so doesn't check out IFF_LOOPBACK. 323 */ 324 325 if (ro->ro_rt) { 326 ia6 = in6_ifawithscope(ro->ro_rt->rt_ifa->ifa_ifp, dst, cred); 327 if (ia6 && jailed) { 328 jsin6.sin6_addr = (&ia6->ia_addr)->sin6_addr; 329 if (!jailed_ip(cred->cr_prison, 330 (struct sockaddr *)&jsin6)) 331 ia6 = NULL; 332 } 333 334 if (ia6 == NULL) /* xxx scope error ?*/ 335 ia6 = ifatoia6(ro->ro_rt->rt_ifa); 336 337 if (ia6 && jailed) { 338 jsin6.sin6_addr = (&ia6->ia_addr)->sin6_addr; 339 if (!jailed_ip(cred->cr_prison, 340 (struct sockaddr *)&jsin6)) 341 ia6 = NULL; 342 } 343 } 344 #if 0 345 /* 346 * xxx The followings are necessary? (kazu) 347 * I don't think so. 348 * It's for SO_DONTROUTE option in IPv4.(jinmei) 349 */ 350 if (ia6 == 0) { 351 struct sockaddr_in6 sin6 = {sizeof(sin6), AF_INET6, 0}; 352 353 sin6->sin6_addr = *dst; 354 355 ia6 = ifatoia6(ifa_ifwithdstaddr(sin6tosa(&sin6))); 356 if (ia6 == 0) 357 ia6 = ifatoia6(ifa_ifwithnet(sin6tosa(&sin6))); 358 if (ia6 == 0) 359 return (0); 360 return (&satosin6(&ia6->ia_addr)->sin6_addr); 361 } 362 #endif /* 0 */ 363 if (ia6 == NULL) { 364 *errorp = EHOSTUNREACH; /* no route */ 365 return (0); 366 } 367 return (&satosin6(&ia6->ia_addr)->sin6_addr); 368 } 369 370 *errorp = EADDRNOTAVAIL; 371 return (0); 372 } 373 374 /* 375 * Default hop limit selection. The precedence is as follows: 376 * 1. Hoplimit value specified via ioctl. 377 * 2. (If the outgoing interface is detected) the current 378 * hop limit of the interface specified by router advertisement. 379 * 3. The system default hoplimit. 380 */ 381 int 382 in6_selecthlim(struct in6pcb *in6p, struct ifnet *ifp) 383 { 384 int hlim; 385 386 if (in6p && in6p->in6p_hops >= 0) { 387 return (in6p->in6p_hops); 388 } else if (ifp) { 389 hlim = ND_IFINFO(ifp)->chlim; 390 if (hlim < ip6_minhlim) 391 hlim = ip6_minhlim; 392 } else { 393 hlim = ip6_defhlim; 394 } 395 return (hlim); 396 } 397 398 /* 399 * XXX: this is borrowed from in6_pcbbind(). If possible, we should 400 * share this function by all *bsd*... 401 */ 402 int 403 in6_pcbsetlport(struct in6_addr *laddr, struct inpcb *inp, struct thread *td) 404 { 405 struct socket *so = inp->inp_socket; 406 u_int16_t lport = 0, first, last, *lastport, step; 407 int count, error = 0, wild = 0; 408 struct inpcbinfo *pcbinfo = inp->inp_pcbinfo; 409 struct inpcbportinfo *portinfo; 410 struct ucred *cred = NULL; 411 int portinfo_first, portinfo_idx; 412 413 /* XXX: this is redundant when called from in6_pcbbind */ 414 if ((so->so_options & (SO_REUSEADDR|SO_REUSEPORT)) == 0) 415 wild = INPLOOKUP_WILDCARD; 416 if (td->td_proc && td->td_proc->p_ucred) 417 cred = td->td_proc->p_ucred; 418 419 inp->inp_flags |= INP_ANONPORT; 420 421 step = pcbinfo->portinfo_mask + 1; 422 portinfo_first = mycpuid & pcbinfo->portinfo_mask; 423 portinfo_idx = portinfo_first; 424 loop: 425 portinfo = &pcbinfo->portinfo[portinfo_idx]; 426 427 if (inp->inp_flags & INP_HIGHPORT) { 428 first = ipport_hifirstauto; /* sysctl */ 429 last = ipport_hilastauto; 430 lastport = &portinfo->lasthi; 431 } else if (inp->inp_flags & INP_LOWPORT) { 432 if ((error = priv_check(td, PRIV_ROOT)) != 0) 433 return error; 434 first = ipport_lowfirstauto; /* 1023 */ 435 last = ipport_lowlastauto; /* 600 */ 436 lastport = &portinfo->lastlow; 437 } else { 438 first = ipport_firstauto; /* sysctl */ 439 last = ipport_lastauto; 440 lastport = &portinfo->lastport; 441 } 442 443 /* 444 * This has to be atomic. If the porthash is shared across multiple 445 * protocol threads (aka tcp) then the token must be held. 446 */ 447 GET_PORT_TOKEN(portinfo); 448 449 /* 450 * Simple check to ensure all ports are not used up causing 451 * a deadlock here. 452 * 453 * We split the two cases (up and down) so that the direction 454 * is not being tested on each round of the loop. 455 */ 456 if (first > last) { 457 /* 458 * counting down 459 */ 460 in_pcbportrange(&first, &last, portinfo->offset, step); 461 count = (first - last) / step; 462 463 do { 464 if (count-- < 0) { /* completely used? */ 465 error = EAGAIN; 466 goto done; 467 } 468 *lastport -= step; 469 if (*lastport > first || *lastport < last) 470 *lastport = first; 471 KKASSERT((*lastport & pcbinfo->portinfo_mask) == 472 portinfo->offset); 473 lport = htons(*lastport); 474 } while (in6_pcblookup_local(portinfo, &inp->in6p_laddr, 475 lport, wild, cred)); 476 } else { 477 /* 478 * counting up 479 */ 480 in_pcbportrange(&last, &first, portinfo->offset, step); 481 count = (last - first) / step; 482 483 do { 484 if (count-- < 0) { /* completely used? */ 485 error = EAGAIN; 486 goto done; 487 } 488 *lastport += step; 489 if (*lastport < first || *lastport > last) 490 *lastport = first; 491 KKASSERT((*lastport & pcbinfo->portinfo_mask) == 492 portinfo->offset); 493 lport = htons(*lastport); 494 } while (in6_pcblookup_local(portinfo, &inp->in6p_laddr, 495 lport, wild, cred)); 496 } 497 498 inp->inp_lport = lport; 499 in_pcbinsporthash(portinfo, inp); 500 error = 0; 501 done: 502 REL_PORT_TOKEN(portinfo); 503 504 if (error) { 505 /* Try next portinfo */ 506 portinfo_idx++; 507 portinfo_idx &= pcbinfo->portinfo_mask; 508 if (portinfo_idx != portinfo_first) 509 goto loop; 510 511 /* Undo any address bind that may have occurred above. */ 512 inp->in6p_laddr = kin6addr_any; 513 } 514 return error; 515 } 516 517 /* 518 * generate kernel-internal form (scopeid embedded into s6_addr16[1]). 519 * If the address scope of is link-local, embed the interface index in the 520 * address. The routine determines our precedence 521 * between advanced API scope/interface specification and basic API 522 * specification. 523 * 524 * this function should be nuked in the future, when we get rid of 525 * embedded scopeid thing. 526 * 527 * XXX actually, it is over-specification to return ifp against sin6_scope_id. 528 * there can be multiple interfaces that belong to a particular scope zone 529 * (in specification, we have 1:N mapping between a scope zone and interfaces). 530 * we may want to change the function to return something other than ifp. 531 */ 532 int 533 in6_embedscope(struct in6_addr *in6, 534 const struct sockaddr_in6 *sin6, 535 #ifdef HAVE_NRL_INPCB 536 struct inpcb *in6p, 537 #define in6p_outputopts inp_outputopts6 538 #define in6p_moptions inp_moptions6 539 #else 540 struct in6pcb *in6p, 541 #endif 542 struct ifnet **ifpp) 543 { 544 struct ifnet *ifp = NULL; 545 u_int32_t scopeid; 546 547 *in6 = sin6->sin6_addr; 548 scopeid = sin6->sin6_scope_id; 549 if (ifpp) 550 *ifpp = NULL; 551 552 /* 553 * don't try to read sin6->sin6_addr beyond here, since the caller may 554 * ask us to overwrite existing sockaddr_in6 555 */ 556 557 #ifdef ENABLE_DEFAULT_SCOPE 558 if (scopeid == 0) 559 scopeid = scope6_addr2default(in6); 560 #endif 561 562 if (IN6_IS_SCOPE_LINKLOCAL(in6)) { 563 struct in6_pktinfo *pi; 564 565 /* 566 * KAME assumption: link id == interface id 567 */ 568 569 if (in6p && in6p->in6p_outputopts && 570 (pi = in6p->in6p_outputopts->ip6po_pktinfo) && 571 pi->ipi6_ifindex) { 572 ifp = ifindex2ifnet[pi->ipi6_ifindex]; 573 in6->s6_addr16[1] = htons(pi->ipi6_ifindex); 574 } else if (in6p && IN6_IS_ADDR_MULTICAST(in6) && 575 in6p->in6p_moptions && 576 in6p->in6p_moptions->im6o_multicast_ifp) { 577 ifp = in6p->in6p_moptions->im6o_multicast_ifp; 578 in6->s6_addr16[1] = htons(ifp->if_index); 579 } else if (scopeid) { 580 /* boundary check */ 581 if (scopeid < 0 || if_index < scopeid) 582 return ENXIO; /* XXX EINVAL? */ 583 ifp = ifindex2ifnet[scopeid]; 584 /*XXX assignment to 16bit from 32bit variable */ 585 in6->s6_addr16[1] = htons(scopeid & 0xffff); 586 } 587 588 if (ifpp) 589 *ifpp = ifp; 590 } 591 592 return 0; 593 } 594 #ifdef HAVE_NRL_INPCB 595 #undef in6p_outputopts 596 #undef in6p_moptions 597 #endif 598 599 /* 600 * generate standard sockaddr_in6 from embedded form. 601 * touches sin6_addr and sin6_scope_id only. 602 * 603 * this function should be nuked in the future, when we get rid of 604 * embedded scopeid thing. 605 */ 606 int 607 in6_recoverscope(struct sockaddr_in6 *sin6, const struct in6_addr *in6, 608 struct ifnet *ifp) 609 { 610 u_int32_t scopeid; 611 612 sin6->sin6_addr = *in6; 613 614 /* 615 * don't try to read *in6 beyond here, since the caller may 616 * ask us to overwrite existing sockaddr_in6 617 */ 618 619 sin6->sin6_scope_id = 0; 620 if (IN6_IS_SCOPE_LINKLOCAL(in6)) { 621 /* 622 * KAME assumption: link id == interface id 623 */ 624 scopeid = ntohs(sin6->sin6_addr.s6_addr16[1]); 625 if (scopeid) { 626 /* sanity check */ 627 if (scopeid < 0 || if_index < scopeid) 628 return ENXIO; 629 if (ifp && ifp->if_index != scopeid) 630 return ENXIO; 631 sin6->sin6_addr.s6_addr16[1] = 0; 632 sin6->sin6_scope_id = scopeid; 633 } 634 } 635 636 return 0; 637 } 638 639 /* 640 * just clear the embedded scope identifer. 641 * XXX: currently used for bsdi4 only as a supplement function. 642 */ 643 void 644 in6_clearscope(struct in6_addr *addr) 645 { 646 if (IN6_IS_SCOPE_LINKLOCAL(addr)) 647 addr->s6_addr16[1] = 0; 648 } 649 650 void 651 addrsel_policy_init(void) 652 { 653 654 init_policy_queue(); 655 656 /* initialize the "last resort" policy */ 657 bzero(&defaultaddrpolicy, sizeof(defaultaddrpolicy)); 658 defaultaddrpolicy.label = ADDR_LABEL_NOTAPP; 659 } 660 661 /* 662 * Subroutines to manage the address selection policy table via sysctl. 663 */ 664 struct walkarg { 665 struct sysctl_req *w_req; 666 }; 667 668 static int in6_src_sysctl(SYSCTL_HANDLER_ARGS); 669 SYSCTL_DECL(_net_inet6_ip6); 670 SYSCTL_NODE(_net_inet6_ip6, IPV6CTL_ADDRCTLPOLICY, addrctlpolicy, 671 CTLFLAG_RD, in6_src_sysctl, "Address selection policy"); 672 673 static int 674 in6_src_sysctl(SYSCTL_HANDLER_ARGS) 675 { 676 struct walkarg w; 677 678 if (req->newptr) 679 return EPERM; 680 681 bzero(&w, sizeof(w)); 682 w.w_req = req; 683 684 return (walk_addrsel_policy(dump_addrsel_policyent, &w)); 685 } 686 687 int 688 in6_src_ioctl(u_long cmd, caddr_t data) 689 { 690 int i; 691 struct in6_addrpolicy ent0; 692 693 if (cmd != SIOCAADDRCTL_POLICY && cmd != SIOCDADDRCTL_POLICY) 694 return (EOPNOTSUPP); /* check for safety */ 695 696 ent0 = *(struct in6_addrpolicy *)data; 697 698 if (ent0.label == ADDR_LABEL_NOTAPP) 699 return (EINVAL); 700 /* check if the prefix mask is consecutive. */ 701 if (in6_mask2len(&ent0.addrmask.sin6_addr, NULL) < 0) 702 return (EINVAL); 703 /* clear trailing garbages (if any) of the prefix address. */ 704 for (i = 0; i < 4; i++) { 705 ent0.addr.sin6_addr.s6_addr32[i] &= 706 ent0.addrmask.sin6_addr.s6_addr32[i]; 707 } 708 ent0.use = 0; 709 710 switch (cmd) { 711 case SIOCAADDRCTL_POLICY: 712 return (add_addrsel_policyent(&ent0)); 713 case SIOCDADDRCTL_POLICY: 714 return (delete_addrsel_policyent(&ent0)); 715 } 716 717 return (0); /* XXX: compromise compilers */ 718 } 719 720 /* 721 * The followings are implementation of the policy table using a 722 * simple tail queue. 723 * XXX such details should be hidden. 724 * XXX implementation using binary tree should be more efficient. 725 */ 726 struct addrsel_policyent { 727 TAILQ_ENTRY(addrsel_policyent) ape_entry; 728 struct in6_addrpolicy ape_policy; 729 }; 730 731 TAILQ_HEAD(addrsel_policyhead, addrsel_policyent); 732 733 struct addrsel_policyhead addrsel_policytab; 734 735 static void 736 init_policy_queue(void) 737 { 738 TAILQ_INIT(&addrsel_policytab); 739 } 740 741 static int 742 add_addrsel_policyent(struct in6_addrpolicy *newpolicy) 743 { 744 struct addrsel_policyent *new, *pol; 745 746 /* duplication check */ 747 for (pol = TAILQ_FIRST(&addrsel_policytab); pol; 748 pol = TAILQ_NEXT(pol, ape_entry)) { 749 if (SA6_ARE_ADDR_EQUAL(&newpolicy->addr, 750 &pol->ape_policy.addr) && 751 SA6_ARE_ADDR_EQUAL(&newpolicy->addrmask, 752 &pol->ape_policy.addrmask)) { 753 return (EEXIST); /* or override it? */ 754 } 755 } 756 757 new = kmalloc(sizeof(*new), M_IFADDR, M_WAITOK | M_ZERO); 758 759 /* XXX: should validate entry */ 760 new->ape_policy = *newpolicy; 761 762 TAILQ_INSERT_TAIL(&addrsel_policytab, new, ape_entry); 763 764 return (0); 765 } 766 767 static int 768 delete_addrsel_policyent(struct in6_addrpolicy *key) 769 { 770 struct addrsel_policyent *pol; 771 772 /* search for the entry in the table */ 773 for (pol = TAILQ_FIRST(&addrsel_policytab); pol; 774 pol = TAILQ_NEXT(pol, ape_entry)) { 775 if (SA6_ARE_ADDR_EQUAL(&key->addr, &pol->ape_policy.addr) && 776 SA6_ARE_ADDR_EQUAL(&key->addrmask, 777 &pol->ape_policy.addrmask)) { 778 break; 779 } 780 } 781 if (pol == NULL) 782 return (ESRCH); 783 784 TAILQ_REMOVE(&addrsel_policytab, pol, ape_entry); 785 kfree(pol, M_IFADDR); 786 787 return (0); 788 } 789 790 static int 791 walk_addrsel_policy(int(*callback)(struct in6_addrpolicy *, void *), void *w) 792 { 793 struct addrsel_policyent *pol; 794 int error = 0; 795 796 for (pol = TAILQ_FIRST(&addrsel_policytab); pol; 797 pol = TAILQ_NEXT(pol, ape_entry)) { 798 if ((error = (*callback)(&pol->ape_policy, w)) != 0) 799 return (error); 800 } 801 802 return (error); 803 } 804 805 static int 806 dump_addrsel_policyent(struct in6_addrpolicy *pol, void *arg) 807 { 808 int error = 0; 809 struct walkarg *w = arg; 810 811 error = SYSCTL_OUT(w->w_req, pol, sizeof(*pol)); 812 813 return (error); 814 } 815