1caf43b02SWarner Losh /*- 251369649SPedro F. Giffuni * SPDX-License-Identifier: BSD-3-Clause 351369649SPedro F. Giffuni * 482cd038dSYoshinobu Inoue * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 582cd038dSYoshinobu Inoue * All rights reserved. 682cd038dSYoshinobu Inoue * 782cd038dSYoshinobu Inoue * Redistribution and use in source and binary forms, with or without 882cd038dSYoshinobu Inoue * modification, are permitted provided that the following conditions 982cd038dSYoshinobu Inoue * are met: 1082cd038dSYoshinobu Inoue * 1. Redistributions of source code must retain the above copyright 1182cd038dSYoshinobu Inoue * notice, this list of conditions and the following disclaimer. 1282cd038dSYoshinobu Inoue * 2. Redistributions in binary form must reproduce the above copyright 1382cd038dSYoshinobu Inoue * notice, this list of conditions and the following disclaimer in the 1482cd038dSYoshinobu Inoue * documentation and/or other materials provided with the distribution. 1582cd038dSYoshinobu Inoue * 3. Neither the name of the project nor the names of its contributors 1682cd038dSYoshinobu Inoue * may be used to endorse or promote products derived from this software 1782cd038dSYoshinobu Inoue * without specific prior written permission. 1882cd038dSYoshinobu Inoue * 1982cd038dSYoshinobu Inoue * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 2082cd038dSYoshinobu Inoue * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 2182cd038dSYoshinobu Inoue * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 2282cd038dSYoshinobu Inoue * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 2382cd038dSYoshinobu Inoue * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2482cd038dSYoshinobu Inoue * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2582cd038dSYoshinobu Inoue * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2682cd038dSYoshinobu Inoue * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2782cd038dSYoshinobu Inoue * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2882cd038dSYoshinobu Inoue * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2982cd038dSYoshinobu Inoue * SUCH DAMAGE. 30b48287a3SDavid E. O'Brien * 31b48287a3SDavid E. O'Brien * $KAME: icmp6.c,v 1.211 2001/04/04 05:56:20 itojun Exp $ 3282cd038dSYoshinobu Inoue */ 3382cd038dSYoshinobu Inoue 34caf43b02SWarner Losh /*- 3582cd038dSYoshinobu Inoue * Copyright (c) 1982, 1986, 1988, 1993 3682cd038dSYoshinobu Inoue * The Regents of the University of California. All rights reserved. 3782cd038dSYoshinobu Inoue * 3882cd038dSYoshinobu Inoue * Redistribution and use in source and binary forms, with or without 3982cd038dSYoshinobu Inoue * modification, are permitted provided that the following conditions 4082cd038dSYoshinobu Inoue * are met: 4182cd038dSYoshinobu Inoue * 1. Redistributions of source code must retain the above copyright 4282cd038dSYoshinobu Inoue * notice, this list of conditions and the following disclaimer. 4382cd038dSYoshinobu Inoue * 2. Redistributions in binary form must reproduce the above copyright 4482cd038dSYoshinobu Inoue * notice, this list of conditions and the following disclaimer in the 4582cd038dSYoshinobu Inoue * documentation and/or other materials provided with the distribution. 46fbbd9655SWarner Losh * 3. Neither the name of the University nor the names of its contributors 4782cd038dSYoshinobu Inoue * may be used to endorse or promote products derived from this software 4882cd038dSYoshinobu Inoue * without specific prior written permission. 4982cd038dSYoshinobu Inoue * 5082cd038dSYoshinobu Inoue * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 5182cd038dSYoshinobu Inoue * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 5282cd038dSYoshinobu Inoue * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 5382cd038dSYoshinobu Inoue * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 5482cd038dSYoshinobu Inoue * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 5582cd038dSYoshinobu Inoue * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 5682cd038dSYoshinobu Inoue * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 5782cd038dSYoshinobu Inoue * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 5882cd038dSYoshinobu Inoue * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 5982cd038dSYoshinobu Inoue * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 6082cd038dSYoshinobu Inoue * SUCH DAMAGE. 6182cd038dSYoshinobu Inoue * 6282cd038dSYoshinobu Inoue * @(#)ip_icmp.c 8.2 (Berkeley) 1/4/94 6382cd038dSYoshinobu Inoue */ 6482cd038dSYoshinobu Inoue 65b48287a3SDavid E. O'Brien #include <sys/cdefs.h> 66b48287a3SDavid E. O'Brien __FBSDID("$FreeBSD$"); 67b48287a3SDavid E. O'Brien 68f0cace5dSRobert Watson #define MBUF_PRIVATE /* XXXRW: Optimisation tries to avoid M_EXT mbufs */ 69f0cace5dSRobert Watson 70686cdd19SJun-ichiro itojun Hagino #include "opt_inet.h" 71686cdd19SJun-ichiro itojun Hagino #include "opt_inet6.h" 7282cd038dSYoshinobu Inoue 7382cd038dSYoshinobu Inoue #include <sys/param.h> 74960ed29cSSeigo Tanimura #include <sys/domain.h> 7576ca6f88SJamie Gritton #include <sys/jail.h> 76960ed29cSSeigo Tanimura #include <sys/kernel.h> 77960ed29cSSeigo Tanimura #include <sys/lock.h> 7833841545SHajimu UMEMOTO #include <sys/malloc.h> 7982cd038dSYoshinobu Inoue #include <sys/mbuf.h> 80530c0060SRobert Watson #include <sys/proc.h> 8182cd038dSYoshinobu Inoue #include <sys/protosw.h> 82960ed29cSSeigo Tanimura #include <sys/signalvar.h> 8382cd038dSYoshinobu Inoue #include <sys/socket.h> 8482cd038dSYoshinobu Inoue #include <sys/socketvar.h> 85960ed29cSSeigo Tanimura #include <sys/sx.h> 8682cd038dSYoshinobu Inoue #include <sys/syslog.h> 87960ed29cSSeigo Tanimura #include <sys/systm.h> 88960ed29cSSeigo Tanimura #include <sys/time.h> 8982cd038dSYoshinobu Inoue 9082cd038dSYoshinobu Inoue #include <net/if.h> 9176039bc8SGleb Smirnoff #include <net/if_var.h> 9282cd038dSYoshinobu Inoue #include <net/if_dl.h> 936e6b3f7cSQing Li #include <net/if_llatbl.h> 9482cd038dSYoshinobu Inoue #include <net/if_types.h> 95960ed29cSSeigo Tanimura #include <net/route.h> 96*9ac7c6cfSAlexander V. Chernikov #include <net/route/nhop.h> 974b79449eSBjoern A. Zeeb #include <net/vnet.h> 9882cd038dSYoshinobu Inoue 9982cd038dSYoshinobu Inoue #include <netinet/in.h> 100960ed29cSSeigo Tanimura #include <netinet/in_pcb.h> 10182cd038dSYoshinobu Inoue #include <netinet/in_var.h> 102686cdd19SJun-ichiro itojun Hagino #include <netinet/ip6.h> 103686cdd19SJun-ichiro itojun Hagino #include <netinet/icmp6.h> 10497d8d152SAndre Oppermann #include <netinet/tcp_var.h> 1054b79449eSBjoern A. Zeeb 1069977be4aSAlexander V. Chernikov #include <netinet6/in6_fib.h> 10782cd038dSYoshinobu Inoue #include <netinet6/in6_ifattach.h> 108960ed29cSSeigo Tanimura #include <netinet6/in6_pcb.h> 10982cd038dSYoshinobu Inoue #include <netinet6/ip6protosw.h> 110960ed29cSSeigo Tanimura #include <netinet6/ip6_var.h> 111a1f7e5f8SHajimu UMEMOTO #include <netinet6/scope6_var.h> 112960ed29cSSeigo Tanimura #include <netinet6/mld6_var.h> 113960ed29cSSeigo Tanimura #include <netinet6/nd6.h> 1141db8d1f8SAna Kukec #include <netinet6/send.h> 11582cd038dSYoshinobu Inoue 11682cd038dSYoshinobu Inoue extern struct domain inet6domain; 11797021c24SMarko Zec 118a786f679SAndrey V. Elsukov VNET_PCPUSTAT_DEFINE(struct icmp6stat, icmp6stat); 119a786f679SAndrey V. Elsukov VNET_PCPUSTAT_SYSINIT(icmp6stat); 120a786f679SAndrey V. Elsukov 121a786f679SAndrey V. Elsukov #ifdef VIMAGE 122a786f679SAndrey V. Elsukov VNET_PCPUSTAT_SYSUNINIT(icmp6stat); 123a786f679SAndrey V. Elsukov #endif /* VIMAGE */ 12482cea7e6SBjoern A. Zeeb 125eddfbb76SRobert Watson VNET_DECLARE(struct inpcbinfo, ripcbinfo); 126eddfbb76SRobert Watson VNET_DECLARE(struct inpcbhead, ripcb); 127eddfbb76SRobert Watson VNET_DECLARE(int, icmp6errppslim); 1285f901c92SAndrew Turner VNET_DEFINE_STATIC(int, icmp6errpps_count) = 0; 1295f901c92SAndrew Turner VNET_DEFINE_STATIC(struct timeval, icmp6errppslim_last); 130eddfbb76SRobert Watson VNET_DECLARE(int, icmp6_nodeinfo); 13182cd038dSYoshinobu Inoue 1321e77c105SRobert Watson #define V_ripcbinfo VNET(ripcbinfo) 1331e77c105SRobert Watson #define V_ripcb VNET(ripcb) 1341e77c105SRobert Watson #define V_icmp6errppslim VNET(icmp6errppslim) 1351e77c105SRobert Watson #define V_icmp6errpps_count VNET(icmp6errpps_count) 1361e77c105SRobert Watson #define V_icmp6errppslim_last VNET(icmp6errppslim_last) 13782cea7e6SBjoern A. Zeeb #define V_icmp6_nodeinfo VNET(icmp6_nodeinfo) 13844e33a07SMarko Zec 13949dc650cSAndrey V. Elsukov static void icmp6_errcount(int, int); 1409233d8f3SDavid E. O'Brien static int icmp6_rip6_input(struct mbuf **, int); 1410700d2c3SBjoern A. Zeeb static void icmp6_reflect(struct mbuf *, size_t); 1429233d8f3SDavid E. O'Brien static int icmp6_ratelimit(const struct in6_addr *, const int, const int); 1436f56329aSXin LI static const char *icmp6_redirect_diag(struct in6_addr *, 1446f56329aSXin LI struct in6_addr *, struct in6_addr *); 1457460ef5dSHiroki Sato static struct mbuf *ni6_input(struct mbuf *, int, struct prison *); 1469233d8f3SDavid E. O'Brien static struct mbuf *ni6_nametodns(const char *, int, int); 1479233d8f3SDavid E. O'Brien static int ni6_dnsmatch(const char *, int, const char *, int); 1486f56329aSXin LI static int ni6_addrs(struct icmp6_nodeinfo *, struct mbuf *, 1496f56329aSXin LI struct ifnet **, struct in6_addr *); 1506f56329aSXin LI static int ni6_store_addrs(struct icmp6_nodeinfo *, struct icmp6_nodeinfo *, 1516f56329aSXin LI struct ifnet *, int); 1529233d8f3SDavid E. O'Brien static int icmp6_notify_error(struct mbuf **, int, int, int); 15382cd038dSYoshinobu Inoue 154315e3e38SRobert Watson /* 155315e3e38SRobert Watson * Kernel module interface for updating icmp6stat. The argument is an index 156315e3e38SRobert Watson * into icmp6stat treated as an array of u_quad_t. While this encodes the 157315e3e38SRobert Watson * general layout of icmp6stat into the caller, it doesn't encode its 158315e3e38SRobert Watson * location, so that future changes to add, for example, per-CPU stats 159315e3e38SRobert Watson * support won't cause binary compatibility problems for kernel modules. 160315e3e38SRobert Watson */ 161315e3e38SRobert Watson void 162315e3e38SRobert Watson kmod_icmp6stat_inc(int statnum) 163315e3e38SRobert Watson { 164315e3e38SRobert Watson 165a786f679SAndrey V. Elsukov counter_u64_add(VNET(icmp6stat)[statnum], 1); 166315e3e38SRobert Watson } 167315e3e38SRobert Watson 168686cdd19SJun-ichiro itojun Hagino static void 16949dc650cSAndrey V. Elsukov icmp6_errcount(int type, int code) 170686cdd19SJun-ichiro itojun Hagino { 171686cdd19SJun-ichiro itojun Hagino switch (type) { 172686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH: 173686cdd19SJun-ichiro itojun Hagino switch (code) { 174686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_NOROUTE: 17549dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_odst_unreach_noroute); 176686cdd19SJun-ichiro itojun Hagino return; 177686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_ADMIN: 17849dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_odst_unreach_admin); 179686cdd19SJun-ichiro itojun Hagino return; 180686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_BEYONDSCOPE: 18149dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_odst_unreach_beyondscope); 182686cdd19SJun-ichiro itojun Hagino return; 183686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_ADDR: 18449dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_odst_unreach_addr); 185686cdd19SJun-ichiro itojun Hagino return; 186686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_NOPORT: 18749dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_odst_unreach_noport); 188686cdd19SJun-ichiro itojun Hagino return; 189686cdd19SJun-ichiro itojun Hagino } 190686cdd19SJun-ichiro itojun Hagino break; 191686cdd19SJun-ichiro itojun Hagino case ICMP6_PACKET_TOO_BIG: 19249dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_opacket_too_big); 193686cdd19SJun-ichiro itojun Hagino return; 194686cdd19SJun-ichiro itojun Hagino case ICMP6_TIME_EXCEEDED: 195686cdd19SJun-ichiro itojun Hagino switch (code) { 196686cdd19SJun-ichiro itojun Hagino case ICMP6_TIME_EXCEED_TRANSIT: 19749dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_otime_exceed_transit); 198686cdd19SJun-ichiro itojun Hagino return; 199686cdd19SJun-ichiro itojun Hagino case ICMP6_TIME_EXCEED_REASSEMBLY: 20049dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_otime_exceed_reassembly); 201686cdd19SJun-ichiro itojun Hagino return; 202686cdd19SJun-ichiro itojun Hagino } 203686cdd19SJun-ichiro itojun Hagino break; 204686cdd19SJun-ichiro itojun Hagino case ICMP6_PARAM_PROB: 205686cdd19SJun-ichiro itojun Hagino switch (code) { 206686cdd19SJun-ichiro itojun Hagino case ICMP6_PARAMPROB_HEADER: 20749dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_oparamprob_header); 208686cdd19SJun-ichiro itojun Hagino return; 209686cdd19SJun-ichiro itojun Hagino case ICMP6_PARAMPROB_NEXTHEADER: 21049dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_oparamprob_nextheader); 211686cdd19SJun-ichiro itojun Hagino return; 212686cdd19SJun-ichiro itojun Hagino case ICMP6_PARAMPROB_OPTION: 21349dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_oparamprob_option); 214686cdd19SJun-ichiro itojun Hagino return; 215686cdd19SJun-ichiro itojun Hagino } 216686cdd19SJun-ichiro itojun Hagino break; 217686cdd19SJun-ichiro itojun Hagino case ND_REDIRECT: 21849dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_oredirect); 219686cdd19SJun-ichiro itojun Hagino return; 220686cdd19SJun-ichiro itojun Hagino } 22149dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_ounknown); 222686cdd19SJun-ichiro itojun Hagino } 223686cdd19SJun-ichiro itojun Hagino 22482cd038dSYoshinobu Inoue /* 225a1f7e5f8SHajimu UMEMOTO * A wrapper function for icmp6_error() necessary when the erroneous packet 226a1f7e5f8SHajimu UMEMOTO * may not contain enough scope zone information. 227a1f7e5f8SHajimu UMEMOTO */ 228a1f7e5f8SHajimu UMEMOTO void 2291272577eSXin LI icmp6_error2(struct mbuf *m, int type, int code, int param, 2301272577eSXin LI struct ifnet *ifp) 231a1f7e5f8SHajimu UMEMOTO { 232a1f7e5f8SHajimu UMEMOTO struct ip6_hdr *ip6; 233a1f7e5f8SHajimu UMEMOTO 234a1f7e5f8SHajimu UMEMOTO if (ifp == NULL) 235a1f7e5f8SHajimu UMEMOTO return; 236a1f7e5f8SHajimu UMEMOTO 237a1f7e5f8SHajimu UMEMOTO if (m->m_len < sizeof(struct ip6_hdr)) { 238a1f7e5f8SHajimu UMEMOTO m = m_pullup(m, sizeof(struct ip6_hdr)); 239a61b5cfbSBjoern A. Zeeb if (m == NULL) { 240a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 241a1f7e5f8SHajimu UMEMOTO return; 242a1f7e5f8SHajimu UMEMOTO } 243a61b5cfbSBjoern A. Zeeb } 244a1f7e5f8SHajimu UMEMOTO ip6 = mtod(m, struct ip6_hdr *); 245a1f7e5f8SHajimu UMEMOTO 246a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&ip6->ip6_src, ifp, NULL) != 0) 247a1f7e5f8SHajimu UMEMOTO return; 248a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&ip6->ip6_dst, ifp, NULL) != 0) 249a1f7e5f8SHajimu UMEMOTO return; 250a1f7e5f8SHajimu UMEMOTO 251a1f7e5f8SHajimu UMEMOTO icmp6_error(m, type, code, param); 252a1f7e5f8SHajimu UMEMOTO } 253a1f7e5f8SHajimu UMEMOTO 254a1f7e5f8SHajimu UMEMOTO /* 25582cd038dSYoshinobu Inoue * Generate an error packet of type error in response to bad IP6 packet. 25682cd038dSYoshinobu Inoue */ 25782cd038dSYoshinobu Inoue void 2581272577eSXin LI icmp6_error(struct mbuf *m, int type, int code, int param) 25982cd038dSYoshinobu Inoue { 26082cd038dSYoshinobu Inoue struct ip6_hdr *oip6, *nip6; 26182cd038dSYoshinobu Inoue struct icmp6_hdr *icmp6; 262686cdd19SJun-ichiro itojun Hagino u_int preplen; 26382cd038dSYoshinobu Inoue int off; 264686cdd19SJun-ichiro itojun Hagino int nxt; 26582cd038dSYoshinobu Inoue 266e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_error); 26782cd038dSYoshinobu Inoue 268686cdd19SJun-ichiro itojun Hagino /* count per-type-code statistics */ 26949dc650cSAndrey V. Elsukov icmp6_errcount(type, code); 27082cd038dSYoshinobu Inoue 271686cdd19SJun-ichiro itojun Hagino #ifdef M_DECRYPTED /*not openbsd*/ 272686cdd19SJun-ichiro itojun Hagino if (m->m_flags & M_DECRYPTED) { 273e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_canterror); 274686cdd19SJun-ichiro itojun Hagino goto freeit; 275686cdd19SJun-ichiro itojun Hagino } 276686cdd19SJun-ichiro itojun Hagino #endif 277686cdd19SJun-ichiro itojun Hagino 278686cdd19SJun-ichiro itojun Hagino if (m->m_len < sizeof(struct ip6_hdr)) { 279686cdd19SJun-ichiro itojun Hagino m = m_pullup(m, sizeof(struct ip6_hdr)); 280a61b5cfbSBjoern A. Zeeb if (m == NULL) { 281a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 282686cdd19SJun-ichiro itojun Hagino return; 283686cdd19SJun-ichiro itojun Hagino } 284a61b5cfbSBjoern A. Zeeb } 28582cd038dSYoshinobu Inoue oip6 = mtod(m, struct ip6_hdr *); 28682cd038dSYoshinobu Inoue 28782cd038dSYoshinobu Inoue /* 288f95d4633SHajimu UMEMOTO * If the destination address of the erroneous packet is a multicast 289f95d4633SHajimu UMEMOTO * address, or the packet was sent using link-layer multicast, 290f95d4633SHajimu UMEMOTO * we should basically suppress sending an error (RFC 2463, Section 291f95d4633SHajimu UMEMOTO * 2.4). 292f95d4633SHajimu UMEMOTO * We have two exceptions (the item e.2 in that section): 2931767c520SBjoern A. Zeeb * - the Packet Too Big message can be sent for path MTU discovery. 294f95d4633SHajimu UMEMOTO * - the Parameter Problem Message that can be allowed an icmp6 error 295f95d4633SHajimu UMEMOTO * in the option type field. This check has been done in 296f95d4633SHajimu UMEMOTO * ip6_unknown_opt(), so we can just check the type and code. 29782cd038dSYoshinobu Inoue */ 29882cd038dSYoshinobu Inoue if ((m->m_flags & (M_BCAST|M_MCAST) || 29982cd038dSYoshinobu Inoue IN6_IS_ADDR_MULTICAST(&oip6->ip6_dst)) && 30082cd038dSYoshinobu Inoue (type != ICMP6_PACKET_TOO_BIG && 30182cd038dSYoshinobu Inoue (type != ICMP6_PARAM_PROB || 30282cd038dSYoshinobu Inoue code != ICMP6_PARAMPROB_OPTION))) 30382cd038dSYoshinobu Inoue goto freeit; 30482cd038dSYoshinobu Inoue 305f95d4633SHajimu UMEMOTO /* 306f95d4633SHajimu UMEMOTO * RFC 2463, 2.4 (e.5): source address check. 307f95d4633SHajimu UMEMOTO * XXX: the case of anycast source? 308f95d4633SHajimu UMEMOTO */ 30982cd038dSYoshinobu Inoue if (IN6_IS_ADDR_UNSPECIFIED(&oip6->ip6_src) || 31082cd038dSYoshinobu Inoue IN6_IS_ADDR_MULTICAST(&oip6->ip6_src)) 31182cd038dSYoshinobu Inoue goto freeit; 31282cd038dSYoshinobu Inoue 31382cd038dSYoshinobu Inoue /* 314686cdd19SJun-ichiro itojun Hagino * If we are about to send ICMPv6 against ICMPv6 error/redirect, 315686cdd19SJun-ichiro itojun Hagino * don't do it. 31682cd038dSYoshinobu Inoue */ 317686cdd19SJun-ichiro itojun Hagino nxt = -1; 318686cdd19SJun-ichiro itojun Hagino off = ip6_lasthdr(m, 0, IPPROTO_IPV6, &nxt); 319686cdd19SJun-ichiro itojun Hagino if (off >= 0 && nxt == IPPROTO_ICMPV6) { 32082cd038dSYoshinobu Inoue struct icmp6_hdr *icp; 32182cd038dSYoshinobu Inoue 322a4adf6ccSBjoern A. Zeeb if (m->m_len < off + sizeof(struct icmp6_hdr)) { 323a61b5cfbSBjoern A. Zeeb m = m_pullup(m, off + sizeof(struct icmp6_hdr)); 324a61b5cfbSBjoern A. Zeeb if (m == NULL) { 325a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 326686cdd19SJun-ichiro itojun Hagino return; 327686cdd19SJun-ichiro itojun Hagino } 328a4adf6ccSBjoern A. Zeeb } 329a61b5cfbSBjoern A. Zeeb oip6 = mtod(m, struct ip6_hdr *); 330a61b5cfbSBjoern A. Zeeb icp = (struct icmp6_hdr *)(mtod(m, caddr_t) + off); 331a61b5cfbSBjoern A. Zeeb 332686cdd19SJun-ichiro itojun Hagino if (icp->icmp6_type < ICMP6_ECHO_REQUEST || 333686cdd19SJun-ichiro itojun Hagino icp->icmp6_type == ND_REDIRECT) { 33482cd038dSYoshinobu Inoue /* 33582cd038dSYoshinobu Inoue * ICMPv6 error 33682cd038dSYoshinobu Inoue * Special case: for redirect (which is 33782cd038dSYoshinobu Inoue * informational) we must not send icmp6 error. 33882cd038dSYoshinobu Inoue */ 339e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_canterror); 34082cd038dSYoshinobu Inoue goto freeit; 34182cd038dSYoshinobu Inoue } else { 342686cdd19SJun-ichiro itojun Hagino /* ICMPv6 informational - send the error */ 34382cd038dSYoshinobu Inoue } 344686cdd19SJun-ichiro itojun Hagino } else { 345686cdd19SJun-ichiro itojun Hagino /* non-ICMPv6 - send the error */ 34682cd038dSYoshinobu Inoue } 34782cd038dSYoshinobu Inoue 34882cd038dSYoshinobu Inoue /* Finally, do rate limitation check. */ 34982cd038dSYoshinobu Inoue if (icmp6_ratelimit(&oip6->ip6_src, type, code)) { 350e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_toofreq); 35182cd038dSYoshinobu Inoue goto freeit; 35282cd038dSYoshinobu Inoue } 35382cd038dSYoshinobu Inoue 35482cd038dSYoshinobu Inoue /* 35582cd038dSYoshinobu Inoue * OK, ICMP6 can be generated. 35682cd038dSYoshinobu Inoue */ 35782cd038dSYoshinobu Inoue 35882cd038dSYoshinobu Inoue if (m->m_pkthdr.len >= ICMPV6_PLD_MAXLEN) 35982cd038dSYoshinobu Inoue m_adj(m, ICMPV6_PLD_MAXLEN - m->m_pkthdr.len); 36082cd038dSYoshinobu Inoue 361686cdd19SJun-ichiro itojun Hagino preplen = sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr); 362eb1b1807SGleb Smirnoff M_PREPEND(m, preplen, M_NOWAIT); /* FIB is also copied over. */ 36382cd038dSYoshinobu Inoue if (m == NULL) { 36433841545SHajimu UMEMOTO nd6log((LOG_DEBUG, "ENOBUFS in icmp6_error %d\n", __LINE__)); 36582cd038dSYoshinobu Inoue return; 36682cd038dSYoshinobu Inoue } 36782cd038dSYoshinobu Inoue 36882cd038dSYoshinobu Inoue nip6 = mtod(m, struct ip6_hdr *); 36982cd038dSYoshinobu Inoue nip6->ip6_src = oip6->ip6_src; 37082cd038dSYoshinobu Inoue nip6->ip6_dst = oip6->ip6_dst; 37182cd038dSYoshinobu Inoue 3729a4f9608SHajimu UMEMOTO in6_clearscope(&oip6->ip6_src); 3739a4f9608SHajimu UMEMOTO in6_clearscope(&oip6->ip6_dst); 37482cd038dSYoshinobu Inoue 37582cd038dSYoshinobu Inoue icmp6 = (struct icmp6_hdr *)(nip6 + 1); 37682cd038dSYoshinobu Inoue icmp6->icmp6_type = type; 37782cd038dSYoshinobu Inoue icmp6->icmp6_code = code; 37882cd038dSYoshinobu Inoue icmp6->icmp6_pptr = htonl((u_int32_t)param); 37982cd038dSYoshinobu Inoue 380e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_outhist[type]); 38182cd038dSYoshinobu Inoue icmp6_reflect(m, sizeof(struct ip6_hdr)); /* header order: IPv6 - ICMPv6 */ 382686cdd19SJun-ichiro itojun Hagino 383686cdd19SJun-ichiro itojun Hagino return; 384686cdd19SJun-ichiro itojun Hagino 385686cdd19SJun-ichiro itojun Hagino freeit: 386686cdd19SJun-ichiro itojun Hagino /* 387cd0fdcf7SHajimu UMEMOTO * If we can't tell whether or not we can generate ICMP6, free it. 388686cdd19SJun-ichiro itojun Hagino */ 389686cdd19SJun-ichiro itojun Hagino m_freem(m); 39082cd038dSYoshinobu Inoue } 39182cd038dSYoshinobu Inoue 39282cd038dSYoshinobu Inoue /* 39382cd038dSYoshinobu Inoue * Process a received ICMP6 message. 39482cd038dSYoshinobu Inoue */ 39582cd038dSYoshinobu Inoue int 3961272577eSXin LI icmp6_input(struct mbuf **mp, int *offp, int proto) 39782cd038dSYoshinobu Inoue { 398503f4e47SBjoern A. Zeeb struct mbuf *m, *n; 39929dc7bc6SBruce M Simpson struct ifnet *ifp; 40082cd038dSYoshinobu Inoue struct ip6_hdr *ip6, *nip6; 40182cd038dSYoshinobu Inoue struct icmp6_hdr *icmp6, *nicmp6; 4021d54aa3bSBjoern A. Zeeb char ip6bufs[INET6_ADDRSTRLEN], ip6bufd[INET6_ADDRSTRLEN]; 403503f4e47SBjoern A. Zeeb int code, error, icmp6len, ip6len, noff, off, sum; 40482cd038dSYoshinobu Inoue 405503f4e47SBjoern A. Zeeb m = *mp; 406503f4e47SBjoern A. Zeeb off = *offp; 40729dc7bc6SBruce M Simpson 408a4adf6ccSBjoern A. Zeeb if (m->m_len < off + sizeof(struct icmp6_hdr)) { 409a61b5cfbSBjoern A. Zeeb m = m_pullup(m, off + sizeof(struct icmp6_hdr)); 410a61b5cfbSBjoern A. Zeeb if (m == NULL) { 411a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 412a61b5cfbSBjoern A. Zeeb *mp = m; 413a61b5cfbSBjoern A. Zeeb return (IPPROTO_DONE); 414a61b5cfbSBjoern A. Zeeb } 415a4adf6ccSBjoern A. Zeeb } 41682cd038dSYoshinobu Inoue 41782cd038dSYoshinobu Inoue /* 41882cd038dSYoshinobu Inoue * Locate icmp6 structure in mbuf, and check 41982cd038dSYoshinobu Inoue * that not corrupted and of at least minimum length 42082cd038dSYoshinobu Inoue */ 42182cd038dSYoshinobu Inoue 422503f4e47SBjoern A. Zeeb icmp6len = m->m_pkthdr.len - off; 42382cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct icmp6_hdr)) { 424e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_tooshort); 42582cd038dSYoshinobu Inoue goto freeit; 42682cd038dSYoshinobu Inoue } 42782cd038dSYoshinobu Inoue 428503f4e47SBjoern A. Zeeb ip6 = mtod(m, struct ip6_hdr *); 429503f4e47SBjoern A. Zeeb ifp = m->m_pkthdr.rcvif; 43082cd038dSYoshinobu Inoue /* 43133cde130SBruce M Simpson * Check multicast group membership. 43233cde130SBruce M Simpson * Note: SSM filters are not applied for ICMPv6 traffic. 43333cde130SBruce M Simpson */ 43433cde130SBruce M Simpson if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) { 43533cde130SBruce M Simpson struct in6_multi *inm; 43633cde130SBruce M Simpson 43733cde130SBruce M Simpson inm = in6m_lookup(ifp, &ip6->ip6_dst); 43833cde130SBruce M Simpson if (inm == NULL) { 43933cde130SBruce M Simpson IP6STAT_INC(ip6s_notmember); 44033cde130SBruce M Simpson in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_discard); 44133cde130SBruce M Simpson goto freeit; 44233cde130SBruce M Simpson } 44333cde130SBruce M Simpson } 44433cde130SBruce M Simpson 445503f4e47SBjoern A. Zeeb /* Calculate the checksum. */ 44682cd038dSYoshinobu Inoue icmp6 = (struct icmp6_hdr *)((caddr_t)ip6 + off); 44782cd038dSYoshinobu Inoue code = icmp6->icmp6_code; 44882cd038dSYoshinobu Inoue if ((sum = in6_cksum(m, IPPROTO_ICMPV6, off, icmp6len)) != 0) { 44933841545SHajimu UMEMOTO nd6log((LOG_ERR, 45082cd038dSYoshinobu Inoue "ICMP6 checksum error(%d|%x) %s\n", 4511d54aa3bSBjoern A. Zeeb icmp6->icmp6_type, sum, 4521d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6bufs, &ip6->ip6_src))); 453e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_checksum); 45482cd038dSYoshinobu Inoue goto freeit; 45582cd038dSYoshinobu Inoue } 45682cd038dSYoshinobu Inoue 457e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_inhist[icmp6->icmp6_type]); 45829dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_msg); 45982cd038dSYoshinobu Inoue if (icmp6->icmp6_type < ICMP6_INFOMSG_MASK) 46029dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_error); 46182cd038dSYoshinobu Inoue 462503f4e47SBjoern A. Zeeb ip6len = sizeof(struct ip6_hdr) + ntohs(ip6->ip6_plen); 46382cd038dSYoshinobu Inoue switch (icmp6->icmp6_type) { 46482cd038dSYoshinobu Inoue case ICMP6_DST_UNREACH: 46529dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_dstunreach); 46682cd038dSYoshinobu Inoue switch (code) { 46782cd038dSYoshinobu Inoue case ICMP6_DST_UNREACH_NOROUTE: 468d4c22202SAndrew Gallatin case ICMP6_DST_UNREACH_ADDR: /* PRC_HOSTDEAD is a DOS */ 46982cd038dSYoshinobu Inoue code = PRC_UNREACH_NET; 47082cd038dSYoshinobu Inoue break; 47182cd038dSYoshinobu Inoue case ICMP6_DST_UNREACH_ADMIN: 47229dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_adminprohib); 4733e146575SMichael Tuexen code = PRC_UNREACH_ADMIN_PROHIB; 47482cd038dSYoshinobu Inoue break; 475686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_BEYONDSCOPE: 476686cdd19SJun-ichiro itojun Hagino /* I mean "source address was incorrect." */ 477686cdd19SJun-ichiro itojun Hagino code = PRC_PARAMPROB; 478686cdd19SJun-ichiro itojun Hagino break; 47982cd038dSYoshinobu Inoue case ICMP6_DST_UNREACH_NOPORT: 48082cd038dSYoshinobu Inoue code = PRC_UNREACH_PORT; 48182cd038dSYoshinobu Inoue break; 48282cd038dSYoshinobu Inoue default: 48382cd038dSYoshinobu Inoue goto badcode; 48482cd038dSYoshinobu Inoue } 48582cd038dSYoshinobu Inoue goto deliver; 48682cd038dSYoshinobu Inoue break; 48782cd038dSYoshinobu Inoue 48882cd038dSYoshinobu Inoue case ICMP6_PACKET_TOO_BIG: 48929dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_pkttoobig); 49082cd038dSYoshinobu Inoue 491aaff9927SHajimu UMEMOTO /* validation is made in icmp6_mtudisc_update */ 492aaff9927SHajimu UMEMOTO 49382cd038dSYoshinobu Inoue code = PRC_MSGSIZE; 49482cd038dSYoshinobu Inoue 495686cdd19SJun-ichiro itojun Hagino /* 496686cdd19SJun-ichiro itojun Hagino * Updating the path MTU will be done after examining 497686cdd19SJun-ichiro itojun Hagino * intermediate extension headers. 498686cdd19SJun-ichiro itojun Hagino */ 49982cd038dSYoshinobu Inoue goto deliver; 50082cd038dSYoshinobu Inoue break; 50182cd038dSYoshinobu Inoue 50282cd038dSYoshinobu Inoue case ICMP6_TIME_EXCEEDED: 50329dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_timeexceed); 50482cd038dSYoshinobu Inoue switch (code) { 50582cd038dSYoshinobu Inoue case ICMP6_TIME_EXCEED_TRANSIT: 5062ce62dceSSUZUKI Shinsuke code = PRC_TIMXCEED_INTRANS; 5072ce62dceSSUZUKI Shinsuke break; 50882cd038dSYoshinobu Inoue case ICMP6_TIME_EXCEED_REASSEMBLY: 5092ce62dceSSUZUKI Shinsuke code = PRC_TIMXCEED_REASS; 51082cd038dSYoshinobu Inoue break; 51182cd038dSYoshinobu Inoue default: 51282cd038dSYoshinobu Inoue goto badcode; 51382cd038dSYoshinobu Inoue } 51482cd038dSYoshinobu Inoue goto deliver; 51582cd038dSYoshinobu Inoue break; 51682cd038dSYoshinobu Inoue 51782cd038dSYoshinobu Inoue case ICMP6_PARAM_PROB: 51829dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_paramprob); 51982cd038dSYoshinobu Inoue switch (code) { 52082cd038dSYoshinobu Inoue case ICMP6_PARAMPROB_NEXTHEADER: 52182cd038dSYoshinobu Inoue code = PRC_UNREACH_PROTOCOL; 52282cd038dSYoshinobu Inoue break; 52382cd038dSYoshinobu Inoue case ICMP6_PARAMPROB_HEADER: 52482cd038dSYoshinobu Inoue case ICMP6_PARAMPROB_OPTION: 52582cd038dSYoshinobu Inoue code = PRC_PARAMPROB; 52682cd038dSYoshinobu Inoue break; 52782cd038dSYoshinobu Inoue default: 52882cd038dSYoshinobu Inoue goto badcode; 52982cd038dSYoshinobu Inoue } 53082cd038dSYoshinobu Inoue goto deliver; 53182cd038dSYoshinobu Inoue break; 53282cd038dSYoshinobu Inoue 53382cd038dSYoshinobu Inoue case ICMP6_ECHO_REQUEST: 53429dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_echo); 53582cd038dSYoshinobu Inoue if (code != 0) 53682cd038dSYoshinobu Inoue goto badcode; 537c3bef61eSKevin Lo if ((n = m_copym(m, 0, M_COPYALL, M_NOWAIT)) == NULL) { 53882cd038dSYoshinobu Inoue /* Give up remote */ 53982cd038dSYoshinobu Inoue break; 54082cd038dSYoshinobu Inoue } 541f0cace5dSRobert Watson if (!M_WRITABLE(n) 542686cdd19SJun-ichiro itojun Hagino || n->m_len < off + sizeof(struct icmp6_hdr)) { 54382cd038dSYoshinobu Inoue struct mbuf *n0 = n; 5442268ca47SSam Leffler int n0len; 54582cd038dSYoshinobu Inoue 54610e5acc3SGleb Smirnoff CTASSERT(sizeof(*nip6) + sizeof(*nicmp6) <= MHLEN); 5477b07d1beSGleb Smirnoff n = m_gethdr(M_NOWAIT, n0->m_type); 54882cd038dSYoshinobu Inoue if (n == NULL) { 54982cd038dSYoshinobu Inoue /* Give up remote */ 55082cd038dSYoshinobu Inoue m_freem(n0); 55182cd038dSYoshinobu Inoue break; 55282cd038dSYoshinobu Inoue } 55310e5acc3SGleb Smirnoff 55410e5acc3SGleb Smirnoff m_move_pkthdr(n, n0); /* FIB copied. */ 55510e5acc3SGleb Smirnoff n0len = n0->m_pkthdr.len; /* save for use below */ 55682cd038dSYoshinobu Inoue /* 55782cd038dSYoshinobu Inoue * Copy IPv6 and ICMPv6 only. 55882cd038dSYoshinobu Inoue */ 55982cd038dSYoshinobu Inoue nip6 = mtod(n, struct ip6_hdr *); 56082cd038dSYoshinobu Inoue bcopy(ip6, nip6, sizeof(struct ip6_hdr)); 56182cd038dSYoshinobu Inoue nicmp6 = (struct icmp6_hdr *)(nip6 + 1); 56282cd038dSYoshinobu Inoue bcopy(icmp6, nicmp6, sizeof(struct icmp6_hdr)); 56382cd038dSYoshinobu Inoue noff = sizeof(struct ip6_hdr); 5642268ca47SSam Leffler /* new mbuf contains only ipv6+icmpv6 headers */ 5652268ca47SSam Leffler n->m_len = noff + sizeof(struct icmp6_hdr); 566686cdd19SJun-ichiro itojun Hagino /* 567686cdd19SJun-ichiro itojun Hagino * Adjust mbuf. ip6_plen will be adjusted in 568686cdd19SJun-ichiro itojun Hagino * ip6_output(). 569686cdd19SJun-ichiro itojun Hagino */ 570686cdd19SJun-ichiro itojun Hagino m_adj(n0, off + sizeof(struct icmp6_hdr)); 5712268ca47SSam Leffler /* recalculate complete packet size */ 5722268ca47SSam Leffler n->m_pkthdr.len = n0len + (noff - off); 573686cdd19SJun-ichiro itojun Hagino n->m_next = n0; 57482cd038dSYoshinobu Inoue } else { 575a4adf6ccSBjoern A. Zeeb if (n->m_len < off + sizeof(*nicmp6)) { 576a61b5cfbSBjoern A. Zeeb n = m_pullup(n, off + sizeof(*nicmp6)); 577a61b5cfbSBjoern A. Zeeb if (n == NULL) { 578a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 579a61b5cfbSBjoern A. Zeeb break; 580a61b5cfbSBjoern A. Zeeb } 581a4adf6ccSBjoern A. Zeeb } 582a61b5cfbSBjoern A. Zeeb nicmp6 = (struct icmp6_hdr *)(mtod(n, caddr_t) + off); 58382cd038dSYoshinobu Inoue noff = off; 58482cd038dSYoshinobu Inoue } 585fb043945SJonathan T. Looney if (n) { 58682cd038dSYoshinobu Inoue nicmp6->icmp6_type = ICMP6_ECHO_REPLY; 58782cd038dSYoshinobu Inoue nicmp6->icmp6_code = 0; 588e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_reflect); 589e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_outhist[ICMP6_ECHO_REPLY]); 59082cd038dSYoshinobu Inoue icmp6_reflect(n, noff); 59182cd038dSYoshinobu Inoue } 59282cd038dSYoshinobu Inoue break; 59382cd038dSYoshinobu Inoue 59482cd038dSYoshinobu Inoue case ICMP6_ECHO_REPLY: 59529dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_echoreply); 59682cd038dSYoshinobu Inoue if (code != 0) 59782cd038dSYoshinobu Inoue goto badcode; 59882cd038dSYoshinobu Inoue break; 59982cd038dSYoshinobu Inoue 60081170631SHajimu UMEMOTO case MLD_LISTENER_QUERY: 60181170631SHajimu UMEMOTO case MLD_LISTENER_REPORT: 60233cde130SBruce M Simpson case MLD_LISTENER_DONE: 60333cde130SBruce M Simpson case MLDV2_LISTENER_REPORT: 60433cde130SBruce M Simpson /* 60529dc7bc6SBruce M Simpson * Drop MLD traffic which is not link-local, has a hop limit 60629dc7bc6SBruce M Simpson * of greater than 1 hop, or which does not have the 60729dc7bc6SBruce M Simpson * IPv6 HBH Router Alert option. 60829dc7bc6SBruce M Simpson * As IPv6 HBH options are stripped in ip6_input() we must 60929dc7bc6SBruce M Simpson * check an mbuf header flag. 61033cde130SBruce M Simpson * XXX Should we also sanity check that these messages 61133cde130SBruce M Simpson * were directed to a link-local multicast prefix? 61233cde130SBruce M Simpson */ 61329dc7bc6SBruce M Simpson if ((ip6->ip6_hlim != 1) || (m->m_flags & M_RTALERT_MLD) == 0) 614686cdd19SJun-ichiro itojun Hagino goto freeit; 61532af08ecSBjoern A. Zeeb if (mld_input(&m, off, icmp6len) != 0) { 616a8fe77d8SBjoern A. Zeeb *mp = NULL; 61733cde130SBruce M Simpson return (IPPROTO_DONE); 618a8fe77d8SBjoern A. Zeeb } 61982cd038dSYoshinobu Inoue /* m stays. */ 62082cd038dSYoshinobu Inoue break; 62182cd038dSYoshinobu Inoue 62282cd038dSYoshinobu Inoue case ICMP6_WRUREQUEST: /* ICMP6_FQDN_QUERY */ 62382cd038dSYoshinobu Inoue { 62482cd038dSYoshinobu Inoue enum { WRU, FQDN } mode; 6257460ef5dSHiroki Sato struct prison *pr; 62682cd038dSYoshinobu Inoue 627603724d3SBjoern A. Zeeb if (!V_icmp6_nodeinfo) 628686cdd19SJun-ichiro itojun Hagino break; 629686cdd19SJun-ichiro itojun Hagino 63082cd038dSYoshinobu Inoue if (icmp6len == sizeof(struct icmp6_hdr) + 4) 63182cd038dSYoshinobu Inoue mode = WRU; 632686cdd19SJun-ichiro itojun Hagino else if (icmp6len >= sizeof(struct icmp6_nodeinfo)) 63382cd038dSYoshinobu Inoue mode = FQDN; 63482cd038dSYoshinobu Inoue else 63582cd038dSYoshinobu Inoue goto badlen; 63682cd038dSYoshinobu Inoue 6377460ef5dSHiroki Sato pr = NULL; 6387460ef5dSHiroki Sato sx_slock(&allprison_lock); 6397460ef5dSHiroki Sato TAILQ_FOREACH(pr, &allprison, pr_list) 6407460ef5dSHiroki Sato if (pr->pr_vnet == ifp->if_vnet) 6417460ef5dSHiroki Sato break; 6427460ef5dSHiroki Sato sx_sunlock(&allprison_lock); 6437460ef5dSHiroki Sato if (pr == NULL) 6447460ef5dSHiroki Sato pr = curthread->td_ucred->cr_prison; 64582cd038dSYoshinobu Inoue if (mode == FQDN) { 646a4adf6ccSBjoern A. Zeeb if (m->m_len < off + sizeof(struct icmp6_nodeinfo)) { 647a4adf6ccSBjoern A. Zeeb m = m_pullup(m, off + 648a4adf6ccSBjoern A. Zeeb sizeof(struct icmp6_nodeinfo)); 649a61b5cfbSBjoern A. Zeeb if (m == NULL) { 650a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 651a61b5cfbSBjoern A. Zeeb *mp = m; 652a61b5cfbSBjoern A. Zeeb return (IPPROTO_DONE); 653a61b5cfbSBjoern A. Zeeb } 654a4adf6ccSBjoern A. Zeeb } 655c3bef61eSKevin Lo n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 656686cdd19SJun-ichiro itojun Hagino if (n) 6577460ef5dSHiroki Sato n = ni6_input(n, off, pr); 658686cdd19SJun-ichiro itojun Hagino /* XXX meaningless if n == NULL */ 65982cd038dSYoshinobu Inoue noff = sizeof(struct ip6_hdr); 66082cd038dSYoshinobu Inoue } else { 66182cd038dSYoshinobu Inoue u_char *p; 66210e5acc3SGleb Smirnoff int maxhlen, hlen; 66382cd038dSYoshinobu Inoue 66418706985SJINMEI Tatuya /* 66518706985SJINMEI Tatuya * XXX: this combination of flags is pointless, 66618706985SJINMEI Tatuya * but should we keep this for compatibility? 66718706985SJINMEI Tatuya */ 668c81c183dSMark Johnston if ((V_icmp6_nodeinfo & (ICMP6_NODEINFO_FQDNOK | 669c81c183dSMark Johnston ICMP6_NODEINFO_TMPADDROK)) != 670c81c183dSMark Johnston (ICMP6_NODEINFO_FQDNOK | ICMP6_NODEINFO_TMPADDROK)) 67133841545SHajimu UMEMOTO break; 67233841545SHajimu UMEMOTO 673686cdd19SJun-ichiro itojun Hagino if (code != 0) 674686cdd19SJun-ichiro itojun Hagino goto badcode; 67510e5acc3SGleb Smirnoff 67610e5acc3SGleb Smirnoff CTASSERT(sizeof(*nip6) + sizeof(*nicmp6) + 4 <= MHLEN); 67710e5acc3SGleb Smirnoff n = m_gethdr(M_NOWAIT, m->m_type); 67810e5acc3SGleb Smirnoff if (n == NULL) { 679686cdd19SJun-ichiro itojun Hagino /* Give up remote */ 680686cdd19SJun-ichiro itojun Hagino break; 681686cdd19SJun-ichiro itojun Hagino } 68210e5acc3SGleb Smirnoff if (!m_dup_pkthdr(n, m, M_NOWAIT)) { 6839967cafcSSam Leffler /* 6849967cafcSSam Leffler * Previous code did a blind M_COPY_PKTHDR 6859967cafcSSam Leffler * and said "just for rcvif". If true, then 6869967cafcSSam Leffler * we could tolerate the dup failing (due to 6879967cafcSSam Leffler * the deep copy of the tag chain). For now 6889967cafcSSam Leffler * be conservative and just fail. 6899967cafcSSam Leffler */ 6909967cafcSSam Leffler m_free(n); 6919967cafcSSam Leffler n = NULL; 692fb043945SJonathan T. Looney break; 6939967cafcSSam Leffler } 69482cd038dSYoshinobu Inoue /* 69582cd038dSYoshinobu Inoue * Copy IPv6 and ICMPv6 only. 69682cd038dSYoshinobu Inoue */ 69782cd038dSYoshinobu Inoue nip6 = mtod(n, struct ip6_hdr *); 69882cd038dSYoshinobu Inoue bcopy(ip6, nip6, sizeof(struct ip6_hdr)); 69982cd038dSYoshinobu Inoue nicmp6 = (struct icmp6_hdr *)(nip6 + 1); 70082cd038dSYoshinobu Inoue bcopy(icmp6, nicmp6, sizeof(struct icmp6_hdr)); 70182cd038dSYoshinobu Inoue p = (u_char *)(nicmp6 + 1); 70282cd038dSYoshinobu Inoue bzero(p, 4); 7037460ef5dSHiroki Sato 7047460ef5dSHiroki Sato maxhlen = M_TRAILINGSPACE(n) - 7057460ef5dSHiroki Sato (sizeof(*nip6) + sizeof(*nicmp6) + 4); 7067460ef5dSHiroki Sato mtx_lock(&pr->pr_mtx); 7077460ef5dSHiroki Sato hlen = strlen(pr->pr_hostname); 7087460ef5dSHiroki Sato if (maxhlen > hlen) 7097460ef5dSHiroki Sato maxhlen = hlen; 710c1f19219SJamie Gritton /* meaningless TTL */ 711c1f19219SJamie Gritton bcopy(pr->pr_hostname, p + 4, maxhlen); 71276ca6f88SJamie Gritton mtx_unlock(&pr->pr_mtx); 71382cd038dSYoshinobu Inoue noff = sizeof(struct ip6_hdr); 71482cd038dSYoshinobu Inoue n->m_pkthdr.len = n->m_len = sizeof(struct ip6_hdr) + 715686cdd19SJun-ichiro itojun Hagino sizeof(struct icmp6_hdr) + 4 + maxhlen; 71682cd038dSYoshinobu Inoue nicmp6->icmp6_type = ICMP6_WRUREPLY; 71782cd038dSYoshinobu Inoue nicmp6->icmp6_code = 0; 71882cd038dSYoshinobu Inoue } 71982cd038dSYoshinobu Inoue if (n) { 720e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_reflect); 721e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_outhist[ICMP6_WRUREPLY]); 72282cd038dSYoshinobu Inoue icmp6_reflect(n, noff); 72382cd038dSYoshinobu Inoue } 72482cd038dSYoshinobu Inoue break; 72582cd038dSYoshinobu Inoue } 72682cd038dSYoshinobu Inoue 72782cd038dSYoshinobu Inoue case ICMP6_WRUREPLY: 72882cd038dSYoshinobu Inoue if (code != 0) 72982cd038dSYoshinobu Inoue goto badcode; 73082cd038dSYoshinobu Inoue break; 73182cd038dSYoshinobu Inoue 73282cd038dSYoshinobu Inoue case ND_ROUTER_SOLICIT: 73329dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_routersolicit); 73482cd038dSYoshinobu Inoue if (code != 0) 73582cd038dSYoshinobu Inoue goto badcode; 73682cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct nd_router_solicit)) 73782cd038dSYoshinobu Inoue goto badlen; 7381db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 739a4adf6ccSBjoern A. Zeeb if (m->m_len < off + icmp6len) { 740a61b5cfbSBjoern A. Zeeb m = m_pullup(m, off + icmp6len); 741a61b5cfbSBjoern A. Zeeb if (m == NULL) { 742a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 743a61b5cfbSBjoern A. Zeeb *mp = NULL; 744a61b5cfbSBjoern A. Zeeb return (IPPROTO_DONE); 745a61b5cfbSBjoern A. Zeeb } 746a4adf6ccSBjoern A. Zeeb } 7472d12d25cSMark Johnston error = send_sendso_input_hook(m, ifp, SND_IN, ip6len); 7482d12d25cSMark Johnston if (error == 0) { 749686cdd19SJun-ichiro itojun Hagino m = NULL; 750686cdd19SJun-ichiro itojun Hagino goto freeit; 751686cdd19SJun-ichiro itojun Hagino } 7522d12d25cSMark Johnston } 7532d12d25cSMark Johnston n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 7542d12d25cSMark Johnston nd6_rs_input(m, off, icmp6len); 7552d12d25cSMark Johnston m = n; 7562d12d25cSMark Johnston if (m == NULL) 757e7a6db74SAna Kukec goto freeit; 75882cd038dSYoshinobu Inoue break; 75982cd038dSYoshinobu Inoue 76082cd038dSYoshinobu Inoue case ND_ROUTER_ADVERT: 76129dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_routeradvert); 76282cd038dSYoshinobu Inoue if (code != 0) 76382cd038dSYoshinobu Inoue goto badcode; 76482cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct nd_router_advert)) 76582cd038dSYoshinobu Inoue goto badlen; 7661db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 7672d12d25cSMark Johnston error = send_sendso_input_hook(m, ifp, SND_IN, ip6len); 7682d12d25cSMark Johnston if (error == 0) { 769686cdd19SJun-ichiro itojun Hagino m = NULL; 770686cdd19SJun-ichiro itojun Hagino goto freeit; 771686cdd19SJun-ichiro itojun Hagino } 7722d12d25cSMark Johnston } 7732d12d25cSMark Johnston n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 7742d12d25cSMark Johnston nd6_ra_input(m, off, icmp6len); 7752d12d25cSMark Johnston m = n; 7762d12d25cSMark Johnston if (m == NULL) 777e7a6db74SAna Kukec goto freeit; 77882cd038dSYoshinobu Inoue break; 77982cd038dSYoshinobu Inoue 78082cd038dSYoshinobu Inoue case ND_NEIGHBOR_SOLICIT: 78129dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_neighborsolicit); 78282cd038dSYoshinobu Inoue if (code != 0) 78382cd038dSYoshinobu Inoue goto badcode; 78482cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct nd_neighbor_solicit)) 78582cd038dSYoshinobu Inoue goto badlen; 7861db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 7872d12d25cSMark Johnston error = send_sendso_input_hook(m, ifp, SND_IN, ip6len); 7882d12d25cSMark Johnston if (error == 0) { 789686cdd19SJun-ichiro itojun Hagino m = NULL; 790686cdd19SJun-ichiro itojun Hagino goto freeit; 791686cdd19SJun-ichiro itojun Hagino } 7922d12d25cSMark Johnston } 7932d12d25cSMark Johnston n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 7942d12d25cSMark Johnston nd6_ns_input(m, off, icmp6len); 7952d12d25cSMark Johnston m = n; 7962d12d25cSMark Johnston if (m == NULL) 797e7a6db74SAna Kukec goto freeit; 79882cd038dSYoshinobu Inoue break; 79982cd038dSYoshinobu Inoue 80082cd038dSYoshinobu Inoue case ND_NEIGHBOR_ADVERT: 80129dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_neighboradvert); 80282cd038dSYoshinobu Inoue if (code != 0) 80382cd038dSYoshinobu Inoue goto badcode; 80482cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct nd_neighbor_advert)) 80582cd038dSYoshinobu Inoue goto badlen; 8061db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 8072d12d25cSMark Johnston error = send_sendso_input_hook(m, ifp, SND_IN, ip6len); 8082d12d25cSMark Johnston if (error == 0) { 809686cdd19SJun-ichiro itojun Hagino m = NULL; 810686cdd19SJun-ichiro itojun Hagino goto freeit; 811686cdd19SJun-ichiro itojun Hagino } 8122d12d25cSMark Johnston } 8132d12d25cSMark Johnston n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 8142d12d25cSMark Johnston nd6_na_input(m, off, icmp6len); 8152d12d25cSMark Johnston m = n; 8162d12d25cSMark Johnston if (m == NULL) 817e7a6db74SAna Kukec goto freeit; 81882cd038dSYoshinobu Inoue break; 81982cd038dSYoshinobu Inoue 82082cd038dSYoshinobu Inoue case ND_REDIRECT: 82129dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_redirect); 82282cd038dSYoshinobu Inoue if (code != 0) 82382cd038dSYoshinobu Inoue goto badcode; 82482cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct nd_redirect)) 82582cd038dSYoshinobu Inoue goto badlen; 8261db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 8272d12d25cSMark Johnston error = send_sendso_input_hook(m, ifp, SND_IN, ip6len); 8282d12d25cSMark Johnston if (error == 0) { 829686cdd19SJun-ichiro itojun Hagino m = NULL; 830686cdd19SJun-ichiro itojun Hagino goto freeit; 831686cdd19SJun-ichiro itojun Hagino } 8322d12d25cSMark Johnston } 8332d12d25cSMark Johnston n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 8342d12d25cSMark Johnston icmp6_redirect_input(m, off); 8352d12d25cSMark Johnston m = n; 8362d12d25cSMark Johnston if (m == NULL) 837e7a6db74SAna Kukec goto freeit; 83882cd038dSYoshinobu Inoue break; 83982cd038dSYoshinobu Inoue 84082cd038dSYoshinobu Inoue case ICMP6_ROUTER_RENUMBERING: 84182cd038dSYoshinobu Inoue if (code != ICMP6_ROUTER_RENUMBERING_COMMAND && 84282cd038dSYoshinobu Inoue code != ICMP6_ROUTER_RENUMBERING_RESULT) 84382cd038dSYoshinobu Inoue goto badcode; 84482cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct icmp6_router_renum)) 84582cd038dSYoshinobu Inoue goto badlen; 84682cd038dSYoshinobu Inoue break; 84782cd038dSYoshinobu Inoue 84882cd038dSYoshinobu Inoue default: 84933841545SHajimu UMEMOTO nd6log((LOG_DEBUG, 85033841545SHajimu UMEMOTO "icmp6_input: unknown type %d(src=%s, dst=%s, ifid=%d)\n", 8511d54aa3bSBjoern A. Zeeb icmp6->icmp6_type, ip6_sprintf(ip6bufs, &ip6->ip6_src), 8521d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6bufd, &ip6->ip6_dst), 85329dc7bc6SBruce M Simpson ifp ? ifp->if_index : 0)); 85482cd038dSYoshinobu Inoue if (icmp6->icmp6_type < ICMP6_ECHO_REQUEST) { 85582cd038dSYoshinobu Inoue /* ICMPv6 error: MUST deliver it by spec... */ 85682cd038dSYoshinobu Inoue code = PRC_NCMDS; 85782cd038dSYoshinobu Inoue /* deliver */ 85882cd038dSYoshinobu Inoue } else { 85982cd038dSYoshinobu Inoue /* ICMPv6 informational: MUST not deliver */ 86082cd038dSYoshinobu Inoue break; 86182cd038dSYoshinobu Inoue } 86282cd038dSYoshinobu Inoue deliver: 86314c129fcSBjoern A. Zeeb if (icmp6_notify_error(&m, off, icmp6len, code) != 0) { 86433841545SHajimu UMEMOTO /* In this case, m should've been freed. */ 865a8fe77d8SBjoern A. Zeeb *mp = NULL; 86633841545SHajimu UMEMOTO return (IPPROTO_DONE); 86733841545SHajimu UMEMOTO } 86833841545SHajimu UMEMOTO break; 86933841545SHajimu UMEMOTO 87033841545SHajimu UMEMOTO badcode: 871e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_badcode); 87233841545SHajimu UMEMOTO break; 87333841545SHajimu UMEMOTO 87433841545SHajimu UMEMOTO badlen: 875e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_badlen); 87633841545SHajimu UMEMOTO break; 87733841545SHajimu UMEMOTO } 87833841545SHajimu UMEMOTO 87933841545SHajimu UMEMOTO /* deliver the packet to appropriate sockets */ 88033841545SHajimu UMEMOTO icmp6_rip6_input(&m, *offp); 88133841545SHajimu UMEMOTO 882a8fe77d8SBjoern A. Zeeb *mp = m; 883a8fe77d8SBjoern A. Zeeb return (IPPROTO_DONE); 88433841545SHajimu UMEMOTO 88533841545SHajimu UMEMOTO freeit: 88633841545SHajimu UMEMOTO m_freem(m); 887a8fe77d8SBjoern A. Zeeb *mp = NULL; 888a8fe77d8SBjoern A. Zeeb return (IPPROTO_DONE); 88933841545SHajimu UMEMOTO } 89033841545SHajimu UMEMOTO 89133841545SHajimu UMEMOTO static int 8921272577eSXin LI icmp6_notify_error(struct mbuf **mp, int off, int icmp6len, int code) 89333841545SHajimu UMEMOTO { 894503f4e47SBjoern A. Zeeb struct mbuf *m; 89533841545SHajimu UMEMOTO struct icmp6_hdr *icmp6; 89633841545SHajimu UMEMOTO struct ip6_hdr *eip6; 89733841545SHajimu UMEMOTO u_int32_t notifymtu; 89833841545SHajimu UMEMOTO struct sockaddr_in6 icmp6src, icmp6dst; 89933841545SHajimu UMEMOTO 900503f4e47SBjoern A. Zeeb m = *mp; 901503f4e47SBjoern A. Zeeb 90282cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct icmp6_hdr) + sizeof(struct ip6_hdr)) { 903e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_tooshort); 90482cd038dSYoshinobu Inoue goto freeit; 90582cd038dSYoshinobu Inoue } 906a61b5cfbSBjoern A. Zeeb 907a4adf6ccSBjoern A. Zeeb if (m->m_len < off + sizeof(*icmp6) + sizeof(struct ip6_hdr)) { 908a61b5cfbSBjoern A. Zeeb m = m_pullup(m, off + sizeof(*icmp6) + sizeof(struct ip6_hdr)); 909a61b5cfbSBjoern A. Zeeb if (m == NULL) { 910a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 911a61b5cfbSBjoern A. Zeeb *mp = m; 91233841545SHajimu UMEMOTO return (-1); 913686cdd19SJun-ichiro itojun Hagino } 914a4adf6ccSBjoern A. Zeeb } 915a61b5cfbSBjoern A. Zeeb icmp6 = (struct icmp6_hdr *)(mtod(m, caddr_t) + off); 91633841545SHajimu UMEMOTO eip6 = (struct ip6_hdr *)(icmp6 + 1); 91782cd038dSYoshinobu Inoue 91882cd038dSYoshinobu Inoue /* Detect the upper level protocol */ 91982cd038dSYoshinobu Inoue { 9209233d8f3SDavid E. O'Brien void (*ctlfunc)(int, struct sockaddr *, void *); 92182cd038dSYoshinobu Inoue u_int8_t nxt = eip6->ip6_nxt; 92282cd038dSYoshinobu Inoue int eoff = off + sizeof(struct icmp6_hdr) + 92382cd038dSYoshinobu Inoue sizeof(struct ip6_hdr); 92482cd038dSYoshinobu Inoue struct ip6ctlparam ip6cp; 925686cdd19SJun-ichiro itojun Hagino struct in6_addr *finaldst = NULL; 926686cdd19SJun-ichiro itojun Hagino int icmp6type = icmp6->icmp6_type; 927686cdd19SJun-ichiro itojun Hagino struct ip6_frag *fh; 928686cdd19SJun-ichiro itojun Hagino struct ip6_rthdr *rth; 929686cdd19SJun-ichiro itojun Hagino struct ip6_rthdr0 *rth0; 930686cdd19SJun-ichiro itojun Hagino int rthlen; 93182cd038dSYoshinobu Inoue 93288ff5695SSUZUKI Shinsuke while (1) { /* XXX: should avoid infinite loop explicitly? */ 93382cd038dSYoshinobu Inoue struct ip6_ext *eh; 93482cd038dSYoshinobu Inoue 93582cd038dSYoshinobu Inoue switch (nxt) { 93682cd038dSYoshinobu Inoue case IPPROTO_HOPOPTS: 93782cd038dSYoshinobu Inoue case IPPROTO_DSTOPTS: 93882cd038dSYoshinobu Inoue case IPPROTO_AH: 939a4adf6ccSBjoern A. Zeeb if (m->m_len < eoff + sizeof(struct ip6_ext)) { 940a4adf6ccSBjoern A. Zeeb m = m_pullup(m, eoff + 941a4adf6ccSBjoern A. Zeeb sizeof(struct ip6_ext)); 942a61b5cfbSBjoern A. Zeeb if (m == NULL) { 943a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 944a61b5cfbSBjoern A. Zeeb *mp = m; 94533841545SHajimu UMEMOTO return (-1); 946686cdd19SJun-ichiro itojun Hagino } 947a4adf6ccSBjoern A. Zeeb } 948a61b5cfbSBjoern A. Zeeb eh = (struct ip6_ext *) 949a61b5cfbSBjoern A. Zeeb (mtod(m, caddr_t) + eoff); 95082cd038dSYoshinobu Inoue if (nxt == IPPROTO_AH) 95182cd038dSYoshinobu Inoue eoff += (eh->ip6e_len + 2) << 2; 95282cd038dSYoshinobu Inoue else 95382cd038dSYoshinobu Inoue eoff += (eh->ip6e_len + 1) << 3; 95482cd038dSYoshinobu Inoue nxt = eh->ip6e_nxt; 95582cd038dSYoshinobu Inoue break; 956686cdd19SJun-ichiro itojun Hagino case IPPROTO_ROUTING: 957686cdd19SJun-ichiro itojun Hagino /* 958686cdd19SJun-ichiro itojun Hagino * When the erroneous packet contains a 959686cdd19SJun-ichiro itojun Hagino * routing header, we should examine the 960686cdd19SJun-ichiro itojun Hagino * header to determine the final destination. 961686cdd19SJun-ichiro itojun Hagino * Otherwise, we can't properly update 962686cdd19SJun-ichiro itojun Hagino * information that depends on the final 963686cdd19SJun-ichiro itojun Hagino * destination (e.g. path MTU). 964686cdd19SJun-ichiro itojun Hagino */ 965a4adf6ccSBjoern A. Zeeb if (m->m_len < eoff + sizeof(*rth)) { 966a61b5cfbSBjoern A. Zeeb m = m_pullup(m, eoff + sizeof(*rth)); 967a61b5cfbSBjoern A. Zeeb if (m == NULL) { 968a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 969a61b5cfbSBjoern A. Zeeb *mp = m; 97033841545SHajimu UMEMOTO return (-1); 971686cdd19SJun-ichiro itojun Hagino } 972a4adf6ccSBjoern A. Zeeb } 973a61b5cfbSBjoern A. Zeeb rth = (struct ip6_rthdr *) 974a61b5cfbSBjoern A. Zeeb (mtod(m, caddr_t) + eoff); 975686cdd19SJun-ichiro itojun Hagino rthlen = (rth->ip6r_len + 1) << 3; 976686cdd19SJun-ichiro itojun Hagino /* 977686cdd19SJun-ichiro itojun Hagino * XXX: currently there is no 978686cdd19SJun-ichiro itojun Hagino * officially defined type other 979686cdd19SJun-ichiro itojun Hagino * than type-0. 980686cdd19SJun-ichiro itojun Hagino * Note that if the segment left field 981686cdd19SJun-ichiro itojun Hagino * is 0, all intermediate hops must 982686cdd19SJun-ichiro itojun Hagino * have been passed. 983686cdd19SJun-ichiro itojun Hagino */ 984686cdd19SJun-ichiro itojun Hagino if (rth->ip6r_segleft && 985686cdd19SJun-ichiro itojun Hagino rth->ip6r_type == IPV6_RTHDR_TYPE_0) { 986686cdd19SJun-ichiro itojun Hagino int hops; 987686cdd19SJun-ichiro itojun Hagino 988a4adf6ccSBjoern A. Zeeb if (m->m_len < eoff + rthlen) { 989a61b5cfbSBjoern A. Zeeb m = m_pullup(m, eoff + rthlen); 990a61b5cfbSBjoern A. Zeeb if (m == NULL) { 991a4adf6ccSBjoern A. Zeeb IP6STAT_INC( 992a4adf6ccSBjoern A. Zeeb ip6s_exthdrtoolong); 993a61b5cfbSBjoern A. Zeeb *mp = m; 99433841545SHajimu UMEMOTO return (-1); 995686cdd19SJun-ichiro itojun Hagino } 996a4adf6ccSBjoern A. Zeeb } 997a61b5cfbSBjoern A. Zeeb rth0 = (struct ip6_rthdr0 *) 998a61b5cfbSBjoern A. Zeeb (mtod(m, caddr_t) + eoff); 999686cdd19SJun-ichiro itojun Hagino /* just ignore a bogus header */ 1000686cdd19SJun-ichiro itojun Hagino if ((rth0->ip6r0_len % 2) == 0 && 1001686cdd19SJun-ichiro itojun Hagino (hops = rth0->ip6r0_len/2)) 1002686cdd19SJun-ichiro itojun Hagino finaldst = (struct in6_addr *)(rth0 + 1) + (hops - 1); 1003686cdd19SJun-ichiro itojun Hagino } 1004686cdd19SJun-ichiro itojun Hagino eoff += rthlen; 1005686cdd19SJun-ichiro itojun Hagino nxt = rth->ip6r_nxt; 1006686cdd19SJun-ichiro itojun Hagino break; 1007686cdd19SJun-ichiro itojun Hagino case IPPROTO_FRAGMENT: 1008a4adf6ccSBjoern A. Zeeb if (m->m_len < eoff + sizeof(struct ip6_frag)) { 1009a4adf6ccSBjoern A. Zeeb m = m_pullup(m, eoff + 1010a4adf6ccSBjoern A. Zeeb sizeof(struct ip6_frag)); 1011a61b5cfbSBjoern A. Zeeb if (m == NULL) { 1012a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 1013a61b5cfbSBjoern A. Zeeb *mp = m; 101433841545SHajimu UMEMOTO return (-1); 1015686cdd19SJun-ichiro itojun Hagino } 1016a4adf6ccSBjoern A. Zeeb } 1017a61b5cfbSBjoern A. Zeeb fh = (struct ip6_frag *)(mtod(m, caddr_t) + 1018a61b5cfbSBjoern A. Zeeb eoff); 1019686cdd19SJun-ichiro itojun Hagino /* 1020686cdd19SJun-ichiro itojun Hagino * Data after a fragment header is meaningless 1021686cdd19SJun-ichiro itojun Hagino * unless it is the first fragment, but 1022686cdd19SJun-ichiro itojun Hagino * we'll go to the notify label for path MTU 1023686cdd19SJun-ichiro itojun Hagino * discovery. 1024686cdd19SJun-ichiro itojun Hagino */ 1025686cdd19SJun-ichiro itojun Hagino if (fh->ip6f_offlg & IP6F_OFF_MASK) 1026686cdd19SJun-ichiro itojun Hagino goto notify; 1027686cdd19SJun-ichiro itojun Hagino 1028686cdd19SJun-ichiro itojun Hagino eoff += sizeof(struct ip6_frag); 1029686cdd19SJun-ichiro itojun Hagino nxt = fh->ip6f_nxt; 1030686cdd19SJun-ichiro itojun Hagino break; 103182cd038dSYoshinobu Inoue default: 1032686cdd19SJun-ichiro itojun Hagino /* 1033686cdd19SJun-ichiro itojun Hagino * This case includes ESP and the No Next 1034686cdd19SJun-ichiro itojun Hagino * Header. In such cases going to the notify 1035686cdd19SJun-ichiro itojun Hagino * label does not have any meaning 1036686cdd19SJun-ichiro itojun Hagino * (i.e. ctlfunc will be NULL), but we go 1037686cdd19SJun-ichiro itojun Hagino * anyway since we might have to update 1038686cdd19SJun-ichiro itojun Hagino * path MTU information. 1039686cdd19SJun-ichiro itojun Hagino */ 104082cd038dSYoshinobu Inoue goto notify; 104182cd038dSYoshinobu Inoue } 104282cd038dSYoshinobu Inoue } 104382cd038dSYoshinobu Inoue notify: 104482cd038dSYoshinobu Inoue icmp6 = (struct icmp6_hdr *)(mtod(m, caddr_t) + off); 104533841545SHajimu UMEMOTO 104606cd0a3fSHajimu UMEMOTO /* 104706cd0a3fSHajimu UMEMOTO * retrieve parameters from the inner IPv6 header, and convert 104806cd0a3fSHajimu UMEMOTO * them into sockaddr structures. 104906cd0a3fSHajimu UMEMOTO * XXX: there is no guarantee that the source or destination 105006cd0a3fSHajimu UMEMOTO * addresses of the inner packet are in the same scope as 105106cd0a3fSHajimu UMEMOTO * the addresses of the icmp packet. But there is no other 105206cd0a3fSHajimu UMEMOTO * way to determine the zone. 105306cd0a3fSHajimu UMEMOTO */ 105433841545SHajimu UMEMOTO eip6 = (struct ip6_hdr *)(icmp6 + 1); 105506cd0a3fSHajimu UMEMOTO 105633841545SHajimu UMEMOTO bzero(&icmp6dst, sizeof(icmp6dst)); 105733841545SHajimu UMEMOTO icmp6dst.sin6_len = sizeof(struct sockaddr_in6); 105833841545SHajimu UMEMOTO icmp6dst.sin6_family = AF_INET6; 1059686cdd19SJun-ichiro itojun Hagino if (finaldst == NULL) 106033841545SHajimu UMEMOTO icmp6dst.sin6_addr = eip6->ip6_dst; 106133841545SHajimu UMEMOTO else 106233841545SHajimu UMEMOTO icmp6dst.sin6_addr = *finaldst; 1063a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&icmp6dst.sin6_addr, m->m_pkthdr.rcvif, NULL)) 10649a4f9608SHajimu UMEMOTO goto freeit; 106533841545SHajimu UMEMOTO bzero(&icmp6src, sizeof(icmp6src)); 106633841545SHajimu UMEMOTO icmp6src.sin6_len = sizeof(struct sockaddr_in6); 106733841545SHajimu UMEMOTO icmp6src.sin6_family = AF_INET6; 106833841545SHajimu UMEMOTO icmp6src.sin6_addr = eip6->ip6_src; 1069a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&icmp6src.sin6_addr, m->m_pkthdr.rcvif, NULL)) 10709a4f9608SHajimu UMEMOTO goto freeit; 1071a1f7e5f8SHajimu UMEMOTO icmp6src.sin6_flowinfo = 1072a1f7e5f8SHajimu UMEMOTO (eip6->ip6_flow & IPV6_FLOWLABEL_MASK); 107333841545SHajimu UMEMOTO 107433841545SHajimu UMEMOTO if (finaldst == NULL) 107533841545SHajimu UMEMOTO finaldst = &eip6->ip6_dst; 107633841545SHajimu UMEMOTO ip6cp.ip6c_m = m; 107733841545SHajimu UMEMOTO ip6cp.ip6c_icmp6 = icmp6; 107833841545SHajimu UMEMOTO ip6cp.ip6c_ip6 = (struct ip6_hdr *)(icmp6 + 1); 107933841545SHajimu UMEMOTO ip6cp.ip6c_off = eoff; 108033841545SHajimu UMEMOTO ip6cp.ip6c_finaldst = finaldst; 108133841545SHajimu UMEMOTO ip6cp.ip6c_src = &icmp6src; 108233841545SHajimu UMEMOTO ip6cp.ip6c_nxt = nxt; 108333841545SHajimu UMEMOTO 108433841545SHajimu UMEMOTO if (icmp6type == ICMP6_PACKET_TOO_BIG) { 108533841545SHajimu UMEMOTO notifymtu = ntohl(icmp6->icmp6_mtu); 108633841545SHajimu UMEMOTO ip6cp.ip6c_cmdarg = (void *)¬ifymtu; 108733841545SHajimu UMEMOTO icmp6_mtudisc_update(&ip6cp, 1); /*XXX*/ 1088686cdd19SJun-ichiro itojun Hagino } 1089686cdd19SJun-ichiro itojun Hagino 10909233d8f3SDavid E. O'Brien ctlfunc = (void (*)(int, struct sockaddr *, void *)) 109182cd038dSYoshinobu Inoue (inet6sw[ip6_protox[nxt]].pr_ctlinput); 109282cd038dSYoshinobu Inoue if (ctlfunc) { 109333841545SHajimu UMEMOTO (void) (*ctlfunc)(code, (struct sockaddr *)&icmp6dst, 109433841545SHajimu UMEMOTO &ip6cp); 109582cd038dSYoshinobu Inoue } 109682cd038dSYoshinobu Inoue } 10979c0fda72SHajimu UMEMOTO *mp = m; 109833841545SHajimu UMEMOTO return (0); 109982cd038dSYoshinobu Inoue 110082cd038dSYoshinobu Inoue freeit: 110182cd038dSYoshinobu Inoue m_freem(m); 1102a8fe77d8SBjoern A. Zeeb *mp = NULL; 110333841545SHajimu UMEMOTO return (-1); 110482cd038dSYoshinobu Inoue } 110582cd038dSYoshinobu Inoue 110633841545SHajimu UMEMOTO void 11071272577eSXin LI icmp6_mtudisc_update(struct ip6ctlparam *ip6cp, int validated) 1108686cdd19SJun-ichiro itojun Hagino { 110933841545SHajimu UMEMOTO struct in6_addr *dst = ip6cp->ip6c_finaldst; 111033841545SHajimu UMEMOTO struct icmp6_hdr *icmp6 = ip6cp->ip6c_icmp6; 111133841545SHajimu UMEMOTO struct mbuf *m = ip6cp->ip6c_m; /* will be necessary for scope issue */ 1112686cdd19SJun-ichiro itojun Hagino u_int mtu = ntohl(icmp6->icmp6_mtu); 111397d8d152SAndre Oppermann struct in_conninfo inc; 1114686cdd19SJun-ichiro itojun Hagino 1115f95d4633SHajimu UMEMOTO #if 0 1116f95d4633SHajimu UMEMOTO /* 1117f95d4633SHajimu UMEMOTO * RFC2460 section 5, last paragraph. 1118f95d4633SHajimu UMEMOTO * even though minimum link MTU for IPv6 is IPV6_MMTU, 1119f95d4633SHajimu UMEMOTO * we may see ICMPv6 too big with mtu < IPV6_MMTU 1120f95d4633SHajimu UMEMOTO * due to packet translator in the middle. 1121f95d4633SHajimu UMEMOTO * see ip6_output() and ip6_getpmtu() "alwaysfrag" case for 1122f95d4633SHajimu UMEMOTO * special handling. 1123f95d4633SHajimu UMEMOTO */ 1124f95d4633SHajimu UMEMOTO if (mtu < IPV6_MMTU) 1125f95d4633SHajimu UMEMOTO return; 1126f95d4633SHajimu UMEMOTO #endif 1127f95d4633SHajimu UMEMOTO 1128f95d4633SHajimu UMEMOTO /* 1129f95d4633SHajimu UMEMOTO * we reject ICMPv6 too big with abnormally small value. 1130f95d4633SHajimu UMEMOTO * XXX what is the good definition of "abnormally small"? 1131f95d4633SHajimu UMEMOTO */ 1132f95d4633SHajimu UMEMOTO if (mtu < sizeof(struct ip6_hdr) + sizeof(struct ip6_frag) + 8) 1133f95d4633SHajimu UMEMOTO return; 1134f95d4633SHajimu UMEMOTO 113533841545SHajimu UMEMOTO if (!validated) 113633841545SHajimu UMEMOTO return; 113733841545SHajimu UMEMOTO 113859ca51adSSimon L. B. Nielsen /* 113959ca51adSSimon L. B. Nielsen * In case the suggested mtu is less than IPV6_MMTU, we 114059ca51adSSimon L. B. Nielsen * only need to remember that it was for above mentioned 114159ca51adSSimon L. B. Nielsen * "alwaysfrag" case. 114259ca51adSSimon L. B. Nielsen * Try to be as close to the spec as possible. 114359ca51adSSimon L. B. Nielsen */ 114459ca51adSSimon L. B. Nielsen if (mtu < IPV6_MMTU) 114559ca51adSSimon L. B. Nielsen mtu = IPV6_MMTU - 8; 114659ca51adSSimon L. B. Nielsen 114797d8d152SAndre Oppermann bzero(&inc, sizeof(inc)); 1148baa09f18SAndrey V. Elsukov inc.inc_fibnum = M_GETFIB(m); 1149dcdb4371SBjoern A. Zeeb inc.inc_flags |= INC_ISIPV6; 115097d8d152SAndre Oppermann inc.inc6_faddr = *dst; 1151a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&inc.inc6_faddr, m->m_pkthdr.rcvif, NULL)) 1152a1f7e5f8SHajimu UMEMOTO return; 1153686cdd19SJun-ichiro itojun Hagino 1154233dcce1SAndre Oppermann if (mtu < tcp_maxmtu6(&inc, NULL)) { 115597d8d152SAndre Oppermann tcp_hc_updatemtu(&inc, mtu); 1156e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_pmtuchg); 1157686cdd19SJun-ichiro itojun Hagino } 1158686cdd19SJun-ichiro itojun Hagino } 1159686cdd19SJun-ichiro itojun Hagino 116082cd038dSYoshinobu Inoue /* 116133841545SHajimu UMEMOTO * Process a Node Information Query packet, based on 116233841545SHajimu UMEMOTO * draft-ietf-ipngwg-icmp-name-lookups-07. 1163686cdd19SJun-ichiro itojun Hagino * 1164686cdd19SJun-ichiro itojun Hagino * Spec incompatibilities: 1165686cdd19SJun-ichiro itojun Hagino * - IPv6 Subject address handling 1166686cdd19SJun-ichiro itojun Hagino * - IPv4 Subject address handling support missing 1167686cdd19SJun-ichiro itojun Hagino * - Proxy reply (answer even if it's not for me) 1168686cdd19SJun-ichiro itojun Hagino * - joins NI group address at in6_ifattach() time only, does not cope 1169686cdd19SJun-ichiro itojun Hagino * with hostname changes by sethostname(3) 117082cd038dSYoshinobu Inoue */ 117182cd038dSYoshinobu Inoue static struct mbuf * 11727460ef5dSHiroki Sato ni6_input(struct mbuf *m, int off, struct prison *pr) 117382cd038dSYoshinobu Inoue { 1174686cdd19SJun-ichiro itojun Hagino struct icmp6_nodeinfo *ni6, *nni6; 117582cd038dSYoshinobu Inoue struct mbuf *n = NULL; 1176686cdd19SJun-ichiro itojun Hagino u_int16_t qtype; 1177686cdd19SJun-ichiro itojun Hagino int subjlen; 117882cd038dSYoshinobu Inoue int replylen = sizeof(struct ip6_hdr) + sizeof(struct icmp6_nodeinfo); 117982cd038dSYoshinobu Inoue struct ni_reply_fqdn *fqdn; 118082cd038dSYoshinobu Inoue int addrs; /* for NI_QTYPE_NODEADDR */ 118182cd038dSYoshinobu Inoue struct ifnet *ifp = NULL; /* for NI_QTYPE_NODEADDR */ 1182a1f7e5f8SHajimu UMEMOTO struct in6_addr in6_subj; /* subject address */ 1183686cdd19SJun-ichiro itojun Hagino struct ip6_hdr *ip6; 1184686cdd19SJun-ichiro itojun Hagino int oldfqdn = 0; /* if 1, return pascal string (03 draft) */ 118533841545SHajimu UMEMOTO char *subj = NULL; 118633841545SHajimu UMEMOTO struct in6_ifaddr *ia6 = NULL; 118782cd038dSYoshinobu Inoue 1188686cdd19SJun-ichiro itojun Hagino ip6 = mtod(m, struct ip6_hdr *); 1189686cdd19SJun-ichiro itojun Hagino ni6 = (struct icmp6_nodeinfo *)(mtod(m, caddr_t) + off); 1190686cdd19SJun-ichiro itojun Hagino 1191686cdd19SJun-ichiro itojun Hagino /* 119218706985SJINMEI Tatuya * Validate IPv6 source address. 119318706985SJINMEI Tatuya * The default configuration MUST be to refuse answering queries from 119418706985SJINMEI Tatuya * global-scope addresses according to RFC4602. 119518706985SJINMEI Tatuya * Notes: 119618706985SJINMEI Tatuya * - it's not very clear what "refuse" means; this implementation 119718706985SJINMEI Tatuya * simply drops it. 119818706985SJINMEI Tatuya * - it's not very easy to identify global-scope (unicast) addresses 119918706985SJINMEI Tatuya * since there are many prefixes for them. It should be safer 120018706985SJINMEI Tatuya * and in practice sufficient to check "all" but loopback and 120118706985SJINMEI Tatuya * link-local (note that site-local unicast was deprecated and 120218706985SJINMEI Tatuya * ULA is defined as global scope-wise) 120318706985SJINMEI Tatuya */ 1204603724d3SBjoern A. Zeeb if ((V_icmp6_nodeinfo & ICMP6_NODEINFO_GLOBALOK) == 0 && 120518706985SJINMEI Tatuya !IN6_IS_ADDR_LOOPBACK(&ip6->ip6_src) && 120618706985SJINMEI Tatuya !IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_src)) 120718706985SJINMEI Tatuya goto bad; 120818706985SJINMEI Tatuya 120918706985SJINMEI Tatuya /* 1210686cdd19SJun-ichiro itojun Hagino * Validate IPv6 destination address. 1211686cdd19SJun-ichiro itojun Hagino * 121233841545SHajimu UMEMOTO * The Responder must discard the Query without further processing 121333841545SHajimu UMEMOTO * unless it is one of the Responder's unicast or anycast addresses, or 121433841545SHajimu UMEMOTO * a link-local scope multicast address which the Responder has joined. 121518706985SJINMEI Tatuya * [RFC4602, Section 5.] 1216686cdd19SJun-ichiro itojun Hagino */ 12172a5aafceSHajimu UMEMOTO if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) { 12182a5aafceSHajimu UMEMOTO if (!IN6_IS_ADDR_MC_LINKLOCAL(&ip6->ip6_dst)) 12192a5aafceSHajimu UMEMOTO goto bad; 12202a5aafceSHajimu UMEMOTO /* else it's a link-local multicast, fine */ 12212a5aafceSHajimu UMEMOTO } else { /* unicast or anycast */ 12223e88eb90SAndrey V. Elsukov ia6 = in6ifa_ifwithaddr(&ip6->ip6_dst, 0 /* XXX */); 12233e88eb90SAndrey V. Elsukov if (ia6 == NULL) 12242a5aafceSHajimu UMEMOTO goto bad; /* XXX impossible */ 12252a5aafceSHajimu UMEMOTO 12262a5aafceSHajimu UMEMOTO if ((ia6->ia6_flags & IN6_IFF_TEMPORARY) && 1227603724d3SBjoern A. Zeeb !(V_icmp6_nodeinfo & ICMP6_NODEINFO_TMPADDROK)) { 12288c0fec80SRobert Watson ifa_free(&ia6->ia_ifa); 122933841545SHajimu UMEMOTO nd6log((LOG_DEBUG, "ni6_input: ignore node info to " 123033841545SHajimu UMEMOTO "a temporary address in %s:%d", 123133841545SHajimu UMEMOTO __FILE__, __LINE__)); 123233841545SHajimu UMEMOTO goto bad; 123333841545SHajimu UMEMOTO } 12348c0fec80SRobert Watson ifa_free(&ia6->ia_ifa); 12352a5aafceSHajimu UMEMOTO } 1236686cdd19SJun-ichiro itojun Hagino 1237686cdd19SJun-ichiro itojun Hagino /* validate query Subject field. */ 123833841545SHajimu UMEMOTO qtype = ntohs(ni6->ni_qtype); 1239686cdd19SJun-ichiro itojun Hagino subjlen = m->m_pkthdr.len - off - sizeof(struct icmp6_nodeinfo); 1240686cdd19SJun-ichiro itojun Hagino switch (qtype) { 1241686cdd19SJun-ichiro itojun Hagino case NI_QTYPE_NOOP: 1242686cdd19SJun-ichiro itojun Hagino case NI_QTYPE_SUPTYPES: 124333841545SHajimu UMEMOTO /* 07 draft */ 124433841545SHajimu UMEMOTO if (ni6->ni_code == ICMP6_NI_SUBJ_FQDN && subjlen == 0) 1245686cdd19SJun-ichiro itojun Hagino break; 124633841545SHajimu UMEMOTO /* FALLTHROUGH */ 1247686cdd19SJun-ichiro itojun Hagino case NI_QTYPE_FQDN: 1248686cdd19SJun-ichiro itojun Hagino case NI_QTYPE_NODEADDR: 1249a22adbc6SSUZUKI Shinsuke case NI_QTYPE_IPV4ADDR: 1250686cdd19SJun-ichiro itojun Hagino switch (ni6->ni_code) { 1251686cdd19SJun-ichiro itojun Hagino case ICMP6_NI_SUBJ_IPV6: 1252686cdd19SJun-ichiro itojun Hagino #if ICMP6_NI_SUBJ_IPV6 != 0 1253686cdd19SJun-ichiro itojun Hagino case 0: 1254686cdd19SJun-ichiro itojun Hagino #endif 1255686cdd19SJun-ichiro itojun Hagino /* 1256686cdd19SJun-ichiro itojun Hagino * backward compatibility - try to accept 03 draft 1257686cdd19SJun-ichiro itojun Hagino * format, where no Subject is present. 1258686cdd19SJun-ichiro itojun Hagino */ 125933841545SHajimu UMEMOTO if (qtype == NI_QTYPE_FQDN && ni6->ni_code == 0 && 126033841545SHajimu UMEMOTO subjlen == 0) { 1261686cdd19SJun-ichiro itojun Hagino oldfqdn++; 1262686cdd19SJun-ichiro itojun Hagino break; 1263686cdd19SJun-ichiro itojun Hagino } 126433841545SHajimu UMEMOTO #if ICMP6_NI_SUBJ_IPV6 != 0 126533841545SHajimu UMEMOTO if (ni6->ni_code != ICMP6_NI_SUBJ_IPV6) 126633841545SHajimu UMEMOTO goto bad; 126733841545SHajimu UMEMOTO #endif 1268686cdd19SJun-ichiro itojun Hagino 12692a5aafceSHajimu UMEMOTO if (subjlen != sizeof(struct in6_addr)) 1270686cdd19SJun-ichiro itojun Hagino goto bad; 1271686cdd19SJun-ichiro itojun Hagino 1272686cdd19SJun-ichiro itojun Hagino /* 1273686cdd19SJun-ichiro itojun Hagino * Validate Subject address. 1274686cdd19SJun-ichiro itojun Hagino * 127533841545SHajimu UMEMOTO * Not sure what exactly "address belongs to the node" 127633841545SHajimu UMEMOTO * means in the spec, is it just unicast, or what? 1277686cdd19SJun-ichiro itojun Hagino * 1278686cdd19SJun-ichiro itojun Hagino * At this moment we consider Subject address as 1279686cdd19SJun-ichiro itojun Hagino * "belong to the node" if the Subject address equals 1280686cdd19SJun-ichiro itojun Hagino * to the IPv6 destination address; validation for 1281686cdd19SJun-ichiro itojun Hagino * IPv6 destination address should have done enough 1282686cdd19SJun-ichiro itojun Hagino * check for us. 1283686cdd19SJun-ichiro itojun Hagino * 1284686cdd19SJun-ichiro itojun Hagino * We do not do proxy at this moment. 1285686cdd19SJun-ichiro itojun Hagino */ 1286686cdd19SJun-ichiro itojun Hagino m_copydata(m, off + sizeof(struct icmp6_nodeinfo), 1287a1f7e5f8SHajimu UMEMOTO subjlen, (caddr_t)&in6_subj); 1288a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&in6_subj, m->m_pkthdr.rcvif, NULL)) 12899a4f9608SHajimu UMEMOTO goto bad; 12902a5aafceSHajimu UMEMOTO 1291a1f7e5f8SHajimu UMEMOTO subj = (char *)&in6_subj; 1292a1f7e5f8SHajimu UMEMOTO if (IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst, &in6_subj)) 1293686cdd19SJun-ichiro itojun Hagino break; 129433841545SHajimu UMEMOTO 1295686cdd19SJun-ichiro itojun Hagino /* 1296686cdd19SJun-ichiro itojun Hagino * XXX if we are to allow other cases, we should really 1297686cdd19SJun-ichiro itojun Hagino * be careful about scope here. 1298686cdd19SJun-ichiro itojun Hagino * basically, we should disallow queries toward IPv6 129906cd0a3fSHajimu UMEMOTO * destination X with subject Y, 130006cd0a3fSHajimu UMEMOTO * if scope(X) > scope(Y). 1301686cdd19SJun-ichiro itojun Hagino * if we allow scope(X) > scope(Y), it will result in 1302686cdd19SJun-ichiro itojun Hagino * information leakage across scope boundary. 1303686cdd19SJun-ichiro itojun Hagino */ 1304686cdd19SJun-ichiro itojun Hagino goto bad; 1305686cdd19SJun-ichiro itojun Hagino 1306686cdd19SJun-ichiro itojun Hagino case ICMP6_NI_SUBJ_FQDN: 1307686cdd19SJun-ichiro itojun Hagino /* 1308686cdd19SJun-ichiro itojun Hagino * Validate Subject name with gethostname(3). 1309686cdd19SJun-ichiro itojun Hagino * 1310686cdd19SJun-ichiro itojun Hagino * The behavior may need some debate, since: 1311686cdd19SJun-ichiro itojun Hagino * - we are not sure if the node has FQDN as 1312686cdd19SJun-ichiro itojun Hagino * hostname (returned by gethostname(3)). 1313686cdd19SJun-ichiro itojun Hagino * - the code does wildcard match for truncated names. 1314686cdd19SJun-ichiro itojun Hagino * however, we are not sure if we want to perform 1315686cdd19SJun-ichiro itojun Hagino * wildcard match, if gethostname(3) side has 1316686cdd19SJun-ichiro itojun Hagino * truncated hostname. 1317686cdd19SJun-ichiro itojun Hagino */ 131876ca6f88SJamie Gritton mtx_lock(&pr->pr_mtx); 1319c1f19219SJamie Gritton n = ni6_nametodns(pr->pr_hostname, 1320c1f19219SJamie Gritton strlen(pr->pr_hostname), 0); 132176ca6f88SJamie Gritton mtx_unlock(&pr->pr_mtx); 1322686cdd19SJun-ichiro itojun Hagino if (!n || n->m_next || n->m_len == 0) 1323686cdd19SJun-ichiro itojun Hagino goto bad; 1324a4adf6ccSBjoern A. Zeeb if (m->m_len < off + sizeof(struct icmp6_nodeinfo) + 1325a4adf6ccSBjoern A. Zeeb subjlen) { 1326a4adf6ccSBjoern A. Zeeb m = m_pullup(m, off + 1327a4adf6ccSBjoern A. Zeeb sizeof(struct icmp6_nodeinfo) + subjlen); 1328a61b5cfbSBjoern A. Zeeb if (m == NULL) { 1329a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 1330686cdd19SJun-ichiro itojun Hagino goto bad; 1331a61b5cfbSBjoern A. Zeeb } 1332a4adf6ccSBjoern A. Zeeb } 1333a61b5cfbSBjoern A. Zeeb /* ip6 possibly invalid but not used after. */ 1334a61b5cfbSBjoern A. Zeeb ni6 = (struct icmp6_nodeinfo *)(mtod(m, caddr_t) + off); 1335a61b5cfbSBjoern A. Zeeb subj = (char *)(mtod(m, caddr_t) + off + 1336a61b5cfbSBjoern A. Zeeb sizeof(struct icmp6_nodeinfo)); 1337686cdd19SJun-ichiro itojun Hagino if (!ni6_dnsmatch(subj, subjlen, mtod(n, const char *), 1338686cdd19SJun-ichiro itojun Hagino n->m_len)) { 1339686cdd19SJun-ichiro itojun Hagino goto bad; 1340686cdd19SJun-ichiro itojun Hagino } 1341686cdd19SJun-ichiro itojun Hagino m_freem(n); 1342686cdd19SJun-ichiro itojun Hagino n = NULL; 1343686cdd19SJun-ichiro itojun Hagino break; 1344686cdd19SJun-ichiro itojun Hagino 134533841545SHajimu UMEMOTO case ICMP6_NI_SUBJ_IPV4: /* XXX: to be implemented? */ 1346686cdd19SJun-ichiro itojun Hagino default: 1347686cdd19SJun-ichiro itojun Hagino goto bad; 1348686cdd19SJun-ichiro itojun Hagino } 1349686cdd19SJun-ichiro itojun Hagino break; 1350686cdd19SJun-ichiro itojun Hagino } 1351686cdd19SJun-ichiro itojun Hagino 135233841545SHajimu UMEMOTO /* refuse based on configuration. XXX ICMP6_NI_REFUSED? */ 135333841545SHajimu UMEMOTO switch (qtype) { 135433841545SHajimu UMEMOTO case NI_QTYPE_FQDN: 1355603724d3SBjoern A. Zeeb if ((V_icmp6_nodeinfo & ICMP6_NODEINFO_FQDNOK) == 0) 135633841545SHajimu UMEMOTO goto bad; 135733841545SHajimu UMEMOTO break; 135833841545SHajimu UMEMOTO case NI_QTYPE_NODEADDR: 1359a22adbc6SSUZUKI Shinsuke case NI_QTYPE_IPV4ADDR: 1360603724d3SBjoern A. Zeeb if ((V_icmp6_nodeinfo & ICMP6_NODEINFO_NODEADDROK) == 0) 136133841545SHajimu UMEMOTO goto bad; 136233841545SHajimu UMEMOTO break; 136333841545SHajimu UMEMOTO } 136433841545SHajimu UMEMOTO 136533841545SHajimu UMEMOTO /* guess reply length */ 136633841545SHajimu UMEMOTO switch (qtype) { 136733841545SHajimu UMEMOTO case NI_QTYPE_NOOP: 136833841545SHajimu UMEMOTO break; /* no reply data */ 136933841545SHajimu UMEMOTO case NI_QTYPE_SUPTYPES: 137033841545SHajimu UMEMOTO replylen += sizeof(u_int32_t); 137133841545SHajimu UMEMOTO break; 137233841545SHajimu UMEMOTO case NI_QTYPE_FQDN: 137333841545SHajimu UMEMOTO /* XXX will append an mbuf */ 137433841545SHajimu UMEMOTO replylen += offsetof(struct ni_reply_fqdn, ni_fqdn_namelen); 137533841545SHajimu UMEMOTO break; 137633841545SHajimu UMEMOTO case NI_QTYPE_NODEADDR: 1377c66b5feaSHajimu UMEMOTO addrs = ni6_addrs(ni6, m, &ifp, (struct in6_addr *)subj); 137833841545SHajimu UMEMOTO if ((replylen += addrs * (sizeof(struct in6_addr) + 137933841545SHajimu UMEMOTO sizeof(u_int32_t))) > MCLBYTES) 138033841545SHajimu UMEMOTO replylen = MCLBYTES; /* XXX: will truncate pkt later */ 138133841545SHajimu UMEMOTO break; 1382a22adbc6SSUZUKI Shinsuke case NI_QTYPE_IPV4ADDR: 1383a22adbc6SSUZUKI Shinsuke /* unsupported - should respond with unknown Qtype? */ 1384a22adbc6SSUZUKI Shinsuke break; 138533841545SHajimu UMEMOTO default: 138633841545SHajimu UMEMOTO /* 138733841545SHajimu UMEMOTO * XXX: We must return a reply with the ICMP6 code 138833841545SHajimu UMEMOTO * `unknown Qtype' in this case. However we regard the case 138933841545SHajimu UMEMOTO * as an FQDN query for backward compatibility. 139033841545SHajimu UMEMOTO * Older versions set a random value to this field, 139133841545SHajimu UMEMOTO * so it rarely varies in the defined qtypes. 139233841545SHajimu UMEMOTO * But the mechanism is not reliable... 139333841545SHajimu UMEMOTO * maybe we should obsolete older versions. 139433841545SHajimu UMEMOTO */ 139533841545SHajimu UMEMOTO qtype = NI_QTYPE_FQDN; 139633841545SHajimu UMEMOTO /* XXX will append an mbuf */ 139733841545SHajimu UMEMOTO replylen += offsetof(struct ni_reply_fqdn, ni_fqdn_namelen); 139833841545SHajimu UMEMOTO oldfqdn++; 139933841545SHajimu UMEMOTO break; 140033841545SHajimu UMEMOTO } 140133841545SHajimu UMEMOTO 140210e5acc3SGleb Smirnoff /* Allocate an mbuf to reply. */ 1403686cdd19SJun-ichiro itojun Hagino if (replylen > MCLBYTES) { 140482cd038dSYoshinobu Inoue /* 140533841545SHajimu UMEMOTO * XXX: should we try to allocate more? But MCLBYTES 140633841545SHajimu UMEMOTO * is probably much larger than IPV6_MMTU... 140782cd038dSYoshinobu Inoue */ 140882cd038dSYoshinobu Inoue goto bad; 1409686cdd19SJun-ichiro itojun Hagino } 141010e5acc3SGleb Smirnoff if (replylen > MHLEN) 141110e5acc3SGleb Smirnoff n = m_getcl(M_NOWAIT, m->m_type, M_PKTHDR); 141210e5acc3SGleb Smirnoff else 141310e5acc3SGleb Smirnoff n = m_gethdr(M_NOWAIT, m->m_type); 141410e5acc3SGleb Smirnoff if (n == NULL) { 141510e5acc3SGleb Smirnoff m_freem(m); 141610e5acc3SGleb Smirnoff return (NULL); 141782cd038dSYoshinobu Inoue } 141810e5acc3SGleb Smirnoff m_move_pkthdr(n, m); /* just for recvif and FIB */ 141982cd038dSYoshinobu Inoue n->m_pkthdr.len = n->m_len = replylen; 142082cd038dSYoshinobu Inoue 142182cd038dSYoshinobu Inoue /* copy mbuf header and IPv6 + Node Information base headers */ 142282cd038dSYoshinobu Inoue bcopy(mtod(m, caddr_t), mtod(n, caddr_t), sizeof(struct ip6_hdr)); 142382cd038dSYoshinobu Inoue nni6 = (struct icmp6_nodeinfo *)(mtod(n, struct ip6_hdr *) + 1); 1424686cdd19SJun-ichiro itojun Hagino bcopy((caddr_t)ni6, (caddr_t)nni6, sizeof(struct icmp6_nodeinfo)); 142582cd038dSYoshinobu Inoue 142682cd038dSYoshinobu Inoue /* qtype dependent procedure */ 142782cd038dSYoshinobu Inoue switch (qtype) { 142882cd038dSYoshinobu Inoue case NI_QTYPE_NOOP: 142933841545SHajimu UMEMOTO nni6->ni_code = ICMP6_NI_SUCCESS; 143082cd038dSYoshinobu Inoue nni6->ni_flags = 0; 143182cd038dSYoshinobu Inoue break; 143282cd038dSYoshinobu Inoue case NI_QTYPE_SUPTYPES: 143333841545SHajimu UMEMOTO { 143433841545SHajimu UMEMOTO u_int32_t v; 143533841545SHajimu UMEMOTO nni6->ni_code = ICMP6_NI_SUCCESS; 143633841545SHajimu UMEMOTO nni6->ni_flags = htons(0x0000); /* raw bitmap */ 143733841545SHajimu UMEMOTO /* supports NOOP, SUPTYPES, FQDN, and NODEADDR */ 143833841545SHajimu UMEMOTO v = (u_int32_t)htonl(0x0000000f); 143933841545SHajimu UMEMOTO bcopy(&v, nni6 + 1, sizeof(u_int32_t)); 144082cd038dSYoshinobu Inoue break; 144133841545SHajimu UMEMOTO } 144282cd038dSYoshinobu Inoue case NI_QTYPE_FQDN: 144333841545SHajimu UMEMOTO nni6->ni_code = ICMP6_NI_SUCCESS; 144482cd038dSYoshinobu Inoue fqdn = (struct ni_reply_fqdn *)(mtod(n, caddr_t) + 144506cd0a3fSHajimu UMEMOTO sizeof(struct ip6_hdr) + sizeof(struct icmp6_nodeinfo)); 144682cd038dSYoshinobu Inoue nni6->ni_flags = 0; /* XXX: meaningless TTL */ 144782cd038dSYoshinobu Inoue fqdn->ni_fqdn_ttl = 0; /* ditto. */ 1448686cdd19SJun-ichiro itojun Hagino /* 144976ca6f88SJamie Gritton * XXX do we really have FQDN in hostname? 1450686cdd19SJun-ichiro itojun Hagino */ 145176ca6f88SJamie Gritton mtx_lock(&pr->pr_mtx); 1452c1f19219SJamie Gritton n->m_next = ni6_nametodns(pr->pr_hostname, 1453c1f19219SJamie Gritton strlen(pr->pr_hostname), oldfqdn); 145476ca6f88SJamie Gritton mtx_unlock(&pr->pr_mtx); 1455686cdd19SJun-ichiro itojun Hagino if (n->m_next == NULL) 1456686cdd19SJun-ichiro itojun Hagino goto bad; 1457686cdd19SJun-ichiro itojun Hagino /* XXX we assume that n->m_next is not a chain */ 1458686cdd19SJun-ichiro itojun Hagino if (n->m_next->m_next != NULL) 1459686cdd19SJun-ichiro itojun Hagino goto bad; 1460686cdd19SJun-ichiro itojun Hagino n->m_pkthdr.len += n->m_next->m_len; 146182cd038dSYoshinobu Inoue break; 146282cd038dSYoshinobu Inoue case NI_QTYPE_NODEADDR: 146382cd038dSYoshinobu Inoue { 146482cd038dSYoshinobu Inoue int lenlim, copied; 146582cd038dSYoshinobu Inoue 146633841545SHajimu UMEMOTO nni6->ni_code = ICMP6_NI_SUCCESS; 146733841545SHajimu UMEMOTO n->m_pkthdr.len = n->m_len = 146833841545SHajimu UMEMOTO sizeof(struct ip6_hdr) + sizeof(struct icmp6_nodeinfo); 146933841545SHajimu UMEMOTO lenlim = M_TRAILINGSPACE(n); 147082cd038dSYoshinobu Inoue copied = ni6_store_addrs(ni6, nni6, ifp, lenlim); 147182cd038dSYoshinobu Inoue /* XXX: reset mbuf length */ 147282cd038dSYoshinobu Inoue n->m_pkthdr.len = n->m_len = sizeof(struct ip6_hdr) + 147382cd038dSYoshinobu Inoue sizeof(struct icmp6_nodeinfo) + copied; 147482cd038dSYoshinobu Inoue break; 147582cd038dSYoshinobu Inoue } 147682cd038dSYoshinobu Inoue default: 147782cd038dSYoshinobu Inoue break; /* XXX impossible! */ 147882cd038dSYoshinobu Inoue } 147982cd038dSYoshinobu Inoue 148082cd038dSYoshinobu Inoue nni6->ni_type = ICMP6_NI_REPLY; 1481686cdd19SJun-ichiro itojun Hagino m_freem(m); 148282cd038dSYoshinobu Inoue return (n); 148382cd038dSYoshinobu Inoue 148482cd038dSYoshinobu Inoue bad: 1485686cdd19SJun-ichiro itojun Hagino m_freem(m); 148682cd038dSYoshinobu Inoue if (n) 148782cd038dSYoshinobu Inoue m_freem(n); 148882cd038dSYoshinobu Inoue return (NULL); 148982cd038dSYoshinobu Inoue } 149082cd038dSYoshinobu Inoue 149182cd038dSYoshinobu Inoue /* 1492686cdd19SJun-ichiro itojun Hagino * make a mbuf with DNS-encoded string. no compression support. 1493686cdd19SJun-ichiro itojun Hagino * 1494686cdd19SJun-ichiro itojun Hagino * XXX names with less than 2 dots (like "foo" or "foo.section") will be 1495686cdd19SJun-ichiro itojun Hagino * treated as truncated name (two \0 at the end). this is a wild guess. 14961272577eSXin LI * 14971272577eSXin LI * old - return pascal string if non-zero 1498686cdd19SJun-ichiro itojun Hagino */ 1499686cdd19SJun-ichiro itojun Hagino static struct mbuf * 15001272577eSXin LI ni6_nametodns(const char *name, int namelen, int old) 1501686cdd19SJun-ichiro itojun Hagino { 1502686cdd19SJun-ichiro itojun Hagino struct mbuf *m; 1503686cdd19SJun-ichiro itojun Hagino char *cp, *ep; 1504686cdd19SJun-ichiro itojun Hagino const char *p, *q; 1505686cdd19SJun-ichiro itojun Hagino int i, len, nterm; 1506686cdd19SJun-ichiro itojun Hagino 1507686cdd19SJun-ichiro itojun Hagino if (old) 1508686cdd19SJun-ichiro itojun Hagino len = namelen + 1; 1509686cdd19SJun-ichiro itojun Hagino else 1510686cdd19SJun-ichiro itojun Hagino len = MCLBYTES; 1511686cdd19SJun-ichiro itojun Hagino 15127b07d1beSGleb Smirnoff /* Because MAXHOSTNAMELEN is usually 256, we use cluster mbuf. */ 15137b07d1beSGleb Smirnoff if (len > MLEN) 15147b07d1beSGleb Smirnoff m = m_getcl(M_NOWAIT, MT_DATA, 0); 15157b07d1beSGleb Smirnoff else 15167b07d1beSGleb Smirnoff m = m_get(M_NOWAIT, MT_DATA); 15177b07d1beSGleb Smirnoff if (m == NULL) 1518686cdd19SJun-ichiro itojun Hagino goto fail; 1519686cdd19SJun-ichiro itojun Hagino 1520686cdd19SJun-ichiro itojun Hagino if (old) { 1521686cdd19SJun-ichiro itojun Hagino m->m_len = len; 1522686cdd19SJun-ichiro itojun Hagino *mtod(m, char *) = namelen; 1523686cdd19SJun-ichiro itojun Hagino bcopy(name, mtod(m, char *) + 1, namelen); 1524686cdd19SJun-ichiro itojun Hagino return m; 1525686cdd19SJun-ichiro itojun Hagino } else { 1526686cdd19SJun-ichiro itojun Hagino m->m_len = 0; 1527686cdd19SJun-ichiro itojun Hagino cp = mtod(m, char *); 1528686cdd19SJun-ichiro itojun Hagino ep = mtod(m, char *) + M_TRAILINGSPACE(m); 1529686cdd19SJun-ichiro itojun Hagino 1530686cdd19SJun-ichiro itojun Hagino /* if not certain about my name, return empty buffer */ 1531686cdd19SJun-ichiro itojun Hagino if (namelen == 0) 1532686cdd19SJun-ichiro itojun Hagino return m; 1533686cdd19SJun-ichiro itojun Hagino 1534686cdd19SJun-ichiro itojun Hagino /* 1535686cdd19SJun-ichiro itojun Hagino * guess if it looks like shortened hostname, or FQDN. 1536686cdd19SJun-ichiro itojun Hagino * shortened hostname needs two trailing "\0". 1537686cdd19SJun-ichiro itojun Hagino */ 1538686cdd19SJun-ichiro itojun Hagino i = 0; 1539686cdd19SJun-ichiro itojun Hagino for (p = name; p < name + namelen; p++) { 1540686cdd19SJun-ichiro itojun Hagino if (*p && *p == '.') 1541686cdd19SJun-ichiro itojun Hagino i++; 1542686cdd19SJun-ichiro itojun Hagino } 1543686cdd19SJun-ichiro itojun Hagino if (i < 2) 1544686cdd19SJun-ichiro itojun Hagino nterm = 2; 1545686cdd19SJun-ichiro itojun Hagino else 1546686cdd19SJun-ichiro itojun Hagino nterm = 1; 1547686cdd19SJun-ichiro itojun Hagino 1548686cdd19SJun-ichiro itojun Hagino p = name; 1549686cdd19SJun-ichiro itojun Hagino while (cp < ep && p < name + namelen) { 1550686cdd19SJun-ichiro itojun Hagino i = 0; 1551686cdd19SJun-ichiro itojun Hagino for (q = p; q < name + namelen && *q && *q != '.'; q++) 1552686cdd19SJun-ichiro itojun Hagino i++; 1553686cdd19SJun-ichiro itojun Hagino /* result does not fit into mbuf */ 1554686cdd19SJun-ichiro itojun Hagino if (cp + i + 1 >= ep) 1555686cdd19SJun-ichiro itojun Hagino goto fail; 1556610be6ceSHajimu UMEMOTO /* 1557610be6ceSHajimu UMEMOTO * DNS label length restriction, RFC1035 page 8. 1558610be6ceSHajimu UMEMOTO * "i == 0" case is included here to avoid returning 1559610be6ceSHajimu UMEMOTO * 0-length label on "foo..bar". 1560610be6ceSHajimu UMEMOTO */ 1561610be6ceSHajimu UMEMOTO if (i <= 0 || i >= 64) 1562686cdd19SJun-ichiro itojun Hagino goto fail; 1563686cdd19SJun-ichiro itojun Hagino *cp++ = i; 1564686cdd19SJun-ichiro itojun Hagino bcopy(p, cp, i); 1565686cdd19SJun-ichiro itojun Hagino cp += i; 1566686cdd19SJun-ichiro itojun Hagino p = q; 1567686cdd19SJun-ichiro itojun Hagino if (p < name + namelen && *p == '.') 1568686cdd19SJun-ichiro itojun Hagino p++; 1569686cdd19SJun-ichiro itojun Hagino } 1570686cdd19SJun-ichiro itojun Hagino /* termination */ 1571686cdd19SJun-ichiro itojun Hagino if (cp + nterm >= ep) 1572686cdd19SJun-ichiro itojun Hagino goto fail; 1573686cdd19SJun-ichiro itojun Hagino while (nterm-- > 0) 1574686cdd19SJun-ichiro itojun Hagino *cp++ = '\0'; 1575686cdd19SJun-ichiro itojun Hagino m->m_len = cp - mtod(m, char *); 1576686cdd19SJun-ichiro itojun Hagino return m; 1577686cdd19SJun-ichiro itojun Hagino } 1578686cdd19SJun-ichiro itojun Hagino 1579686cdd19SJun-ichiro itojun Hagino panic("should not reach here"); 1580686cdd19SJun-ichiro itojun Hagino /* NOTREACHED */ 1581686cdd19SJun-ichiro itojun Hagino 1582686cdd19SJun-ichiro itojun Hagino fail: 1583686cdd19SJun-ichiro itojun Hagino if (m) 1584686cdd19SJun-ichiro itojun Hagino m_freem(m); 1585686cdd19SJun-ichiro itojun Hagino return NULL; 1586686cdd19SJun-ichiro itojun Hagino } 1587686cdd19SJun-ichiro itojun Hagino 1588686cdd19SJun-ichiro itojun Hagino /* 1589686cdd19SJun-ichiro itojun Hagino * check if two DNS-encoded string matches. takes care of truncated 1590686cdd19SJun-ichiro itojun Hagino * form (with \0\0 at the end). no compression support. 159133841545SHajimu UMEMOTO * XXX upper/lowercase match (see RFC2065) 1592686cdd19SJun-ichiro itojun Hagino */ 1593686cdd19SJun-ichiro itojun Hagino static int 15941272577eSXin LI ni6_dnsmatch(const char *a, int alen, const char *b, int blen) 1595686cdd19SJun-ichiro itojun Hagino { 1596686cdd19SJun-ichiro itojun Hagino const char *a0, *b0; 1597686cdd19SJun-ichiro itojun Hagino int l; 1598686cdd19SJun-ichiro itojun Hagino 1599686cdd19SJun-ichiro itojun Hagino /* simplest case - need validation? */ 1600686cdd19SJun-ichiro itojun Hagino if (alen == blen && bcmp(a, b, alen) == 0) 1601686cdd19SJun-ichiro itojun Hagino return 1; 1602686cdd19SJun-ichiro itojun Hagino 1603686cdd19SJun-ichiro itojun Hagino a0 = a; 1604686cdd19SJun-ichiro itojun Hagino b0 = b; 1605686cdd19SJun-ichiro itojun Hagino 1606686cdd19SJun-ichiro itojun Hagino /* termination is mandatory */ 1607686cdd19SJun-ichiro itojun Hagino if (alen < 2 || blen < 2) 1608686cdd19SJun-ichiro itojun Hagino return 0; 1609686cdd19SJun-ichiro itojun Hagino if (a0[alen - 1] != '\0' || b0[blen - 1] != '\0') 1610686cdd19SJun-ichiro itojun Hagino return 0; 1611686cdd19SJun-ichiro itojun Hagino alen--; 1612686cdd19SJun-ichiro itojun Hagino blen--; 1613686cdd19SJun-ichiro itojun Hagino 1614686cdd19SJun-ichiro itojun Hagino while (a - a0 < alen && b - b0 < blen) { 1615686cdd19SJun-ichiro itojun Hagino if (a - a0 + 1 > alen || b - b0 + 1 > blen) 1616686cdd19SJun-ichiro itojun Hagino return 0; 1617686cdd19SJun-ichiro itojun Hagino 1618686cdd19SJun-ichiro itojun Hagino if ((signed char)a[0] < 0 || (signed char)b[0] < 0) 1619686cdd19SJun-ichiro itojun Hagino return 0; 1620686cdd19SJun-ichiro itojun Hagino /* we don't support compression yet */ 1621686cdd19SJun-ichiro itojun Hagino if (a[0] >= 64 || b[0] >= 64) 1622686cdd19SJun-ichiro itojun Hagino return 0; 1623686cdd19SJun-ichiro itojun Hagino 1624686cdd19SJun-ichiro itojun Hagino /* truncated case */ 1625686cdd19SJun-ichiro itojun Hagino if (a[0] == 0 && a - a0 == alen - 1) 1626686cdd19SJun-ichiro itojun Hagino return 1; 1627686cdd19SJun-ichiro itojun Hagino if (b[0] == 0 && b - b0 == blen - 1) 1628686cdd19SJun-ichiro itojun Hagino return 1; 1629686cdd19SJun-ichiro itojun Hagino if (a[0] == 0 || b[0] == 0) 1630686cdd19SJun-ichiro itojun Hagino return 0; 1631686cdd19SJun-ichiro itojun Hagino 1632686cdd19SJun-ichiro itojun Hagino if (a[0] != b[0]) 1633686cdd19SJun-ichiro itojun Hagino return 0; 1634686cdd19SJun-ichiro itojun Hagino l = a[0]; 1635686cdd19SJun-ichiro itojun Hagino if (a - a0 + 1 + l > alen || b - b0 + 1 + l > blen) 1636686cdd19SJun-ichiro itojun Hagino return 0; 1637686cdd19SJun-ichiro itojun Hagino if (bcmp(a + 1, b + 1, l) != 0) 1638686cdd19SJun-ichiro itojun Hagino return 0; 1639686cdd19SJun-ichiro itojun Hagino 1640686cdd19SJun-ichiro itojun Hagino a += 1 + l; 1641686cdd19SJun-ichiro itojun Hagino b += 1 + l; 1642686cdd19SJun-ichiro itojun Hagino } 1643686cdd19SJun-ichiro itojun Hagino 1644686cdd19SJun-ichiro itojun Hagino if (a - a0 == alen && b - b0 == blen) 1645686cdd19SJun-ichiro itojun Hagino return 1; 1646686cdd19SJun-ichiro itojun Hagino else 1647686cdd19SJun-ichiro itojun Hagino return 0; 1648686cdd19SJun-ichiro itojun Hagino } 1649686cdd19SJun-ichiro itojun Hagino 1650686cdd19SJun-ichiro itojun Hagino /* 165182cd038dSYoshinobu Inoue * calculate the number of addresses to be returned in the node info reply. 165282cd038dSYoshinobu Inoue */ 165382cd038dSYoshinobu Inoue static int 16541272577eSXin LI ni6_addrs(struct icmp6_nodeinfo *ni6, struct mbuf *m, struct ifnet **ifpp, 16551272577eSXin LI struct in6_addr *subj) 165682cd038dSYoshinobu Inoue { 165733841545SHajimu UMEMOTO struct ifnet *ifp; 165833841545SHajimu UMEMOTO struct in6_ifaddr *ifa6; 165933841545SHajimu UMEMOTO struct ifaddr *ifa; 166082cd038dSYoshinobu Inoue int addrs = 0, addrsofif, iffound = 0; 166133841545SHajimu UMEMOTO int niflags = ni6->ni_flags; 166233841545SHajimu UMEMOTO 1663b8a6e03fSGleb Smirnoff NET_EPOCH_ASSERT(); 1664b8a6e03fSGleb Smirnoff 166533841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_ALL) == 0) { 166633841545SHajimu UMEMOTO switch (ni6->ni_code) { 166733841545SHajimu UMEMOTO case ICMP6_NI_SUBJ_IPV6: 166833841545SHajimu UMEMOTO if (subj == NULL) /* must be impossible... */ 166933841545SHajimu UMEMOTO return (0); 167033841545SHajimu UMEMOTO break; 167133841545SHajimu UMEMOTO default: 167233841545SHajimu UMEMOTO /* 167333841545SHajimu UMEMOTO * XXX: we only support IPv6 subject address for 167433841545SHajimu UMEMOTO * this Qtype. 167533841545SHajimu UMEMOTO */ 167633841545SHajimu UMEMOTO return (0); 167733841545SHajimu UMEMOTO } 167833841545SHajimu UMEMOTO } 167982cd038dSYoshinobu Inoue 16804f6c66ccSMatt Macy CK_STAILQ_FOREACH(ifp, &V_ifnet, if_link) { 168182cd038dSYoshinobu Inoue addrsofif = 0; 1682d7c5a620SMatt Macy CK_STAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) { 168382cd038dSYoshinobu Inoue if (ifa->ifa_addr->sa_family != AF_INET6) 168482cd038dSYoshinobu Inoue continue; 168582cd038dSYoshinobu Inoue ifa6 = (struct in6_ifaddr *)ifa; 168682cd038dSYoshinobu Inoue 168733841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_ALL) == 0 && 1688c66b5feaSHajimu UMEMOTO IN6_ARE_ADDR_EQUAL(subj, &ifa6->ia_addr.sin6_addr)) 168982cd038dSYoshinobu Inoue iffound = 1; 169082cd038dSYoshinobu Inoue 1691686cdd19SJun-ichiro itojun Hagino /* 1692686cdd19SJun-ichiro itojun Hagino * IPv4-mapped addresses can only be returned by a 1693686cdd19SJun-ichiro itojun Hagino * Node Information proxy, since they represent 1694686cdd19SJun-ichiro itojun Hagino * addresses of IPv4-only nodes, which perforce do 1695686cdd19SJun-ichiro itojun Hagino * not implement this protocol. 169633841545SHajimu UMEMOTO * [icmp-name-lookups-07, Section 5.4] 1697686cdd19SJun-ichiro itojun Hagino * So we don't support NI_NODEADDR_FLAG_COMPAT in 1698686cdd19SJun-ichiro itojun Hagino * this function at this moment. 1699686cdd19SJun-ichiro itojun Hagino */ 1700686cdd19SJun-ichiro itojun Hagino 170182cd038dSYoshinobu Inoue /* What do we have to do about ::1? */ 170282cd038dSYoshinobu Inoue switch (in6_addrscope(&ifa6->ia_addr.sin6_addr)) { 170382cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_LINKLOCAL: 170433841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_LINKLOCAL) == 0) 170533841545SHajimu UMEMOTO continue; 170682cd038dSYoshinobu Inoue break; 170782cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_SITELOCAL: 170833841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_SITELOCAL) == 0) 170933841545SHajimu UMEMOTO continue; 171082cd038dSYoshinobu Inoue break; 171182cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_GLOBAL: 171233841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_GLOBAL) == 0) 171333841545SHajimu UMEMOTO continue; 171482cd038dSYoshinobu Inoue break; 171582cd038dSYoshinobu Inoue default: 171682cd038dSYoshinobu Inoue continue; 171782cd038dSYoshinobu Inoue } 171833841545SHajimu UMEMOTO 171933841545SHajimu UMEMOTO /* 172033841545SHajimu UMEMOTO * check if anycast is okay. 172133841545SHajimu UMEMOTO * XXX: just experimental. not in the spec. 172233841545SHajimu UMEMOTO */ 172333841545SHajimu UMEMOTO if ((ifa6->ia6_flags & IN6_IFF_ANYCAST) != 0 && 172433841545SHajimu UMEMOTO (niflags & NI_NODEADDR_FLAG_ANYCAST) == 0) 172533841545SHajimu UMEMOTO continue; /* we need only unicast addresses */ 172633841545SHajimu UMEMOTO if ((ifa6->ia6_flags & IN6_IFF_TEMPORARY) != 0 && 1727603724d3SBjoern A. Zeeb (V_icmp6_nodeinfo & ICMP6_NODEINFO_TMPADDROK) == 0) { 172833841545SHajimu UMEMOTO continue; 172933841545SHajimu UMEMOTO } 173033841545SHajimu UMEMOTO addrsofif++; /* count the address */ 173182cd038dSYoshinobu Inoue } 173282cd038dSYoshinobu Inoue if (iffound) { 173382cd038dSYoshinobu Inoue *ifpp = ifp; 173482cd038dSYoshinobu Inoue return (addrsofif); 173582cd038dSYoshinobu Inoue } 173682cd038dSYoshinobu Inoue 173782cd038dSYoshinobu Inoue addrs += addrsofif; 173882cd038dSYoshinobu Inoue } 173982cd038dSYoshinobu Inoue 174082cd038dSYoshinobu Inoue return (addrs); 174182cd038dSYoshinobu Inoue } 174282cd038dSYoshinobu Inoue 174382cd038dSYoshinobu Inoue static int 17441272577eSXin LI ni6_store_addrs(struct icmp6_nodeinfo *ni6, struct icmp6_nodeinfo *nni6, 17451272577eSXin LI struct ifnet *ifp0, int resid) 174682cd038dSYoshinobu Inoue { 174794e83133SJohn Baldwin struct ifnet *ifp; 174833841545SHajimu UMEMOTO struct in6_ifaddr *ifa6; 174933841545SHajimu UMEMOTO struct ifaddr *ifa; 175033841545SHajimu UMEMOTO struct ifnet *ifp_dep = NULL; 175133841545SHajimu UMEMOTO int copied = 0, allow_deprecated = 0; 175282cd038dSYoshinobu Inoue u_char *cp = (u_char *)(nni6 + 1); 175333841545SHajimu UMEMOTO int niflags = ni6->ni_flags; 175433841545SHajimu UMEMOTO u_int32_t ltime; 175582cd038dSYoshinobu Inoue 1756b8a6e03fSGleb Smirnoff NET_EPOCH_ASSERT(); 1757b8a6e03fSGleb Smirnoff 175833841545SHajimu UMEMOTO if (ifp0 == NULL && !(niflags & NI_NODEADDR_FLAG_ALL)) 175982cd038dSYoshinobu Inoue return (0); /* needless to copy */ 176082cd038dSYoshinobu Inoue 17614f6c66ccSMatt Macy ifp = ifp0 ? ifp0 : CK_STAILQ_FIRST(&V_ifnet); 176233841545SHajimu UMEMOTO again: 17630527d333SHajimu UMEMOTO 17644f6c66ccSMatt Macy for (; ifp; ifp = CK_STAILQ_NEXT(ifp, if_link)) { 1765d7c5a620SMatt Macy CK_STAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) { 176682cd038dSYoshinobu Inoue if (ifa->ifa_addr->sa_family != AF_INET6) 176782cd038dSYoshinobu Inoue continue; 176882cd038dSYoshinobu Inoue ifa6 = (struct in6_ifaddr *)ifa; 176982cd038dSYoshinobu Inoue 177033841545SHajimu UMEMOTO if ((ifa6->ia6_flags & IN6_IFF_DEPRECATED) != 0 && 177133841545SHajimu UMEMOTO allow_deprecated == 0) { 177233841545SHajimu UMEMOTO /* 177333841545SHajimu UMEMOTO * prefererred address should be put before 177433841545SHajimu UMEMOTO * deprecated addresses. 177533841545SHajimu UMEMOTO */ 177633841545SHajimu UMEMOTO 177733841545SHajimu UMEMOTO /* record the interface for later search */ 177833841545SHajimu UMEMOTO if (ifp_dep == NULL) 177933841545SHajimu UMEMOTO ifp_dep = ifp; 178033841545SHajimu UMEMOTO 178182cd038dSYoshinobu Inoue continue; 178206cd0a3fSHajimu UMEMOTO } else if ((ifa6->ia6_flags & IN6_IFF_DEPRECATED) == 0 && 178333841545SHajimu UMEMOTO allow_deprecated != 0) 178433841545SHajimu UMEMOTO continue; /* we now collect deprecated addrs */ 178582cd038dSYoshinobu Inoue 178682cd038dSYoshinobu Inoue /* What do we have to do about ::1? */ 178782cd038dSYoshinobu Inoue switch (in6_addrscope(&ifa6->ia_addr.sin6_addr)) { 178882cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_LINKLOCAL: 178933841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_LINKLOCAL) == 0) 179033841545SHajimu UMEMOTO continue; 179182cd038dSYoshinobu Inoue break; 179282cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_SITELOCAL: 179333841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_SITELOCAL) == 0) 179433841545SHajimu UMEMOTO continue; 179582cd038dSYoshinobu Inoue break; 179682cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_GLOBAL: 179733841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_GLOBAL) == 0) 179833841545SHajimu UMEMOTO continue; 179982cd038dSYoshinobu Inoue break; 180082cd038dSYoshinobu Inoue default: 180182cd038dSYoshinobu Inoue continue; 180282cd038dSYoshinobu Inoue } 180382cd038dSYoshinobu Inoue 180433841545SHajimu UMEMOTO /* 180533841545SHajimu UMEMOTO * check if anycast is okay. 180633841545SHajimu UMEMOTO * XXX: just experimental. not in the spec. 180733841545SHajimu UMEMOTO */ 180833841545SHajimu UMEMOTO if ((ifa6->ia6_flags & IN6_IFF_ANYCAST) != 0 && 180933841545SHajimu UMEMOTO (niflags & NI_NODEADDR_FLAG_ANYCAST) == 0) 181033841545SHajimu UMEMOTO continue; 181133841545SHajimu UMEMOTO if ((ifa6->ia6_flags & IN6_IFF_TEMPORARY) != 0 && 1812603724d3SBjoern A. Zeeb (V_icmp6_nodeinfo & ICMP6_NODEINFO_TMPADDROK) == 0) { 181333841545SHajimu UMEMOTO continue; 181433841545SHajimu UMEMOTO } 181533841545SHajimu UMEMOTO 181633841545SHajimu UMEMOTO /* now we can copy the address */ 181733841545SHajimu UMEMOTO if (resid < sizeof(struct in6_addr) + 181833841545SHajimu UMEMOTO sizeof(u_int32_t)) { 181982cd038dSYoshinobu Inoue /* 182082cd038dSYoshinobu Inoue * We give up much more copy. 182182cd038dSYoshinobu Inoue * Set the truncate flag and return. 182282cd038dSYoshinobu Inoue */ 182306cd0a3fSHajimu UMEMOTO nni6->ni_flags |= NI_NODEADDR_FLAG_TRUNCATE; 182482cd038dSYoshinobu Inoue return (copied); 182582cd038dSYoshinobu Inoue } 182633841545SHajimu UMEMOTO 182733841545SHajimu UMEMOTO /* 182833841545SHajimu UMEMOTO * Set the TTL of the address. 182933841545SHajimu UMEMOTO * The TTL value should be one of the following 183033841545SHajimu UMEMOTO * according to the specification: 183133841545SHajimu UMEMOTO * 183233841545SHajimu UMEMOTO * 1. The remaining lifetime of a DHCP lease on the 183333841545SHajimu UMEMOTO * address, or 183433841545SHajimu UMEMOTO * 2. The remaining Valid Lifetime of a prefix from 183533841545SHajimu UMEMOTO * which the address was derived through Stateless 183633841545SHajimu UMEMOTO * Autoconfiguration. 183733841545SHajimu UMEMOTO * 183833841545SHajimu UMEMOTO * Note that we currently do not support stateful 183933841545SHajimu UMEMOTO * address configuration by DHCPv6, so the former 184033841545SHajimu UMEMOTO * case can't happen. 184133841545SHajimu UMEMOTO */ 184233841545SHajimu UMEMOTO if (ifa6->ia6_lifetime.ia6t_expire == 0) 184333841545SHajimu UMEMOTO ltime = ND6_INFINITE_LIFETIME; 184433841545SHajimu UMEMOTO else { 184533841545SHajimu UMEMOTO if (ifa6->ia6_lifetime.ia6t_expire > 18467d26db17SHiroki Sato time_uptime) 18477d26db17SHiroki Sato ltime = htonl(ifa6->ia6_lifetime.ia6t_expire - time_uptime); 184833841545SHajimu UMEMOTO else 184933841545SHajimu UMEMOTO ltime = 0; 185033841545SHajimu UMEMOTO } 185133841545SHajimu UMEMOTO 185233841545SHajimu UMEMOTO bcopy(<ime, cp, sizeof(u_int32_t)); 185333841545SHajimu UMEMOTO cp += sizeof(u_int32_t); 185433841545SHajimu UMEMOTO 185533841545SHajimu UMEMOTO /* copy the address itself */ 185682cd038dSYoshinobu Inoue bcopy(&ifa6->ia_addr.sin6_addr, cp, 185782cd038dSYoshinobu Inoue sizeof(struct in6_addr)); 18589a4f9608SHajimu UMEMOTO in6_clearscope((struct in6_addr *)cp); /* XXX */ 185982cd038dSYoshinobu Inoue cp += sizeof(struct in6_addr); 186033841545SHajimu UMEMOTO 186133841545SHajimu UMEMOTO resid -= (sizeof(struct in6_addr) + sizeof(u_int32_t)); 186206cd0a3fSHajimu UMEMOTO copied += (sizeof(struct in6_addr) + sizeof(u_int32_t)); 186382cd038dSYoshinobu Inoue } 186482cd038dSYoshinobu Inoue if (ifp0) /* we need search only on the specified IF */ 186582cd038dSYoshinobu Inoue break; 186682cd038dSYoshinobu Inoue } 186782cd038dSYoshinobu Inoue 186833841545SHajimu UMEMOTO if (allow_deprecated == 0 && ifp_dep != NULL) { 186933841545SHajimu UMEMOTO ifp = ifp_dep; 187033841545SHajimu UMEMOTO allow_deprecated = 1; 187133841545SHajimu UMEMOTO 187233841545SHajimu UMEMOTO goto again; 187333841545SHajimu UMEMOTO } 187433841545SHajimu UMEMOTO 187582cd038dSYoshinobu Inoue return (copied); 187682cd038dSYoshinobu Inoue } 187782cd038dSYoshinobu Inoue 187882cd038dSYoshinobu Inoue /* 187982cd038dSYoshinobu Inoue * XXX almost dup'ed code with rip6_input. 188082cd038dSYoshinobu Inoue */ 188182cd038dSYoshinobu Inoue static int 18821272577eSXin LI icmp6_rip6_input(struct mbuf **mp, int off) 188382cd038dSYoshinobu Inoue { 188482cd038dSYoshinobu Inoue struct mbuf *m = *mp; 188533841545SHajimu UMEMOTO struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *); 18860ecd976eSBjoern A. Zeeb struct inpcb *inp; 1887fc384fa5SBjoern A. Zeeb struct inpcb *last = NULL; 18889a4f9608SHajimu UMEMOTO struct sockaddr_in6 fromsa; 188982cd038dSYoshinobu Inoue struct icmp6_hdr *icmp6; 189082cd038dSYoshinobu Inoue struct mbuf *opts = NULL; 189182cd038dSYoshinobu Inoue 1892cf377af6SGleb Smirnoff NET_EPOCH_ASSERT(); 1893cf377af6SGleb Smirnoff 1894a61b5cfbSBjoern A. Zeeb /* This is assumed to be safe; icmp6_input() does a pullup. */ 189582cd038dSYoshinobu Inoue icmp6 = (struct icmp6_hdr *)((caddr_t)ip6 + off); 189682cd038dSYoshinobu Inoue 1897a1f7e5f8SHajimu UMEMOTO /* 1898a1f7e5f8SHajimu UMEMOTO * XXX: the address may have embedded scope zone ID, which should be 1899a1f7e5f8SHajimu UMEMOTO * hidden from applications. 1900a1f7e5f8SHajimu UMEMOTO */ 19019a4f9608SHajimu UMEMOTO bzero(&fromsa, sizeof(fromsa)); 19029a4f9608SHajimu UMEMOTO fromsa.sin6_family = AF_INET6; 1903a1f7e5f8SHajimu UMEMOTO fromsa.sin6_len = sizeof(struct sockaddr_in6); 1904a1f7e5f8SHajimu UMEMOTO fromsa.sin6_addr = ip6->ip6_src; 1905a1f7e5f8SHajimu UMEMOTO if (sa6_recoverscope(&fromsa)) { 1906a1f7e5f8SHajimu UMEMOTO m_freem(m); 1907a8fe77d8SBjoern A. Zeeb *mp = NULL; 1908a1f7e5f8SHajimu UMEMOTO return (IPPROTO_DONE); 1909a1f7e5f8SHajimu UMEMOTO } 191082cd038dSYoshinobu Inoue 19110ecd976eSBjoern A. Zeeb CK_LIST_FOREACH(inp, &V_ripcb, inp_list) { 19120ecd976eSBjoern A. Zeeb if ((inp->inp_vflag & INP_IPV6) == 0) 191382cd038dSYoshinobu Inoue continue; 19140ecd976eSBjoern A. Zeeb if (inp->inp_ip_p != IPPROTO_ICMPV6) 1915b11e21aeSAlexander Motin continue; 19160ecd976eSBjoern A. Zeeb if (!IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr) && 19170ecd976eSBjoern A. Zeeb !IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr, &ip6->ip6_dst)) 1918b11e21aeSAlexander Motin continue; 19190ecd976eSBjoern A. Zeeb if (!IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_faddr) && 19200ecd976eSBjoern A. Zeeb !IN6_ARE_ADDR_EQUAL(&inp->in6p_faddr, &ip6->ip6_src)) 1921b11e21aeSAlexander Motin continue; 19220ecd976eSBjoern A. Zeeb INP_RLOCK(inp); 19230ecd976eSBjoern A. Zeeb if (__predict_false(inp->inp_flags2 & INP_FREED)) { 19240ecd976eSBjoern A. Zeeb INP_RUNLOCK(inp); 19256675bee8SBjoern A. Zeeb continue; 19266675bee8SBjoern A. Zeeb } 19272f1ff0cdSRobert Watson if (ICMP6_FILTER_WILLBLOCK(icmp6->icmp6_type, 19280ecd976eSBjoern A. Zeeb inp->in6p_icmp6filt)) { 19290ecd976eSBjoern A. Zeeb INP_RUNLOCK(inp); 1930b11e21aeSAlexander Motin continue; 19316c5bbf5cSAlexander Motin } 1932aba53ef0SKip Macy if (last != NULL) { 1933657db3c8SHajimu UMEMOTO struct mbuf *n = NULL; 1934657db3c8SHajimu UMEMOTO 1935657db3c8SHajimu UMEMOTO /* 1936657db3c8SHajimu UMEMOTO * Recent network drivers tend to allocate a single 1937657db3c8SHajimu UMEMOTO * mbuf cluster, rather than to make a couple of 1938657db3c8SHajimu UMEMOTO * mbufs without clusters. Also, since the IPv6 code 1939657db3c8SHajimu UMEMOTO * path tries to avoid m_pullup(), it is highly 1940657db3c8SHajimu UMEMOTO * probable that we still have an mbuf cluster here 1941657db3c8SHajimu UMEMOTO * even though the necessary length can be stored in an 1942657db3c8SHajimu UMEMOTO * mbuf's internal buffer. 1943657db3c8SHajimu UMEMOTO * Meanwhile, the default size of the receive socket 1944657db3c8SHajimu UMEMOTO * buffer for raw sockets is not so large. This means 1945657db3c8SHajimu UMEMOTO * the possibility of packet loss is relatively higher 1946657db3c8SHajimu UMEMOTO * than before. To avoid this scenario, we copy the 1947657db3c8SHajimu UMEMOTO * received data to a separate mbuf that does not use 1948657db3c8SHajimu UMEMOTO * a cluster, if possible. 1949657db3c8SHajimu UMEMOTO * XXX: it is better to copy the data after stripping 1950657db3c8SHajimu UMEMOTO * intermediate headers. 1951657db3c8SHajimu UMEMOTO */ 1952657db3c8SHajimu UMEMOTO if ((m->m_flags & M_EXT) && m->m_next == NULL && 1953657db3c8SHajimu UMEMOTO m->m_len <= MHLEN) { 19547b07d1beSGleb Smirnoff n = m_get(M_NOWAIT, m->m_type); 1955657db3c8SHajimu UMEMOTO if (n != NULL) { 1956c543ec4eSGeorge V. Neville-Neil if (m_dup_pkthdr(n, m, M_NOWAIT)) { 1957c543ec4eSGeorge V. Neville-Neil bcopy(m->m_data, n->m_data, 1958c543ec4eSGeorge V. Neville-Neil m->m_len); 1959657db3c8SHajimu UMEMOTO n->m_len = m->m_len; 1960c543ec4eSGeorge V. Neville-Neil } else { 1961c543ec4eSGeorge V. Neville-Neil m_free(n); 1962c543ec4eSGeorge V. Neville-Neil n = NULL; 1963c543ec4eSGeorge V. Neville-Neil } 1964657db3c8SHajimu UMEMOTO } 1965657db3c8SHajimu UMEMOTO } 1966657db3c8SHajimu UMEMOTO if (n != NULL || 1967c3bef61eSKevin Lo (n = m_copym(m, 0, M_COPYALL, M_NOWAIT)) != NULL) { 196897590249SBjoern A. Zeeb if (last->inp_flags & INP_CONTROLOPTS) 196911de19f4SHajimu UMEMOTO ip6_savecontrol(last, n, &opts); 197082cd038dSYoshinobu Inoue /* strip intermediate headers */ 197182cd038dSYoshinobu Inoue m_adj(n, off); 1972fc384fa5SBjoern A. Zeeb SOCKBUF_LOCK(&last->inp_socket->so_rcv); 1973c9db0fadSRobert Watson if (sbappendaddr_locked( 1974fc384fa5SBjoern A. Zeeb &last->inp_socket->so_rcv, 19759a4f9608SHajimu UMEMOTO (struct sockaddr *)&fromsa, n, opts) 197606cd0a3fSHajimu UMEMOTO == 0) { 197782cd038dSYoshinobu Inoue /* should notify about lost packet */ 197882cd038dSYoshinobu Inoue m_freem(n); 197933841545SHajimu UMEMOTO if (opts) { 198082cd038dSYoshinobu Inoue m_freem(opts); 198133841545SHajimu UMEMOTO } 1982c9db0fadSRobert Watson SOCKBUF_UNLOCK( 1983fc384fa5SBjoern A. Zeeb &last->inp_socket->so_rcv); 19844cc20ab1SSeigo Tanimura } else 1985fc384fa5SBjoern A. Zeeb sorwakeup_locked(last->inp_socket); 198682cd038dSYoshinobu Inoue opts = NULL; 198782cd038dSYoshinobu Inoue } 1988bb145f60SRobert Watson INP_RUNLOCK(last); 198982cd038dSYoshinobu Inoue } 19900ecd976eSBjoern A. Zeeb last = inp; 199182cd038dSYoshinobu Inoue } 1992aba53ef0SKip Macy if (last != NULL) { 199397590249SBjoern A. Zeeb if (last->inp_flags & INP_CONTROLOPTS) 199411de19f4SHajimu UMEMOTO ip6_savecontrol(last, m, &opts); 199582cd038dSYoshinobu Inoue /* strip intermediate headers */ 199682cd038dSYoshinobu Inoue m_adj(m, off); 1997657db3c8SHajimu UMEMOTO 1998657db3c8SHajimu UMEMOTO /* avoid using mbuf clusters if possible (see above) */ 1999657db3c8SHajimu UMEMOTO if ((m->m_flags & M_EXT) && m->m_next == NULL && 2000657db3c8SHajimu UMEMOTO m->m_len <= MHLEN) { 2001657db3c8SHajimu UMEMOTO struct mbuf *n; 2002657db3c8SHajimu UMEMOTO 20037b07d1beSGleb Smirnoff n = m_get(M_NOWAIT, m->m_type); 2004657db3c8SHajimu UMEMOTO if (n != NULL) { 2005c543ec4eSGeorge V. Neville-Neil if (m_dup_pkthdr(n, m, M_NOWAIT)) { 2006657db3c8SHajimu UMEMOTO bcopy(m->m_data, n->m_data, m->m_len); 2007657db3c8SHajimu UMEMOTO n->m_len = m->m_len; 2008657db3c8SHajimu UMEMOTO 2009657db3c8SHajimu UMEMOTO m_freem(m); 2010657db3c8SHajimu UMEMOTO m = n; 2011c543ec4eSGeorge V. Neville-Neil } else { 2012c543ec4eSGeorge V. Neville-Neil m_freem(n); 2013c543ec4eSGeorge V. Neville-Neil n = NULL; 2014c543ec4eSGeorge V. Neville-Neil } 2015657db3c8SHajimu UMEMOTO } 2016657db3c8SHajimu UMEMOTO } 2017fc384fa5SBjoern A. Zeeb SOCKBUF_LOCK(&last->inp_socket->so_rcv); 2018fc384fa5SBjoern A. Zeeb if (sbappendaddr_locked(&last->inp_socket->so_rcv, 20199a4f9608SHajimu UMEMOTO (struct sockaddr *)&fromsa, m, opts) == 0) { 202082cd038dSYoshinobu Inoue m_freem(m); 202182cd038dSYoshinobu Inoue if (opts) 202282cd038dSYoshinobu Inoue m_freem(opts); 2023fc384fa5SBjoern A. Zeeb SOCKBUF_UNLOCK(&last->inp_socket->so_rcv); 20244cc20ab1SSeigo Tanimura } else 2025fc384fa5SBjoern A. Zeeb sorwakeup_locked(last->inp_socket); 2026bb145f60SRobert Watson INP_RUNLOCK(last); 202782cd038dSYoshinobu Inoue } else { 202882cd038dSYoshinobu Inoue m_freem(m); 202933cde130SBruce M Simpson IP6STAT_DEC(ip6s_delivered); 203082cd038dSYoshinobu Inoue } 2031a8fe77d8SBjoern A. Zeeb *mp = NULL; 2032a8fe77d8SBjoern A. Zeeb return (IPPROTO_DONE); 203382cd038dSYoshinobu Inoue } 203482cd038dSYoshinobu Inoue 203582cd038dSYoshinobu Inoue /* 203682cd038dSYoshinobu Inoue * Reflect the ip6 packet back to the source. 2037686cdd19SJun-ichiro itojun Hagino * OFF points to the icmp6 header, counted from the top of the mbuf. 203882cd038dSYoshinobu Inoue */ 20390700d2c3SBjoern A. Zeeb static void 20401272577eSXin LI icmp6_reflect(struct mbuf *m, size_t off) 204182cd038dSYoshinobu Inoue { 2042ab861e6cSAlexander V. Chernikov struct in6_addr src6, *srcp; 2043686cdd19SJun-ichiro itojun Hagino struct ip6_hdr *ip6; 204482cd038dSYoshinobu Inoue struct icmp6_hdr *icmp6; 20458c0fec80SRobert Watson struct in6_ifaddr *ia = NULL; 20463e88eb90SAndrey V. Elsukov struct ifnet *outif = NULL; 2047686cdd19SJun-ichiro itojun Hagino int plen; 2048ab861e6cSAlexander V. Chernikov int type, code, hlim; 204982cd038dSYoshinobu Inoue 2050686cdd19SJun-ichiro itojun Hagino /* too short to reflect */ 2051686cdd19SJun-ichiro itojun Hagino if (off < sizeof(struct ip6_hdr)) { 205233841545SHajimu UMEMOTO nd6log((LOG_DEBUG, 205333841545SHajimu UMEMOTO "sanity fail: off=%lx, sizeof(ip6)=%lx in %s:%d\n", 2054686cdd19SJun-ichiro itojun Hagino (u_long)off, (u_long)sizeof(struct ip6_hdr), 205533841545SHajimu UMEMOTO __FILE__, __LINE__)); 2056686cdd19SJun-ichiro itojun Hagino goto bad; 2057686cdd19SJun-ichiro itojun Hagino } 2058686cdd19SJun-ichiro itojun Hagino 205982cd038dSYoshinobu Inoue /* 206082cd038dSYoshinobu Inoue * If there are extra headers between IPv6 and ICMPv6, strip 206182cd038dSYoshinobu Inoue * off that header first. 206282cd038dSYoshinobu Inoue */ 2063686cdd19SJun-ichiro itojun Hagino #ifdef DIAGNOSTIC 2064686cdd19SJun-ichiro itojun Hagino if (sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr) > MHLEN) 2065686cdd19SJun-ichiro itojun Hagino panic("assumption failed in icmp6_reflect"); 2066686cdd19SJun-ichiro itojun Hagino #endif 2067686cdd19SJun-ichiro itojun Hagino if (off > sizeof(struct ip6_hdr)) { 2068686cdd19SJun-ichiro itojun Hagino size_t l; 2069686cdd19SJun-ichiro itojun Hagino struct ip6_hdr nip6; 207082cd038dSYoshinobu Inoue 2071686cdd19SJun-ichiro itojun Hagino l = off - sizeof(struct ip6_hdr); 2072686cdd19SJun-ichiro itojun Hagino m_copydata(m, 0, sizeof(nip6), (caddr_t)&nip6); 2073686cdd19SJun-ichiro itojun Hagino m_adj(m, l); 2074686cdd19SJun-ichiro itojun Hagino l = sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr); 2075686cdd19SJun-ichiro itojun Hagino if (m->m_len < l) { 2076686cdd19SJun-ichiro itojun Hagino if ((m = m_pullup(m, l)) == NULL) 2077686cdd19SJun-ichiro itojun Hagino return; 207882cd038dSYoshinobu Inoue } 2079686cdd19SJun-ichiro itojun Hagino bcopy((caddr_t)&nip6, mtod(m, caddr_t), sizeof(nip6)); 2080686cdd19SJun-ichiro itojun Hagino } else /* off == sizeof(struct ip6_hdr) */ { 2081686cdd19SJun-ichiro itojun Hagino size_t l; 2082686cdd19SJun-ichiro itojun Hagino l = sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr); 2083686cdd19SJun-ichiro itojun Hagino if (m->m_len < l) { 2084686cdd19SJun-ichiro itojun Hagino if ((m = m_pullup(m, l)) == NULL) 2085686cdd19SJun-ichiro itojun Hagino return; 208682cd038dSYoshinobu Inoue } 2087686cdd19SJun-ichiro itojun Hagino } 2088686cdd19SJun-ichiro itojun Hagino plen = m->m_pkthdr.len - sizeof(struct ip6_hdr); 208982cd038dSYoshinobu Inoue ip6 = mtod(m, struct ip6_hdr *); 209082cd038dSYoshinobu Inoue ip6->ip6_nxt = IPPROTO_ICMPV6; 209182cd038dSYoshinobu Inoue icmp6 = (struct icmp6_hdr *)(ip6 + 1); 209282cd038dSYoshinobu Inoue type = icmp6->icmp6_type; /* keep type for statistics */ 209382cd038dSYoshinobu Inoue code = icmp6->icmp6_code; /* ditto. */ 2094ab861e6cSAlexander V. Chernikov hlim = 0; 2095ab861e6cSAlexander V. Chernikov srcp = NULL; 209682cd038dSYoshinobu Inoue 209782cd038dSYoshinobu Inoue /* 209882cd038dSYoshinobu Inoue * If the incoming packet was addressed directly to us (i.e. unicast), 209982cd038dSYoshinobu Inoue * use dst as the src for the reply. 210006cd0a3fSHajimu UMEMOTO * The IN6_IFF_NOTREADY case should be VERY rare, but is possible 2101686cdd19SJun-ichiro itojun Hagino * (for example) when we encounter an error while forwarding procedure 2102686cdd19SJun-ichiro itojun Hagino * destined to a duplicated address of ours. 210382cd038dSYoshinobu Inoue */ 21043e88eb90SAndrey V. Elsukov if (!IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) { 21053e88eb90SAndrey V. Elsukov ia = in6ifa_ifwithaddr(&ip6->ip6_dst, 0 /* XXX */); 21063e88eb90SAndrey V. Elsukov if (ia != NULL && !(ia->ia6_flags & 2107ab861e6cSAlexander V. Chernikov (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY))) { 2108ab861e6cSAlexander V. Chernikov src6 = ia->ia_addr.sin6_addr; 2109ab861e6cSAlexander V. Chernikov srcp = &src6; 2110ab861e6cSAlexander V. Chernikov 2111ab861e6cSAlexander V. Chernikov if (m->m_pkthdr.rcvif != NULL) { 2112ab861e6cSAlexander V. Chernikov /* XXX: This may not be the outgoing interface */ 2113ab861e6cSAlexander V. Chernikov hlim = ND_IFINFO(m->m_pkthdr.rcvif)->chlim; 2114ab861e6cSAlexander V. Chernikov } else 2115ab861e6cSAlexander V. Chernikov hlim = V_ip6_defhlim; 2116ab861e6cSAlexander V. Chernikov } 2117ab861e6cSAlexander V. Chernikov if (ia != NULL) 2118ab861e6cSAlexander V. Chernikov ifa_free(&ia->ia_ifa); 211982cd038dSYoshinobu Inoue } 212082cd038dSYoshinobu Inoue 212188d166bfSBjoern A. Zeeb if (srcp == NULL) { 2122601c0b8bSAlexander V. Chernikov int error; 2123601c0b8bSAlexander V. Chernikov struct in6_addr dst6; 2124601c0b8bSAlexander V. Chernikov uint32_t scopeid; 212533841545SHajimu UMEMOTO 212682cd038dSYoshinobu Inoue /* 2127686cdd19SJun-ichiro itojun Hagino * This case matches to multicasts, our anycast, or unicasts 212833841545SHajimu UMEMOTO * that we do not own. Select a source address based on the 212933841545SHajimu UMEMOTO * source address of the erroneous packet. 213082cd038dSYoshinobu Inoue */ 21315a03e781SAndrey V. Elsukov in6_splitscope(&ip6->ip6_src, &dst6, &scopeid); 2132559b4296SAlan Somers error = in6_selectsrc_addr(M_GETFIB(m), &dst6, 2133601c0b8bSAlexander V. Chernikov scopeid, NULL, &src6, &hlim); 2134a1f7e5f8SHajimu UMEMOTO 2135601c0b8bSAlexander V. Chernikov if (error) { 21361d54aa3bSBjoern A. Zeeb char ip6buf[INET6_ADDRSTRLEN]; 213733841545SHajimu UMEMOTO nd6log((LOG_DEBUG, 213833841545SHajimu UMEMOTO "icmp6_reflect: source can't be determined: " 213933841545SHajimu UMEMOTO "dst=%s, error=%d\n", 2140601c0b8bSAlexander V. Chernikov ip6_sprintf(ip6buf, &ip6->ip6_dst), error)); 214182cd038dSYoshinobu Inoue goto bad; 214233841545SHajimu UMEMOTO } 2143ab861e6cSAlexander V. Chernikov srcp = &src6; 214433841545SHajimu UMEMOTO } 21453e88eb90SAndrey V. Elsukov /* 21463e88eb90SAndrey V. Elsukov * ip6_input() drops a packet if its src is multicast. 21473e88eb90SAndrey V. Elsukov * So, the src is never multicast. 21483e88eb90SAndrey V. Elsukov */ 21493e88eb90SAndrey V. Elsukov ip6->ip6_dst = ip6->ip6_src; 215088d166bfSBjoern A. Zeeb ip6->ip6_src = *srcp; 215182cd038dSYoshinobu Inoue ip6->ip6_flow = 0; 2152686cdd19SJun-ichiro itojun Hagino ip6->ip6_vfc &= ~IPV6_VERSION_MASK; 2153686cdd19SJun-ichiro itojun Hagino ip6->ip6_vfc |= IPV6_VERSION; 215482cd038dSYoshinobu Inoue ip6->ip6_nxt = IPPROTO_ICMPV6; 2155ab861e6cSAlexander V. Chernikov ip6->ip6_hlim = hlim; 215682cd038dSYoshinobu Inoue 215782cd038dSYoshinobu Inoue icmp6->icmp6_cksum = 0; 215882cd038dSYoshinobu Inoue icmp6->icmp6_cksum = in6_cksum(m, IPPROTO_ICMPV6, 215982cd038dSYoshinobu Inoue sizeof(struct ip6_hdr), plen); 216082cd038dSYoshinobu Inoue 216182cd038dSYoshinobu Inoue /* 216233841545SHajimu UMEMOTO * XXX option handling 216382cd038dSYoshinobu Inoue */ 216482cd038dSYoshinobu Inoue 216582cd038dSYoshinobu Inoue m->m_flags &= ~(M_BCAST|M_MCAST); 2166849eeaa5SAndrey V. Elsukov m->m_pkthdr.rcvif = NULL; 21675d846453SSam Leffler ip6_output(m, NULL, NULL, 0, NULL, &outif, NULL); 216882cd038dSYoshinobu Inoue if (outif) 216982cd038dSYoshinobu Inoue icmp6_ifoutstat_inc(outif, type, code); 217082cd038dSYoshinobu Inoue 217182cd038dSYoshinobu Inoue return; 217282cd038dSYoshinobu Inoue 217382cd038dSYoshinobu Inoue bad: 217482cd038dSYoshinobu Inoue m_freem(m); 217582cd038dSYoshinobu Inoue return; 217682cd038dSYoshinobu Inoue } 217782cd038dSYoshinobu Inoue 217882cd038dSYoshinobu Inoue void 21791272577eSXin LI icmp6_fasttimo(void) 218082cd038dSYoshinobu Inoue { 2181686cdd19SJun-ichiro itojun Hagino 218233cde130SBruce M Simpson mld_fasttimo(); 218333cde130SBruce M Simpson } 218433cde130SBruce M Simpson 218533cde130SBruce M Simpson void 218633cde130SBruce M Simpson icmp6_slowtimo(void) 218733cde130SBruce M Simpson { 218833cde130SBruce M Simpson 218933cde130SBruce M Simpson mld_slowtimo(); 219082cd038dSYoshinobu Inoue } 219182cd038dSYoshinobu Inoue 219282cd038dSYoshinobu Inoue static const char * 21931272577eSXin LI icmp6_redirect_diag(struct in6_addr *src6, struct in6_addr *dst6, 21941272577eSXin LI struct in6_addr *tgt6) 219582cd038dSYoshinobu Inoue { 219682cd038dSYoshinobu Inoue static char buf[1024]; 21971d54aa3bSBjoern A. Zeeb char ip6bufs[INET6_ADDRSTRLEN]; 21981d54aa3bSBjoern A. Zeeb char ip6bufd[INET6_ADDRSTRLEN]; 21991d54aa3bSBjoern A. Zeeb char ip6buft[INET6_ADDRSTRLEN]; 220082cd038dSYoshinobu Inoue snprintf(buf, sizeof(buf), "(src=%s dst=%s tgt=%s)", 22011d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6bufs, src6), ip6_sprintf(ip6bufd, dst6), 22021d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6buft, tgt6)); 220382cd038dSYoshinobu Inoue return buf; 220482cd038dSYoshinobu Inoue } 220582cd038dSYoshinobu Inoue 220682cd038dSYoshinobu Inoue void 22071272577eSXin LI icmp6_redirect_input(struct mbuf *m, int off) 220882cd038dSYoshinobu Inoue { 22092cb64cb2SGeorge V. Neville-Neil struct ifnet *ifp; 2210503f4e47SBjoern A. Zeeb struct ip6_hdr *ip6; 2211686cdd19SJun-ichiro itojun Hagino struct nd_redirect *nd_rd; 2212a61b5cfbSBjoern A. Zeeb struct in6_addr src6, redtgt6, reddst6; 221382cd038dSYoshinobu Inoue union nd_opts ndopts; 22141d54aa3bSBjoern A. Zeeb char ip6buf[INET6_ADDRSTRLEN]; 2215503f4e47SBjoern A. Zeeb char *lladdr; 2216503f4e47SBjoern A. Zeeb int icmp6len, is_onlink, is_router, lladdrlen; 221782cd038dSYoshinobu Inoue 221837c1ff48SGleb Smirnoff M_ASSERTPKTHDR(m); 221937c1ff48SGleb Smirnoff KASSERT(m->m_pkthdr.rcvif != NULL, ("%s: no rcvif", __func__)); 22202cb64cb2SGeorge V. Neville-Neil 222182cd038dSYoshinobu Inoue /* XXX if we are router, we don't update route by icmp6 redirect */ 2222603724d3SBjoern A. Zeeb if (V_ip6_forwarding) 2223686cdd19SJun-ichiro itojun Hagino goto freeit; 2224603724d3SBjoern A. Zeeb if (!V_icmp6_rediraccept) 2225686cdd19SJun-ichiro itojun Hagino goto freeit; 2226686cdd19SJun-ichiro itojun Hagino 2227a4061289SAndrey V. Elsukov /* RFC 6980: Nodes MUST silently ignore fragments */ 2228a4061289SAndrey V. Elsukov if(m->m_flags & M_FRAGMENTED) 2229a4061289SAndrey V. Elsukov goto freeit; 2230a4061289SAndrey V. Elsukov 2231503f4e47SBjoern A. Zeeb ip6 = mtod(m, struct ip6_hdr *); 2232503f4e47SBjoern A. Zeeb icmp6len = ntohs(ip6->ip6_plen); 2233a4adf6ccSBjoern A. Zeeb if (m->m_len < off + icmp6len) { 2234a61b5cfbSBjoern A. Zeeb m = m_pullup(m, off + icmp6len); 2235a61b5cfbSBjoern A. Zeeb if (m == NULL) { 2236a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 223782cd038dSYoshinobu Inoue return; 2238686cdd19SJun-ichiro itojun Hagino } 2239a4adf6ccSBjoern A. Zeeb } 2240a61b5cfbSBjoern A. Zeeb ip6 = mtod(m, struct ip6_hdr *); 2241a61b5cfbSBjoern A. Zeeb nd_rd = (struct nd_redirect *)((caddr_t)ip6 + off); 2242503f4e47SBjoern A. Zeeb 2243503f4e47SBjoern A. Zeeb ifp = m->m_pkthdr.rcvif; 2244686cdd19SJun-ichiro itojun Hagino redtgt6 = nd_rd->nd_rd_target; 2245686cdd19SJun-ichiro itojun Hagino reddst6 = nd_rd->nd_rd_dst; 224682cd038dSYoshinobu Inoue 2247503f4e47SBjoern A. Zeeb if (in6_setscope(&redtgt6, ifp, NULL) || 2248503f4e47SBjoern A. Zeeb in6_setscope(&reddst6, ifp, NULL)) { 2249a1f7e5f8SHajimu UMEMOTO goto freeit; 2250a1f7e5f8SHajimu UMEMOTO } 225182cd038dSYoshinobu Inoue 225282cd038dSYoshinobu Inoue /* validation */ 2253503f4e47SBjoern A. Zeeb src6 = ip6->ip6_src; 225482cd038dSYoshinobu Inoue if (!IN6_IS_ADDR_LINKLOCAL(&src6)) { 225533841545SHajimu UMEMOTO nd6log((LOG_ERR, 225682cd038dSYoshinobu Inoue "ICMP6 redirect sent from %s rejected; " 225706cd0a3fSHajimu UMEMOTO "must be from linklocal\n", 22581d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6buf, &src6))); 225933841545SHajimu UMEMOTO goto bad; 226082cd038dSYoshinobu Inoue } 226182cd038dSYoshinobu Inoue if (ip6->ip6_hlim != 255) { 226233841545SHajimu UMEMOTO nd6log((LOG_ERR, 226382cd038dSYoshinobu Inoue "ICMP6 redirect sent from %s rejected; " 226482cd038dSYoshinobu Inoue "hlim=%d (must be 255)\n", 22651d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6buf, &src6), ip6->ip6_hlim)); 226633841545SHajimu UMEMOTO goto bad; 226782cd038dSYoshinobu Inoue } 226882cd038dSYoshinobu Inoue { 226982cd038dSYoshinobu Inoue /* ip6->ip6_src must be equal to gw for icmp6->icmp6_reddst */ 22709977be4aSAlexander V. Chernikov struct nhop6_basic nh6; 22719977be4aSAlexander V. Chernikov struct in6_addr kdst; 22729977be4aSAlexander V. Chernikov uint32_t scopeid; 227382cd038dSYoshinobu Inoue 22749977be4aSAlexander V. Chernikov in6_splitscope(&reddst6, &kdst, &scopeid); 2275559b4296SAlan Somers if (fib6_lookup_nh_basic(ifp->if_fib, &kdst, scopeid, 0, 0,&nh6)==0){ 22769977be4aSAlexander V. Chernikov if ((nh6.nh_flags & NHF_GATEWAY) == 0) { 227733841545SHajimu UMEMOTO nd6log((LOG_ERR, 2278deebc913SHajimu UMEMOTO "ICMP6 redirect rejected; no route " 2279deebc913SHajimu UMEMOTO "with inet6 gateway found for redirect dst: %s\n", 228033841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 228133841545SHajimu UMEMOTO goto bad; 2282deebc913SHajimu UMEMOTO } 2283deebc913SHajimu UMEMOTO 228443105e58SEric van Gyzen /* 228543105e58SEric van Gyzen * Embed scope zone id into next hop address, since 228643105e58SEric van Gyzen * fib6_lookup_nh_basic() returns address without embedded 228743105e58SEric van Gyzen * scope zone id. 228843105e58SEric van Gyzen */ 228943105e58SEric van Gyzen if (in6_setscope(&nh6.nh_addr, m->m_pkthdr.rcvif, NULL)) 229043105e58SEric van Gyzen goto freeit; 229143105e58SEric van Gyzen 22929977be4aSAlexander V. Chernikov if (IN6_ARE_ADDR_EQUAL(&src6, &nh6.nh_addr) == 0) { 229333841545SHajimu UMEMOTO nd6log((LOG_ERR, 229482cd038dSYoshinobu Inoue "ICMP6 redirect rejected; " 229582cd038dSYoshinobu Inoue "not equal to gw-for-src=%s (must be same): " 229682cd038dSYoshinobu Inoue "%s\n", 22979977be4aSAlexander V. Chernikov ip6_sprintf(ip6buf, &nh6.nh_addr), 229833841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 229933841545SHajimu UMEMOTO goto bad; 230082cd038dSYoshinobu Inoue } 230182cd038dSYoshinobu Inoue } else { 230233841545SHajimu UMEMOTO nd6log((LOG_ERR, 230382cd038dSYoshinobu Inoue "ICMP6 redirect rejected; " 230482cd038dSYoshinobu Inoue "no route found for redirect dst: %s\n", 230533841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 230633841545SHajimu UMEMOTO goto bad; 230782cd038dSYoshinobu Inoue } 230882cd038dSYoshinobu Inoue } 230982cd038dSYoshinobu Inoue if (IN6_IS_ADDR_MULTICAST(&reddst6)) { 231033841545SHajimu UMEMOTO nd6log((LOG_ERR, 231182cd038dSYoshinobu Inoue "ICMP6 redirect rejected; " 231282cd038dSYoshinobu Inoue "redirect dst must be unicast: %s\n", 231333841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 231433841545SHajimu UMEMOTO goto bad; 231582cd038dSYoshinobu Inoue } 231682cd038dSYoshinobu Inoue 231782cd038dSYoshinobu Inoue is_router = is_onlink = 0; 231882cd038dSYoshinobu Inoue if (IN6_IS_ADDR_LINKLOCAL(&redtgt6)) 231982cd038dSYoshinobu Inoue is_router = 1; /* router case */ 232082cd038dSYoshinobu Inoue if (bcmp(&redtgt6, &reddst6, sizeof(redtgt6)) == 0) 232182cd038dSYoshinobu Inoue is_onlink = 1; /* on-link destination case */ 232282cd038dSYoshinobu Inoue if (!is_router && !is_onlink) { 232333841545SHajimu UMEMOTO nd6log((LOG_ERR, 232482cd038dSYoshinobu Inoue "ICMP6 redirect rejected; " 232582cd038dSYoshinobu Inoue "neither router case nor onlink case: %s\n", 232633841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 232733841545SHajimu UMEMOTO goto bad; 232882cd038dSYoshinobu Inoue } 232982cd038dSYoshinobu Inoue 233082cd038dSYoshinobu Inoue icmp6len -= sizeof(*nd_rd); 233182cd038dSYoshinobu Inoue nd6_option_init(nd_rd + 1, icmp6len, &ndopts); 233282cd038dSYoshinobu Inoue if (nd6_options(&ndopts) < 0) { 233337c1ff48SGleb Smirnoff nd6log((LOG_INFO, "%s: invalid ND option, rejected: %s\n", 233437c1ff48SGleb Smirnoff __func__, icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 233533841545SHajimu UMEMOTO /* nd6_options have incremented stats */ 2336686cdd19SJun-ichiro itojun Hagino goto freeit; 233782cd038dSYoshinobu Inoue } 233882cd038dSYoshinobu Inoue 2339503f4e47SBjoern A. Zeeb lladdr = NULL; 2340503f4e47SBjoern A. Zeeb lladdrlen = 0; 234182cd038dSYoshinobu Inoue if (ndopts.nd_opts_tgt_lladdr) { 234282cd038dSYoshinobu Inoue lladdr = (char *)(ndopts.nd_opts_tgt_lladdr + 1); 234382cd038dSYoshinobu Inoue lladdrlen = ndopts.nd_opts_tgt_lladdr->nd_opt_len << 3; 234482cd038dSYoshinobu Inoue } 234582cd038dSYoshinobu Inoue 234682cd038dSYoshinobu Inoue if (lladdr && ((ifp->if_addrlen + 2 + 7) & ~7) != lladdrlen) { 234737c1ff48SGleb Smirnoff nd6log((LOG_INFO, "%s: lladdrlen mismatch for %s " 234882cd038dSYoshinobu Inoue "(if %d, icmp6 packet %d): %s\n", 234937c1ff48SGleb Smirnoff __func__, ip6_sprintf(ip6buf, &redtgt6), 23501d54aa3bSBjoern A. Zeeb ifp->if_addrlen, lladdrlen - 2, 235133841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 235233841545SHajimu UMEMOTO goto bad; 235382cd038dSYoshinobu Inoue } 235482cd038dSYoshinobu Inoue 2355bfbc08b8SBjoern A. Zeeb /* Validation passed. */ 2356bfbc08b8SBjoern A. Zeeb 235782cd038dSYoshinobu Inoue /* RFC 2461 8.3 */ 235882cd038dSYoshinobu Inoue nd6_cache_lladdr(ifp, &redtgt6, lladdr, lladdrlen, ND_REDIRECT, 235982cd038dSYoshinobu Inoue is_onlink ? ND_REDIRECT_ONLINK : ND_REDIRECT_ROUTER); 236082cd038dSYoshinobu Inoue 236117a03656SEric van Gyzen /* 236217a03656SEric van Gyzen * Install a gateway route in the better-router case or an interface 236317a03656SEric van Gyzen * route in the on-link-destination case. 236417a03656SEric van Gyzen */ 236517a03656SEric van Gyzen { 236682cd038dSYoshinobu Inoue struct sockaddr_in6 sdst; 236782cd038dSYoshinobu Inoue struct sockaddr_in6 sgw; 236882cd038dSYoshinobu Inoue struct sockaddr_in6 ssrc; 236917a03656SEric van Gyzen struct sockaddr *gw; 237017a03656SEric van Gyzen int rt_flags; 237181d5d46bSBjoern A. Zeeb u_int fibnum; 237282cd038dSYoshinobu Inoue 237382cd038dSYoshinobu Inoue bzero(&sdst, sizeof(sdst)); 237482cd038dSYoshinobu Inoue bzero(&ssrc, sizeof(ssrc)); 237517a03656SEric van Gyzen sdst.sin6_family = ssrc.sin6_family = AF_INET6; 237617a03656SEric van Gyzen sdst.sin6_len = ssrc.sin6_len = sizeof(struct sockaddr_in6); 237782cd038dSYoshinobu Inoue bcopy(&reddst6, &sdst.sin6_addr, sizeof(struct in6_addr)); 237882cd038dSYoshinobu Inoue bcopy(&src6, &ssrc.sin6_addr, sizeof(struct in6_addr)); 237934a5582cSAlexander V. Chernikov rt_flags = 0; 238017a03656SEric van Gyzen if (is_router) { 238117a03656SEric van Gyzen bzero(&sgw, sizeof(sgw)); 238217a03656SEric van Gyzen sgw.sin6_family = AF_INET6; 238317a03656SEric van Gyzen sgw.sin6_len = sizeof(struct sockaddr_in6); 238417a03656SEric van Gyzen bcopy(&redtgt6, &sgw.sin6_addr, 238517a03656SEric van Gyzen sizeof(struct in6_addr)); 238617a03656SEric van Gyzen gw = (struct sockaddr *)&sgw; 238717a03656SEric van Gyzen rt_flags |= RTF_GATEWAY; 238817a03656SEric van Gyzen } else 238917a03656SEric van Gyzen gw = ifp->if_addr->ifa_addr; 239081d5d46bSBjoern A. Zeeb for (fibnum = 0; fibnum < rt_numfibs; fibnum++) 239134a5582cSAlexander V. Chernikov rib_add_redirect(fibnum, (struct sockaddr *)&sdst, gw, 239234a5582cSAlexander V. Chernikov (struct sockaddr *)&ssrc, ifp, rt_flags, 239334a5582cSAlexander V. Chernikov V_icmp6_redirtimeout); 239482cd038dSYoshinobu Inoue } 239582cd038dSYoshinobu Inoue /* finally update cached route in each socket via pfctlinput */ 239682cd038dSYoshinobu Inoue { 239782cd038dSYoshinobu Inoue struct sockaddr_in6 sdst; 239882cd038dSYoshinobu Inoue 239982cd038dSYoshinobu Inoue bzero(&sdst, sizeof(sdst)); 240082cd038dSYoshinobu Inoue sdst.sin6_family = AF_INET6; 240182cd038dSYoshinobu Inoue sdst.sin6_len = sizeof(struct sockaddr_in6); 240282cd038dSYoshinobu Inoue bcopy(&reddst6, &sdst.sin6_addr, sizeof(struct in6_addr)); 240382cd038dSYoshinobu Inoue pfctlinput(PRC_REDIRECT_HOST, (struct sockaddr *)&sdst); 240482cd038dSYoshinobu Inoue } 2405686cdd19SJun-ichiro itojun Hagino 2406686cdd19SJun-ichiro itojun Hagino freeit: 2407686cdd19SJun-ichiro itojun Hagino m_freem(m); 240833841545SHajimu UMEMOTO return; 240933841545SHajimu UMEMOTO 241033841545SHajimu UMEMOTO bad: 2411e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_badredirect); 241233841545SHajimu UMEMOTO m_freem(m); 241382cd038dSYoshinobu Inoue } 241482cd038dSYoshinobu Inoue 241582cd038dSYoshinobu Inoue void 2416*9ac7c6cfSAlexander V. Chernikov icmp6_redirect_output(struct mbuf *m0, struct nhop_object *nh) 241782cd038dSYoshinobu Inoue { 241882cd038dSYoshinobu Inoue struct ifnet *ifp; /* my outgoing interface */ 241982cd038dSYoshinobu Inoue struct in6_addr *ifp_ll6; 242082cd038dSYoshinobu Inoue struct in6_addr *router_ll6; 242182cd038dSYoshinobu Inoue struct ip6_hdr *sip6; /* m0 as struct ip6_hdr */ 242282cd038dSYoshinobu Inoue struct mbuf *m = NULL; /* newly allocated one */ 24231db8d1f8SAna Kukec struct m_tag *mtag; 242482cd038dSYoshinobu Inoue struct ip6_hdr *ip6; /* m as struct ip6_hdr */ 242582cd038dSYoshinobu Inoue struct nd_redirect *nd_rd; 242656c423b0SKip Macy struct llentry *ln = NULL; 242782cd038dSYoshinobu Inoue size_t maxlen; 242882cd038dSYoshinobu Inoue u_char *p; 242982cd038dSYoshinobu Inoue struct ifnet *outif = NULL; 2430686cdd19SJun-ichiro itojun Hagino struct sockaddr_in6 src_sa; 2431686cdd19SJun-ichiro itojun Hagino 243249dc650cSAndrey V. Elsukov icmp6_errcount(ND_REDIRECT, 0); 243382cd038dSYoshinobu Inoue 243482cd038dSYoshinobu Inoue /* if we are not router, we don't send icmp6 redirect */ 2435603724d3SBjoern A. Zeeb if (!V_ip6_forwarding) 243682cd038dSYoshinobu Inoue goto fail; 243782cd038dSYoshinobu Inoue 243882cd038dSYoshinobu Inoue /* sanity check */ 2439*9ac7c6cfSAlexander V. Chernikov if (!m0 || !nh || !(NH_IS_VALID(nh)) || !(ifp = nh->nh_ifp)) 244082cd038dSYoshinobu Inoue goto fail; 244182cd038dSYoshinobu Inoue 244282cd038dSYoshinobu Inoue /* 244382cd038dSYoshinobu Inoue * Address check: 244482cd038dSYoshinobu Inoue * the source address must identify a neighbor, and 244582cd038dSYoshinobu Inoue * the destination address must not be a multicast address 244682cd038dSYoshinobu Inoue * [RFC 2461, sec 8.2] 244782cd038dSYoshinobu Inoue */ 244882cd038dSYoshinobu Inoue sip6 = mtod(m0, struct ip6_hdr *); 2449686cdd19SJun-ichiro itojun Hagino bzero(&src_sa, sizeof(src_sa)); 2450686cdd19SJun-ichiro itojun Hagino src_sa.sin6_family = AF_INET6; 2451686cdd19SJun-ichiro itojun Hagino src_sa.sin6_len = sizeof(src_sa); 2452686cdd19SJun-ichiro itojun Hagino src_sa.sin6_addr = sip6->ip6_src; 2453686cdd19SJun-ichiro itojun Hagino if (nd6_is_addr_neighbor(&src_sa, ifp) == 0) 245482cd038dSYoshinobu Inoue goto fail; 245582cd038dSYoshinobu Inoue if (IN6_IS_ADDR_MULTICAST(&sip6->ip6_dst)) 245682cd038dSYoshinobu Inoue goto fail; /* what should we do here? */ 245782cd038dSYoshinobu Inoue 245882cd038dSYoshinobu Inoue /* rate limit */ 245982cd038dSYoshinobu Inoue if (icmp6_ratelimit(&sip6->ip6_src, ND_REDIRECT, 0)) 246082cd038dSYoshinobu Inoue goto fail; 246182cd038dSYoshinobu Inoue 246282cd038dSYoshinobu Inoue /* 246382cd038dSYoshinobu Inoue * Since we are going to append up to 1280 bytes (= IPV6_MMTU), 246482cd038dSYoshinobu Inoue * we almost always ask for an mbuf cluster for simplicity. 246582cd038dSYoshinobu Inoue * (MHLEN < IPV6_MMTU is almost always true) 246682cd038dSYoshinobu Inoue */ 2467686cdd19SJun-ichiro itojun Hagino #if IPV6_MMTU >= MCLBYTES 2468686cdd19SJun-ichiro itojun Hagino # error assumption failed about IPV6_MMTU and MCLBYTES 2469686cdd19SJun-ichiro itojun Hagino #endif 24707b07d1beSGleb Smirnoff m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 24717b07d1beSGleb Smirnoff if (m == NULL) 247282cd038dSYoshinobu Inoue goto fail; 2473*9ac7c6cfSAlexander V. Chernikov M_SETFIB(m, M_GETFIB(m0)); 247433841545SHajimu UMEMOTO maxlen = M_TRAILINGSPACE(m); 247582cd038dSYoshinobu Inoue maxlen = min(IPV6_MMTU, maxlen); 247682cd038dSYoshinobu Inoue /* just for safety */ 2477686cdd19SJun-ichiro itojun Hagino if (maxlen < sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr) + 2478686cdd19SJun-ichiro itojun Hagino ((sizeof(struct nd_opt_hdr) + ifp->if_addrlen + 7) & ~7)) { 247982cd038dSYoshinobu Inoue goto fail; 2480686cdd19SJun-ichiro itojun Hagino } 248182cd038dSYoshinobu Inoue 248282cd038dSYoshinobu Inoue { 248382cd038dSYoshinobu Inoue /* get ip6 linklocal address for ifp(my outgoing interface). */ 2484686cdd19SJun-ichiro itojun Hagino struct in6_ifaddr *ia; 2485686cdd19SJun-ichiro itojun Hagino if ((ia = in6ifa_ifpforlinklocal(ifp, 2486686cdd19SJun-ichiro itojun Hagino IN6_IFF_NOTREADY| 2487686cdd19SJun-ichiro itojun Hagino IN6_IFF_ANYCAST)) == NULL) 248882cd038dSYoshinobu Inoue goto fail; 248982cd038dSYoshinobu Inoue ifp_ll6 = &ia->ia_addr.sin6_addr; 24908c0fec80SRobert Watson /* XXXRW: reference released prematurely. */ 24918c0fec80SRobert Watson ifa_free(&ia->ia_ifa); 249282cd038dSYoshinobu Inoue } 249382cd038dSYoshinobu Inoue 249482cd038dSYoshinobu Inoue /* get ip6 linklocal address for the router. */ 2495*9ac7c6cfSAlexander V. Chernikov if (nh->nh_flags & NHF_GATEWAY) { 249682cd038dSYoshinobu Inoue struct sockaddr_in6 *sin6; 2497*9ac7c6cfSAlexander V. Chernikov sin6 = &nh->gw6_sa; 249882cd038dSYoshinobu Inoue router_ll6 = &sin6->sin6_addr; 249982cd038dSYoshinobu Inoue if (!IN6_IS_ADDR_LINKLOCAL(router_ll6)) 250082cd038dSYoshinobu Inoue router_ll6 = (struct in6_addr *)NULL; 250182cd038dSYoshinobu Inoue } else 250282cd038dSYoshinobu Inoue router_ll6 = (struct in6_addr *)NULL; 250382cd038dSYoshinobu Inoue 250482cd038dSYoshinobu Inoue /* ip6 */ 250582cd038dSYoshinobu Inoue ip6 = mtod(m, struct ip6_hdr *); 250682cd038dSYoshinobu Inoue ip6->ip6_flow = 0; 2507686cdd19SJun-ichiro itojun Hagino ip6->ip6_vfc &= ~IPV6_VERSION_MASK; 2508686cdd19SJun-ichiro itojun Hagino ip6->ip6_vfc |= IPV6_VERSION; 250982cd038dSYoshinobu Inoue /* ip6->ip6_plen will be set later */ 251082cd038dSYoshinobu Inoue ip6->ip6_nxt = IPPROTO_ICMPV6; 251182cd038dSYoshinobu Inoue ip6->ip6_hlim = 255; 251282cd038dSYoshinobu Inoue /* ip6->ip6_src must be linklocal addr for my outgoing if. */ 251382cd038dSYoshinobu Inoue bcopy(ifp_ll6, &ip6->ip6_src, sizeof(struct in6_addr)); 251482cd038dSYoshinobu Inoue bcopy(&sip6->ip6_src, &ip6->ip6_dst, sizeof(struct in6_addr)); 251582cd038dSYoshinobu Inoue 251682cd038dSYoshinobu Inoue /* ND Redirect */ 251782cd038dSYoshinobu Inoue nd_rd = (struct nd_redirect *)(ip6 + 1); 251882cd038dSYoshinobu Inoue nd_rd->nd_rd_type = ND_REDIRECT; 251982cd038dSYoshinobu Inoue nd_rd->nd_rd_code = 0; 252082cd038dSYoshinobu Inoue nd_rd->nd_rd_reserved = 0; 2521*9ac7c6cfSAlexander V. Chernikov if (nh->nh_flags & NHF_GATEWAY) { 252282cd038dSYoshinobu Inoue /* 252382cd038dSYoshinobu Inoue * nd_rd->nd_rd_target must be a link-local address in 252482cd038dSYoshinobu Inoue * better router cases. 252582cd038dSYoshinobu Inoue */ 252682cd038dSYoshinobu Inoue if (!router_ll6) 252782cd038dSYoshinobu Inoue goto fail; 252882cd038dSYoshinobu Inoue bcopy(router_ll6, &nd_rd->nd_rd_target, 252982cd038dSYoshinobu Inoue sizeof(nd_rd->nd_rd_target)); 253082cd038dSYoshinobu Inoue bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_dst, 253182cd038dSYoshinobu Inoue sizeof(nd_rd->nd_rd_dst)); 253282cd038dSYoshinobu Inoue } else { 253382cd038dSYoshinobu Inoue /* make sure redtgt == reddst */ 253482cd038dSYoshinobu Inoue bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_target, 253582cd038dSYoshinobu Inoue sizeof(nd_rd->nd_rd_target)); 253682cd038dSYoshinobu Inoue bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_dst, 253782cd038dSYoshinobu Inoue sizeof(nd_rd->nd_rd_dst)); 253882cd038dSYoshinobu Inoue } 253982cd038dSYoshinobu Inoue 254082cd038dSYoshinobu Inoue p = (u_char *)(nd_rd + 1); 254182cd038dSYoshinobu Inoue 254282cd038dSYoshinobu Inoue if (!router_ll6) 254382cd038dSYoshinobu Inoue goto nolladdropt; 254482cd038dSYoshinobu Inoue 254582cd038dSYoshinobu Inoue { 254682cd038dSYoshinobu Inoue /* target lladdr option */ 254782cd038dSYoshinobu Inoue int len; 254882cd038dSYoshinobu Inoue struct nd_opt_hdr *nd_opt; 254982cd038dSYoshinobu Inoue char *lladdr; 255082cd038dSYoshinobu Inoue 25516e6b3f7cSQing Li ln = nd6_lookup(router_ll6, 0, ifp); 255256c423b0SKip Macy if (ln == NULL) 255382cd038dSYoshinobu Inoue goto nolladdropt; 25546e6b3f7cSQing Li 2555686cdd19SJun-ichiro itojun Hagino len = sizeof(*nd_opt) + ifp->if_addrlen; 2556686cdd19SJun-ichiro itojun Hagino len = (len + 7) & ~7; /* round by 8 */ 2557686cdd19SJun-ichiro itojun Hagino /* safety check */ 2558686cdd19SJun-ichiro itojun Hagino if (len + (p - (u_char *)ip6) > maxlen) 2559686cdd19SJun-ichiro itojun Hagino goto nolladdropt; 25606e6b3f7cSQing Li 25616e6b3f7cSQing Li if (ln->la_flags & LLE_VALID) { 256282cd038dSYoshinobu Inoue nd_opt = (struct nd_opt_hdr *)p; 256382cd038dSYoshinobu Inoue nd_opt->nd_opt_type = ND_OPT_TARGET_LINKADDR; 256482cd038dSYoshinobu Inoue nd_opt->nd_opt_len = len >> 3; 256582cd038dSYoshinobu Inoue lladdr = (char *)(nd_opt + 1); 25664fb3a820SAlexander V. Chernikov bcopy(ln->ll_addr, lladdr, ifp->if_addrlen); 2567686cdd19SJun-ichiro itojun Hagino p += len; 256882cd038dSYoshinobu Inoue } 256982cd038dSYoshinobu Inoue } 257056c423b0SKip Macy nolladdropt: 257156c423b0SKip Macy if (ln != NULL) 257256c423b0SKip Macy LLE_RUNLOCK(ln); 257382cd038dSYoshinobu Inoue 257482cd038dSYoshinobu Inoue m->m_pkthdr.len = m->m_len = p - (u_char *)ip6; 257582cd038dSYoshinobu Inoue 257682cd038dSYoshinobu Inoue /* just to be safe */ 2577686cdd19SJun-ichiro itojun Hagino #ifdef M_DECRYPTED /*not openbsd*/ 257882cd038dSYoshinobu Inoue if (m0->m_flags & M_DECRYPTED) 257982cd038dSYoshinobu Inoue goto noredhdropt; 2580686cdd19SJun-ichiro itojun Hagino #endif 2581686cdd19SJun-ichiro itojun Hagino if (p - (u_char *)ip6 > maxlen) 2582686cdd19SJun-ichiro itojun Hagino goto noredhdropt; 258382cd038dSYoshinobu Inoue 258482cd038dSYoshinobu Inoue { 258582cd038dSYoshinobu Inoue /* redirected header option */ 258682cd038dSYoshinobu Inoue int len; 258782cd038dSYoshinobu Inoue struct nd_opt_rd_hdr *nd_opt_rh; 258882cd038dSYoshinobu Inoue 258982cd038dSYoshinobu Inoue /* 259082cd038dSYoshinobu Inoue * compute the maximum size for icmp6 redirect header option. 259182cd038dSYoshinobu Inoue * XXX room for auth header? 259282cd038dSYoshinobu Inoue */ 259382cd038dSYoshinobu Inoue len = maxlen - (p - (u_char *)ip6); 259482cd038dSYoshinobu Inoue len &= ~7; 259582cd038dSYoshinobu Inoue 259682cd038dSYoshinobu Inoue /* This is just for simplicity. */ 259782cd038dSYoshinobu Inoue if (m0->m_pkthdr.len != m0->m_len) { 259882cd038dSYoshinobu Inoue if (m0->m_next) { 259982cd038dSYoshinobu Inoue m_freem(m0->m_next); 260082cd038dSYoshinobu Inoue m0->m_next = NULL; 260182cd038dSYoshinobu Inoue } 260282cd038dSYoshinobu Inoue m0->m_pkthdr.len = m0->m_len; 260382cd038dSYoshinobu Inoue } 260482cd038dSYoshinobu Inoue 260582cd038dSYoshinobu Inoue /* 260682cd038dSYoshinobu Inoue * Redirected header option spec (RFC2461 4.6.3) talks nothing 260782cd038dSYoshinobu Inoue * about padding/truncate rule for the original IP packet. 260806cd0a3fSHajimu UMEMOTO * From the discussion on IPv6imp in Feb 1999, 260906cd0a3fSHajimu UMEMOTO * the consensus was: 261082cd038dSYoshinobu Inoue * - "attach as much as possible" is the goal 261106cd0a3fSHajimu UMEMOTO * - pad if not aligned (original size can be guessed by 261206cd0a3fSHajimu UMEMOTO * original ip6 header) 261382cd038dSYoshinobu Inoue * Following code adds the padding if it is simple enough, 261482cd038dSYoshinobu Inoue * and truncates if not. 261582cd038dSYoshinobu Inoue */ 261682cd038dSYoshinobu Inoue if (m0->m_next || m0->m_pkthdr.len != m0->m_len) 261706cd0a3fSHajimu UMEMOTO panic("assumption failed in %s:%d", __FILE__, 261806cd0a3fSHajimu UMEMOTO __LINE__); 261982cd038dSYoshinobu Inoue 262082cd038dSYoshinobu Inoue if (len - sizeof(*nd_opt_rh) < m0->m_pkthdr.len) { 262182cd038dSYoshinobu Inoue /* not enough room, truncate */ 262206cd0a3fSHajimu UMEMOTO m0->m_pkthdr.len = m0->m_len = len - 262306cd0a3fSHajimu UMEMOTO sizeof(*nd_opt_rh); 262482cd038dSYoshinobu Inoue } else { 262582cd038dSYoshinobu Inoue /* enough room, pad or truncate */ 262682cd038dSYoshinobu Inoue size_t extra; 262782cd038dSYoshinobu Inoue 262882cd038dSYoshinobu Inoue extra = m0->m_pkthdr.len % 8; 262982cd038dSYoshinobu Inoue if (extra) { 263082cd038dSYoshinobu Inoue /* pad if easy enough, truncate if not */ 263182cd038dSYoshinobu Inoue if (8 - extra <= M_TRAILINGSPACE(m0)) { 263282cd038dSYoshinobu Inoue /* pad */ 263382cd038dSYoshinobu Inoue m0->m_len += (8 - extra); 263482cd038dSYoshinobu Inoue m0->m_pkthdr.len += (8 - extra); 263582cd038dSYoshinobu Inoue } else { 263682cd038dSYoshinobu Inoue /* truncate */ 263782cd038dSYoshinobu Inoue m0->m_pkthdr.len -= extra; 263882cd038dSYoshinobu Inoue m0->m_len -= extra; 263982cd038dSYoshinobu Inoue } 264082cd038dSYoshinobu Inoue } 264182cd038dSYoshinobu Inoue len = m0->m_pkthdr.len + sizeof(*nd_opt_rh); 264206cd0a3fSHajimu UMEMOTO m0->m_pkthdr.len = m0->m_len = len - 264306cd0a3fSHajimu UMEMOTO sizeof(*nd_opt_rh); 264482cd038dSYoshinobu Inoue } 264582cd038dSYoshinobu Inoue 264682cd038dSYoshinobu Inoue nd_opt_rh = (struct nd_opt_rd_hdr *)p; 264782cd038dSYoshinobu Inoue bzero(nd_opt_rh, sizeof(*nd_opt_rh)); 264882cd038dSYoshinobu Inoue nd_opt_rh->nd_opt_rh_type = ND_OPT_REDIRECTED_HEADER; 264982cd038dSYoshinobu Inoue nd_opt_rh->nd_opt_rh_len = len >> 3; 265082cd038dSYoshinobu Inoue p += sizeof(*nd_opt_rh); 265182cd038dSYoshinobu Inoue m->m_pkthdr.len = m->m_len = p - (u_char *)ip6; 265282cd038dSYoshinobu Inoue 265382cd038dSYoshinobu Inoue /* connect m0 to m */ 2654db06e8a0SSUZUKI Shinsuke m_tag_delete_chain(m0, NULL); 2655db06e8a0SSUZUKI Shinsuke m0->m_flags &= ~M_PKTHDR; 265682cd038dSYoshinobu Inoue m->m_next = m0; 265782cd038dSYoshinobu Inoue m->m_pkthdr.len = m->m_len + m0->m_len; 2658db06e8a0SSUZUKI Shinsuke m0 = NULL; 265982cd038dSYoshinobu Inoue } 266082cd038dSYoshinobu Inoue noredhdropt:; 2661db06e8a0SSUZUKI Shinsuke if (m0) { 2662db06e8a0SSUZUKI Shinsuke m_freem(m0); 2663db06e8a0SSUZUKI Shinsuke m0 = NULL; 2664db06e8a0SSUZUKI Shinsuke } 266582cd038dSYoshinobu Inoue 26669a4f9608SHajimu UMEMOTO /* XXX: clear embedded link IDs in the inner header */ 26679a4f9608SHajimu UMEMOTO in6_clearscope(&sip6->ip6_src); 26689a4f9608SHajimu UMEMOTO in6_clearscope(&sip6->ip6_dst); 26699a4f9608SHajimu UMEMOTO in6_clearscope(&nd_rd->nd_rd_target); 26709a4f9608SHajimu UMEMOTO in6_clearscope(&nd_rd->nd_rd_dst); 267182cd038dSYoshinobu Inoue 267282cd038dSYoshinobu Inoue ip6->ip6_plen = htons(m->m_pkthdr.len - sizeof(struct ip6_hdr)); 267382cd038dSYoshinobu Inoue 267482cd038dSYoshinobu Inoue nd_rd->nd_rd_cksum = 0; 267506cd0a3fSHajimu UMEMOTO nd_rd->nd_rd_cksum = in6_cksum(m, IPPROTO_ICMPV6, 267606cd0a3fSHajimu UMEMOTO sizeof(*ip6), ntohs(ip6->ip6_plen)); 267782cd038dSYoshinobu Inoue 26781db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 26791db8d1f8SAna Kukec mtag = m_tag_get(PACKET_TAG_ND_OUTGOING, sizeof(unsigned short), 26801db8d1f8SAna Kukec M_NOWAIT); 26811db8d1f8SAna Kukec if (mtag == NULL) 26821db8d1f8SAna Kukec goto fail; 26831db8d1f8SAna Kukec *(unsigned short *)(mtag + 1) = nd_rd->nd_rd_type; 26841db8d1f8SAna Kukec m_tag_prepend(m, mtag); 26851db8d1f8SAna Kukec } 26861db8d1f8SAna Kukec 268782cd038dSYoshinobu Inoue /* send the packet to outside... */ 26885d846453SSam Leffler ip6_output(m, NULL, NULL, 0, NULL, &outif, NULL); 268982cd038dSYoshinobu Inoue if (outif) { 269082cd038dSYoshinobu Inoue icmp6_ifstat_inc(outif, ifs6_out_msg); 269182cd038dSYoshinobu Inoue icmp6_ifstat_inc(outif, ifs6_out_redirect); 269282cd038dSYoshinobu Inoue } 2693e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_outhist[ND_REDIRECT]); 269482cd038dSYoshinobu Inoue 269582cd038dSYoshinobu Inoue return; 269682cd038dSYoshinobu Inoue 269782cd038dSYoshinobu Inoue fail: 269882cd038dSYoshinobu Inoue if (m) 269982cd038dSYoshinobu Inoue m_freem(m); 270082cd038dSYoshinobu Inoue if (m0) 270182cd038dSYoshinobu Inoue m_freem(m0); 270282cd038dSYoshinobu Inoue } 270382cd038dSYoshinobu Inoue 270482cd038dSYoshinobu Inoue /* 270582cd038dSYoshinobu Inoue * ICMPv6 socket option processing. 270682cd038dSYoshinobu Inoue */ 270782cd038dSYoshinobu Inoue int 27081272577eSXin LI icmp6_ctloutput(struct socket *so, struct sockopt *sopt) 270982cd038dSYoshinobu Inoue { 271082cd038dSYoshinobu Inoue int error = 0; 271182cd038dSYoshinobu Inoue int optlen; 271233841545SHajimu UMEMOTO struct inpcb *inp = sotoinpcb(so); 271382cd038dSYoshinobu Inoue int level, op, optname; 271482cd038dSYoshinobu Inoue 271582cd038dSYoshinobu Inoue if (sopt) { 271682cd038dSYoshinobu Inoue level = sopt->sopt_level; 271782cd038dSYoshinobu Inoue op = sopt->sopt_dir; 271882cd038dSYoshinobu Inoue optname = sopt->sopt_name; 271982cd038dSYoshinobu Inoue optlen = sopt->sopt_valsize; 272082cd038dSYoshinobu Inoue } else 272182cd038dSYoshinobu Inoue level = op = optname = optlen = 0; 272233841545SHajimu UMEMOTO 272382cd038dSYoshinobu Inoue if (level != IPPROTO_ICMPV6) { 272482cd038dSYoshinobu Inoue return EINVAL; 272582cd038dSYoshinobu Inoue } 272682cd038dSYoshinobu Inoue 272782cd038dSYoshinobu Inoue switch (op) { 272882cd038dSYoshinobu Inoue case PRCO_SETOPT: 272982cd038dSYoshinobu Inoue switch (optname) { 273082cd038dSYoshinobu Inoue case ICMP6_FILTER: 273182cd038dSYoshinobu Inoue { 2732ae89d5a3SRobert Watson struct icmp6_filter ic6f; 273382cd038dSYoshinobu Inoue 2734ae89d5a3SRobert Watson if (optlen != sizeof(ic6f)) { 273582cd038dSYoshinobu Inoue error = EMSGSIZE; 273682cd038dSYoshinobu Inoue break; 273782cd038dSYoshinobu Inoue } 2738ae89d5a3SRobert Watson error = sooptcopyin(sopt, &ic6f, optlen, optlen); 2739ae89d5a3SRobert Watson if (error == 0) { 2740ae89d5a3SRobert Watson INP_WLOCK(inp); 2741ae89d5a3SRobert Watson *inp->in6p_icmp6filt = ic6f; 2742ae89d5a3SRobert Watson INP_WUNLOCK(inp); 2743ae89d5a3SRobert Watson } 274482cd038dSYoshinobu Inoue break; 274582cd038dSYoshinobu Inoue } 274682cd038dSYoshinobu Inoue 274782cd038dSYoshinobu Inoue default: 274882cd038dSYoshinobu Inoue error = ENOPROTOOPT; 274982cd038dSYoshinobu Inoue break; 275082cd038dSYoshinobu Inoue } 275182cd038dSYoshinobu Inoue break; 275282cd038dSYoshinobu Inoue 275382cd038dSYoshinobu Inoue case PRCO_GETOPT: 275482cd038dSYoshinobu Inoue switch (optname) { 275582cd038dSYoshinobu Inoue case ICMP6_FILTER: 275682cd038dSYoshinobu Inoue { 2757ae89d5a3SRobert Watson struct icmp6_filter ic6f; 2758ae89d5a3SRobert Watson 2759ae89d5a3SRobert Watson INP_RLOCK(inp); 2760ae89d5a3SRobert Watson ic6f = *inp->in6p_icmp6filt; 2761ae89d5a3SRobert Watson INP_RUNLOCK(inp); 2762ae89d5a3SRobert Watson error = sooptcopyout(sopt, &ic6f, sizeof(ic6f)); 276382cd038dSYoshinobu Inoue break; 276482cd038dSYoshinobu Inoue } 276582cd038dSYoshinobu Inoue 276682cd038dSYoshinobu Inoue default: 276782cd038dSYoshinobu Inoue error = ENOPROTOOPT; 276882cd038dSYoshinobu Inoue break; 276982cd038dSYoshinobu Inoue } 277082cd038dSYoshinobu Inoue break; 277182cd038dSYoshinobu Inoue } 277282cd038dSYoshinobu Inoue 277382cd038dSYoshinobu Inoue return (error); 277482cd038dSYoshinobu Inoue } 277582cd038dSYoshinobu Inoue 277682cd038dSYoshinobu Inoue /* 277782cd038dSYoshinobu Inoue * Perform rate limit check. 277882cd038dSYoshinobu Inoue * Returns 0 if it is okay to send the icmp6 packet. 277982cd038dSYoshinobu Inoue * Returns 1 if the router SHOULD NOT send this icmp6 packet due to rate 278082cd038dSYoshinobu Inoue * limitation. 278182cd038dSYoshinobu Inoue * 278282cd038dSYoshinobu Inoue * XXX per-destination/type check necessary? 27831272577eSXin LI * 27841272577eSXin LI * dst - not used at this moment 27851272577eSXin LI * type - not used at this moment 27861272577eSXin LI * code - not used at this moment 278782cd038dSYoshinobu Inoue */ 278882cd038dSYoshinobu Inoue static int 27891272577eSXin LI icmp6_ratelimit(const struct in6_addr *dst, const int type, 27901272577eSXin LI const int code) 279182cd038dSYoshinobu Inoue { 2792686cdd19SJun-ichiro itojun Hagino int ret; 279382cd038dSYoshinobu Inoue 2794686cdd19SJun-ichiro itojun Hagino ret = 0; /* okay to send */ 279582cd038dSYoshinobu Inoue 2796686cdd19SJun-ichiro itojun Hagino /* PPS limit */ 2797603724d3SBjoern A. Zeeb if (!ppsratecheck(&V_icmp6errppslim_last, &V_icmp6errpps_count, 2798603724d3SBjoern A. Zeeb V_icmp6errppslim)) { 279982cd038dSYoshinobu Inoue /* The packet is subject to rate limit */ 2800686cdd19SJun-ichiro itojun Hagino ret++; 280182cd038dSYoshinobu Inoue } 280282cd038dSYoshinobu Inoue 2803686cdd19SJun-ichiro itojun Hagino return ret; 280482cd038dSYoshinobu Inoue } 2805