1686cdd19SJun-ichiro itojun Hagino /* $FreeBSD$ */ 2d6385b1cSHajimu UMEMOTO /* $KAME: in6_src.c,v 1.132 2003/08/26 04:42:27 keiichi Exp $ */ 3686cdd19SJun-ichiro itojun Hagino 4caf43b02SWarner Losh /*- 5686cdd19SJun-ichiro itojun Hagino * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 6686cdd19SJun-ichiro itojun Hagino * All rights reserved. 7686cdd19SJun-ichiro itojun Hagino * 8686cdd19SJun-ichiro itojun Hagino * Redistribution and use in source and binary forms, with or without 9686cdd19SJun-ichiro itojun Hagino * modification, are permitted provided that the following conditions 10686cdd19SJun-ichiro itojun Hagino * are met: 11686cdd19SJun-ichiro itojun Hagino * 1. Redistributions of source code must retain the above copyright 12686cdd19SJun-ichiro itojun Hagino * notice, this list of conditions and the following disclaimer. 13686cdd19SJun-ichiro itojun Hagino * 2. Redistributions in binary form must reproduce the above copyright 14686cdd19SJun-ichiro itojun Hagino * notice, this list of conditions and the following disclaimer in the 15686cdd19SJun-ichiro itojun Hagino * documentation and/or other materials provided with the distribution. 16686cdd19SJun-ichiro itojun Hagino * 3. Neither the name of the project nor the names of its contributors 17686cdd19SJun-ichiro itojun Hagino * may be used to endorse or promote products derived from this software 18686cdd19SJun-ichiro itojun Hagino * without specific prior written permission. 19686cdd19SJun-ichiro itojun Hagino * 20686cdd19SJun-ichiro itojun Hagino * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 21686cdd19SJun-ichiro itojun Hagino * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22686cdd19SJun-ichiro itojun Hagino * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23686cdd19SJun-ichiro itojun Hagino * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 24686cdd19SJun-ichiro itojun Hagino * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25686cdd19SJun-ichiro itojun Hagino * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26686cdd19SJun-ichiro itojun Hagino * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27686cdd19SJun-ichiro itojun Hagino * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28686cdd19SJun-ichiro itojun Hagino * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29686cdd19SJun-ichiro itojun Hagino * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30686cdd19SJun-ichiro itojun Hagino * SUCH DAMAGE. 31686cdd19SJun-ichiro itojun Hagino */ 32686cdd19SJun-ichiro itojun Hagino 33caf43b02SWarner Losh /*- 34686cdd19SJun-ichiro itojun Hagino * Copyright (c) 1982, 1986, 1991, 1993 35686cdd19SJun-ichiro itojun Hagino * The Regents of the University of California. All rights reserved. 36686cdd19SJun-ichiro itojun Hagino * 37686cdd19SJun-ichiro itojun Hagino * Redistribution and use in source and binary forms, with or without 38686cdd19SJun-ichiro itojun Hagino * modification, are permitted provided that the following conditions 39686cdd19SJun-ichiro itojun Hagino * are met: 40686cdd19SJun-ichiro itojun Hagino * 1. Redistributions of source code must retain the above copyright 41686cdd19SJun-ichiro itojun Hagino * notice, this list of conditions and the following disclaimer. 42686cdd19SJun-ichiro itojun Hagino * 2. Redistributions in binary form must reproduce the above copyright 43686cdd19SJun-ichiro itojun Hagino * notice, this list of conditions and the following disclaimer in the 44686cdd19SJun-ichiro itojun Hagino * documentation and/or other materials provided with the distribution. 45686cdd19SJun-ichiro itojun Hagino * 4. Neither the name of the University nor the names of its contributors 46686cdd19SJun-ichiro itojun Hagino * may be used to endorse or promote products derived from this software 47686cdd19SJun-ichiro itojun Hagino * without specific prior written permission. 48686cdd19SJun-ichiro itojun Hagino * 49686cdd19SJun-ichiro itojun Hagino * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 50686cdd19SJun-ichiro itojun Hagino * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 51686cdd19SJun-ichiro itojun Hagino * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 52686cdd19SJun-ichiro itojun Hagino * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 53686cdd19SJun-ichiro itojun Hagino * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 54686cdd19SJun-ichiro itojun Hagino * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 55686cdd19SJun-ichiro itojun Hagino * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 56686cdd19SJun-ichiro itojun Hagino * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 57686cdd19SJun-ichiro itojun Hagino * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 58686cdd19SJun-ichiro itojun Hagino * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 59686cdd19SJun-ichiro itojun Hagino * SUCH DAMAGE. 60686cdd19SJun-ichiro itojun Hagino * 61686cdd19SJun-ichiro itojun Hagino * @(#)in_pcb.c 8.2 (Berkeley) 1/4/94 62686cdd19SJun-ichiro itojun Hagino */ 63686cdd19SJun-ichiro itojun Hagino 64686cdd19SJun-ichiro itojun Hagino #include "opt_inet.h" 65686cdd19SJun-ichiro itojun Hagino #include "opt_inet6.h" 66686cdd19SJun-ichiro itojun Hagino 67686cdd19SJun-ichiro itojun Hagino #include <sys/param.h> 68686cdd19SJun-ichiro itojun Hagino #include <sys/systm.h> 6933841545SHajimu UMEMOTO #include <sys/malloc.h> 70686cdd19SJun-ichiro itojun Hagino #include <sys/mbuf.h> 71686cdd19SJun-ichiro itojun Hagino #include <sys/protosw.h> 72686cdd19SJun-ichiro itojun Hagino #include <sys/socket.h> 73686cdd19SJun-ichiro itojun Hagino #include <sys/socketvar.h> 747fc91b3fSHajimu UMEMOTO #include <sys/sockio.h> 757fc91b3fSHajimu UMEMOTO #include <sys/sysctl.h> 76686cdd19SJun-ichiro itojun Hagino #include <sys/errno.h> 77686cdd19SJun-ichiro itojun Hagino #include <sys/time.h> 784a201dfcSHajimu UMEMOTO #include <sys/kernel.h> 79686cdd19SJun-ichiro itojun Hagino 80686cdd19SJun-ichiro itojun Hagino #include <net/if.h> 81686cdd19SJun-ichiro itojun Hagino #include <net/route.h> 82686cdd19SJun-ichiro itojun Hagino 83686cdd19SJun-ichiro itojun Hagino #include <netinet/in.h> 84686cdd19SJun-ichiro itojun Hagino #include <netinet/in_var.h> 85686cdd19SJun-ichiro itojun Hagino #include <netinet/in_systm.h> 86686cdd19SJun-ichiro itojun Hagino #include <netinet/ip.h> 87686cdd19SJun-ichiro itojun Hagino #include <netinet/in_pcb.h> 88686cdd19SJun-ichiro itojun Hagino #include <netinet6/in6_var.h> 89686cdd19SJun-ichiro itojun Hagino #include <netinet/ip6.h> 90686cdd19SJun-ichiro itojun Hagino #include <netinet6/in6_pcb.h> 91686cdd19SJun-ichiro itojun Hagino #include <netinet6/ip6_var.h> 92a1f7e5f8SHajimu UMEMOTO #include <netinet6/scope6_var.h> 93686cdd19SJun-ichiro itojun Hagino #include <netinet6/nd6.h> 94686cdd19SJun-ichiro itojun Hagino #ifdef ENABLE_DEFAULT_SCOPE 95686cdd19SJun-ichiro itojun Hagino #include <netinet6/scope6_var.h> 96686cdd19SJun-ichiro itojun Hagino #endif 97686cdd19SJun-ichiro itojun Hagino 98686cdd19SJun-ichiro itojun Hagino #include <net/net_osdep.h> 99686cdd19SJun-ichiro itojun Hagino 1007fc91b3fSHajimu UMEMOTO static struct mtx addrsel_lock; 1017fc91b3fSHajimu UMEMOTO #define ADDRSEL_LOCK_INIT() mtx_init(&addrsel_lock, "addrsel_lock", NULL, MTX_DEF) 1027fc91b3fSHajimu UMEMOTO #define ADDRSEL_LOCK() mtx_lock(&addrsel_lock) 1037fc91b3fSHajimu UMEMOTO #define ADDRSEL_UNLOCK() mtx_unlock(&addrsel_lock) 1047fc91b3fSHajimu UMEMOTO #define ADDRSEL_LOCK_ASSERT() mtx_assert(&addrsel_lock, MA_OWNED) 1057fc91b3fSHajimu UMEMOTO 1067fc91b3fSHajimu UMEMOTO #define ADDR_LABEL_NOTAPP (-1) 1077fc91b3fSHajimu UMEMOTO struct in6_addrpolicy defaultaddrpolicy; 1087fc91b3fSHajimu UMEMOTO 109d6385b1cSHajimu UMEMOTO int ip6_prefer_tempaddr = 0; 110d6385b1cSHajimu UMEMOTO 111a1f7e5f8SHajimu UMEMOTO static int selectroute __P((struct sockaddr_in6 *, struct ip6_pktopts *, 112a1f7e5f8SHajimu UMEMOTO struct ip6_moptions *, struct route_in6 *, struct ifnet **, 113a1f7e5f8SHajimu UMEMOTO struct rtentry **, int, int)); 114d6385b1cSHajimu UMEMOTO static int in6_selectif __P((struct sockaddr_in6 *, struct ip6_pktopts *, 11568efda09SHajimu UMEMOTO struct ip6_moptions *, struct route_in6 *ro, struct ifnet **)); 116d6385b1cSHajimu UMEMOTO 117d6385b1cSHajimu UMEMOTO static struct in6_addrpolicy *lookup_addrsel_policy __P((struct sockaddr_in6 *)); 118d6385b1cSHajimu UMEMOTO 1197fc91b3fSHajimu UMEMOTO static void init_policy_queue __P((void)); 1207fc91b3fSHajimu UMEMOTO static int add_addrsel_policyent __P((struct in6_addrpolicy *)); 1217fc91b3fSHajimu UMEMOTO static int delete_addrsel_policyent __P((struct in6_addrpolicy *)); 1227fc91b3fSHajimu UMEMOTO static int walk_addrsel_policy __P((int (*)(struct in6_addrpolicy *, void *), 1237fc91b3fSHajimu UMEMOTO void *)); 1247fc91b3fSHajimu UMEMOTO static int dump_addrsel_policyent __P((struct in6_addrpolicy *, void *)); 125d6385b1cSHajimu UMEMOTO static struct in6_addrpolicy *match_addrsel_policy __P((struct sockaddr_in6 *)); 1267fc91b3fSHajimu UMEMOTO 127686cdd19SJun-ichiro itojun Hagino /* 12833841545SHajimu UMEMOTO * Return an IPv6 address, which is the most appropriate for a given 129686cdd19SJun-ichiro itojun Hagino * destination and user specified options. 13033841545SHajimu UMEMOTO * If necessary, this function lookups the routing table and returns 131686cdd19SJun-ichiro itojun Hagino * an entry to the caller for later use. 132686cdd19SJun-ichiro itojun Hagino */ 133d6385b1cSHajimu UMEMOTO #define REPLACE(r) do {\ 134d6385b1cSHajimu UMEMOTO if ((r) < sizeof(ip6stat.ip6s_sources_rule) / \ 135d6385b1cSHajimu UMEMOTO sizeof(ip6stat.ip6s_sources_rule[0])) /* check for safety */ \ 136d6385b1cSHajimu UMEMOTO ip6stat.ip6s_sources_rule[(r)]++; \ 137d6385b1cSHajimu UMEMOTO /* printf("in6_selectsrc: replace %s with %s by %d\n", ia_best ? ip6_sprintf(&ia_best->ia_addr.sin6_addr) : "none", ip6_sprintf(&ia->ia_addr.sin6_addr), (r)); */ \ 138d6385b1cSHajimu UMEMOTO goto replace; \ 139d6385b1cSHajimu UMEMOTO } while(0) 140d6385b1cSHajimu UMEMOTO #define NEXT(r) do {\ 141d6385b1cSHajimu UMEMOTO if ((r) < sizeof(ip6stat.ip6s_sources_rule) / \ 142d6385b1cSHajimu UMEMOTO sizeof(ip6stat.ip6s_sources_rule[0])) /* check for safety */ \ 143d6385b1cSHajimu UMEMOTO ip6stat.ip6s_sources_rule[(r)]++; \ 144d6385b1cSHajimu UMEMOTO /* printf("in6_selectsrc: keep %s against %s by %d\n", ia_best ? ip6_sprintf(&ia_best->ia_addr.sin6_addr) : "none", ip6_sprintf(&ia->ia_addr.sin6_addr), (r)); */ \ 145d6385b1cSHajimu UMEMOTO goto next; /* XXX: we can't use 'continue' here */ \ 146d6385b1cSHajimu UMEMOTO } while(0) 147d6385b1cSHajimu UMEMOTO #define BREAK(r) do { \ 148d6385b1cSHajimu UMEMOTO if ((r) < sizeof(ip6stat.ip6s_sources_rule) / \ 149d6385b1cSHajimu UMEMOTO sizeof(ip6stat.ip6s_sources_rule[0])) /* check for safety */ \ 150d6385b1cSHajimu UMEMOTO ip6stat.ip6s_sources_rule[(r)]++; \ 151d6385b1cSHajimu UMEMOTO goto out; /* XXX: we can't use 'break' here */ \ 152d6385b1cSHajimu UMEMOTO } while(0) 153d6385b1cSHajimu UMEMOTO 154686cdd19SJun-ichiro itojun Hagino struct in6_addr * 155a1f7e5f8SHajimu UMEMOTO in6_selectsrc(dstsock, opts, mopts, ro, laddr, ifpp, errorp) 156686cdd19SJun-ichiro itojun Hagino struct sockaddr_in6 *dstsock; 157686cdd19SJun-ichiro itojun Hagino struct ip6_pktopts *opts; 158686cdd19SJun-ichiro itojun Hagino struct ip6_moptions *mopts; 159686cdd19SJun-ichiro itojun Hagino struct route_in6 *ro; 160686cdd19SJun-ichiro itojun Hagino struct in6_addr *laddr; 161a1f7e5f8SHajimu UMEMOTO struct ifnet **ifpp; 162686cdd19SJun-ichiro itojun Hagino int *errorp; 163686cdd19SJun-ichiro itojun Hagino { 164a1f7e5f8SHajimu UMEMOTO struct in6_addr dst; 165d6385b1cSHajimu UMEMOTO struct ifnet *ifp = NULL; 166d6385b1cSHajimu UMEMOTO struct in6_ifaddr *ia = NULL, *ia_best = NULL; 167686cdd19SJun-ichiro itojun Hagino struct in6_pktinfo *pi = NULL; 168d6385b1cSHajimu UMEMOTO int dst_scope = -1, best_scope = -1, best_matchlen = -1; 169d6385b1cSHajimu UMEMOTO struct in6_addrpolicy *dst_policy = NULL, *best_policy = NULL; 170d6385b1cSHajimu UMEMOTO u_int32_t odstzone; 171d6385b1cSHajimu UMEMOTO int prefer_tempaddr; 172e6a27350SHajimu UMEMOTO 173a1f7e5f8SHajimu UMEMOTO dst = dstsock->sin6_addr; /* make a copy for local operation */ 174686cdd19SJun-ichiro itojun Hagino *errorp = 0; 175a1f7e5f8SHajimu UMEMOTO if (ifpp) 176a1f7e5f8SHajimu UMEMOTO *ifpp = NULL; 177686cdd19SJun-ichiro itojun Hagino 178686cdd19SJun-ichiro itojun Hagino /* 179686cdd19SJun-ichiro itojun Hagino * If the source address is explicitly specified by the caller, 180d6385b1cSHajimu UMEMOTO * check if the requested source address is indeed a unicast address 181d6385b1cSHajimu UMEMOTO * assigned to the node, and can be used as the packet's source 182d6385b1cSHajimu UMEMOTO * address. If everything is okay, use the address as source. 183686cdd19SJun-ichiro itojun Hagino */ 184686cdd19SJun-ichiro itojun Hagino if (opts && (pi = opts->ip6po_pktinfo) && 185d6385b1cSHajimu UMEMOTO !IN6_IS_ADDR_UNSPECIFIED(&pi->ipi6_addr)) { 186d6385b1cSHajimu UMEMOTO struct sockaddr_in6 srcsock; 187d6385b1cSHajimu UMEMOTO struct in6_ifaddr *ia6; 188d6385b1cSHajimu UMEMOTO 189d6385b1cSHajimu UMEMOTO /* get the outgoing interface */ 190d6385b1cSHajimu UMEMOTO if ((*errorp = in6_selectif(dstsock, opts, mopts, ro, &ifp)) 191d6385b1cSHajimu UMEMOTO != 0) { 192d6385b1cSHajimu UMEMOTO return (NULL); 193d6385b1cSHajimu UMEMOTO } 19468efda09SHajimu UMEMOTO 195686cdd19SJun-ichiro itojun Hagino /* 196d6385b1cSHajimu UMEMOTO * determine the appropriate zone id of the source based on 197d6385b1cSHajimu UMEMOTO * the zone of the destination and the outgoing interface. 198a1f7e5f8SHajimu UMEMOTO * If the specified address is ambiguous wrt the scope zone, 199a1f7e5f8SHajimu UMEMOTO * the interface must be specified; otherwise, ifa_ifwithaddr() 200a1f7e5f8SHajimu UMEMOTO * will fail matching the address. 201d6385b1cSHajimu UMEMOTO */ 202d6385b1cSHajimu UMEMOTO bzero(&srcsock, sizeof(srcsock)); 203d6385b1cSHajimu UMEMOTO srcsock.sin6_family = AF_INET6; 204d6385b1cSHajimu UMEMOTO srcsock.sin6_len = sizeof(srcsock); 205d6385b1cSHajimu UMEMOTO srcsock.sin6_addr = pi->ipi6_addr; 206d6385b1cSHajimu UMEMOTO if (ifp) { 207a1f7e5f8SHajimu UMEMOTO *errorp = in6_setscope(&srcsock.sin6_addr, ifp, NULL); 208a1f7e5f8SHajimu UMEMOTO if (*errorp != 0) 209d6385b1cSHajimu UMEMOTO return (NULL); 210d6385b1cSHajimu UMEMOTO } 211a1f7e5f8SHajimu UMEMOTO 212d6385b1cSHajimu UMEMOTO ia6 = (struct in6_ifaddr *)ifa_ifwithaddr((struct sockaddr *)(&srcsock)); 213d6385b1cSHajimu UMEMOTO if (ia6 == NULL || 214d6385b1cSHajimu UMEMOTO (ia6->ia6_flags & (IN6_IFF_ANYCAST | IN6_IFF_NOTREADY))) { 215d6385b1cSHajimu UMEMOTO *errorp = EADDRNOTAVAIL; 216d6385b1cSHajimu UMEMOTO return (NULL); 217d6385b1cSHajimu UMEMOTO } 218d6385b1cSHajimu UMEMOTO pi->ipi6_addr = srcsock.sin6_addr; /* XXX: this overrides pi */ 219a1f7e5f8SHajimu UMEMOTO if (ifpp) 220a1f7e5f8SHajimu UMEMOTO *ifpp = ifp; 221d6385b1cSHajimu UMEMOTO return (&ia6->ia_addr.sin6_addr); 222d6385b1cSHajimu UMEMOTO } 223d6385b1cSHajimu UMEMOTO 224d6385b1cSHajimu UMEMOTO /* 225d6385b1cSHajimu UMEMOTO * Otherwise, if the socket has already bound the source, just use it. 226686cdd19SJun-ichiro itojun Hagino */ 227686cdd19SJun-ichiro itojun Hagino if (laddr && !IN6_IS_ADDR_UNSPECIFIED(laddr)) 228686cdd19SJun-ichiro itojun Hagino return (laddr); 229686cdd19SJun-ichiro itojun Hagino 230686cdd19SJun-ichiro itojun Hagino /* 231d6385b1cSHajimu UMEMOTO * If the address is not specified, choose the best one based on 232d6385b1cSHajimu UMEMOTO * the outgoing interface and the destination address. 233686cdd19SJun-ichiro itojun Hagino */ 234d6385b1cSHajimu UMEMOTO /* get the outgoing interface */ 235d6385b1cSHajimu UMEMOTO if ((*errorp = in6_selectif(dstsock, opts, mopts, ro, &ifp)) != 0) 236d6385b1cSHajimu UMEMOTO return (NULL); 237686cdd19SJun-ichiro itojun Hagino 238d6385b1cSHajimu UMEMOTO #ifdef DIAGNOSTIC 239d6385b1cSHajimu UMEMOTO if (ifp == NULL) /* this should not happen */ 240d6385b1cSHajimu UMEMOTO panic("in6_selectsrc: NULL ifp"); 241d6385b1cSHajimu UMEMOTO #endif 242a1f7e5f8SHajimu UMEMOTO *errorp = in6_setscope(&dst, ifp, &odstzone); 243a1f7e5f8SHajimu UMEMOTO if (*errorp != 0) 244d6385b1cSHajimu UMEMOTO return (NULL); 245a1f7e5f8SHajimu UMEMOTO 246d6385b1cSHajimu UMEMOTO for (ia = in6_ifaddr; ia; ia = ia->ia_next) { 247d6385b1cSHajimu UMEMOTO int new_scope = -1, new_matchlen = -1; 248d6385b1cSHajimu UMEMOTO struct in6_addrpolicy *new_policy = NULL; 249d6385b1cSHajimu UMEMOTO u_int32_t srczone, osrczone, dstzone; 250a1f7e5f8SHajimu UMEMOTO struct in6_addr src; 251d6385b1cSHajimu UMEMOTO struct ifnet *ifp1 = ia->ia_ifp; 252d6385b1cSHajimu UMEMOTO 253d6385b1cSHajimu UMEMOTO /* 254d6385b1cSHajimu UMEMOTO * We'll never take an address that breaks the scope zone 255d6385b1cSHajimu UMEMOTO * of the destination. We also skip an address if its zone 256d6385b1cSHajimu UMEMOTO * does not contain the outgoing interface. 257d6385b1cSHajimu UMEMOTO * XXX: we should probably use sin6_scope_id here. 258d6385b1cSHajimu UMEMOTO */ 259a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&dst, ifp1, &dstzone) || 260d6385b1cSHajimu UMEMOTO odstzone != dstzone) { 261d6385b1cSHajimu UMEMOTO continue; 262d6385b1cSHajimu UMEMOTO } 263a1f7e5f8SHajimu UMEMOTO src = ia->ia_addr.sin6_addr; 264a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&src, ifp, &osrczone) || 265a1f7e5f8SHajimu UMEMOTO in6_setscope(&src, ifp1, &srczone) || 266d6385b1cSHajimu UMEMOTO osrczone != srczone) { 267d6385b1cSHajimu UMEMOTO continue; 268686cdd19SJun-ichiro itojun Hagino } 269686cdd19SJun-ichiro itojun Hagino 270d6385b1cSHajimu UMEMOTO /* avoid unusable addresses */ 271d6385b1cSHajimu UMEMOTO if ((ia->ia6_flags & 272d6385b1cSHajimu UMEMOTO (IN6_IFF_NOTREADY | IN6_IFF_ANYCAST | IN6_IFF_DETACHED))) { 273d6385b1cSHajimu UMEMOTO continue; 274d6385b1cSHajimu UMEMOTO } 275d6385b1cSHajimu UMEMOTO if (!ip6_use_deprecated && IFA6_IS_DEPRECATED(ia)) 276d6385b1cSHajimu UMEMOTO continue; 277d6385b1cSHajimu UMEMOTO 278d6385b1cSHajimu UMEMOTO /* Rule 1: Prefer same address */ 279a1f7e5f8SHajimu UMEMOTO if (IN6_ARE_ADDR_EQUAL(&dst, &ia->ia_addr.sin6_addr)) { 280d6385b1cSHajimu UMEMOTO ia_best = ia; 281d6385b1cSHajimu UMEMOTO BREAK(1); /* there should be no better candidate */ 282d6385b1cSHajimu UMEMOTO } 283d6385b1cSHajimu UMEMOTO 284d6385b1cSHajimu UMEMOTO if (ia_best == NULL) 285d6385b1cSHajimu UMEMOTO REPLACE(0); 286d6385b1cSHajimu UMEMOTO 287d6385b1cSHajimu UMEMOTO /* Rule 2: Prefer appropriate scope */ 288d6385b1cSHajimu UMEMOTO if (dst_scope < 0) 289a1f7e5f8SHajimu UMEMOTO dst_scope = in6_addrscope(&dst); 290d6385b1cSHajimu UMEMOTO new_scope = in6_addrscope(&ia->ia_addr.sin6_addr); 291d6385b1cSHajimu UMEMOTO if (IN6_ARE_SCOPE_CMP(best_scope, new_scope) < 0) { 292d6385b1cSHajimu UMEMOTO if (IN6_ARE_SCOPE_CMP(best_scope, dst_scope) < 0) 293d6385b1cSHajimu UMEMOTO REPLACE(2); 294d6385b1cSHajimu UMEMOTO NEXT(2); 295d6385b1cSHajimu UMEMOTO } else if (IN6_ARE_SCOPE_CMP(new_scope, best_scope) < 0) { 296d6385b1cSHajimu UMEMOTO if (IN6_ARE_SCOPE_CMP(new_scope, dst_scope) < 0) 297d6385b1cSHajimu UMEMOTO NEXT(2); 298d6385b1cSHajimu UMEMOTO REPLACE(2); 299d6385b1cSHajimu UMEMOTO } 300d6385b1cSHajimu UMEMOTO 301d6385b1cSHajimu UMEMOTO /* 302d6385b1cSHajimu UMEMOTO * Rule 3: Avoid deprecated addresses. Note that the case of 303d6385b1cSHajimu UMEMOTO * !ip6_use_deprecated is already rejected above. 304d6385b1cSHajimu UMEMOTO */ 305d6385b1cSHajimu UMEMOTO if (!IFA6_IS_DEPRECATED(ia_best) && IFA6_IS_DEPRECATED(ia)) 306d6385b1cSHajimu UMEMOTO NEXT(3); 307d6385b1cSHajimu UMEMOTO if (IFA6_IS_DEPRECATED(ia_best) && !IFA6_IS_DEPRECATED(ia)) 308d6385b1cSHajimu UMEMOTO REPLACE(3); 309d6385b1cSHajimu UMEMOTO 310d6385b1cSHajimu UMEMOTO /* Rule 4: Prefer home addresses */ 311d6385b1cSHajimu UMEMOTO /* 312d6385b1cSHajimu UMEMOTO * XXX: This is a TODO. We should probably merge the MIP6 313d6385b1cSHajimu UMEMOTO * case above. 314d6385b1cSHajimu UMEMOTO */ 315d6385b1cSHajimu UMEMOTO 316d6385b1cSHajimu UMEMOTO /* Rule 5: Prefer outgoing interface */ 317d6385b1cSHajimu UMEMOTO if (ia_best->ia_ifp == ifp && ia->ia_ifp != ifp) 318d6385b1cSHajimu UMEMOTO NEXT(5); 319d6385b1cSHajimu UMEMOTO if (ia_best->ia_ifp != ifp && ia->ia_ifp == ifp) 320d6385b1cSHajimu UMEMOTO REPLACE(5); 321d6385b1cSHajimu UMEMOTO 322d6385b1cSHajimu UMEMOTO /* 323d6385b1cSHajimu UMEMOTO * Rule 6: Prefer matching label 324d6385b1cSHajimu UMEMOTO * Note that best_policy should be non-NULL here. 325d6385b1cSHajimu UMEMOTO */ 326d6385b1cSHajimu UMEMOTO if (dst_policy == NULL) 327d6385b1cSHajimu UMEMOTO dst_policy = lookup_addrsel_policy(dstsock); 328d6385b1cSHajimu UMEMOTO if (dst_policy->label != ADDR_LABEL_NOTAPP) { 329d6385b1cSHajimu UMEMOTO new_policy = lookup_addrsel_policy(&ia->ia_addr); 330d6385b1cSHajimu UMEMOTO if (dst_policy->label == best_policy->label && 331d6385b1cSHajimu UMEMOTO dst_policy->label != new_policy->label) 332d6385b1cSHajimu UMEMOTO NEXT(6); 333d6385b1cSHajimu UMEMOTO if (dst_policy->label != best_policy->label && 334d6385b1cSHajimu UMEMOTO dst_policy->label == new_policy->label) 335d6385b1cSHajimu UMEMOTO REPLACE(6); 336d6385b1cSHajimu UMEMOTO } 337d6385b1cSHajimu UMEMOTO 338d6385b1cSHajimu UMEMOTO /* 339d6385b1cSHajimu UMEMOTO * Rule 7: Prefer public addresses. 340d6385b1cSHajimu UMEMOTO * We allow users to reverse the logic by configuring 341d6385b1cSHajimu UMEMOTO * a sysctl variable, so that privacy conscious users can 342d6385b1cSHajimu UMEMOTO * always prefer temporary addresses. 343d6385b1cSHajimu UMEMOTO */ 344d6385b1cSHajimu UMEMOTO if (opts == NULL || 345d6385b1cSHajimu UMEMOTO opts->ip6po_prefer_tempaddr == IP6PO_TEMPADDR_SYSTEM) { 346d6385b1cSHajimu UMEMOTO prefer_tempaddr = ip6_prefer_tempaddr; 347d6385b1cSHajimu UMEMOTO } else if (opts->ip6po_prefer_tempaddr == 348d6385b1cSHajimu UMEMOTO IP6PO_TEMPADDR_NOTPREFER) { 349d6385b1cSHajimu UMEMOTO prefer_tempaddr = 0; 350d6385b1cSHajimu UMEMOTO } else 351d6385b1cSHajimu UMEMOTO prefer_tempaddr = 1; 352d6385b1cSHajimu UMEMOTO if (!(ia_best->ia6_flags & IN6_IFF_TEMPORARY) && 353d6385b1cSHajimu UMEMOTO (ia->ia6_flags & IN6_IFF_TEMPORARY)) { 354d6385b1cSHajimu UMEMOTO if (prefer_tempaddr) 355d6385b1cSHajimu UMEMOTO REPLACE(7); 356d6385b1cSHajimu UMEMOTO else 357d6385b1cSHajimu UMEMOTO NEXT(7); 358d6385b1cSHajimu UMEMOTO } 359d6385b1cSHajimu UMEMOTO if ((ia_best->ia6_flags & IN6_IFF_TEMPORARY) && 360d6385b1cSHajimu UMEMOTO !(ia->ia6_flags & IN6_IFF_TEMPORARY)) { 361d6385b1cSHajimu UMEMOTO if (prefer_tempaddr) 362d6385b1cSHajimu UMEMOTO NEXT(7); 363d6385b1cSHajimu UMEMOTO else 364d6385b1cSHajimu UMEMOTO REPLACE(7); 365d6385b1cSHajimu UMEMOTO } 366d6385b1cSHajimu UMEMOTO 367d6385b1cSHajimu UMEMOTO /* 368d6385b1cSHajimu UMEMOTO * Rule 8: prefer addresses on alive interfaces. 369d6385b1cSHajimu UMEMOTO * This is a KAME specific rule. 370d6385b1cSHajimu UMEMOTO */ 371d6385b1cSHajimu UMEMOTO if ((ia_best->ia_ifp->if_flags & IFF_UP) && 372d6385b1cSHajimu UMEMOTO !(ia->ia_ifp->if_flags & IFF_UP)) 373d6385b1cSHajimu UMEMOTO NEXT(8); 374d6385b1cSHajimu UMEMOTO if (!(ia_best->ia_ifp->if_flags & IFF_UP) && 375d6385b1cSHajimu UMEMOTO (ia->ia_ifp->if_flags & IFF_UP)) 376d6385b1cSHajimu UMEMOTO REPLACE(8); 377d6385b1cSHajimu UMEMOTO 378d6385b1cSHajimu UMEMOTO /* 379d6385b1cSHajimu UMEMOTO * Rule 14: Use longest matching prefix. 380d6385b1cSHajimu UMEMOTO * Note: in the address selection draft, this rule is 381d6385b1cSHajimu UMEMOTO * documented as "Rule 8". However, since it is also 382d6385b1cSHajimu UMEMOTO * documented that this rule can be overridden, we assign 383d6385b1cSHajimu UMEMOTO * a large number so that it is easy to assign smaller numbers 384d6385b1cSHajimu UMEMOTO * to more preferred rules. 385d6385b1cSHajimu UMEMOTO */ 386a1f7e5f8SHajimu UMEMOTO new_matchlen = in6_matchlen(&ia->ia_addr.sin6_addr, &dst); 387d6385b1cSHajimu UMEMOTO if (best_matchlen < new_matchlen) 388d6385b1cSHajimu UMEMOTO REPLACE(14); 389d6385b1cSHajimu UMEMOTO if (new_matchlen < best_matchlen) 390d6385b1cSHajimu UMEMOTO NEXT(14); 391d6385b1cSHajimu UMEMOTO 392d6385b1cSHajimu UMEMOTO /* Rule 15 is reserved. */ 393d6385b1cSHajimu UMEMOTO 394d6385b1cSHajimu UMEMOTO /* 395d6385b1cSHajimu UMEMOTO * Last resort: just keep the current candidate. 396d6385b1cSHajimu UMEMOTO * Or, do we need more rules? 397d6385b1cSHajimu UMEMOTO */ 398d6385b1cSHajimu UMEMOTO continue; 399d6385b1cSHajimu UMEMOTO 400d6385b1cSHajimu UMEMOTO replace: 401d6385b1cSHajimu UMEMOTO ia_best = ia; 402d6385b1cSHajimu UMEMOTO best_scope = (new_scope >= 0 ? new_scope : 403d6385b1cSHajimu UMEMOTO in6_addrscope(&ia_best->ia_addr.sin6_addr)); 404d6385b1cSHajimu UMEMOTO best_policy = (new_policy ? new_policy : 405d6385b1cSHajimu UMEMOTO lookup_addrsel_policy(&ia_best->ia_addr)); 406d6385b1cSHajimu UMEMOTO best_matchlen = (new_matchlen >= 0 ? new_matchlen : 407d6385b1cSHajimu UMEMOTO in6_matchlen(&ia_best->ia_addr.sin6_addr, 408a1f7e5f8SHajimu UMEMOTO &dst)); 409d6385b1cSHajimu UMEMOTO 410d6385b1cSHajimu UMEMOTO next: 411d6385b1cSHajimu UMEMOTO continue; 412d6385b1cSHajimu UMEMOTO 413d6385b1cSHajimu UMEMOTO out: 414d6385b1cSHajimu UMEMOTO break; 415d6385b1cSHajimu UMEMOTO } 416d6385b1cSHajimu UMEMOTO 417d6385b1cSHajimu UMEMOTO if ((ia = ia_best) == NULL) { 418686cdd19SJun-ichiro itojun Hagino *errorp = EADDRNOTAVAIL; 419d6385b1cSHajimu UMEMOTO return (NULL); 420686cdd19SJun-ichiro itojun Hagino } 421686cdd19SJun-ichiro itojun Hagino 422a1f7e5f8SHajimu UMEMOTO if (ifpp) 423a1f7e5f8SHajimu UMEMOTO *ifpp = ifp; 424a1f7e5f8SHajimu UMEMOTO 425d6385b1cSHajimu UMEMOTO return (&ia->ia_addr.sin6_addr); 426d6385b1cSHajimu UMEMOTO } 427d6385b1cSHajimu UMEMOTO 428d6385b1cSHajimu UMEMOTO static int 429a1f7e5f8SHajimu UMEMOTO selectroute(dstsock, opts, mopts, ro, retifp, retrt, clone, norouteok) 430d6385b1cSHajimu UMEMOTO struct sockaddr_in6 *dstsock; 431d6385b1cSHajimu UMEMOTO struct ip6_pktopts *opts; 432d6385b1cSHajimu UMEMOTO struct ip6_moptions *mopts; 433d6385b1cSHajimu UMEMOTO struct route_in6 *ro; 434d6385b1cSHajimu UMEMOTO struct ifnet **retifp; 435d6385b1cSHajimu UMEMOTO struct rtentry **retrt; 436d6385b1cSHajimu UMEMOTO int clone; /* meaningful only for bsdi and freebsd. */ 437a1f7e5f8SHajimu UMEMOTO int norouteok; 438d6385b1cSHajimu UMEMOTO { 439d6385b1cSHajimu UMEMOTO int error = 0; 440d6385b1cSHajimu UMEMOTO struct ifnet *ifp = NULL; 441d6385b1cSHajimu UMEMOTO struct rtentry *rt = NULL; 442d6385b1cSHajimu UMEMOTO struct sockaddr_in6 *sin6_next; 443d6385b1cSHajimu UMEMOTO struct in6_pktinfo *pi = NULL; 444d6385b1cSHajimu UMEMOTO struct in6_addr *dst = &dstsock->sin6_addr; 445d6385b1cSHajimu UMEMOTO 446d6385b1cSHajimu UMEMOTO #if 0 447d6385b1cSHajimu UMEMOTO if (dstsock->sin6_addr.s6_addr32[0] == 0 && 448d6385b1cSHajimu UMEMOTO dstsock->sin6_addr.s6_addr32[1] == 0 && 449d6385b1cSHajimu UMEMOTO !IN6_IS_ADDR_LOOPBACK(&dstsock->sin6_addr)) { 450d6385b1cSHajimu UMEMOTO printf("in6_selectroute: strange destination %s\n", 451d6385b1cSHajimu UMEMOTO ip6_sprintf(&dstsock->sin6_addr)); 452d6385b1cSHajimu UMEMOTO } else { 453d6385b1cSHajimu UMEMOTO printf("in6_selectroute: destination = %s%%%d\n", 454d6385b1cSHajimu UMEMOTO ip6_sprintf(&dstsock->sin6_addr), 455d6385b1cSHajimu UMEMOTO dstsock->sin6_scope_id); /* for debug */ 456d6385b1cSHajimu UMEMOTO } 457d6385b1cSHajimu UMEMOTO #endif 458d6385b1cSHajimu UMEMOTO 459d6385b1cSHajimu UMEMOTO /* If the caller specify the outgoing interface explicitly, use it. */ 460d6385b1cSHajimu UMEMOTO if (opts && (pi = opts->ip6po_pktinfo) != NULL && pi->ipi6_ifindex) { 461d6385b1cSHajimu UMEMOTO /* XXX boundary check is assumed to be already done. */ 462d6385b1cSHajimu UMEMOTO ifp = ifnet_byindex(pi->ipi6_ifindex); 463d6385b1cSHajimu UMEMOTO if (ifp != NULL && 464a1f7e5f8SHajimu UMEMOTO (norouteok || retrt == NULL || 465a1f7e5f8SHajimu UMEMOTO IN6_IS_ADDR_MULTICAST(dst))) { 466d6385b1cSHajimu UMEMOTO /* 467d6385b1cSHajimu UMEMOTO * we do not have to check nor get the route for 468d6385b1cSHajimu UMEMOTO * multicast. 469d6385b1cSHajimu UMEMOTO */ 470d6385b1cSHajimu UMEMOTO goto done; 471d6385b1cSHajimu UMEMOTO } else 472d6385b1cSHajimu UMEMOTO goto getroute; 473d6385b1cSHajimu UMEMOTO } 474d6385b1cSHajimu UMEMOTO 475d6385b1cSHajimu UMEMOTO /* 476d6385b1cSHajimu UMEMOTO * If the destination address is a multicast address and the outgoing 477d6385b1cSHajimu UMEMOTO * interface for the address is specified by the caller, use it. 478d6385b1cSHajimu UMEMOTO */ 479d6385b1cSHajimu UMEMOTO if (IN6_IS_ADDR_MULTICAST(dst) && 480d6385b1cSHajimu UMEMOTO mopts != NULL && (ifp = mopts->im6o_multicast_ifp) != NULL) { 481d6385b1cSHajimu UMEMOTO goto done; /* we do not need a route for multicast. */ 482d6385b1cSHajimu UMEMOTO } 483d6385b1cSHajimu UMEMOTO 484d6385b1cSHajimu UMEMOTO getroute: 485d6385b1cSHajimu UMEMOTO /* 486d6385b1cSHajimu UMEMOTO * If the next hop address for the packet is specified by the caller, 487d6385b1cSHajimu UMEMOTO * use it as the gateway. 488d6385b1cSHajimu UMEMOTO */ 489d6385b1cSHajimu UMEMOTO if (opts && opts->ip6po_nexthop) { 490d6385b1cSHajimu UMEMOTO struct route_in6 *ron; 491d6385b1cSHajimu UMEMOTO 492d6385b1cSHajimu UMEMOTO sin6_next = satosin6(opts->ip6po_nexthop); 493d6385b1cSHajimu UMEMOTO 494d6385b1cSHajimu UMEMOTO /* at this moment, we only support AF_INET6 next hops */ 495d6385b1cSHajimu UMEMOTO if (sin6_next->sin6_family != AF_INET6) { 496d6385b1cSHajimu UMEMOTO error = EAFNOSUPPORT; /* or should we proceed? */ 497d6385b1cSHajimu UMEMOTO goto done; 498d6385b1cSHajimu UMEMOTO } 499d6385b1cSHajimu UMEMOTO 500d6385b1cSHajimu UMEMOTO /* 501d6385b1cSHajimu UMEMOTO * If the next hop is an IPv6 address, then the node identified 502d6385b1cSHajimu UMEMOTO * by that address must be a neighbor of the sending host. 503d6385b1cSHajimu UMEMOTO */ 504d6385b1cSHajimu UMEMOTO ron = &opts->ip6po_nextroute; 505d6385b1cSHajimu UMEMOTO if ((ron->ro_rt && 506d6385b1cSHajimu UMEMOTO (ron->ro_rt->rt_flags & (RTF_UP | RTF_LLINFO)) != 507d6385b1cSHajimu UMEMOTO (RTF_UP | RTF_LLINFO)) || 508d6385b1cSHajimu UMEMOTO !SA6_ARE_ADDR_EQUAL(satosin6(&ron->ro_dst), sin6_next)) { 509d6385b1cSHajimu UMEMOTO if (ron->ro_rt) { 510d6385b1cSHajimu UMEMOTO RTFREE(ron->ro_rt); 511d6385b1cSHajimu UMEMOTO ron->ro_rt = NULL; 512d6385b1cSHajimu UMEMOTO } 513d6385b1cSHajimu UMEMOTO *satosin6(&ron->ro_dst) = *sin6_next; 514d6385b1cSHajimu UMEMOTO } 515d6385b1cSHajimu UMEMOTO if (ron->ro_rt == NULL) { 516d6385b1cSHajimu UMEMOTO rtalloc((struct route *)ron); /* multi path case? */ 517d6385b1cSHajimu UMEMOTO if (ron->ro_rt == NULL || 518d6385b1cSHajimu UMEMOTO !(ron->ro_rt->rt_flags & RTF_LLINFO)) { 519d6385b1cSHajimu UMEMOTO if (ron->ro_rt) { 520d6385b1cSHajimu UMEMOTO RTFREE(ron->ro_rt); 521d6385b1cSHajimu UMEMOTO ron->ro_rt = NULL; 522d6385b1cSHajimu UMEMOTO } 523d6385b1cSHajimu UMEMOTO error = EHOSTUNREACH; 524d6385b1cSHajimu UMEMOTO goto done; 525d6385b1cSHajimu UMEMOTO } 526d6385b1cSHajimu UMEMOTO } 527d6385b1cSHajimu UMEMOTO rt = ron->ro_rt; 528d6385b1cSHajimu UMEMOTO ifp = rt->rt_ifp; 529d6385b1cSHajimu UMEMOTO 530d6385b1cSHajimu UMEMOTO /* 531d6385b1cSHajimu UMEMOTO * When cloning is required, try to allocate a route to the 532d6385b1cSHajimu UMEMOTO * destination so that the caller can store path MTU 533d6385b1cSHajimu UMEMOTO * information. 534d6385b1cSHajimu UMEMOTO */ 535d6385b1cSHajimu UMEMOTO if (!clone) 536d6385b1cSHajimu UMEMOTO goto done; 537d6385b1cSHajimu UMEMOTO } 538d6385b1cSHajimu UMEMOTO 539d6385b1cSHajimu UMEMOTO /* 540d6385b1cSHajimu UMEMOTO * Use a cached route if it exists and is valid, else try to allocate 541d6385b1cSHajimu UMEMOTO * a new one. Note that we should check the address family of the 542d6385b1cSHajimu UMEMOTO * cached destination, in case of sharing the cache with IPv4. 543686cdd19SJun-ichiro itojun Hagino */ 544686cdd19SJun-ichiro itojun Hagino if (ro) { 545686cdd19SJun-ichiro itojun Hagino if (ro->ro_rt && 54654c1b882SHajimu UMEMOTO (!(ro->ro_rt->rt_flags & RTF_UP) || 547d6385b1cSHajimu UMEMOTO ((struct sockaddr *)(&ro->ro_dst))->sa_family != AF_INET6 || 54854c1b882SHajimu UMEMOTO !IN6_ARE_ADDR_EQUAL(&satosin6(&ro->ro_dst)->sin6_addr, 54954c1b882SHajimu UMEMOTO dst))) { 550686cdd19SJun-ichiro itojun Hagino RTFREE(ro->ro_rt); 551d6385b1cSHajimu UMEMOTO ro->ro_rt = (struct rtentry *)NULL; 552686cdd19SJun-ichiro itojun Hagino } 553d6385b1cSHajimu UMEMOTO if (ro->ro_rt == (struct rtentry *)NULL) { 55433841545SHajimu UMEMOTO struct sockaddr_in6 *sa6; 55533841545SHajimu UMEMOTO 556686cdd19SJun-ichiro itojun Hagino /* No route yet, so try to acquire one */ 557686cdd19SJun-ichiro itojun Hagino bzero(&ro->ro_dst, sizeof(struct sockaddr_in6)); 55833841545SHajimu UMEMOTO sa6 = (struct sockaddr_in6 *)&ro->ro_dst; 559d6385b1cSHajimu UMEMOTO *sa6 = *dstsock; 560e6a27350SHajimu UMEMOTO sa6->sin6_scope_id = 0; 56197d8d152SAndre Oppermann 562d6385b1cSHajimu UMEMOTO if (clone) { 563d6385b1cSHajimu UMEMOTO rtalloc((struct route *)ro); 564d6385b1cSHajimu UMEMOTO } else { 565686cdd19SJun-ichiro itojun Hagino ro->ro_rt = rtalloc1(&((struct route *)ro) 566a89ec05eSPeter Wemm ->ro_dst, 0, 0UL); 56737bdc280SSam Leffler if (ro->ro_rt) 568d1dd20beSSam Leffler RT_UNLOCK(ro->ro_rt); 569686cdd19SJun-ichiro itojun Hagino } 570686cdd19SJun-ichiro itojun Hagino } 571686cdd19SJun-ichiro itojun Hagino 572686cdd19SJun-ichiro itojun Hagino /* 573d6385b1cSHajimu UMEMOTO * do not care about the result if we have the nexthop 574d6385b1cSHajimu UMEMOTO * explicitly specified. 575686cdd19SJun-ichiro itojun Hagino */ 576d6385b1cSHajimu UMEMOTO if (opts && opts->ip6po_nexthop) 577d6385b1cSHajimu UMEMOTO goto done; 578686cdd19SJun-ichiro itojun Hagino 579686cdd19SJun-ichiro itojun Hagino if (ro->ro_rt) { 580d6385b1cSHajimu UMEMOTO ifp = ro->ro_rt->rt_ifp; 581d6385b1cSHajimu UMEMOTO 582d6385b1cSHajimu UMEMOTO if (ifp == NULL) { /* can this really happen? */ 583d6385b1cSHajimu UMEMOTO RTFREE(ro->ro_rt); 584d6385b1cSHajimu UMEMOTO ro->ro_rt = NULL; 585686cdd19SJun-ichiro itojun Hagino } 586686cdd19SJun-ichiro itojun Hagino } 587d6385b1cSHajimu UMEMOTO if (ro->ro_rt == NULL) 588d6385b1cSHajimu UMEMOTO error = EHOSTUNREACH; 589d6385b1cSHajimu UMEMOTO rt = ro->ro_rt; 590d6385b1cSHajimu UMEMOTO 591d6385b1cSHajimu UMEMOTO /* 592d6385b1cSHajimu UMEMOTO * Check if the outgoing interface conflicts with 593d6385b1cSHajimu UMEMOTO * the interface specified by ipi6_ifindex (if specified). 594d6385b1cSHajimu UMEMOTO * Note that loopback interface is always okay. 595d6385b1cSHajimu UMEMOTO * (this may happen when we are sending a packet to one of 596d6385b1cSHajimu UMEMOTO * our own addresses.) 597d6385b1cSHajimu UMEMOTO */ 598403cbcf5SGeorge V. Neville-Neil if (ifp && opts && opts->ip6po_pktinfo && 59968efda09SHajimu UMEMOTO opts->ip6po_pktinfo->ipi6_ifindex) { 600d6385b1cSHajimu UMEMOTO if (!(ifp->if_flags & IFF_LOOPBACK) && 601d6385b1cSHajimu UMEMOTO ifp->if_index != 602d6385b1cSHajimu UMEMOTO opts->ip6po_pktinfo->ipi6_ifindex) { 603d6385b1cSHajimu UMEMOTO error = EHOSTUNREACH; 604d6385b1cSHajimu UMEMOTO goto done; 605d6385b1cSHajimu UMEMOTO } 606d6385b1cSHajimu UMEMOTO } 607686cdd19SJun-ichiro itojun Hagino } 608686cdd19SJun-ichiro itojun Hagino 609d6385b1cSHajimu UMEMOTO done: 610d6385b1cSHajimu UMEMOTO if (ifp == NULL && rt == NULL) { 611d6385b1cSHajimu UMEMOTO /* 612d6385b1cSHajimu UMEMOTO * This can happen if the caller did not pass a cached route 613d6385b1cSHajimu UMEMOTO * nor any other hints. We treat this case an error. 614d6385b1cSHajimu UMEMOTO */ 615d6385b1cSHajimu UMEMOTO error = EHOSTUNREACH; 616d6385b1cSHajimu UMEMOTO } 617d6385b1cSHajimu UMEMOTO if (error == EHOSTUNREACH) 618d6385b1cSHajimu UMEMOTO ip6stat.ip6s_noroute++; 619d6385b1cSHajimu UMEMOTO 620d6385b1cSHajimu UMEMOTO if (retifp != NULL) 621d6385b1cSHajimu UMEMOTO *retifp = ifp; 622d6385b1cSHajimu UMEMOTO if (retrt != NULL) 623d6385b1cSHajimu UMEMOTO *retrt = rt; /* rt may be NULL */ 624d6385b1cSHajimu UMEMOTO 625d6385b1cSHajimu UMEMOTO return (error); 626686cdd19SJun-ichiro itojun Hagino } 627686cdd19SJun-ichiro itojun Hagino 628a1f7e5f8SHajimu UMEMOTO static int 629a1f7e5f8SHajimu UMEMOTO in6_selectif(dstsock, opts, mopts, ro, retifp) 630a1f7e5f8SHajimu UMEMOTO struct sockaddr_in6 *dstsock; 631a1f7e5f8SHajimu UMEMOTO struct ip6_pktopts *opts; 632a1f7e5f8SHajimu UMEMOTO struct ip6_moptions *mopts; 633a1f7e5f8SHajimu UMEMOTO struct route_in6 *ro; 634a1f7e5f8SHajimu UMEMOTO struct ifnet **retifp; 635a1f7e5f8SHajimu UMEMOTO { 636a1f7e5f8SHajimu UMEMOTO int error; 637a1f7e5f8SHajimu UMEMOTO struct route_in6 sro; 638a1f7e5f8SHajimu UMEMOTO struct rtentry *rt = NULL; 639a1f7e5f8SHajimu UMEMOTO 640a1f7e5f8SHajimu UMEMOTO if (ro == NULL) { 641a1f7e5f8SHajimu UMEMOTO bzero(&sro, sizeof(sro)); 642a1f7e5f8SHajimu UMEMOTO ro = &sro; 643a1f7e5f8SHajimu UMEMOTO } 644a1f7e5f8SHajimu UMEMOTO 645a1f7e5f8SHajimu UMEMOTO if ((error = selectroute(dstsock, opts, mopts, ro, retifp, 646a1f7e5f8SHajimu UMEMOTO &rt, 0, 1)) != 0) { 647a1f7e5f8SHajimu UMEMOTO if (rt && rt == sro.ro_rt) 648a1f7e5f8SHajimu UMEMOTO RTFREE(rt); 649a1f7e5f8SHajimu UMEMOTO return (error); 650a1f7e5f8SHajimu UMEMOTO } 651a1f7e5f8SHajimu UMEMOTO 652a1f7e5f8SHajimu UMEMOTO /* 653a1f7e5f8SHajimu UMEMOTO * do not use a rejected or black hole route. 654a1f7e5f8SHajimu UMEMOTO * XXX: this check should be done in the L2 output routine. 655a1f7e5f8SHajimu UMEMOTO * However, if we skipped this check here, we'd see the following 656a1f7e5f8SHajimu UMEMOTO * scenario: 657a1f7e5f8SHajimu UMEMOTO * - install a rejected route for a scoped address prefix 658a1f7e5f8SHajimu UMEMOTO * (like fe80::/10) 659a1f7e5f8SHajimu UMEMOTO * - send a packet to a destination that matches the scoped prefix, 660a1f7e5f8SHajimu UMEMOTO * with ambiguity about the scope zone. 661a1f7e5f8SHajimu UMEMOTO * - pick the outgoing interface from the route, and disambiguate the 662a1f7e5f8SHajimu UMEMOTO * scope zone with the interface. 663a1f7e5f8SHajimu UMEMOTO * - ip6_output() would try to get another route with the "new" 664a1f7e5f8SHajimu UMEMOTO * destination, which may be valid. 665a1f7e5f8SHajimu UMEMOTO * - we'd see no error on output. 666a1f7e5f8SHajimu UMEMOTO * Although this may not be very harmful, it should still be confusing. 667a1f7e5f8SHajimu UMEMOTO * We thus reject the case here. 668a1f7e5f8SHajimu UMEMOTO */ 669a1f7e5f8SHajimu UMEMOTO if (rt && (rt->rt_flags & (RTF_REJECT | RTF_BLACKHOLE))) { 670a1f7e5f8SHajimu UMEMOTO int flags = (rt->rt_flags & RTF_HOST ? EHOSTUNREACH : ENETUNREACH); 671a1f7e5f8SHajimu UMEMOTO 672a1f7e5f8SHajimu UMEMOTO if (rt && rt == sro.ro_rt) 673a1f7e5f8SHajimu UMEMOTO RTFREE(rt); 674a1f7e5f8SHajimu UMEMOTO return (flags); 675a1f7e5f8SHajimu UMEMOTO } 676a1f7e5f8SHajimu UMEMOTO 677a1f7e5f8SHajimu UMEMOTO /* 678a1f7e5f8SHajimu UMEMOTO * Adjust the "outgoing" interface. If we're going to loop the packet 679a1f7e5f8SHajimu UMEMOTO * back to ourselves, the ifp would be the loopback interface. 680a1f7e5f8SHajimu UMEMOTO * However, we'd rather know the interface associated to the 681a1f7e5f8SHajimu UMEMOTO * destination address (which should probably be one of our own 682a1f7e5f8SHajimu UMEMOTO * addresses.) 683a1f7e5f8SHajimu UMEMOTO */ 684a1f7e5f8SHajimu UMEMOTO if (rt && rt->rt_ifa && rt->rt_ifa->ifa_ifp) 685a1f7e5f8SHajimu UMEMOTO *retifp = rt->rt_ifa->ifa_ifp; 686a1f7e5f8SHajimu UMEMOTO 687a1f7e5f8SHajimu UMEMOTO if (rt && rt == sro.ro_rt) 688a1f7e5f8SHajimu UMEMOTO RTFREE(rt); 689a1f7e5f8SHajimu UMEMOTO return (0); 690a1f7e5f8SHajimu UMEMOTO } 691a1f7e5f8SHajimu UMEMOTO 692a1f7e5f8SHajimu UMEMOTO int 693a1f7e5f8SHajimu UMEMOTO in6_selectroute(dstsock, opts, mopts, ro, retifp, retrt, clone) 694a1f7e5f8SHajimu UMEMOTO struct sockaddr_in6 *dstsock; 695a1f7e5f8SHajimu UMEMOTO struct ip6_pktopts *opts; 696a1f7e5f8SHajimu UMEMOTO struct ip6_moptions *mopts; 697a1f7e5f8SHajimu UMEMOTO struct route_in6 *ro; 698a1f7e5f8SHajimu UMEMOTO struct ifnet **retifp; 699a1f7e5f8SHajimu UMEMOTO struct rtentry **retrt; 700a1f7e5f8SHajimu UMEMOTO int clone; /* meaningful only for bsdi and freebsd. */ 701a1f7e5f8SHajimu UMEMOTO { 702a1f7e5f8SHajimu UMEMOTO return (selectroute(dstsock, opts, mopts, ro, retifp, 703a1f7e5f8SHajimu UMEMOTO retrt, clone, 0)); 704a1f7e5f8SHajimu UMEMOTO } 705a1f7e5f8SHajimu UMEMOTO 706686cdd19SJun-ichiro itojun Hagino /* 707686cdd19SJun-ichiro itojun Hagino * Default hop limit selection. The precedence is as follows: 708686cdd19SJun-ichiro itojun Hagino * 1. Hoplimit value specified via ioctl. 709686cdd19SJun-ichiro itojun Hagino * 2. (If the outgoing interface is detected) the current 710686cdd19SJun-ichiro itojun Hagino * hop limit of the interface specified by router advertisement. 711686cdd19SJun-ichiro itojun Hagino * 3. The system default hoplimit. 712686cdd19SJun-ichiro itojun Hagino */ 713686cdd19SJun-ichiro itojun Hagino int 714686cdd19SJun-ichiro itojun Hagino in6_selecthlim(in6p, ifp) 715686cdd19SJun-ichiro itojun Hagino struct in6pcb *in6p; 716686cdd19SJun-ichiro itojun Hagino struct ifnet *ifp; 717686cdd19SJun-ichiro itojun Hagino { 718686cdd19SJun-ichiro itojun Hagino if (in6p && in6p->in6p_hops >= 0) 719686cdd19SJun-ichiro itojun Hagino return (in6p->in6p_hops); 720686cdd19SJun-ichiro itojun Hagino else if (ifp) 72131b1bfe1SHajimu UMEMOTO return (ND_IFINFO(ifp)->chlim); 72297d8d152SAndre Oppermann else if (in6p && !IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr)) { 72397d8d152SAndre Oppermann struct route_in6 ro6; 72497d8d152SAndre Oppermann struct ifnet *lifp; 72597d8d152SAndre Oppermann 72697d8d152SAndre Oppermann bzero(&ro6, sizeof(ro6)); 72797d8d152SAndre Oppermann ro6.ro_dst.sin6_family = AF_INET6; 72897d8d152SAndre Oppermann ro6.ro_dst.sin6_len = sizeof(struct sockaddr_in6); 72997d8d152SAndre Oppermann ro6.ro_dst.sin6_addr = in6p->in6p_faddr; 73097d8d152SAndre Oppermann rtalloc((struct route *)&ro6); 73197d8d152SAndre Oppermann if (ro6.ro_rt) { 73297d8d152SAndre Oppermann lifp = ro6.ro_rt->rt_ifp; 73397d8d152SAndre Oppermann RTFREE(ro6.ro_rt); 73497d8d152SAndre Oppermann if (lifp) 73597d8d152SAndre Oppermann return (ND_IFINFO(lifp)->chlim); 73697d8d152SAndre Oppermann } else 73797d8d152SAndre Oppermann return (ip6_defhlim); 73897d8d152SAndre Oppermann } 739686cdd19SJun-ichiro itojun Hagino return (ip6_defhlim); 740686cdd19SJun-ichiro itojun Hagino } 741686cdd19SJun-ichiro itojun Hagino 742686cdd19SJun-ichiro itojun Hagino /* 743686cdd19SJun-ichiro itojun Hagino * XXX: this is borrowed from in6_pcbbind(). If possible, we should 744686cdd19SJun-ichiro itojun Hagino * share this function by all *bsd*... 745686cdd19SJun-ichiro itojun Hagino */ 746686cdd19SJun-ichiro itojun Hagino int 747b0330ed9SPawel Jakub Dawidek in6_pcbsetport(laddr, inp, cred) 748686cdd19SJun-ichiro itojun Hagino struct in6_addr *laddr; 749686cdd19SJun-ichiro itojun Hagino struct inpcb *inp; 750b0330ed9SPawel Jakub Dawidek struct ucred *cred; 751686cdd19SJun-ichiro itojun Hagino { 752686cdd19SJun-ichiro itojun Hagino struct socket *so = inp->inp_socket; 753686cdd19SJun-ichiro itojun Hagino u_int16_t lport = 0, first, last, *lastport; 754686cdd19SJun-ichiro itojun Hagino int count, error = 0, wild = 0; 755686cdd19SJun-ichiro itojun Hagino struct inpcbinfo *pcbinfo = inp->inp_pcbinfo; 756686cdd19SJun-ichiro itojun Hagino 757686cdd19SJun-ichiro itojun Hagino /* XXX: this is redundant when called from in6_pcbbind */ 758686cdd19SJun-ichiro itojun Hagino if ((so->so_options & (SO_REUSEADDR|SO_REUSEPORT)) == 0) 759686cdd19SJun-ichiro itojun Hagino wild = INPLOOKUP_WILDCARD; 760686cdd19SJun-ichiro itojun Hagino 761686cdd19SJun-ichiro itojun Hagino inp->inp_flags |= INP_ANONPORT; 762686cdd19SJun-ichiro itojun Hagino 763686cdd19SJun-ichiro itojun Hagino if (inp->inp_flags & INP_HIGHPORT) { 764686cdd19SJun-ichiro itojun Hagino first = ipport_hifirstauto; /* sysctl */ 765686cdd19SJun-ichiro itojun Hagino last = ipport_hilastauto; 766686cdd19SJun-ichiro itojun Hagino lastport = &pcbinfo->lasthi; 767686cdd19SJun-ichiro itojun Hagino } else if (inp->inp_flags & INP_LOWPORT) { 768b0330ed9SPawel Jakub Dawidek if ((error = suser_cred(cred, 0))) 769686cdd19SJun-ichiro itojun Hagino return error; 770686cdd19SJun-ichiro itojun Hagino first = ipport_lowfirstauto; /* 1023 */ 771686cdd19SJun-ichiro itojun Hagino last = ipport_lowlastauto; /* 600 */ 772686cdd19SJun-ichiro itojun Hagino lastport = &pcbinfo->lastlow; 773686cdd19SJun-ichiro itojun Hagino } else { 774686cdd19SJun-ichiro itojun Hagino first = ipport_firstauto; /* sysctl */ 775686cdd19SJun-ichiro itojun Hagino last = ipport_lastauto; 776686cdd19SJun-ichiro itojun Hagino lastport = &pcbinfo->lastport; 777686cdd19SJun-ichiro itojun Hagino } 778686cdd19SJun-ichiro itojun Hagino /* 779686cdd19SJun-ichiro itojun Hagino * Simple check to ensure all ports are not used up causing 780686cdd19SJun-ichiro itojun Hagino * a deadlock here. 781686cdd19SJun-ichiro itojun Hagino * 782686cdd19SJun-ichiro itojun Hagino * We split the two cases (up and down) so that the direction 783686cdd19SJun-ichiro itojun Hagino * is not being tested on each round of the loop. 784686cdd19SJun-ichiro itojun Hagino */ 785686cdd19SJun-ichiro itojun Hagino if (first > last) { 786686cdd19SJun-ichiro itojun Hagino /* 787686cdd19SJun-ichiro itojun Hagino * counting down 788686cdd19SJun-ichiro itojun Hagino */ 789686cdd19SJun-ichiro itojun Hagino count = first - last; 790686cdd19SJun-ichiro itojun Hagino 791686cdd19SJun-ichiro itojun Hagino do { 792686cdd19SJun-ichiro itojun Hagino if (count-- < 0) { /* completely used? */ 793686cdd19SJun-ichiro itojun Hagino /* 794686cdd19SJun-ichiro itojun Hagino * Undo any address bind that may have 795686cdd19SJun-ichiro itojun Hagino * occurred above. 796686cdd19SJun-ichiro itojun Hagino */ 797686cdd19SJun-ichiro itojun Hagino inp->in6p_laddr = in6addr_any; 798686cdd19SJun-ichiro itojun Hagino return (EAGAIN); 799686cdd19SJun-ichiro itojun Hagino } 800686cdd19SJun-ichiro itojun Hagino --*lastport; 801686cdd19SJun-ichiro itojun Hagino if (*lastport > first || *lastport < last) 802686cdd19SJun-ichiro itojun Hagino *lastport = first; 803686cdd19SJun-ichiro itojun Hagino lport = htons(*lastport); 80468efda09SHajimu UMEMOTO } while (in6_pcblookup_local(pcbinfo, &inp->in6p_laddr, 80568efda09SHajimu UMEMOTO lport, wild)); 806686cdd19SJun-ichiro itojun Hagino } else { 807686cdd19SJun-ichiro itojun Hagino /* 808686cdd19SJun-ichiro itojun Hagino * counting up 809686cdd19SJun-ichiro itojun Hagino */ 810686cdd19SJun-ichiro itojun Hagino count = last - first; 811686cdd19SJun-ichiro itojun Hagino 812686cdd19SJun-ichiro itojun Hagino do { 813686cdd19SJun-ichiro itojun Hagino if (count-- < 0) { /* completely used? */ 814686cdd19SJun-ichiro itojun Hagino /* 815686cdd19SJun-ichiro itojun Hagino * Undo any address bind that may have 816686cdd19SJun-ichiro itojun Hagino * occurred above. 817686cdd19SJun-ichiro itojun Hagino */ 818686cdd19SJun-ichiro itojun Hagino inp->in6p_laddr = in6addr_any; 819686cdd19SJun-ichiro itojun Hagino return (EAGAIN); 820686cdd19SJun-ichiro itojun Hagino } 821686cdd19SJun-ichiro itojun Hagino ++*lastport; 822686cdd19SJun-ichiro itojun Hagino if (*lastport < first || *lastport > last) 823686cdd19SJun-ichiro itojun Hagino *lastport = first; 824686cdd19SJun-ichiro itojun Hagino lport = htons(*lastport); 825686cdd19SJun-ichiro itojun Hagino } while (in6_pcblookup_local(pcbinfo, 826686cdd19SJun-ichiro itojun Hagino &inp->in6p_laddr, lport, wild)); 827686cdd19SJun-ichiro itojun Hagino } 828686cdd19SJun-ichiro itojun Hagino 829686cdd19SJun-ichiro itojun Hagino inp->inp_lport = lport; 830686cdd19SJun-ichiro itojun Hagino if (in_pcbinshash(inp) != 0) { 831686cdd19SJun-ichiro itojun Hagino inp->in6p_laddr = in6addr_any; 832686cdd19SJun-ichiro itojun Hagino inp->inp_lport = 0; 833686cdd19SJun-ichiro itojun Hagino return (EAGAIN); 834686cdd19SJun-ichiro itojun Hagino } 835686cdd19SJun-ichiro itojun Hagino 836686cdd19SJun-ichiro itojun Hagino return (0); 837686cdd19SJun-ichiro itojun Hagino } 838686cdd19SJun-ichiro itojun Hagino 8397fc91b3fSHajimu UMEMOTO void 8407fc91b3fSHajimu UMEMOTO addrsel_policy_init() 8417fc91b3fSHajimu UMEMOTO { 8427fc91b3fSHajimu UMEMOTO ADDRSEL_LOCK_INIT(); 8437fc91b3fSHajimu UMEMOTO 8447fc91b3fSHajimu UMEMOTO init_policy_queue(); 8457fc91b3fSHajimu UMEMOTO 8467fc91b3fSHajimu UMEMOTO /* initialize the "last resort" policy */ 8477fc91b3fSHajimu UMEMOTO bzero(&defaultaddrpolicy, sizeof(defaultaddrpolicy)); 8487fc91b3fSHajimu UMEMOTO defaultaddrpolicy.label = ADDR_LABEL_NOTAPP; 8497fc91b3fSHajimu UMEMOTO } 8507fc91b3fSHajimu UMEMOTO 851d6385b1cSHajimu UMEMOTO static struct in6_addrpolicy * 852d6385b1cSHajimu UMEMOTO lookup_addrsel_policy(key) 853d6385b1cSHajimu UMEMOTO struct sockaddr_in6 *key; 854d6385b1cSHajimu UMEMOTO { 855d6385b1cSHajimu UMEMOTO struct in6_addrpolicy *match = NULL; 856d6385b1cSHajimu UMEMOTO 857d6385b1cSHajimu UMEMOTO ADDRSEL_LOCK(); 858d6385b1cSHajimu UMEMOTO match = match_addrsel_policy(key); 859d6385b1cSHajimu UMEMOTO 860d6385b1cSHajimu UMEMOTO if (match == NULL) 861d6385b1cSHajimu UMEMOTO match = &defaultaddrpolicy; 862d6385b1cSHajimu UMEMOTO else 863d6385b1cSHajimu UMEMOTO match->use++; 864d6385b1cSHajimu UMEMOTO ADDRSEL_UNLOCK(); 865d6385b1cSHajimu UMEMOTO 866d6385b1cSHajimu UMEMOTO return (match); 867d6385b1cSHajimu UMEMOTO } 868d6385b1cSHajimu UMEMOTO 8697fc91b3fSHajimu UMEMOTO /* 8707fc91b3fSHajimu UMEMOTO * Subroutines to manage the address selection policy table via sysctl. 8717fc91b3fSHajimu UMEMOTO */ 8727fc91b3fSHajimu UMEMOTO struct walkarg { 8737fc91b3fSHajimu UMEMOTO struct sysctl_req *w_req; 8747fc91b3fSHajimu UMEMOTO }; 8757fc91b3fSHajimu UMEMOTO 8767fc91b3fSHajimu UMEMOTO static int in6_src_sysctl(SYSCTL_HANDLER_ARGS); 8777fc91b3fSHajimu UMEMOTO SYSCTL_DECL(_net_inet6_ip6); 8787fc91b3fSHajimu UMEMOTO SYSCTL_NODE(_net_inet6_ip6, IPV6CTL_ADDRCTLPOLICY, addrctlpolicy, 8797fc91b3fSHajimu UMEMOTO CTLFLAG_RD, in6_src_sysctl, ""); 8807fc91b3fSHajimu UMEMOTO 8817fc91b3fSHajimu UMEMOTO static int 8827fc91b3fSHajimu UMEMOTO in6_src_sysctl(SYSCTL_HANDLER_ARGS) 8837fc91b3fSHajimu UMEMOTO { 8847fc91b3fSHajimu UMEMOTO struct walkarg w; 8857fc91b3fSHajimu UMEMOTO 8867fc91b3fSHajimu UMEMOTO if (req->newptr) 8877fc91b3fSHajimu UMEMOTO return EPERM; 8887fc91b3fSHajimu UMEMOTO 8897fc91b3fSHajimu UMEMOTO bzero(&w, sizeof(w)); 8907fc91b3fSHajimu UMEMOTO w.w_req = req; 8917fc91b3fSHajimu UMEMOTO 8927fc91b3fSHajimu UMEMOTO return (walk_addrsel_policy(dump_addrsel_policyent, &w)); 8937fc91b3fSHajimu UMEMOTO } 8947fc91b3fSHajimu UMEMOTO 8957fc91b3fSHajimu UMEMOTO int 8967fc91b3fSHajimu UMEMOTO in6_src_ioctl(cmd, data) 8977fc91b3fSHajimu UMEMOTO u_long cmd; 8987fc91b3fSHajimu UMEMOTO caddr_t data; 8997fc91b3fSHajimu UMEMOTO { 9007fc91b3fSHajimu UMEMOTO int i; 9017fc91b3fSHajimu UMEMOTO struct in6_addrpolicy ent0; 9027fc91b3fSHajimu UMEMOTO 9037fc91b3fSHajimu UMEMOTO if (cmd != SIOCAADDRCTL_POLICY && cmd != SIOCDADDRCTL_POLICY) 9047fc91b3fSHajimu UMEMOTO return (EOPNOTSUPP); /* check for safety */ 9057fc91b3fSHajimu UMEMOTO 9067fc91b3fSHajimu UMEMOTO ent0 = *(struct in6_addrpolicy *)data; 9077fc91b3fSHajimu UMEMOTO 9087fc91b3fSHajimu UMEMOTO if (ent0.label == ADDR_LABEL_NOTAPP) 9097fc91b3fSHajimu UMEMOTO return (EINVAL); 9107fc91b3fSHajimu UMEMOTO /* check if the prefix mask is consecutive. */ 9117fc91b3fSHajimu UMEMOTO if (in6_mask2len(&ent0.addrmask.sin6_addr, NULL) < 0) 9127fc91b3fSHajimu UMEMOTO return (EINVAL); 9137fc91b3fSHajimu UMEMOTO /* clear trailing garbages (if any) of the prefix address. */ 9147fc91b3fSHajimu UMEMOTO for (i = 0; i < 4; i++) { 9157fc91b3fSHajimu UMEMOTO ent0.addr.sin6_addr.s6_addr32[i] &= 9167fc91b3fSHajimu UMEMOTO ent0.addrmask.sin6_addr.s6_addr32[i]; 9177fc91b3fSHajimu UMEMOTO } 9187fc91b3fSHajimu UMEMOTO ent0.use = 0; 9197fc91b3fSHajimu UMEMOTO 9207fc91b3fSHajimu UMEMOTO switch (cmd) { 9217fc91b3fSHajimu UMEMOTO case SIOCAADDRCTL_POLICY: 9227fc91b3fSHajimu UMEMOTO return (add_addrsel_policyent(&ent0)); 9237fc91b3fSHajimu UMEMOTO case SIOCDADDRCTL_POLICY: 9247fc91b3fSHajimu UMEMOTO return (delete_addrsel_policyent(&ent0)); 9257fc91b3fSHajimu UMEMOTO } 9267fc91b3fSHajimu UMEMOTO 9277fc91b3fSHajimu UMEMOTO return (0); /* XXX: compromise compilers */ 9287fc91b3fSHajimu UMEMOTO } 9297fc91b3fSHajimu UMEMOTO 9307fc91b3fSHajimu UMEMOTO /* 9317fc91b3fSHajimu UMEMOTO * The followings are implementation of the policy table using a 9327fc91b3fSHajimu UMEMOTO * simple tail queue. 9337fc91b3fSHajimu UMEMOTO * XXX such details should be hidden. 9347fc91b3fSHajimu UMEMOTO * XXX implementation using binary tree should be more efficient. 9357fc91b3fSHajimu UMEMOTO */ 9367fc91b3fSHajimu UMEMOTO struct addrsel_policyent { 9377fc91b3fSHajimu UMEMOTO TAILQ_ENTRY(addrsel_policyent) ape_entry; 9387fc91b3fSHajimu UMEMOTO struct in6_addrpolicy ape_policy; 9397fc91b3fSHajimu UMEMOTO }; 9407fc91b3fSHajimu UMEMOTO 9417fc91b3fSHajimu UMEMOTO TAILQ_HEAD(addrsel_policyhead, addrsel_policyent); 9427fc91b3fSHajimu UMEMOTO 9437fc91b3fSHajimu UMEMOTO struct addrsel_policyhead addrsel_policytab; 9447fc91b3fSHajimu UMEMOTO 9457fc91b3fSHajimu UMEMOTO static void 9467fc91b3fSHajimu UMEMOTO init_policy_queue() 9477fc91b3fSHajimu UMEMOTO { 9487fc91b3fSHajimu UMEMOTO TAILQ_INIT(&addrsel_policytab); 9497fc91b3fSHajimu UMEMOTO } 9507fc91b3fSHajimu UMEMOTO 9517fc91b3fSHajimu UMEMOTO static int 9527fc91b3fSHajimu UMEMOTO add_addrsel_policyent(newpolicy) 9537fc91b3fSHajimu UMEMOTO struct in6_addrpolicy *newpolicy; 9547fc91b3fSHajimu UMEMOTO { 9557fc91b3fSHajimu UMEMOTO struct addrsel_policyent *new, *pol; 9567fc91b3fSHajimu UMEMOTO 957349b668aSHajimu UMEMOTO MALLOC(new, struct addrsel_policyent *, sizeof(*new), M_IFADDR, 958349b668aSHajimu UMEMOTO M_WAITOK); 9597fc91b3fSHajimu UMEMOTO ADDRSEL_LOCK(); 9607fc91b3fSHajimu UMEMOTO 9617fc91b3fSHajimu UMEMOTO /* duplication check */ 9627fc91b3fSHajimu UMEMOTO for (pol = TAILQ_FIRST(&addrsel_policytab); pol; 9637fc91b3fSHajimu UMEMOTO pol = TAILQ_NEXT(pol, ape_entry)) { 9647fc91b3fSHajimu UMEMOTO if (SA6_ARE_ADDR_EQUAL(&newpolicy->addr, 9657fc91b3fSHajimu UMEMOTO &pol->ape_policy.addr) && 9667fc91b3fSHajimu UMEMOTO SA6_ARE_ADDR_EQUAL(&newpolicy->addrmask, 9677fc91b3fSHajimu UMEMOTO &pol->ape_policy.addrmask)) { 968349b668aSHajimu UMEMOTO ADDRSEL_UNLOCK(); 969349b668aSHajimu UMEMOTO FREE(new, M_IFADDR); 9707fc91b3fSHajimu UMEMOTO return (EEXIST); /* or override it? */ 9717fc91b3fSHajimu UMEMOTO } 9727fc91b3fSHajimu UMEMOTO } 9737fc91b3fSHajimu UMEMOTO 9747fc91b3fSHajimu UMEMOTO bzero(new, sizeof(*new)); 9757fc91b3fSHajimu UMEMOTO 9767fc91b3fSHajimu UMEMOTO /* XXX: should validate entry */ 9777fc91b3fSHajimu UMEMOTO new->ape_policy = *newpolicy; 9787fc91b3fSHajimu UMEMOTO 9797fc91b3fSHajimu UMEMOTO TAILQ_INSERT_TAIL(&addrsel_policytab, new, ape_entry); 9807fc91b3fSHajimu UMEMOTO ADDRSEL_UNLOCK(); 9817fc91b3fSHajimu UMEMOTO 9827fc91b3fSHajimu UMEMOTO return (0); 9837fc91b3fSHajimu UMEMOTO } 9847fc91b3fSHajimu UMEMOTO 9857fc91b3fSHajimu UMEMOTO static int 9867fc91b3fSHajimu UMEMOTO delete_addrsel_policyent(key) 9877fc91b3fSHajimu UMEMOTO struct in6_addrpolicy *key; 9887fc91b3fSHajimu UMEMOTO { 9897fc91b3fSHajimu UMEMOTO struct addrsel_policyent *pol; 9907fc91b3fSHajimu UMEMOTO 9917fc91b3fSHajimu UMEMOTO ADDRSEL_LOCK(); 9927fc91b3fSHajimu UMEMOTO 9937fc91b3fSHajimu UMEMOTO /* search for the entry in the table */ 9947fc91b3fSHajimu UMEMOTO for (pol = TAILQ_FIRST(&addrsel_policytab); pol; 9957fc91b3fSHajimu UMEMOTO pol = TAILQ_NEXT(pol, ape_entry)) { 9967fc91b3fSHajimu UMEMOTO if (SA6_ARE_ADDR_EQUAL(&key->addr, &pol->ape_policy.addr) && 9977fc91b3fSHajimu UMEMOTO SA6_ARE_ADDR_EQUAL(&key->addrmask, 9987fc91b3fSHajimu UMEMOTO &pol->ape_policy.addrmask)) { 9997fc91b3fSHajimu UMEMOTO break; 10007fc91b3fSHajimu UMEMOTO } 10017fc91b3fSHajimu UMEMOTO } 1002349b668aSHajimu UMEMOTO if (pol == NULL) { 1003349b668aSHajimu UMEMOTO ADDRSEL_UNLOCK(); 10047fc91b3fSHajimu UMEMOTO return (ESRCH); 1005349b668aSHajimu UMEMOTO } 10067fc91b3fSHajimu UMEMOTO 10077fc91b3fSHajimu UMEMOTO TAILQ_REMOVE(&addrsel_policytab, pol, ape_entry); 10087fc91b3fSHajimu UMEMOTO ADDRSEL_UNLOCK(); 10097fc91b3fSHajimu UMEMOTO 10107fc91b3fSHajimu UMEMOTO return (0); 10117fc91b3fSHajimu UMEMOTO } 10127fc91b3fSHajimu UMEMOTO 10137fc91b3fSHajimu UMEMOTO static int 10147fc91b3fSHajimu UMEMOTO walk_addrsel_policy(callback, w) 10157fc91b3fSHajimu UMEMOTO int (*callback) __P((struct in6_addrpolicy *, void *)); 10167fc91b3fSHajimu UMEMOTO void *w; 10177fc91b3fSHajimu UMEMOTO { 10187fc91b3fSHajimu UMEMOTO struct addrsel_policyent *pol; 10197fc91b3fSHajimu UMEMOTO int error = 0; 10207fc91b3fSHajimu UMEMOTO 10217fc91b3fSHajimu UMEMOTO ADDRSEL_LOCK(); 10227fc91b3fSHajimu UMEMOTO for (pol = TAILQ_FIRST(&addrsel_policytab); pol; 10237fc91b3fSHajimu UMEMOTO pol = TAILQ_NEXT(pol, ape_entry)) { 1024349b668aSHajimu UMEMOTO if ((error = (*callback)(&pol->ape_policy, w)) != 0) { 1025349b668aSHajimu UMEMOTO ADDRSEL_UNLOCK(); 10267fc91b3fSHajimu UMEMOTO return (error); 10277fc91b3fSHajimu UMEMOTO } 1028349b668aSHajimu UMEMOTO } 10297fc91b3fSHajimu UMEMOTO ADDRSEL_UNLOCK(); 10307fc91b3fSHajimu UMEMOTO 10317fc91b3fSHajimu UMEMOTO return (error); 10327fc91b3fSHajimu UMEMOTO } 10337fc91b3fSHajimu UMEMOTO 10347fc91b3fSHajimu UMEMOTO static int 10357fc91b3fSHajimu UMEMOTO dump_addrsel_policyent(pol, arg) 10367fc91b3fSHajimu UMEMOTO struct in6_addrpolicy *pol; 10377fc91b3fSHajimu UMEMOTO void *arg; 10387fc91b3fSHajimu UMEMOTO { 10397fc91b3fSHajimu UMEMOTO int error = 0; 10407fc91b3fSHajimu UMEMOTO struct walkarg *w = arg; 10417fc91b3fSHajimu UMEMOTO 10427fc91b3fSHajimu UMEMOTO error = SYSCTL_OUT(w->w_req, pol, sizeof(*pol)); 10437fc91b3fSHajimu UMEMOTO 10447fc91b3fSHajimu UMEMOTO return (error); 10457fc91b3fSHajimu UMEMOTO } 1046d6385b1cSHajimu UMEMOTO 1047d6385b1cSHajimu UMEMOTO static struct in6_addrpolicy * 1048d6385b1cSHajimu UMEMOTO match_addrsel_policy(key) 1049d6385b1cSHajimu UMEMOTO struct sockaddr_in6 *key; 1050d6385b1cSHajimu UMEMOTO { 1051d6385b1cSHajimu UMEMOTO struct addrsel_policyent *pent; 1052d6385b1cSHajimu UMEMOTO struct in6_addrpolicy *bestpol = NULL, *pol; 1053d6385b1cSHajimu UMEMOTO int matchlen, bestmatchlen = -1; 1054d6385b1cSHajimu UMEMOTO u_char *mp, *ep, *k, *p, m; 1055d6385b1cSHajimu UMEMOTO 1056d6385b1cSHajimu UMEMOTO for (pent = TAILQ_FIRST(&addrsel_policytab); pent; 1057d6385b1cSHajimu UMEMOTO pent = TAILQ_NEXT(pent, ape_entry)) { 1058d6385b1cSHajimu UMEMOTO matchlen = 0; 1059d6385b1cSHajimu UMEMOTO 1060d6385b1cSHajimu UMEMOTO pol = &pent->ape_policy; 1061d6385b1cSHajimu UMEMOTO mp = (u_char *)&pol->addrmask.sin6_addr; 1062d6385b1cSHajimu UMEMOTO ep = mp + 16; /* XXX: scope field? */ 1063d6385b1cSHajimu UMEMOTO k = (u_char *)&key->sin6_addr; 1064d6385b1cSHajimu UMEMOTO p = (u_char *)&pol->addr.sin6_addr; 1065d6385b1cSHajimu UMEMOTO for (; mp < ep && *mp; mp++, k++, p++) { 1066d6385b1cSHajimu UMEMOTO m = *mp; 1067d6385b1cSHajimu UMEMOTO if ((*k & m) != *p) 1068d6385b1cSHajimu UMEMOTO goto next; /* not match */ 1069d6385b1cSHajimu UMEMOTO if (m == 0xff) /* short cut for a typical case */ 1070d6385b1cSHajimu UMEMOTO matchlen += 8; 1071d6385b1cSHajimu UMEMOTO else { 1072d6385b1cSHajimu UMEMOTO while (m >= 0x80) { 1073d6385b1cSHajimu UMEMOTO matchlen++; 1074d6385b1cSHajimu UMEMOTO m <<= 1; 1075d6385b1cSHajimu UMEMOTO } 1076d6385b1cSHajimu UMEMOTO } 1077d6385b1cSHajimu UMEMOTO } 1078d6385b1cSHajimu UMEMOTO 1079d6385b1cSHajimu UMEMOTO /* matched. check if this is better than the current best. */ 1080d6385b1cSHajimu UMEMOTO if (bestpol == NULL || 1081d6385b1cSHajimu UMEMOTO matchlen > bestmatchlen) { 1082d6385b1cSHajimu UMEMOTO bestpol = pol; 1083d6385b1cSHajimu UMEMOTO bestmatchlen = matchlen; 1084d6385b1cSHajimu UMEMOTO } 1085d6385b1cSHajimu UMEMOTO 1086d6385b1cSHajimu UMEMOTO next: 1087d6385b1cSHajimu UMEMOTO continue; 1088d6385b1cSHajimu UMEMOTO } 1089d6385b1cSHajimu UMEMOTO 1090d6385b1cSHajimu UMEMOTO return (bestpol); 1091d6385b1cSHajimu UMEMOTO } 1092