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> 96da187ddbSAlexander V. Chernikov #include <net/route/route_ctl.h> 979ac7c6cfSAlexander V. Chernikov #include <net/route/nhop.h> 984b79449eSBjoern A. Zeeb #include <net/vnet.h> 9982cd038dSYoshinobu Inoue 10082cd038dSYoshinobu Inoue #include <netinet/in.h> 101960ed29cSSeigo Tanimura #include <netinet/in_pcb.h> 10282cd038dSYoshinobu Inoue #include <netinet/in_var.h> 103686cdd19SJun-ichiro itojun Hagino #include <netinet/ip6.h> 104686cdd19SJun-ichiro itojun Hagino #include <netinet/icmp6.h> 10597d8d152SAndre Oppermann #include <netinet/tcp_var.h> 1064b79449eSBjoern A. Zeeb 1079977be4aSAlexander V. Chernikov #include <netinet6/in6_fib.h> 10882cd038dSYoshinobu Inoue #include <netinet6/in6_ifattach.h> 109960ed29cSSeigo Tanimura #include <netinet6/in6_pcb.h> 11082cd038dSYoshinobu Inoue #include <netinet6/ip6protosw.h> 111960ed29cSSeigo Tanimura #include <netinet6/ip6_var.h> 112a1f7e5f8SHajimu UMEMOTO #include <netinet6/scope6_var.h> 113960ed29cSSeigo Tanimura #include <netinet6/mld6_var.h> 114960ed29cSSeigo Tanimura #include <netinet6/nd6.h> 1151db8d1f8SAna Kukec #include <netinet6/send.h> 11682cd038dSYoshinobu Inoue 11782cd038dSYoshinobu Inoue extern struct domain inet6domain; 11897021c24SMarko Zec 119a786f679SAndrey V. Elsukov VNET_PCPUSTAT_DEFINE(struct icmp6stat, icmp6stat); 120a786f679SAndrey V. Elsukov VNET_PCPUSTAT_SYSINIT(icmp6stat); 121a786f679SAndrey V. Elsukov 122a786f679SAndrey V. Elsukov #ifdef VIMAGE 123a786f679SAndrey V. Elsukov VNET_PCPUSTAT_SYSUNINIT(icmp6stat); 124a786f679SAndrey V. Elsukov #endif /* VIMAGE */ 12582cea7e6SBjoern A. Zeeb 126eddfbb76SRobert Watson VNET_DECLARE(struct inpcbinfo, ripcbinfo); 127eddfbb76SRobert Watson VNET_DECLARE(struct inpcbhead, ripcb); 128eddfbb76SRobert Watson VNET_DECLARE(int, icmp6errppslim); 1295f901c92SAndrew Turner VNET_DEFINE_STATIC(int, icmp6errpps_count) = 0; 1305f901c92SAndrew Turner VNET_DEFINE_STATIC(struct timeval, icmp6errppslim_last); 131eddfbb76SRobert Watson VNET_DECLARE(int, icmp6_nodeinfo); 13282cd038dSYoshinobu Inoue 1331e77c105SRobert Watson #define V_ripcbinfo VNET(ripcbinfo) 1341e77c105SRobert Watson #define V_ripcb VNET(ripcb) 1351e77c105SRobert Watson #define V_icmp6errppslim VNET(icmp6errppslim) 1361e77c105SRobert Watson #define V_icmp6errpps_count VNET(icmp6errpps_count) 1371e77c105SRobert Watson #define V_icmp6errppslim_last VNET(icmp6errppslim_last) 13882cea7e6SBjoern A. Zeeb #define V_icmp6_nodeinfo VNET(icmp6_nodeinfo) 13944e33a07SMarko Zec 14049dc650cSAndrey V. Elsukov static void icmp6_errcount(int, int); 1419233d8f3SDavid E. O'Brien static int icmp6_rip6_input(struct mbuf **, int); 1420700d2c3SBjoern A. Zeeb static void icmp6_reflect(struct mbuf *, size_t); 1439233d8f3SDavid E. O'Brien static int icmp6_ratelimit(const struct in6_addr *, const int, const int); 1446f56329aSXin LI static const char *icmp6_redirect_diag(struct in6_addr *, 1456f56329aSXin LI struct in6_addr *, struct in6_addr *); 1467460ef5dSHiroki Sato static struct mbuf *ni6_input(struct mbuf *, int, struct prison *); 1479233d8f3SDavid E. O'Brien static struct mbuf *ni6_nametodns(const char *, int, int); 1489233d8f3SDavid E. O'Brien static int ni6_dnsmatch(const char *, int, const char *, int); 1496f56329aSXin LI static int ni6_addrs(struct icmp6_nodeinfo *, struct mbuf *, 1506f56329aSXin LI struct ifnet **, struct in6_addr *); 1516f56329aSXin LI static int ni6_store_addrs(struct icmp6_nodeinfo *, struct icmp6_nodeinfo *, 1526f56329aSXin LI struct ifnet *, int); 1539233d8f3SDavid E. O'Brien static int icmp6_notify_error(struct mbuf **, int, int, int); 15482cd038dSYoshinobu Inoue 155315e3e38SRobert Watson /* 156315e3e38SRobert Watson * Kernel module interface for updating icmp6stat. The argument is an index 157315e3e38SRobert Watson * into icmp6stat treated as an array of u_quad_t. While this encodes the 158315e3e38SRobert Watson * general layout of icmp6stat into the caller, it doesn't encode its 159315e3e38SRobert Watson * location, so that future changes to add, for example, per-CPU stats 160315e3e38SRobert Watson * support won't cause binary compatibility problems for kernel modules. 161315e3e38SRobert Watson */ 162315e3e38SRobert Watson void 163315e3e38SRobert Watson kmod_icmp6stat_inc(int statnum) 164315e3e38SRobert Watson { 165315e3e38SRobert Watson 166a786f679SAndrey V. Elsukov counter_u64_add(VNET(icmp6stat)[statnum], 1); 167315e3e38SRobert Watson } 168315e3e38SRobert Watson 169686cdd19SJun-ichiro itojun Hagino static void 17049dc650cSAndrey V. Elsukov icmp6_errcount(int type, int code) 171686cdd19SJun-ichiro itojun Hagino { 172686cdd19SJun-ichiro itojun Hagino switch (type) { 173686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH: 174686cdd19SJun-ichiro itojun Hagino switch (code) { 175686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_NOROUTE: 17649dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_odst_unreach_noroute); 177686cdd19SJun-ichiro itojun Hagino return; 178686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_ADMIN: 17949dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_odst_unreach_admin); 180686cdd19SJun-ichiro itojun Hagino return; 181686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_BEYONDSCOPE: 18249dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_odst_unreach_beyondscope); 183686cdd19SJun-ichiro itojun Hagino return; 184686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_ADDR: 18549dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_odst_unreach_addr); 186686cdd19SJun-ichiro itojun Hagino return; 187686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_NOPORT: 18849dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_odst_unreach_noport); 189686cdd19SJun-ichiro itojun Hagino return; 190686cdd19SJun-ichiro itojun Hagino } 191686cdd19SJun-ichiro itojun Hagino break; 192686cdd19SJun-ichiro itojun Hagino case ICMP6_PACKET_TOO_BIG: 19349dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_opacket_too_big); 194686cdd19SJun-ichiro itojun Hagino return; 195686cdd19SJun-ichiro itojun Hagino case ICMP6_TIME_EXCEEDED: 196686cdd19SJun-ichiro itojun Hagino switch (code) { 197686cdd19SJun-ichiro itojun Hagino case ICMP6_TIME_EXCEED_TRANSIT: 19849dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_otime_exceed_transit); 199686cdd19SJun-ichiro itojun Hagino return; 200686cdd19SJun-ichiro itojun Hagino case ICMP6_TIME_EXCEED_REASSEMBLY: 20149dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_otime_exceed_reassembly); 202686cdd19SJun-ichiro itojun Hagino return; 203686cdd19SJun-ichiro itojun Hagino } 204686cdd19SJun-ichiro itojun Hagino break; 205686cdd19SJun-ichiro itojun Hagino case ICMP6_PARAM_PROB: 206686cdd19SJun-ichiro itojun Hagino switch (code) { 207686cdd19SJun-ichiro itojun Hagino case ICMP6_PARAMPROB_HEADER: 20849dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_oparamprob_header); 209686cdd19SJun-ichiro itojun Hagino return; 210686cdd19SJun-ichiro itojun Hagino case ICMP6_PARAMPROB_NEXTHEADER: 21149dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_oparamprob_nextheader); 212686cdd19SJun-ichiro itojun Hagino return; 213686cdd19SJun-ichiro itojun Hagino case ICMP6_PARAMPROB_OPTION: 21449dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_oparamprob_option); 215686cdd19SJun-ichiro itojun Hagino return; 216686cdd19SJun-ichiro itojun Hagino } 217686cdd19SJun-ichiro itojun Hagino break; 218686cdd19SJun-ichiro itojun Hagino case ND_REDIRECT: 21949dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_oredirect); 220686cdd19SJun-ichiro itojun Hagino return; 221686cdd19SJun-ichiro itojun Hagino } 22249dc650cSAndrey V. Elsukov ICMP6STAT_INC(icp6s_ounknown); 223686cdd19SJun-ichiro itojun Hagino } 224686cdd19SJun-ichiro itojun Hagino 22582cd038dSYoshinobu Inoue /* 226a1f7e5f8SHajimu UMEMOTO * A wrapper function for icmp6_error() necessary when the erroneous packet 227a1f7e5f8SHajimu UMEMOTO * may not contain enough scope zone information. 228a1f7e5f8SHajimu UMEMOTO */ 229a1f7e5f8SHajimu UMEMOTO void 2301272577eSXin LI icmp6_error2(struct mbuf *m, int type, int code, int param, 2311272577eSXin LI struct ifnet *ifp) 232a1f7e5f8SHajimu UMEMOTO { 233a1f7e5f8SHajimu UMEMOTO struct ip6_hdr *ip6; 234a1f7e5f8SHajimu UMEMOTO 235a1f7e5f8SHajimu UMEMOTO if (ifp == NULL) 236a1f7e5f8SHajimu UMEMOTO return; 237a1f7e5f8SHajimu UMEMOTO 238a1f7e5f8SHajimu UMEMOTO if (m->m_len < sizeof(struct ip6_hdr)) { 239a1f7e5f8SHajimu UMEMOTO m = m_pullup(m, sizeof(struct ip6_hdr)); 240a61b5cfbSBjoern A. Zeeb if (m == NULL) { 241a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 242a1f7e5f8SHajimu UMEMOTO return; 243a1f7e5f8SHajimu UMEMOTO } 244a61b5cfbSBjoern A. Zeeb } 245a1f7e5f8SHajimu UMEMOTO ip6 = mtod(m, struct ip6_hdr *); 246a1f7e5f8SHajimu UMEMOTO 247a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&ip6->ip6_src, ifp, NULL) != 0) 248a1f7e5f8SHajimu UMEMOTO return; 249a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&ip6->ip6_dst, ifp, NULL) != 0) 250a1f7e5f8SHajimu UMEMOTO return; 251a1f7e5f8SHajimu UMEMOTO 252a1f7e5f8SHajimu UMEMOTO icmp6_error(m, type, code, param); 253a1f7e5f8SHajimu UMEMOTO } 254a1f7e5f8SHajimu UMEMOTO 255a1f7e5f8SHajimu UMEMOTO /* 25682cd038dSYoshinobu Inoue * Generate an error packet of type error in response to bad IP6 packet. 25782cd038dSYoshinobu Inoue */ 25882cd038dSYoshinobu Inoue void 2591272577eSXin LI icmp6_error(struct mbuf *m, int type, int code, int param) 26082cd038dSYoshinobu Inoue { 26182cd038dSYoshinobu Inoue struct ip6_hdr *oip6, *nip6; 26282cd038dSYoshinobu Inoue struct icmp6_hdr *icmp6; 263686cdd19SJun-ichiro itojun Hagino u_int preplen; 26482cd038dSYoshinobu Inoue int off; 265686cdd19SJun-ichiro itojun Hagino int nxt; 26682cd038dSYoshinobu Inoue 267e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_error); 26882cd038dSYoshinobu Inoue 269686cdd19SJun-ichiro itojun Hagino /* count per-type-code statistics */ 27049dc650cSAndrey V. Elsukov icmp6_errcount(type, code); 27182cd038dSYoshinobu Inoue 272686cdd19SJun-ichiro itojun Hagino #ifdef M_DECRYPTED /*not openbsd*/ 273686cdd19SJun-ichiro itojun Hagino if (m->m_flags & M_DECRYPTED) { 274e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_canterror); 275686cdd19SJun-ichiro itojun Hagino goto freeit; 276686cdd19SJun-ichiro itojun Hagino } 277686cdd19SJun-ichiro itojun Hagino #endif 278686cdd19SJun-ichiro itojun Hagino 279686cdd19SJun-ichiro itojun Hagino if (m->m_len < sizeof(struct ip6_hdr)) { 280686cdd19SJun-ichiro itojun Hagino m = m_pullup(m, sizeof(struct ip6_hdr)); 281a61b5cfbSBjoern A. Zeeb if (m == NULL) { 282a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 283686cdd19SJun-ichiro itojun Hagino return; 284686cdd19SJun-ichiro itojun Hagino } 285a61b5cfbSBjoern A. Zeeb } 28682cd038dSYoshinobu Inoue oip6 = mtod(m, struct ip6_hdr *); 28782cd038dSYoshinobu Inoue 28882cd038dSYoshinobu Inoue /* 289f95d4633SHajimu UMEMOTO * If the destination address of the erroneous packet is a multicast 290f95d4633SHajimu UMEMOTO * address, or the packet was sent using link-layer multicast, 291f95d4633SHajimu UMEMOTO * we should basically suppress sending an error (RFC 2463, Section 292f95d4633SHajimu UMEMOTO * 2.4). 293f95d4633SHajimu UMEMOTO * We have two exceptions (the item e.2 in that section): 2941767c520SBjoern A. Zeeb * - the Packet Too Big message can be sent for path MTU discovery. 295f95d4633SHajimu UMEMOTO * - the Parameter Problem Message that can be allowed an icmp6 error 296f95d4633SHajimu UMEMOTO * in the option type field. This check has been done in 297f95d4633SHajimu UMEMOTO * ip6_unknown_opt(), so we can just check the type and code. 29882cd038dSYoshinobu Inoue */ 29982cd038dSYoshinobu Inoue if ((m->m_flags & (M_BCAST|M_MCAST) || 30082cd038dSYoshinobu Inoue IN6_IS_ADDR_MULTICAST(&oip6->ip6_dst)) && 30182cd038dSYoshinobu Inoue (type != ICMP6_PACKET_TOO_BIG && 30282cd038dSYoshinobu Inoue (type != ICMP6_PARAM_PROB || 30382cd038dSYoshinobu Inoue code != ICMP6_PARAMPROB_OPTION))) 30482cd038dSYoshinobu Inoue goto freeit; 30582cd038dSYoshinobu Inoue 306f95d4633SHajimu UMEMOTO /* 307f95d4633SHajimu UMEMOTO * RFC 2463, 2.4 (e.5): source address check. 308f95d4633SHajimu UMEMOTO * XXX: the case of anycast source? 309f95d4633SHajimu UMEMOTO */ 31082cd038dSYoshinobu Inoue if (IN6_IS_ADDR_UNSPECIFIED(&oip6->ip6_src) || 31182cd038dSYoshinobu Inoue IN6_IS_ADDR_MULTICAST(&oip6->ip6_src)) 31282cd038dSYoshinobu Inoue goto freeit; 31382cd038dSYoshinobu Inoue 31482cd038dSYoshinobu Inoue /* 315686cdd19SJun-ichiro itojun Hagino * If we are about to send ICMPv6 against ICMPv6 error/redirect, 316686cdd19SJun-ichiro itojun Hagino * don't do it. 31782cd038dSYoshinobu Inoue */ 318686cdd19SJun-ichiro itojun Hagino nxt = -1; 319686cdd19SJun-ichiro itojun Hagino off = ip6_lasthdr(m, 0, IPPROTO_IPV6, &nxt); 320686cdd19SJun-ichiro itojun Hagino if (off >= 0 && nxt == IPPROTO_ICMPV6) { 32182cd038dSYoshinobu Inoue struct icmp6_hdr *icp; 32282cd038dSYoshinobu Inoue 323a4adf6ccSBjoern A. Zeeb if (m->m_len < off + sizeof(struct icmp6_hdr)) { 324a61b5cfbSBjoern A. Zeeb m = m_pullup(m, off + sizeof(struct icmp6_hdr)); 325a61b5cfbSBjoern A. Zeeb if (m == NULL) { 326a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 327686cdd19SJun-ichiro itojun Hagino return; 328686cdd19SJun-ichiro itojun Hagino } 329a4adf6ccSBjoern A. Zeeb } 330a61b5cfbSBjoern A. Zeeb oip6 = mtod(m, struct ip6_hdr *); 331a61b5cfbSBjoern A. Zeeb icp = (struct icmp6_hdr *)(mtod(m, caddr_t) + off); 332a61b5cfbSBjoern A. Zeeb 333686cdd19SJun-ichiro itojun Hagino if (icp->icmp6_type < ICMP6_ECHO_REQUEST || 334686cdd19SJun-ichiro itojun Hagino icp->icmp6_type == ND_REDIRECT) { 33582cd038dSYoshinobu Inoue /* 33682cd038dSYoshinobu Inoue * ICMPv6 error 33782cd038dSYoshinobu Inoue * Special case: for redirect (which is 33882cd038dSYoshinobu Inoue * informational) we must not send icmp6 error. 33982cd038dSYoshinobu Inoue */ 340e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_canterror); 34182cd038dSYoshinobu Inoue goto freeit; 34282cd038dSYoshinobu Inoue } else { 343686cdd19SJun-ichiro itojun Hagino /* ICMPv6 informational - send the error */ 34482cd038dSYoshinobu Inoue } 345686cdd19SJun-ichiro itojun Hagino } else { 346686cdd19SJun-ichiro itojun Hagino /* non-ICMPv6 - send the error */ 34782cd038dSYoshinobu Inoue } 34882cd038dSYoshinobu Inoue 34982cd038dSYoshinobu Inoue /* Finally, do rate limitation check. */ 35082cd038dSYoshinobu Inoue if (icmp6_ratelimit(&oip6->ip6_src, type, code)) { 351e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_toofreq); 35282cd038dSYoshinobu Inoue goto freeit; 35382cd038dSYoshinobu Inoue } 35482cd038dSYoshinobu Inoue 35582cd038dSYoshinobu Inoue /* 35682cd038dSYoshinobu Inoue * OK, ICMP6 can be generated. 35782cd038dSYoshinobu Inoue */ 35882cd038dSYoshinobu Inoue 35982cd038dSYoshinobu Inoue if (m->m_pkthdr.len >= ICMPV6_PLD_MAXLEN) 36082cd038dSYoshinobu Inoue m_adj(m, ICMPV6_PLD_MAXLEN - m->m_pkthdr.len); 36182cd038dSYoshinobu Inoue 362686cdd19SJun-ichiro itojun Hagino preplen = sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr); 363eb1b1807SGleb Smirnoff M_PREPEND(m, preplen, M_NOWAIT); /* FIB is also copied over. */ 36482cd038dSYoshinobu Inoue if (m == NULL) { 36533841545SHajimu UMEMOTO nd6log((LOG_DEBUG, "ENOBUFS in icmp6_error %d\n", __LINE__)); 36682cd038dSYoshinobu Inoue return; 36782cd038dSYoshinobu Inoue } 36882cd038dSYoshinobu Inoue 36982cd038dSYoshinobu Inoue nip6 = mtod(m, struct ip6_hdr *); 37082cd038dSYoshinobu Inoue nip6->ip6_src = oip6->ip6_src; 37182cd038dSYoshinobu Inoue nip6->ip6_dst = oip6->ip6_dst; 37282cd038dSYoshinobu Inoue 3739a4f9608SHajimu UMEMOTO in6_clearscope(&oip6->ip6_src); 3749a4f9608SHajimu UMEMOTO in6_clearscope(&oip6->ip6_dst); 37582cd038dSYoshinobu Inoue 37682cd038dSYoshinobu Inoue icmp6 = (struct icmp6_hdr *)(nip6 + 1); 37782cd038dSYoshinobu Inoue icmp6->icmp6_type = type; 37882cd038dSYoshinobu Inoue icmp6->icmp6_code = code; 37982cd038dSYoshinobu Inoue icmp6->icmp6_pptr = htonl((u_int32_t)param); 38082cd038dSYoshinobu Inoue 381e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_outhist[type]); 38282cd038dSYoshinobu Inoue icmp6_reflect(m, sizeof(struct ip6_hdr)); /* header order: IPv6 - ICMPv6 */ 383686cdd19SJun-ichiro itojun Hagino 384686cdd19SJun-ichiro itojun Hagino return; 385686cdd19SJun-ichiro itojun Hagino 386686cdd19SJun-ichiro itojun Hagino freeit: 387686cdd19SJun-ichiro itojun Hagino /* 388cd0fdcf7SHajimu UMEMOTO * If we can't tell whether or not we can generate ICMP6, free it. 389686cdd19SJun-ichiro itojun Hagino */ 390686cdd19SJun-ichiro itojun Hagino m_freem(m); 39182cd038dSYoshinobu Inoue } 39282cd038dSYoshinobu Inoue 39382cd038dSYoshinobu Inoue /* 39482cd038dSYoshinobu Inoue * Process a received ICMP6 message. 39582cd038dSYoshinobu Inoue */ 39682cd038dSYoshinobu Inoue int 3971272577eSXin LI icmp6_input(struct mbuf **mp, int *offp, int proto) 39882cd038dSYoshinobu Inoue { 399503f4e47SBjoern A. Zeeb struct mbuf *m, *n; 40029dc7bc6SBruce M Simpson struct ifnet *ifp; 40182cd038dSYoshinobu Inoue struct ip6_hdr *ip6, *nip6; 40282cd038dSYoshinobu Inoue struct icmp6_hdr *icmp6, *nicmp6; 4031d54aa3bSBjoern A. Zeeb char ip6bufs[INET6_ADDRSTRLEN], ip6bufd[INET6_ADDRSTRLEN]; 404503f4e47SBjoern A. Zeeb int code, error, icmp6len, ip6len, noff, off, sum; 40582cd038dSYoshinobu Inoue 406a37a5246SAlexander V. Chernikov NET_EPOCH_ASSERT(); 407a37a5246SAlexander V. Chernikov 408503f4e47SBjoern A. Zeeb m = *mp; 409503f4e47SBjoern A. Zeeb off = *offp; 41029dc7bc6SBruce M Simpson 411a4adf6ccSBjoern A. Zeeb if (m->m_len < off + sizeof(struct icmp6_hdr)) { 412a61b5cfbSBjoern A. Zeeb m = m_pullup(m, off + sizeof(struct icmp6_hdr)); 413a61b5cfbSBjoern A. Zeeb if (m == NULL) { 414a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 415a61b5cfbSBjoern A. Zeeb *mp = m; 416a61b5cfbSBjoern A. Zeeb return (IPPROTO_DONE); 417a61b5cfbSBjoern A. Zeeb } 418a4adf6ccSBjoern A. Zeeb } 41982cd038dSYoshinobu Inoue 42082cd038dSYoshinobu Inoue /* 42182cd038dSYoshinobu Inoue * Locate icmp6 structure in mbuf, and check 42282cd038dSYoshinobu Inoue * that not corrupted and of at least minimum length 42382cd038dSYoshinobu Inoue */ 42482cd038dSYoshinobu Inoue 425503f4e47SBjoern A. Zeeb icmp6len = m->m_pkthdr.len - off; 42682cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct icmp6_hdr)) { 427e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_tooshort); 42882cd038dSYoshinobu Inoue goto freeit; 42982cd038dSYoshinobu Inoue } 43082cd038dSYoshinobu Inoue 431503f4e47SBjoern A. Zeeb ip6 = mtod(m, struct ip6_hdr *); 432503f4e47SBjoern A. Zeeb ifp = m->m_pkthdr.rcvif; 43382cd038dSYoshinobu Inoue /* 43433cde130SBruce M Simpson * Check multicast group membership. 43533cde130SBruce M Simpson * Note: SSM filters are not applied for ICMPv6 traffic. 43633cde130SBruce M Simpson */ 43733cde130SBruce M Simpson if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) { 43833cde130SBruce M Simpson struct in6_multi *inm; 43933cde130SBruce M Simpson 44033cde130SBruce M Simpson inm = in6m_lookup(ifp, &ip6->ip6_dst); 44133cde130SBruce M Simpson if (inm == NULL) { 44233cde130SBruce M Simpson IP6STAT_INC(ip6s_notmember); 44333cde130SBruce M Simpson in6_ifstat_inc(m->m_pkthdr.rcvif, ifs6_in_discard); 44433cde130SBruce M Simpson goto freeit; 44533cde130SBruce M Simpson } 44633cde130SBruce M Simpson } 44733cde130SBruce M Simpson 448503f4e47SBjoern A. Zeeb /* Calculate the checksum. */ 44982cd038dSYoshinobu Inoue icmp6 = (struct icmp6_hdr *)((caddr_t)ip6 + off); 45082cd038dSYoshinobu Inoue code = icmp6->icmp6_code; 45182cd038dSYoshinobu Inoue if ((sum = in6_cksum(m, IPPROTO_ICMPV6, off, icmp6len)) != 0) { 45233841545SHajimu UMEMOTO nd6log((LOG_ERR, 45382cd038dSYoshinobu Inoue "ICMP6 checksum error(%d|%x) %s\n", 4541d54aa3bSBjoern A. Zeeb icmp6->icmp6_type, sum, 4551d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6bufs, &ip6->ip6_src))); 456e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_checksum); 45782cd038dSYoshinobu Inoue goto freeit; 45882cd038dSYoshinobu Inoue } 45982cd038dSYoshinobu Inoue 460e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_inhist[icmp6->icmp6_type]); 46129dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_msg); 46282cd038dSYoshinobu Inoue if (icmp6->icmp6_type < ICMP6_INFOMSG_MASK) 46329dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_error); 46482cd038dSYoshinobu Inoue 465503f4e47SBjoern A. Zeeb ip6len = sizeof(struct ip6_hdr) + ntohs(ip6->ip6_plen); 46682cd038dSYoshinobu Inoue switch (icmp6->icmp6_type) { 46782cd038dSYoshinobu Inoue case ICMP6_DST_UNREACH: 46829dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_dstunreach); 46982cd038dSYoshinobu Inoue switch (code) { 47082cd038dSYoshinobu Inoue case ICMP6_DST_UNREACH_NOROUTE: 471d4c22202SAndrew Gallatin case ICMP6_DST_UNREACH_ADDR: /* PRC_HOSTDEAD is a DOS */ 47282cd038dSYoshinobu Inoue code = PRC_UNREACH_NET; 47382cd038dSYoshinobu Inoue break; 47482cd038dSYoshinobu Inoue case ICMP6_DST_UNREACH_ADMIN: 47529dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_adminprohib); 4763e146575SMichael Tuexen code = PRC_UNREACH_ADMIN_PROHIB; 47782cd038dSYoshinobu Inoue break; 478686cdd19SJun-ichiro itojun Hagino case ICMP6_DST_UNREACH_BEYONDSCOPE: 479686cdd19SJun-ichiro itojun Hagino /* I mean "source address was incorrect." */ 480686cdd19SJun-ichiro itojun Hagino code = PRC_PARAMPROB; 481686cdd19SJun-ichiro itojun Hagino break; 48282cd038dSYoshinobu Inoue case ICMP6_DST_UNREACH_NOPORT: 48382cd038dSYoshinobu Inoue code = PRC_UNREACH_PORT; 48482cd038dSYoshinobu Inoue break; 48582cd038dSYoshinobu Inoue default: 48682cd038dSYoshinobu Inoue goto badcode; 48782cd038dSYoshinobu Inoue } 48882cd038dSYoshinobu Inoue goto deliver; 48982cd038dSYoshinobu Inoue break; 49082cd038dSYoshinobu Inoue 49182cd038dSYoshinobu Inoue case ICMP6_PACKET_TOO_BIG: 49229dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_pkttoobig); 49382cd038dSYoshinobu Inoue 494aaff9927SHajimu UMEMOTO /* validation is made in icmp6_mtudisc_update */ 495aaff9927SHajimu UMEMOTO 49682cd038dSYoshinobu Inoue code = PRC_MSGSIZE; 49782cd038dSYoshinobu Inoue 498686cdd19SJun-ichiro itojun Hagino /* 499686cdd19SJun-ichiro itojun Hagino * Updating the path MTU will be done after examining 500686cdd19SJun-ichiro itojun Hagino * intermediate extension headers. 501686cdd19SJun-ichiro itojun Hagino */ 50282cd038dSYoshinobu Inoue goto deliver; 50382cd038dSYoshinobu Inoue break; 50482cd038dSYoshinobu Inoue 50582cd038dSYoshinobu Inoue case ICMP6_TIME_EXCEEDED: 50629dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_timeexceed); 50782cd038dSYoshinobu Inoue switch (code) { 50882cd038dSYoshinobu Inoue case ICMP6_TIME_EXCEED_TRANSIT: 5092ce62dceSSUZUKI Shinsuke code = PRC_TIMXCEED_INTRANS; 5102ce62dceSSUZUKI Shinsuke break; 51182cd038dSYoshinobu Inoue case ICMP6_TIME_EXCEED_REASSEMBLY: 5122ce62dceSSUZUKI Shinsuke code = PRC_TIMXCEED_REASS; 51382cd038dSYoshinobu Inoue break; 51482cd038dSYoshinobu Inoue default: 51582cd038dSYoshinobu Inoue goto badcode; 51682cd038dSYoshinobu Inoue } 51782cd038dSYoshinobu Inoue goto deliver; 51882cd038dSYoshinobu Inoue break; 51982cd038dSYoshinobu Inoue 52082cd038dSYoshinobu Inoue case ICMP6_PARAM_PROB: 52129dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_paramprob); 52282cd038dSYoshinobu Inoue switch (code) { 52382cd038dSYoshinobu Inoue case ICMP6_PARAMPROB_NEXTHEADER: 52482cd038dSYoshinobu Inoue code = PRC_UNREACH_PROTOCOL; 52582cd038dSYoshinobu Inoue break; 52682cd038dSYoshinobu Inoue case ICMP6_PARAMPROB_HEADER: 52782cd038dSYoshinobu Inoue case ICMP6_PARAMPROB_OPTION: 52882cd038dSYoshinobu Inoue code = PRC_PARAMPROB; 52982cd038dSYoshinobu Inoue break; 53082cd038dSYoshinobu Inoue default: 53182cd038dSYoshinobu Inoue goto badcode; 53282cd038dSYoshinobu Inoue } 53382cd038dSYoshinobu Inoue goto deliver; 53482cd038dSYoshinobu Inoue break; 53582cd038dSYoshinobu Inoue 53682cd038dSYoshinobu Inoue case ICMP6_ECHO_REQUEST: 53729dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_echo); 53882cd038dSYoshinobu Inoue if (code != 0) 53982cd038dSYoshinobu Inoue goto badcode; 540c3bef61eSKevin Lo if ((n = m_copym(m, 0, M_COPYALL, M_NOWAIT)) == NULL) { 54182cd038dSYoshinobu Inoue /* Give up remote */ 54282cd038dSYoshinobu Inoue break; 54382cd038dSYoshinobu Inoue } 544f0cace5dSRobert Watson if (!M_WRITABLE(n) 545686cdd19SJun-ichiro itojun Hagino || n->m_len < off + sizeof(struct icmp6_hdr)) { 54682cd038dSYoshinobu Inoue struct mbuf *n0 = n; 5472268ca47SSam Leffler int n0len; 54882cd038dSYoshinobu Inoue 54910e5acc3SGleb Smirnoff CTASSERT(sizeof(*nip6) + sizeof(*nicmp6) <= MHLEN); 5507b07d1beSGleb Smirnoff n = m_gethdr(M_NOWAIT, n0->m_type); 55182cd038dSYoshinobu Inoue if (n == NULL) { 55282cd038dSYoshinobu Inoue /* Give up remote */ 55382cd038dSYoshinobu Inoue m_freem(n0); 55482cd038dSYoshinobu Inoue break; 55582cd038dSYoshinobu Inoue } 55610e5acc3SGleb Smirnoff 55710e5acc3SGleb Smirnoff m_move_pkthdr(n, n0); /* FIB copied. */ 55810e5acc3SGleb Smirnoff n0len = n0->m_pkthdr.len; /* save for use below */ 55982cd038dSYoshinobu Inoue /* 56082cd038dSYoshinobu Inoue * Copy IPv6 and ICMPv6 only. 56182cd038dSYoshinobu Inoue */ 56282cd038dSYoshinobu Inoue nip6 = mtod(n, struct ip6_hdr *); 56382cd038dSYoshinobu Inoue bcopy(ip6, nip6, sizeof(struct ip6_hdr)); 56482cd038dSYoshinobu Inoue nicmp6 = (struct icmp6_hdr *)(nip6 + 1); 56582cd038dSYoshinobu Inoue bcopy(icmp6, nicmp6, sizeof(struct icmp6_hdr)); 56682cd038dSYoshinobu Inoue noff = sizeof(struct ip6_hdr); 5672268ca47SSam Leffler /* new mbuf contains only ipv6+icmpv6 headers */ 5682268ca47SSam Leffler n->m_len = noff + sizeof(struct icmp6_hdr); 569686cdd19SJun-ichiro itojun Hagino /* 570686cdd19SJun-ichiro itojun Hagino * Adjust mbuf. ip6_plen will be adjusted in 571686cdd19SJun-ichiro itojun Hagino * ip6_output(). 572686cdd19SJun-ichiro itojun Hagino */ 573686cdd19SJun-ichiro itojun Hagino m_adj(n0, off + sizeof(struct icmp6_hdr)); 5742268ca47SSam Leffler /* recalculate complete packet size */ 5752268ca47SSam Leffler n->m_pkthdr.len = n0len + (noff - off); 576686cdd19SJun-ichiro itojun Hagino n->m_next = n0; 57782cd038dSYoshinobu Inoue } else { 578a4adf6ccSBjoern A. Zeeb if (n->m_len < off + sizeof(*nicmp6)) { 579a61b5cfbSBjoern A. Zeeb n = m_pullup(n, off + sizeof(*nicmp6)); 580a61b5cfbSBjoern A. Zeeb if (n == NULL) { 581a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 582a61b5cfbSBjoern A. Zeeb break; 583a61b5cfbSBjoern A. Zeeb } 584a4adf6ccSBjoern A. Zeeb } 585a61b5cfbSBjoern A. Zeeb nicmp6 = (struct icmp6_hdr *)(mtod(n, caddr_t) + off); 58682cd038dSYoshinobu Inoue noff = off; 58782cd038dSYoshinobu Inoue } 588fb043945SJonathan T. Looney if (n) { 58982cd038dSYoshinobu Inoue nicmp6->icmp6_type = ICMP6_ECHO_REPLY; 59082cd038dSYoshinobu Inoue nicmp6->icmp6_code = 0; 591e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_reflect); 592e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_outhist[ICMP6_ECHO_REPLY]); 59382cd038dSYoshinobu Inoue icmp6_reflect(n, noff); 59482cd038dSYoshinobu Inoue } 59582cd038dSYoshinobu Inoue break; 59682cd038dSYoshinobu Inoue 59782cd038dSYoshinobu Inoue case ICMP6_ECHO_REPLY: 59829dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_echoreply); 59982cd038dSYoshinobu Inoue if (code != 0) 60082cd038dSYoshinobu Inoue goto badcode; 60182cd038dSYoshinobu Inoue break; 60282cd038dSYoshinobu Inoue 60381170631SHajimu UMEMOTO case MLD_LISTENER_QUERY: 60481170631SHajimu UMEMOTO case MLD_LISTENER_REPORT: 60533cde130SBruce M Simpson case MLD_LISTENER_DONE: 60633cde130SBruce M Simpson case MLDV2_LISTENER_REPORT: 60733cde130SBruce M Simpson /* 60829dc7bc6SBruce M Simpson * Drop MLD traffic which is not link-local, has a hop limit 60929dc7bc6SBruce M Simpson * of greater than 1 hop, or which does not have the 61029dc7bc6SBruce M Simpson * IPv6 HBH Router Alert option. 61129dc7bc6SBruce M Simpson * As IPv6 HBH options are stripped in ip6_input() we must 61229dc7bc6SBruce M Simpson * check an mbuf header flag. 61333cde130SBruce M Simpson * XXX Should we also sanity check that these messages 61433cde130SBruce M Simpson * were directed to a link-local multicast prefix? 61533cde130SBruce M Simpson */ 61629dc7bc6SBruce M Simpson if ((ip6->ip6_hlim != 1) || (m->m_flags & M_RTALERT_MLD) == 0) 617686cdd19SJun-ichiro itojun Hagino goto freeit; 61832af08ecSBjoern A. Zeeb if (mld_input(&m, off, icmp6len) != 0) { 619a8fe77d8SBjoern A. Zeeb *mp = NULL; 62033cde130SBruce M Simpson return (IPPROTO_DONE); 621a8fe77d8SBjoern A. Zeeb } 62282cd038dSYoshinobu Inoue /* m stays. */ 62382cd038dSYoshinobu Inoue break; 62482cd038dSYoshinobu Inoue 62582cd038dSYoshinobu Inoue case ICMP6_WRUREQUEST: /* ICMP6_FQDN_QUERY */ 62682cd038dSYoshinobu Inoue { 62782cd038dSYoshinobu Inoue enum { WRU, FQDN } mode; 6287460ef5dSHiroki Sato struct prison *pr; 62982cd038dSYoshinobu Inoue 630603724d3SBjoern A. Zeeb if (!V_icmp6_nodeinfo) 631686cdd19SJun-ichiro itojun Hagino break; 632686cdd19SJun-ichiro itojun Hagino 63382cd038dSYoshinobu Inoue if (icmp6len == sizeof(struct icmp6_hdr) + 4) 63482cd038dSYoshinobu Inoue mode = WRU; 635686cdd19SJun-ichiro itojun Hagino else if (icmp6len >= sizeof(struct icmp6_nodeinfo)) 63682cd038dSYoshinobu Inoue mode = FQDN; 63782cd038dSYoshinobu Inoue else 63882cd038dSYoshinobu Inoue goto badlen; 63982cd038dSYoshinobu Inoue 6407460ef5dSHiroki Sato pr = NULL; 6417460ef5dSHiroki Sato sx_slock(&allprison_lock); 6427460ef5dSHiroki Sato TAILQ_FOREACH(pr, &allprison, pr_list) 6437460ef5dSHiroki Sato if (pr->pr_vnet == ifp->if_vnet) 6447460ef5dSHiroki Sato break; 6457460ef5dSHiroki Sato sx_sunlock(&allprison_lock); 6467460ef5dSHiroki Sato if (pr == NULL) 6477460ef5dSHiroki Sato pr = curthread->td_ucred->cr_prison; 64882cd038dSYoshinobu Inoue if (mode == FQDN) { 649a4adf6ccSBjoern A. Zeeb if (m->m_len < off + sizeof(struct icmp6_nodeinfo)) { 650a4adf6ccSBjoern A. Zeeb m = m_pullup(m, off + 651a4adf6ccSBjoern A. Zeeb sizeof(struct icmp6_nodeinfo)); 652a61b5cfbSBjoern A. Zeeb if (m == NULL) { 653a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 654a61b5cfbSBjoern A. Zeeb *mp = m; 655a61b5cfbSBjoern A. Zeeb return (IPPROTO_DONE); 656a61b5cfbSBjoern A. Zeeb } 657a4adf6ccSBjoern A. Zeeb } 658c3bef61eSKevin Lo n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 659686cdd19SJun-ichiro itojun Hagino if (n) 6607460ef5dSHiroki Sato n = ni6_input(n, off, pr); 661686cdd19SJun-ichiro itojun Hagino /* XXX meaningless if n == NULL */ 66282cd038dSYoshinobu Inoue noff = sizeof(struct ip6_hdr); 66382cd038dSYoshinobu Inoue } else { 66482cd038dSYoshinobu Inoue u_char *p; 66510e5acc3SGleb Smirnoff int maxhlen, hlen; 66682cd038dSYoshinobu Inoue 66718706985SJINMEI Tatuya /* 66818706985SJINMEI Tatuya * XXX: this combination of flags is pointless, 66918706985SJINMEI Tatuya * but should we keep this for compatibility? 67018706985SJINMEI Tatuya */ 671c81c183dSMark Johnston if ((V_icmp6_nodeinfo & (ICMP6_NODEINFO_FQDNOK | 672c81c183dSMark Johnston ICMP6_NODEINFO_TMPADDROK)) != 673c81c183dSMark Johnston (ICMP6_NODEINFO_FQDNOK | ICMP6_NODEINFO_TMPADDROK)) 67433841545SHajimu UMEMOTO break; 67533841545SHajimu UMEMOTO 676686cdd19SJun-ichiro itojun Hagino if (code != 0) 677686cdd19SJun-ichiro itojun Hagino goto badcode; 67810e5acc3SGleb Smirnoff 67910e5acc3SGleb Smirnoff CTASSERT(sizeof(*nip6) + sizeof(*nicmp6) + 4 <= MHLEN); 68010e5acc3SGleb Smirnoff n = m_gethdr(M_NOWAIT, m->m_type); 68110e5acc3SGleb Smirnoff if (n == NULL) { 682686cdd19SJun-ichiro itojun Hagino /* Give up remote */ 683686cdd19SJun-ichiro itojun Hagino break; 684686cdd19SJun-ichiro itojun Hagino } 68510e5acc3SGleb Smirnoff if (!m_dup_pkthdr(n, m, M_NOWAIT)) { 6869967cafcSSam Leffler /* 6879967cafcSSam Leffler * Previous code did a blind M_COPY_PKTHDR 6889967cafcSSam Leffler * and said "just for rcvif". If true, then 6899967cafcSSam Leffler * we could tolerate the dup failing (due to 6909967cafcSSam Leffler * the deep copy of the tag chain). For now 6919967cafcSSam Leffler * be conservative and just fail. 6929967cafcSSam Leffler */ 6939967cafcSSam Leffler m_free(n); 6949967cafcSSam Leffler n = NULL; 695fb043945SJonathan T. Looney break; 6969967cafcSSam Leffler } 69782cd038dSYoshinobu Inoue /* 69882cd038dSYoshinobu Inoue * Copy IPv6 and ICMPv6 only. 69982cd038dSYoshinobu Inoue */ 70082cd038dSYoshinobu Inoue nip6 = mtod(n, struct ip6_hdr *); 70182cd038dSYoshinobu Inoue bcopy(ip6, nip6, sizeof(struct ip6_hdr)); 70282cd038dSYoshinobu Inoue nicmp6 = (struct icmp6_hdr *)(nip6 + 1); 70382cd038dSYoshinobu Inoue bcopy(icmp6, nicmp6, sizeof(struct icmp6_hdr)); 70482cd038dSYoshinobu Inoue p = (u_char *)(nicmp6 + 1); 70582cd038dSYoshinobu Inoue bzero(p, 4); 7067460ef5dSHiroki Sato 7077460ef5dSHiroki Sato maxhlen = M_TRAILINGSPACE(n) - 7087460ef5dSHiroki Sato (sizeof(*nip6) + sizeof(*nicmp6) + 4); 7097460ef5dSHiroki Sato mtx_lock(&pr->pr_mtx); 7107460ef5dSHiroki Sato hlen = strlen(pr->pr_hostname); 7117460ef5dSHiroki Sato if (maxhlen > hlen) 7127460ef5dSHiroki Sato maxhlen = hlen; 713c1f19219SJamie Gritton /* meaningless TTL */ 714c1f19219SJamie Gritton bcopy(pr->pr_hostname, p + 4, maxhlen); 71576ca6f88SJamie Gritton mtx_unlock(&pr->pr_mtx); 71682cd038dSYoshinobu Inoue noff = sizeof(struct ip6_hdr); 71782cd038dSYoshinobu Inoue n->m_pkthdr.len = n->m_len = sizeof(struct ip6_hdr) + 718686cdd19SJun-ichiro itojun Hagino sizeof(struct icmp6_hdr) + 4 + maxhlen; 71982cd038dSYoshinobu Inoue nicmp6->icmp6_type = ICMP6_WRUREPLY; 72082cd038dSYoshinobu Inoue nicmp6->icmp6_code = 0; 72182cd038dSYoshinobu Inoue } 72282cd038dSYoshinobu Inoue if (n) { 723e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_reflect); 724e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_outhist[ICMP6_WRUREPLY]); 72582cd038dSYoshinobu Inoue icmp6_reflect(n, noff); 72682cd038dSYoshinobu Inoue } 72782cd038dSYoshinobu Inoue break; 72882cd038dSYoshinobu Inoue } 72982cd038dSYoshinobu Inoue 73082cd038dSYoshinobu Inoue case ICMP6_WRUREPLY: 73182cd038dSYoshinobu Inoue if (code != 0) 73282cd038dSYoshinobu Inoue goto badcode; 73382cd038dSYoshinobu Inoue break; 73482cd038dSYoshinobu Inoue 73582cd038dSYoshinobu Inoue case ND_ROUTER_SOLICIT: 73629dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_routersolicit); 73782cd038dSYoshinobu Inoue if (code != 0) 73882cd038dSYoshinobu Inoue goto badcode; 73982cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct nd_router_solicit)) 74082cd038dSYoshinobu Inoue goto badlen; 7411db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 742a4adf6ccSBjoern A. Zeeb if (m->m_len < off + icmp6len) { 743a61b5cfbSBjoern A. Zeeb m = m_pullup(m, off + icmp6len); 744a61b5cfbSBjoern A. Zeeb if (m == NULL) { 745a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 746a61b5cfbSBjoern A. Zeeb *mp = NULL; 747a61b5cfbSBjoern A. Zeeb return (IPPROTO_DONE); 748a61b5cfbSBjoern A. Zeeb } 749a4adf6ccSBjoern A. Zeeb } 7502d12d25cSMark Johnston error = send_sendso_input_hook(m, ifp, SND_IN, ip6len); 7512d12d25cSMark Johnston if (error == 0) { 752686cdd19SJun-ichiro itojun Hagino m = NULL; 753686cdd19SJun-ichiro itojun Hagino goto freeit; 754686cdd19SJun-ichiro itojun Hagino } 7552d12d25cSMark Johnston } 7562d12d25cSMark Johnston n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 7572d12d25cSMark Johnston nd6_rs_input(m, off, icmp6len); 7582d12d25cSMark Johnston m = n; 7592d12d25cSMark Johnston if (m == NULL) 760e7a6db74SAna Kukec goto freeit; 76182cd038dSYoshinobu Inoue break; 76282cd038dSYoshinobu Inoue 76382cd038dSYoshinobu Inoue case ND_ROUTER_ADVERT: 76429dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_routeradvert); 76582cd038dSYoshinobu Inoue if (code != 0) 76682cd038dSYoshinobu Inoue goto badcode; 76782cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct nd_router_advert)) 76882cd038dSYoshinobu Inoue goto badlen; 7691db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 7702d12d25cSMark Johnston error = send_sendso_input_hook(m, ifp, SND_IN, ip6len); 7712d12d25cSMark Johnston if (error == 0) { 772686cdd19SJun-ichiro itojun Hagino m = NULL; 773686cdd19SJun-ichiro itojun Hagino goto freeit; 774686cdd19SJun-ichiro itojun Hagino } 7752d12d25cSMark Johnston } 7762d12d25cSMark Johnston n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 7772d12d25cSMark Johnston nd6_ra_input(m, off, icmp6len); 7782d12d25cSMark Johnston m = n; 7792d12d25cSMark Johnston if (m == NULL) 780e7a6db74SAna Kukec goto freeit; 78182cd038dSYoshinobu Inoue break; 78282cd038dSYoshinobu Inoue 78382cd038dSYoshinobu Inoue case ND_NEIGHBOR_SOLICIT: 78429dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_neighborsolicit); 78582cd038dSYoshinobu Inoue if (code != 0) 78682cd038dSYoshinobu Inoue goto badcode; 78782cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct nd_neighbor_solicit)) 78882cd038dSYoshinobu Inoue goto badlen; 7891db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 7902d12d25cSMark Johnston error = send_sendso_input_hook(m, ifp, SND_IN, ip6len); 7912d12d25cSMark Johnston if (error == 0) { 792686cdd19SJun-ichiro itojun Hagino m = NULL; 793686cdd19SJun-ichiro itojun Hagino goto freeit; 794686cdd19SJun-ichiro itojun Hagino } 7952d12d25cSMark Johnston } 7962d12d25cSMark Johnston n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 7972d12d25cSMark Johnston nd6_ns_input(m, off, icmp6len); 7982d12d25cSMark Johnston m = n; 7992d12d25cSMark Johnston if (m == NULL) 800e7a6db74SAna Kukec goto freeit; 80182cd038dSYoshinobu Inoue break; 80282cd038dSYoshinobu Inoue 80382cd038dSYoshinobu Inoue case ND_NEIGHBOR_ADVERT: 80429dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_neighboradvert); 80582cd038dSYoshinobu Inoue if (code != 0) 80682cd038dSYoshinobu Inoue goto badcode; 80782cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct nd_neighbor_advert)) 80882cd038dSYoshinobu Inoue goto badlen; 8091db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 8102d12d25cSMark Johnston error = send_sendso_input_hook(m, ifp, SND_IN, ip6len); 8112d12d25cSMark Johnston if (error == 0) { 812686cdd19SJun-ichiro itojun Hagino m = NULL; 813686cdd19SJun-ichiro itojun Hagino goto freeit; 814686cdd19SJun-ichiro itojun Hagino } 8152d12d25cSMark Johnston } 8162d12d25cSMark Johnston n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 8172d12d25cSMark Johnston nd6_na_input(m, off, icmp6len); 8182d12d25cSMark Johnston m = n; 8192d12d25cSMark Johnston if (m == NULL) 820e7a6db74SAna Kukec goto freeit; 82182cd038dSYoshinobu Inoue break; 82282cd038dSYoshinobu Inoue 82382cd038dSYoshinobu Inoue case ND_REDIRECT: 82429dc7bc6SBruce M Simpson icmp6_ifstat_inc(ifp, ifs6_in_redirect); 82582cd038dSYoshinobu Inoue if (code != 0) 82682cd038dSYoshinobu Inoue goto badcode; 82782cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct nd_redirect)) 82882cd038dSYoshinobu Inoue goto badlen; 8291db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 8302d12d25cSMark Johnston error = send_sendso_input_hook(m, ifp, SND_IN, ip6len); 8312d12d25cSMark Johnston if (error == 0) { 832686cdd19SJun-ichiro itojun Hagino m = NULL; 833686cdd19SJun-ichiro itojun Hagino goto freeit; 834686cdd19SJun-ichiro itojun Hagino } 8352d12d25cSMark Johnston } 8362d12d25cSMark Johnston n = m_copym(m, 0, M_COPYALL, M_NOWAIT); 8372d12d25cSMark Johnston icmp6_redirect_input(m, off); 8382d12d25cSMark Johnston m = n; 8392d12d25cSMark Johnston if (m == NULL) 840e7a6db74SAna Kukec goto freeit; 84182cd038dSYoshinobu Inoue break; 84282cd038dSYoshinobu Inoue 84382cd038dSYoshinobu Inoue case ICMP6_ROUTER_RENUMBERING: 84482cd038dSYoshinobu Inoue if (code != ICMP6_ROUTER_RENUMBERING_COMMAND && 84582cd038dSYoshinobu Inoue code != ICMP6_ROUTER_RENUMBERING_RESULT) 84682cd038dSYoshinobu Inoue goto badcode; 84782cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct icmp6_router_renum)) 84882cd038dSYoshinobu Inoue goto badlen; 84982cd038dSYoshinobu Inoue break; 85082cd038dSYoshinobu Inoue 85182cd038dSYoshinobu Inoue default: 85233841545SHajimu UMEMOTO nd6log((LOG_DEBUG, 85333841545SHajimu UMEMOTO "icmp6_input: unknown type %d(src=%s, dst=%s, ifid=%d)\n", 8541d54aa3bSBjoern A. Zeeb icmp6->icmp6_type, ip6_sprintf(ip6bufs, &ip6->ip6_src), 8551d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6bufd, &ip6->ip6_dst), 85629dc7bc6SBruce M Simpson ifp ? ifp->if_index : 0)); 85782cd038dSYoshinobu Inoue if (icmp6->icmp6_type < ICMP6_ECHO_REQUEST) { 85882cd038dSYoshinobu Inoue /* ICMPv6 error: MUST deliver it by spec... */ 85982cd038dSYoshinobu Inoue code = PRC_NCMDS; 86082cd038dSYoshinobu Inoue /* deliver */ 86182cd038dSYoshinobu Inoue } else { 86282cd038dSYoshinobu Inoue /* ICMPv6 informational: MUST not deliver */ 86382cd038dSYoshinobu Inoue break; 86482cd038dSYoshinobu Inoue } 86582cd038dSYoshinobu Inoue deliver: 86614c129fcSBjoern A. Zeeb if (icmp6_notify_error(&m, off, icmp6len, code) != 0) { 86733841545SHajimu UMEMOTO /* In this case, m should've been freed. */ 868a8fe77d8SBjoern A. Zeeb *mp = NULL; 86933841545SHajimu UMEMOTO return (IPPROTO_DONE); 87033841545SHajimu UMEMOTO } 87133841545SHajimu UMEMOTO break; 87233841545SHajimu UMEMOTO 87333841545SHajimu UMEMOTO badcode: 874e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_badcode); 87533841545SHajimu UMEMOTO break; 87633841545SHajimu UMEMOTO 87733841545SHajimu UMEMOTO badlen: 878e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_badlen); 87933841545SHajimu UMEMOTO break; 88033841545SHajimu UMEMOTO } 88133841545SHajimu UMEMOTO 88233841545SHajimu UMEMOTO /* deliver the packet to appropriate sockets */ 88333841545SHajimu UMEMOTO icmp6_rip6_input(&m, *offp); 88433841545SHajimu UMEMOTO 885a8fe77d8SBjoern A. Zeeb *mp = m; 886a8fe77d8SBjoern A. Zeeb return (IPPROTO_DONE); 88733841545SHajimu UMEMOTO 88833841545SHajimu UMEMOTO freeit: 88933841545SHajimu UMEMOTO m_freem(m); 890a8fe77d8SBjoern A. Zeeb *mp = NULL; 891a8fe77d8SBjoern A. Zeeb return (IPPROTO_DONE); 89233841545SHajimu UMEMOTO } 89333841545SHajimu UMEMOTO 89433841545SHajimu UMEMOTO static int 8951272577eSXin LI icmp6_notify_error(struct mbuf **mp, int off, int icmp6len, int code) 89633841545SHajimu UMEMOTO { 897503f4e47SBjoern A. Zeeb struct mbuf *m; 89833841545SHajimu UMEMOTO struct icmp6_hdr *icmp6; 89933841545SHajimu UMEMOTO struct ip6_hdr *eip6; 90033841545SHajimu UMEMOTO u_int32_t notifymtu; 90133841545SHajimu UMEMOTO struct sockaddr_in6 icmp6src, icmp6dst; 90233841545SHajimu UMEMOTO 903503f4e47SBjoern A. Zeeb m = *mp; 904503f4e47SBjoern A. Zeeb 90582cd038dSYoshinobu Inoue if (icmp6len < sizeof(struct icmp6_hdr) + sizeof(struct ip6_hdr)) { 906e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_tooshort); 90782cd038dSYoshinobu Inoue goto freeit; 90882cd038dSYoshinobu Inoue } 909a61b5cfbSBjoern A. Zeeb 910a4adf6ccSBjoern A. Zeeb if (m->m_len < off + sizeof(*icmp6) + sizeof(struct ip6_hdr)) { 911a61b5cfbSBjoern A. Zeeb m = m_pullup(m, off + sizeof(*icmp6) + sizeof(struct ip6_hdr)); 912a61b5cfbSBjoern A. Zeeb if (m == NULL) { 913a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 914a61b5cfbSBjoern A. Zeeb *mp = m; 91533841545SHajimu UMEMOTO return (-1); 916686cdd19SJun-ichiro itojun Hagino } 917a4adf6ccSBjoern A. Zeeb } 918a61b5cfbSBjoern A. Zeeb icmp6 = (struct icmp6_hdr *)(mtod(m, caddr_t) + off); 91933841545SHajimu UMEMOTO eip6 = (struct ip6_hdr *)(icmp6 + 1); 920*d9999ae9SAlexander V. Chernikov bzero(&icmp6dst, sizeof(icmp6dst)); 92182cd038dSYoshinobu Inoue 92282cd038dSYoshinobu Inoue /* Detect the upper level protocol */ 92382cd038dSYoshinobu Inoue { 9249233d8f3SDavid E. O'Brien void (*ctlfunc)(int, struct sockaddr *, void *); 92582cd038dSYoshinobu Inoue u_int8_t nxt = eip6->ip6_nxt; 92682cd038dSYoshinobu Inoue int eoff = off + sizeof(struct icmp6_hdr) + 92782cd038dSYoshinobu Inoue sizeof(struct ip6_hdr); 92882cd038dSYoshinobu Inoue struct ip6ctlparam ip6cp; 929686cdd19SJun-ichiro itojun Hagino int icmp6type = icmp6->icmp6_type; 930686cdd19SJun-ichiro itojun Hagino struct ip6_frag *fh; 931686cdd19SJun-ichiro itojun Hagino struct ip6_rthdr *rth; 932686cdd19SJun-ichiro itojun Hagino struct ip6_rthdr0 *rth0; 933686cdd19SJun-ichiro itojun Hagino int rthlen; 93482cd038dSYoshinobu Inoue 93588ff5695SSUZUKI Shinsuke while (1) { /* XXX: should avoid infinite loop explicitly? */ 93682cd038dSYoshinobu Inoue struct ip6_ext *eh; 93782cd038dSYoshinobu Inoue 93882cd038dSYoshinobu Inoue switch (nxt) { 93982cd038dSYoshinobu Inoue case IPPROTO_HOPOPTS: 94082cd038dSYoshinobu Inoue case IPPROTO_DSTOPTS: 94182cd038dSYoshinobu Inoue case IPPROTO_AH: 942a4adf6ccSBjoern A. Zeeb if (m->m_len < eoff + sizeof(struct ip6_ext)) { 943a4adf6ccSBjoern A. Zeeb m = m_pullup(m, eoff + 944a4adf6ccSBjoern A. Zeeb sizeof(struct ip6_ext)); 945a61b5cfbSBjoern A. Zeeb if (m == NULL) { 946a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 947a61b5cfbSBjoern A. Zeeb *mp = m; 94833841545SHajimu UMEMOTO return (-1); 949686cdd19SJun-ichiro itojun Hagino } 950a4adf6ccSBjoern A. Zeeb } 951a61b5cfbSBjoern A. Zeeb eh = (struct ip6_ext *) 952a61b5cfbSBjoern A. Zeeb (mtod(m, caddr_t) + eoff); 95382cd038dSYoshinobu Inoue if (nxt == IPPROTO_AH) 95482cd038dSYoshinobu Inoue eoff += (eh->ip6e_len + 2) << 2; 95582cd038dSYoshinobu Inoue else 95682cd038dSYoshinobu Inoue eoff += (eh->ip6e_len + 1) << 3; 95782cd038dSYoshinobu Inoue nxt = eh->ip6e_nxt; 95882cd038dSYoshinobu Inoue break; 959686cdd19SJun-ichiro itojun Hagino case IPPROTO_ROUTING: 960686cdd19SJun-ichiro itojun Hagino /* 961686cdd19SJun-ichiro itojun Hagino * When the erroneous packet contains a 962686cdd19SJun-ichiro itojun Hagino * routing header, we should examine the 963686cdd19SJun-ichiro itojun Hagino * header to determine the final destination. 964686cdd19SJun-ichiro itojun Hagino * Otherwise, we can't properly update 965686cdd19SJun-ichiro itojun Hagino * information that depends on the final 966686cdd19SJun-ichiro itojun Hagino * destination (e.g. path MTU). 967686cdd19SJun-ichiro itojun Hagino */ 968a4adf6ccSBjoern A. Zeeb if (m->m_len < eoff + sizeof(*rth)) { 969a61b5cfbSBjoern A. Zeeb m = m_pullup(m, eoff + sizeof(*rth)); 970a61b5cfbSBjoern A. Zeeb if (m == NULL) { 971a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 972a61b5cfbSBjoern A. Zeeb *mp = m; 97333841545SHajimu UMEMOTO return (-1); 974686cdd19SJun-ichiro itojun Hagino } 975a4adf6ccSBjoern A. Zeeb } 976a61b5cfbSBjoern A. Zeeb rth = (struct ip6_rthdr *) 977a61b5cfbSBjoern A. Zeeb (mtod(m, caddr_t) + eoff); 978686cdd19SJun-ichiro itojun Hagino rthlen = (rth->ip6r_len + 1) << 3; 979686cdd19SJun-ichiro itojun Hagino /* 980686cdd19SJun-ichiro itojun Hagino * XXX: currently there is no 981686cdd19SJun-ichiro itojun Hagino * officially defined type other 982686cdd19SJun-ichiro itojun Hagino * than type-0. 983686cdd19SJun-ichiro itojun Hagino * Note that if the segment left field 984686cdd19SJun-ichiro itojun Hagino * is 0, all intermediate hops must 985686cdd19SJun-ichiro itojun Hagino * have been passed. 986686cdd19SJun-ichiro itojun Hagino */ 987686cdd19SJun-ichiro itojun Hagino if (rth->ip6r_segleft && 988686cdd19SJun-ichiro itojun Hagino rth->ip6r_type == IPV6_RTHDR_TYPE_0) { 989686cdd19SJun-ichiro itojun Hagino int hops; 990686cdd19SJun-ichiro itojun Hagino 991a4adf6ccSBjoern A. Zeeb if (m->m_len < eoff + rthlen) { 992a61b5cfbSBjoern A. Zeeb m = m_pullup(m, eoff + rthlen); 993a61b5cfbSBjoern A. Zeeb if (m == NULL) { 994a4adf6ccSBjoern A. Zeeb IP6STAT_INC( 995a4adf6ccSBjoern A. Zeeb ip6s_exthdrtoolong); 996a61b5cfbSBjoern A. Zeeb *mp = m; 99733841545SHajimu UMEMOTO return (-1); 998686cdd19SJun-ichiro itojun Hagino } 999a4adf6ccSBjoern A. Zeeb } 1000a61b5cfbSBjoern A. Zeeb rth0 = (struct ip6_rthdr0 *) 1001a61b5cfbSBjoern A. Zeeb (mtod(m, caddr_t) + eoff); 1002*d9999ae9SAlexander V. Chernikov 1003686cdd19SJun-ichiro itojun Hagino /* just ignore a bogus header */ 1004686cdd19SJun-ichiro itojun Hagino if ((rth0->ip6r0_len % 2) == 0 && 1005686cdd19SJun-ichiro itojun Hagino (hops = rth0->ip6r0_len/2)) 1006*d9999ae9SAlexander V. Chernikov icmp6dst.sin6_addr = *((struct in6_addr *)(rth0 + 1) + (hops - 1)); 1007686cdd19SJun-ichiro itojun Hagino } 1008686cdd19SJun-ichiro itojun Hagino eoff += rthlen; 1009686cdd19SJun-ichiro itojun Hagino nxt = rth->ip6r_nxt; 1010686cdd19SJun-ichiro itojun Hagino break; 1011686cdd19SJun-ichiro itojun Hagino case IPPROTO_FRAGMENT: 1012a4adf6ccSBjoern A. Zeeb if (m->m_len < eoff + sizeof(struct ip6_frag)) { 1013a4adf6ccSBjoern A. Zeeb m = m_pullup(m, eoff + 1014a4adf6ccSBjoern A. Zeeb sizeof(struct ip6_frag)); 1015a61b5cfbSBjoern A. Zeeb if (m == NULL) { 1016a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 1017a61b5cfbSBjoern A. Zeeb *mp = m; 101833841545SHajimu UMEMOTO return (-1); 1019686cdd19SJun-ichiro itojun Hagino } 1020a4adf6ccSBjoern A. Zeeb } 1021a61b5cfbSBjoern A. Zeeb fh = (struct ip6_frag *)(mtod(m, caddr_t) + 1022a61b5cfbSBjoern A. Zeeb eoff); 1023686cdd19SJun-ichiro itojun Hagino /* 1024686cdd19SJun-ichiro itojun Hagino * Data after a fragment header is meaningless 1025686cdd19SJun-ichiro itojun Hagino * unless it is the first fragment, but 1026686cdd19SJun-ichiro itojun Hagino * we'll go to the notify label for path MTU 1027686cdd19SJun-ichiro itojun Hagino * discovery. 1028686cdd19SJun-ichiro itojun Hagino */ 1029686cdd19SJun-ichiro itojun Hagino if (fh->ip6f_offlg & IP6F_OFF_MASK) 1030686cdd19SJun-ichiro itojun Hagino goto notify; 1031686cdd19SJun-ichiro itojun Hagino 1032686cdd19SJun-ichiro itojun Hagino eoff += sizeof(struct ip6_frag); 1033686cdd19SJun-ichiro itojun Hagino nxt = fh->ip6f_nxt; 1034686cdd19SJun-ichiro itojun Hagino break; 103582cd038dSYoshinobu Inoue default: 1036686cdd19SJun-ichiro itojun Hagino /* 1037686cdd19SJun-ichiro itojun Hagino * This case includes ESP and the No Next 1038686cdd19SJun-ichiro itojun Hagino * Header. In such cases going to the notify 1039686cdd19SJun-ichiro itojun Hagino * label does not have any meaning 1040686cdd19SJun-ichiro itojun Hagino * (i.e. ctlfunc will be NULL), but we go 1041686cdd19SJun-ichiro itojun Hagino * anyway since we might have to update 1042686cdd19SJun-ichiro itojun Hagino * path MTU information. 1043686cdd19SJun-ichiro itojun Hagino */ 104482cd038dSYoshinobu Inoue goto notify; 104582cd038dSYoshinobu Inoue } 104682cd038dSYoshinobu Inoue } 104782cd038dSYoshinobu Inoue notify: 104882cd038dSYoshinobu Inoue icmp6 = (struct icmp6_hdr *)(mtod(m, caddr_t) + off); 104933841545SHajimu UMEMOTO 105006cd0a3fSHajimu UMEMOTO /* 105106cd0a3fSHajimu UMEMOTO * retrieve parameters from the inner IPv6 header, and convert 105206cd0a3fSHajimu UMEMOTO * them into sockaddr structures. 105306cd0a3fSHajimu UMEMOTO * XXX: there is no guarantee that the source or destination 105406cd0a3fSHajimu UMEMOTO * addresses of the inner packet are in the same scope as 105506cd0a3fSHajimu UMEMOTO * the addresses of the icmp packet. But there is no other 105606cd0a3fSHajimu UMEMOTO * way to determine the zone. 105706cd0a3fSHajimu UMEMOTO */ 105833841545SHajimu UMEMOTO eip6 = (struct ip6_hdr *)(icmp6 + 1); 105906cd0a3fSHajimu UMEMOTO 106033841545SHajimu UMEMOTO icmp6dst.sin6_len = sizeof(struct sockaddr_in6); 106133841545SHajimu UMEMOTO icmp6dst.sin6_family = AF_INET6; 1062*d9999ae9SAlexander V. Chernikov if (IN6_IS_ADDR_UNSPECIFIED(&icmp6dst.sin6_addr)) 106333841545SHajimu UMEMOTO icmp6dst.sin6_addr = eip6->ip6_dst; 1064a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&icmp6dst.sin6_addr, m->m_pkthdr.rcvif, NULL)) 10659a4f9608SHajimu UMEMOTO goto freeit; 106633841545SHajimu UMEMOTO bzero(&icmp6src, sizeof(icmp6src)); 106733841545SHajimu UMEMOTO icmp6src.sin6_len = sizeof(struct sockaddr_in6); 106833841545SHajimu UMEMOTO icmp6src.sin6_family = AF_INET6; 106933841545SHajimu UMEMOTO icmp6src.sin6_addr = eip6->ip6_src; 1070a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&icmp6src.sin6_addr, m->m_pkthdr.rcvif, NULL)) 10719a4f9608SHajimu UMEMOTO goto freeit; 1072a1f7e5f8SHajimu UMEMOTO icmp6src.sin6_flowinfo = 1073a1f7e5f8SHajimu UMEMOTO (eip6->ip6_flow & IPV6_FLOWLABEL_MASK); 107433841545SHajimu UMEMOTO 107533841545SHajimu UMEMOTO ip6cp.ip6c_m = m; 107633841545SHajimu UMEMOTO ip6cp.ip6c_icmp6 = icmp6; 107733841545SHajimu UMEMOTO ip6cp.ip6c_ip6 = (struct ip6_hdr *)(icmp6 + 1); 107833841545SHajimu UMEMOTO ip6cp.ip6c_off = eoff; 1079*d9999ae9SAlexander V. Chernikov ip6cp.ip6c_finaldst = &icmp6dst.sin6_addr; 108033841545SHajimu UMEMOTO ip6cp.ip6c_src = &icmp6src; 108133841545SHajimu UMEMOTO ip6cp.ip6c_nxt = nxt; 108233841545SHajimu UMEMOTO 108333841545SHajimu UMEMOTO if (icmp6type == ICMP6_PACKET_TOO_BIG) { 108433841545SHajimu UMEMOTO notifymtu = ntohl(icmp6->icmp6_mtu); 108533841545SHajimu UMEMOTO ip6cp.ip6c_cmdarg = (void *)¬ifymtu; 108633841545SHajimu UMEMOTO icmp6_mtudisc_update(&ip6cp, 1); /*XXX*/ 1087686cdd19SJun-ichiro itojun Hagino } 1088686cdd19SJun-ichiro itojun Hagino 10899233d8f3SDavid E. O'Brien ctlfunc = (void (*)(int, struct sockaddr *, void *)) 109082cd038dSYoshinobu Inoue (inet6sw[ip6_protox[nxt]].pr_ctlinput); 109182cd038dSYoshinobu Inoue if (ctlfunc) { 109233841545SHajimu UMEMOTO (void) (*ctlfunc)(code, (struct sockaddr *)&icmp6dst, 109333841545SHajimu UMEMOTO &ip6cp); 109482cd038dSYoshinobu Inoue } 109582cd038dSYoshinobu Inoue } 10969c0fda72SHajimu UMEMOTO *mp = m; 109733841545SHajimu UMEMOTO return (0); 109882cd038dSYoshinobu Inoue 109982cd038dSYoshinobu Inoue freeit: 110082cd038dSYoshinobu Inoue m_freem(m); 1101a8fe77d8SBjoern A. Zeeb *mp = NULL; 110233841545SHajimu UMEMOTO return (-1); 110382cd038dSYoshinobu Inoue } 110482cd038dSYoshinobu Inoue 110533841545SHajimu UMEMOTO void 11061272577eSXin LI icmp6_mtudisc_update(struct ip6ctlparam *ip6cp, int validated) 1107686cdd19SJun-ichiro itojun Hagino { 110833841545SHajimu UMEMOTO struct in6_addr *dst = ip6cp->ip6c_finaldst; 110933841545SHajimu UMEMOTO struct icmp6_hdr *icmp6 = ip6cp->ip6c_icmp6; 111033841545SHajimu UMEMOTO struct mbuf *m = ip6cp->ip6c_m; /* will be necessary for scope issue */ 1111686cdd19SJun-ichiro itojun Hagino u_int mtu = ntohl(icmp6->icmp6_mtu); 111297d8d152SAndre Oppermann struct in_conninfo inc; 1113686cdd19SJun-ichiro itojun Hagino 1114f95d4633SHajimu UMEMOTO #if 0 1115f95d4633SHajimu UMEMOTO /* 1116f95d4633SHajimu UMEMOTO * RFC2460 section 5, last paragraph. 1117f95d4633SHajimu UMEMOTO * even though minimum link MTU for IPv6 is IPV6_MMTU, 1118f95d4633SHajimu UMEMOTO * we may see ICMPv6 too big with mtu < IPV6_MMTU 1119f95d4633SHajimu UMEMOTO * due to packet translator in the middle. 1120f95d4633SHajimu UMEMOTO * see ip6_output() and ip6_getpmtu() "alwaysfrag" case for 1121f95d4633SHajimu UMEMOTO * special handling. 1122f95d4633SHajimu UMEMOTO */ 1123f95d4633SHajimu UMEMOTO if (mtu < IPV6_MMTU) 1124f95d4633SHajimu UMEMOTO return; 1125f95d4633SHajimu UMEMOTO #endif 1126f95d4633SHajimu UMEMOTO 1127f95d4633SHajimu UMEMOTO /* 1128f95d4633SHajimu UMEMOTO * we reject ICMPv6 too big with abnormally small value. 1129f95d4633SHajimu UMEMOTO * XXX what is the good definition of "abnormally small"? 1130f95d4633SHajimu UMEMOTO */ 1131f95d4633SHajimu UMEMOTO if (mtu < sizeof(struct ip6_hdr) + sizeof(struct ip6_frag) + 8) 1132f95d4633SHajimu UMEMOTO return; 1133f95d4633SHajimu UMEMOTO 113433841545SHajimu UMEMOTO if (!validated) 113533841545SHajimu UMEMOTO return; 113633841545SHajimu UMEMOTO 113759ca51adSSimon L. B. Nielsen /* 113859ca51adSSimon L. B. Nielsen * In case the suggested mtu is less than IPV6_MMTU, we 113959ca51adSSimon L. B. Nielsen * only need to remember that it was for above mentioned 114059ca51adSSimon L. B. Nielsen * "alwaysfrag" case. 114159ca51adSSimon L. B. Nielsen * Try to be as close to the spec as possible. 114259ca51adSSimon L. B. Nielsen */ 114359ca51adSSimon L. B. Nielsen if (mtu < IPV6_MMTU) 114459ca51adSSimon L. B. Nielsen mtu = IPV6_MMTU - 8; 114559ca51adSSimon L. B. Nielsen 114697d8d152SAndre Oppermann bzero(&inc, sizeof(inc)); 1147baa09f18SAndrey V. Elsukov inc.inc_fibnum = M_GETFIB(m); 1148dcdb4371SBjoern A. Zeeb inc.inc_flags |= INC_ISIPV6; 114997d8d152SAndre Oppermann inc.inc6_faddr = *dst; 1150a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&inc.inc6_faddr, m->m_pkthdr.rcvif, NULL)) 1151a1f7e5f8SHajimu UMEMOTO return; 1152686cdd19SJun-ichiro itojun Hagino 1153233dcce1SAndre Oppermann if (mtu < tcp_maxmtu6(&inc, NULL)) { 115497d8d152SAndre Oppermann tcp_hc_updatemtu(&inc, mtu); 1155e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_pmtuchg); 1156686cdd19SJun-ichiro itojun Hagino } 1157686cdd19SJun-ichiro itojun Hagino } 1158686cdd19SJun-ichiro itojun Hagino 115982cd038dSYoshinobu Inoue /* 116033841545SHajimu UMEMOTO * Process a Node Information Query packet, based on 116133841545SHajimu UMEMOTO * draft-ietf-ipngwg-icmp-name-lookups-07. 1162686cdd19SJun-ichiro itojun Hagino * 1163686cdd19SJun-ichiro itojun Hagino * Spec incompatibilities: 1164686cdd19SJun-ichiro itojun Hagino * - IPv6 Subject address handling 1165686cdd19SJun-ichiro itojun Hagino * - IPv4 Subject address handling support missing 1166686cdd19SJun-ichiro itojun Hagino * - Proxy reply (answer even if it's not for me) 1167686cdd19SJun-ichiro itojun Hagino * - joins NI group address at in6_ifattach() time only, does not cope 1168686cdd19SJun-ichiro itojun Hagino * with hostname changes by sethostname(3) 116982cd038dSYoshinobu Inoue */ 117082cd038dSYoshinobu Inoue static struct mbuf * 11717460ef5dSHiroki Sato ni6_input(struct mbuf *m, int off, struct prison *pr) 117282cd038dSYoshinobu Inoue { 1173686cdd19SJun-ichiro itojun Hagino struct icmp6_nodeinfo *ni6, *nni6; 117482cd038dSYoshinobu Inoue struct mbuf *n = NULL; 1175686cdd19SJun-ichiro itojun Hagino u_int16_t qtype; 1176686cdd19SJun-ichiro itojun Hagino int subjlen; 117782cd038dSYoshinobu Inoue int replylen = sizeof(struct ip6_hdr) + sizeof(struct icmp6_nodeinfo); 117882cd038dSYoshinobu Inoue struct ni_reply_fqdn *fqdn; 117982cd038dSYoshinobu Inoue int addrs; /* for NI_QTYPE_NODEADDR */ 118082cd038dSYoshinobu Inoue struct ifnet *ifp = NULL; /* for NI_QTYPE_NODEADDR */ 1181a1f7e5f8SHajimu UMEMOTO struct in6_addr in6_subj; /* subject address */ 1182686cdd19SJun-ichiro itojun Hagino struct ip6_hdr *ip6; 1183686cdd19SJun-ichiro itojun Hagino int oldfqdn = 0; /* if 1, return pascal string (03 draft) */ 118433841545SHajimu UMEMOTO char *subj = NULL; 118533841545SHajimu UMEMOTO struct in6_ifaddr *ia6 = NULL; 118682cd038dSYoshinobu Inoue 1187686cdd19SJun-ichiro itojun Hagino ip6 = mtod(m, struct ip6_hdr *); 1188686cdd19SJun-ichiro itojun Hagino ni6 = (struct icmp6_nodeinfo *)(mtod(m, caddr_t) + off); 1189686cdd19SJun-ichiro itojun Hagino 1190686cdd19SJun-ichiro itojun Hagino /* 119118706985SJINMEI Tatuya * Validate IPv6 source address. 119218706985SJINMEI Tatuya * The default configuration MUST be to refuse answering queries from 119318706985SJINMEI Tatuya * global-scope addresses according to RFC4602. 119418706985SJINMEI Tatuya * Notes: 119518706985SJINMEI Tatuya * - it's not very clear what "refuse" means; this implementation 119618706985SJINMEI Tatuya * simply drops it. 119718706985SJINMEI Tatuya * - it's not very easy to identify global-scope (unicast) addresses 119818706985SJINMEI Tatuya * since there are many prefixes for them. It should be safer 119918706985SJINMEI Tatuya * and in practice sufficient to check "all" but loopback and 120018706985SJINMEI Tatuya * link-local (note that site-local unicast was deprecated and 120118706985SJINMEI Tatuya * ULA is defined as global scope-wise) 120218706985SJINMEI Tatuya */ 1203603724d3SBjoern A. Zeeb if ((V_icmp6_nodeinfo & ICMP6_NODEINFO_GLOBALOK) == 0 && 120418706985SJINMEI Tatuya !IN6_IS_ADDR_LOOPBACK(&ip6->ip6_src) && 120518706985SJINMEI Tatuya !IN6_IS_ADDR_LINKLOCAL(&ip6->ip6_src)) 120618706985SJINMEI Tatuya goto bad; 120718706985SJINMEI Tatuya 120818706985SJINMEI Tatuya /* 1209686cdd19SJun-ichiro itojun Hagino * Validate IPv6 destination address. 1210686cdd19SJun-ichiro itojun Hagino * 121133841545SHajimu UMEMOTO * The Responder must discard the Query without further processing 121233841545SHajimu UMEMOTO * unless it is one of the Responder's unicast or anycast addresses, or 121333841545SHajimu UMEMOTO * a link-local scope multicast address which the Responder has joined. 121418706985SJINMEI Tatuya * [RFC4602, Section 5.] 1215686cdd19SJun-ichiro itojun Hagino */ 12162a5aafceSHajimu UMEMOTO if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) { 12172a5aafceSHajimu UMEMOTO if (!IN6_IS_ADDR_MC_LINKLOCAL(&ip6->ip6_dst)) 12182a5aafceSHajimu UMEMOTO goto bad; 12192a5aafceSHajimu UMEMOTO /* else it's a link-local multicast, fine */ 12202a5aafceSHajimu UMEMOTO } else { /* unicast or anycast */ 12213e88eb90SAndrey V. Elsukov ia6 = in6ifa_ifwithaddr(&ip6->ip6_dst, 0 /* XXX */); 12223e88eb90SAndrey V. Elsukov if (ia6 == NULL) 12232a5aafceSHajimu UMEMOTO goto bad; /* XXX impossible */ 12242a5aafceSHajimu UMEMOTO 12252a5aafceSHajimu UMEMOTO if ((ia6->ia6_flags & IN6_IFF_TEMPORARY) && 1226603724d3SBjoern A. Zeeb !(V_icmp6_nodeinfo & ICMP6_NODEINFO_TMPADDROK)) { 12278c0fec80SRobert Watson ifa_free(&ia6->ia_ifa); 122833841545SHajimu UMEMOTO nd6log((LOG_DEBUG, "ni6_input: ignore node info to " 122933841545SHajimu UMEMOTO "a temporary address in %s:%d", 123033841545SHajimu UMEMOTO __FILE__, __LINE__)); 123133841545SHajimu UMEMOTO goto bad; 123233841545SHajimu UMEMOTO } 12338c0fec80SRobert Watson ifa_free(&ia6->ia_ifa); 12342a5aafceSHajimu UMEMOTO } 1235686cdd19SJun-ichiro itojun Hagino 1236686cdd19SJun-ichiro itojun Hagino /* validate query Subject field. */ 123733841545SHajimu UMEMOTO qtype = ntohs(ni6->ni_qtype); 1238686cdd19SJun-ichiro itojun Hagino subjlen = m->m_pkthdr.len - off - sizeof(struct icmp6_nodeinfo); 1239686cdd19SJun-ichiro itojun Hagino switch (qtype) { 1240686cdd19SJun-ichiro itojun Hagino case NI_QTYPE_NOOP: 1241686cdd19SJun-ichiro itojun Hagino case NI_QTYPE_SUPTYPES: 124233841545SHajimu UMEMOTO /* 07 draft */ 124333841545SHajimu UMEMOTO if (ni6->ni_code == ICMP6_NI_SUBJ_FQDN && subjlen == 0) 1244686cdd19SJun-ichiro itojun Hagino break; 124533841545SHajimu UMEMOTO /* FALLTHROUGH */ 1246686cdd19SJun-ichiro itojun Hagino case NI_QTYPE_FQDN: 1247686cdd19SJun-ichiro itojun Hagino case NI_QTYPE_NODEADDR: 1248a22adbc6SSUZUKI Shinsuke case NI_QTYPE_IPV4ADDR: 1249686cdd19SJun-ichiro itojun Hagino switch (ni6->ni_code) { 1250686cdd19SJun-ichiro itojun Hagino case ICMP6_NI_SUBJ_IPV6: 1251686cdd19SJun-ichiro itojun Hagino #if ICMP6_NI_SUBJ_IPV6 != 0 1252686cdd19SJun-ichiro itojun Hagino case 0: 1253686cdd19SJun-ichiro itojun Hagino #endif 1254686cdd19SJun-ichiro itojun Hagino /* 1255686cdd19SJun-ichiro itojun Hagino * backward compatibility - try to accept 03 draft 1256686cdd19SJun-ichiro itojun Hagino * format, where no Subject is present. 1257686cdd19SJun-ichiro itojun Hagino */ 125833841545SHajimu UMEMOTO if (qtype == NI_QTYPE_FQDN && ni6->ni_code == 0 && 125933841545SHajimu UMEMOTO subjlen == 0) { 1260686cdd19SJun-ichiro itojun Hagino oldfqdn++; 1261686cdd19SJun-ichiro itojun Hagino break; 1262686cdd19SJun-ichiro itojun Hagino } 126333841545SHajimu UMEMOTO #if ICMP6_NI_SUBJ_IPV6 != 0 126433841545SHajimu UMEMOTO if (ni6->ni_code != ICMP6_NI_SUBJ_IPV6) 126533841545SHajimu UMEMOTO goto bad; 126633841545SHajimu UMEMOTO #endif 1267686cdd19SJun-ichiro itojun Hagino 12682a5aafceSHajimu UMEMOTO if (subjlen != sizeof(struct in6_addr)) 1269686cdd19SJun-ichiro itojun Hagino goto bad; 1270686cdd19SJun-ichiro itojun Hagino 1271686cdd19SJun-ichiro itojun Hagino /* 1272686cdd19SJun-ichiro itojun Hagino * Validate Subject address. 1273686cdd19SJun-ichiro itojun Hagino * 127433841545SHajimu UMEMOTO * Not sure what exactly "address belongs to the node" 127533841545SHajimu UMEMOTO * means in the spec, is it just unicast, or what? 1276686cdd19SJun-ichiro itojun Hagino * 1277686cdd19SJun-ichiro itojun Hagino * At this moment we consider Subject address as 1278686cdd19SJun-ichiro itojun Hagino * "belong to the node" if the Subject address equals 1279686cdd19SJun-ichiro itojun Hagino * to the IPv6 destination address; validation for 1280686cdd19SJun-ichiro itojun Hagino * IPv6 destination address should have done enough 1281686cdd19SJun-ichiro itojun Hagino * check for us. 1282686cdd19SJun-ichiro itojun Hagino * 1283686cdd19SJun-ichiro itojun Hagino * We do not do proxy at this moment. 1284686cdd19SJun-ichiro itojun Hagino */ 1285686cdd19SJun-ichiro itojun Hagino m_copydata(m, off + sizeof(struct icmp6_nodeinfo), 1286a1f7e5f8SHajimu UMEMOTO subjlen, (caddr_t)&in6_subj); 1287a1f7e5f8SHajimu UMEMOTO if (in6_setscope(&in6_subj, m->m_pkthdr.rcvif, NULL)) 12889a4f9608SHajimu UMEMOTO goto bad; 12892a5aafceSHajimu UMEMOTO 1290a1f7e5f8SHajimu UMEMOTO subj = (char *)&in6_subj; 1291a1f7e5f8SHajimu UMEMOTO if (IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst, &in6_subj)) 1292686cdd19SJun-ichiro itojun Hagino break; 129333841545SHajimu UMEMOTO 1294686cdd19SJun-ichiro itojun Hagino /* 1295686cdd19SJun-ichiro itojun Hagino * XXX if we are to allow other cases, we should really 1296686cdd19SJun-ichiro itojun Hagino * be careful about scope here. 1297686cdd19SJun-ichiro itojun Hagino * basically, we should disallow queries toward IPv6 129806cd0a3fSHajimu UMEMOTO * destination X with subject Y, 129906cd0a3fSHajimu UMEMOTO * if scope(X) > scope(Y). 1300686cdd19SJun-ichiro itojun Hagino * if we allow scope(X) > scope(Y), it will result in 1301686cdd19SJun-ichiro itojun Hagino * information leakage across scope boundary. 1302686cdd19SJun-ichiro itojun Hagino */ 1303686cdd19SJun-ichiro itojun Hagino goto bad; 1304686cdd19SJun-ichiro itojun Hagino 1305686cdd19SJun-ichiro itojun Hagino case ICMP6_NI_SUBJ_FQDN: 1306686cdd19SJun-ichiro itojun Hagino /* 1307686cdd19SJun-ichiro itojun Hagino * Validate Subject name with gethostname(3). 1308686cdd19SJun-ichiro itojun Hagino * 1309686cdd19SJun-ichiro itojun Hagino * The behavior may need some debate, since: 1310686cdd19SJun-ichiro itojun Hagino * - we are not sure if the node has FQDN as 1311686cdd19SJun-ichiro itojun Hagino * hostname (returned by gethostname(3)). 1312686cdd19SJun-ichiro itojun Hagino * - the code does wildcard match for truncated names. 1313686cdd19SJun-ichiro itojun Hagino * however, we are not sure if we want to perform 1314686cdd19SJun-ichiro itojun Hagino * wildcard match, if gethostname(3) side has 1315686cdd19SJun-ichiro itojun Hagino * truncated hostname. 1316686cdd19SJun-ichiro itojun Hagino */ 131776ca6f88SJamie Gritton mtx_lock(&pr->pr_mtx); 1318c1f19219SJamie Gritton n = ni6_nametodns(pr->pr_hostname, 1319c1f19219SJamie Gritton strlen(pr->pr_hostname), 0); 132076ca6f88SJamie Gritton mtx_unlock(&pr->pr_mtx); 1321686cdd19SJun-ichiro itojun Hagino if (!n || n->m_next || n->m_len == 0) 1322686cdd19SJun-ichiro itojun Hagino goto bad; 1323a4adf6ccSBjoern A. Zeeb if (m->m_len < off + sizeof(struct icmp6_nodeinfo) + 1324a4adf6ccSBjoern A. Zeeb subjlen) { 1325a4adf6ccSBjoern A. Zeeb m = m_pullup(m, off + 1326a4adf6ccSBjoern A. Zeeb sizeof(struct icmp6_nodeinfo) + subjlen); 1327a61b5cfbSBjoern A. Zeeb if (m == NULL) { 1328a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 1329686cdd19SJun-ichiro itojun Hagino goto bad; 1330a61b5cfbSBjoern A. Zeeb } 1331a4adf6ccSBjoern A. Zeeb } 1332a61b5cfbSBjoern A. Zeeb /* ip6 possibly invalid but not used after. */ 1333a61b5cfbSBjoern A. Zeeb ni6 = (struct icmp6_nodeinfo *)(mtod(m, caddr_t) + off); 1334a61b5cfbSBjoern A. Zeeb subj = (char *)(mtod(m, caddr_t) + off + 1335a61b5cfbSBjoern A. Zeeb sizeof(struct icmp6_nodeinfo)); 1336686cdd19SJun-ichiro itojun Hagino if (!ni6_dnsmatch(subj, subjlen, mtod(n, const char *), 1337686cdd19SJun-ichiro itojun Hagino n->m_len)) { 1338686cdd19SJun-ichiro itojun Hagino goto bad; 1339686cdd19SJun-ichiro itojun Hagino } 1340686cdd19SJun-ichiro itojun Hagino m_freem(n); 1341686cdd19SJun-ichiro itojun Hagino n = NULL; 1342686cdd19SJun-ichiro itojun Hagino break; 1343686cdd19SJun-ichiro itojun Hagino 134433841545SHajimu UMEMOTO case ICMP6_NI_SUBJ_IPV4: /* XXX: to be implemented? */ 1345686cdd19SJun-ichiro itojun Hagino default: 1346686cdd19SJun-ichiro itojun Hagino goto bad; 1347686cdd19SJun-ichiro itojun Hagino } 1348686cdd19SJun-ichiro itojun Hagino break; 1349686cdd19SJun-ichiro itojun Hagino } 1350686cdd19SJun-ichiro itojun Hagino 135133841545SHajimu UMEMOTO /* refuse based on configuration. XXX ICMP6_NI_REFUSED? */ 135233841545SHajimu UMEMOTO switch (qtype) { 135333841545SHajimu UMEMOTO case NI_QTYPE_FQDN: 1354603724d3SBjoern A. Zeeb if ((V_icmp6_nodeinfo & ICMP6_NODEINFO_FQDNOK) == 0) 135533841545SHajimu UMEMOTO goto bad; 135633841545SHajimu UMEMOTO break; 135733841545SHajimu UMEMOTO case NI_QTYPE_NODEADDR: 1358a22adbc6SSUZUKI Shinsuke case NI_QTYPE_IPV4ADDR: 1359603724d3SBjoern A. Zeeb if ((V_icmp6_nodeinfo & ICMP6_NODEINFO_NODEADDROK) == 0) 136033841545SHajimu UMEMOTO goto bad; 136133841545SHajimu UMEMOTO break; 136233841545SHajimu UMEMOTO } 136333841545SHajimu UMEMOTO 136433841545SHajimu UMEMOTO /* guess reply length */ 136533841545SHajimu UMEMOTO switch (qtype) { 136633841545SHajimu UMEMOTO case NI_QTYPE_NOOP: 136733841545SHajimu UMEMOTO break; /* no reply data */ 136833841545SHajimu UMEMOTO case NI_QTYPE_SUPTYPES: 136933841545SHajimu UMEMOTO replylen += sizeof(u_int32_t); 137033841545SHajimu UMEMOTO break; 137133841545SHajimu UMEMOTO case NI_QTYPE_FQDN: 137233841545SHajimu UMEMOTO /* XXX will append an mbuf */ 137333841545SHajimu UMEMOTO replylen += offsetof(struct ni_reply_fqdn, ni_fqdn_namelen); 137433841545SHajimu UMEMOTO break; 137533841545SHajimu UMEMOTO case NI_QTYPE_NODEADDR: 1376c66b5feaSHajimu UMEMOTO addrs = ni6_addrs(ni6, m, &ifp, (struct in6_addr *)subj); 137733841545SHajimu UMEMOTO if ((replylen += addrs * (sizeof(struct in6_addr) + 137833841545SHajimu UMEMOTO sizeof(u_int32_t))) > MCLBYTES) 137933841545SHajimu UMEMOTO replylen = MCLBYTES; /* XXX: will truncate pkt later */ 138033841545SHajimu UMEMOTO break; 1381a22adbc6SSUZUKI Shinsuke case NI_QTYPE_IPV4ADDR: 1382a22adbc6SSUZUKI Shinsuke /* unsupported - should respond with unknown Qtype? */ 1383a22adbc6SSUZUKI Shinsuke break; 138433841545SHajimu UMEMOTO default: 138533841545SHajimu UMEMOTO /* 138633841545SHajimu UMEMOTO * XXX: We must return a reply with the ICMP6 code 138733841545SHajimu UMEMOTO * `unknown Qtype' in this case. However we regard the case 138833841545SHajimu UMEMOTO * as an FQDN query for backward compatibility. 138933841545SHajimu UMEMOTO * Older versions set a random value to this field, 139033841545SHajimu UMEMOTO * so it rarely varies in the defined qtypes. 139133841545SHajimu UMEMOTO * But the mechanism is not reliable... 139233841545SHajimu UMEMOTO * maybe we should obsolete older versions. 139333841545SHajimu UMEMOTO */ 139433841545SHajimu UMEMOTO qtype = NI_QTYPE_FQDN; 139533841545SHajimu UMEMOTO /* XXX will append an mbuf */ 139633841545SHajimu UMEMOTO replylen += offsetof(struct ni_reply_fqdn, ni_fqdn_namelen); 139733841545SHajimu UMEMOTO oldfqdn++; 139833841545SHajimu UMEMOTO break; 139933841545SHajimu UMEMOTO } 140033841545SHajimu UMEMOTO 140110e5acc3SGleb Smirnoff /* Allocate an mbuf to reply. */ 1402686cdd19SJun-ichiro itojun Hagino if (replylen > MCLBYTES) { 140382cd038dSYoshinobu Inoue /* 140433841545SHajimu UMEMOTO * XXX: should we try to allocate more? But MCLBYTES 140533841545SHajimu UMEMOTO * is probably much larger than IPV6_MMTU... 140682cd038dSYoshinobu Inoue */ 140782cd038dSYoshinobu Inoue goto bad; 1408686cdd19SJun-ichiro itojun Hagino } 140910e5acc3SGleb Smirnoff if (replylen > MHLEN) 141010e5acc3SGleb Smirnoff n = m_getcl(M_NOWAIT, m->m_type, M_PKTHDR); 141110e5acc3SGleb Smirnoff else 141210e5acc3SGleb Smirnoff n = m_gethdr(M_NOWAIT, m->m_type); 141310e5acc3SGleb Smirnoff if (n == NULL) { 141410e5acc3SGleb Smirnoff m_freem(m); 141510e5acc3SGleb Smirnoff return (NULL); 141682cd038dSYoshinobu Inoue } 141710e5acc3SGleb Smirnoff m_move_pkthdr(n, m); /* just for recvif and FIB */ 141882cd038dSYoshinobu Inoue n->m_pkthdr.len = n->m_len = replylen; 141982cd038dSYoshinobu Inoue 142082cd038dSYoshinobu Inoue /* copy mbuf header and IPv6 + Node Information base headers */ 142182cd038dSYoshinobu Inoue bcopy(mtod(m, caddr_t), mtod(n, caddr_t), sizeof(struct ip6_hdr)); 142282cd038dSYoshinobu Inoue nni6 = (struct icmp6_nodeinfo *)(mtod(n, struct ip6_hdr *) + 1); 1423686cdd19SJun-ichiro itojun Hagino bcopy((caddr_t)ni6, (caddr_t)nni6, sizeof(struct icmp6_nodeinfo)); 142482cd038dSYoshinobu Inoue 142582cd038dSYoshinobu Inoue /* qtype dependent procedure */ 142682cd038dSYoshinobu Inoue switch (qtype) { 142782cd038dSYoshinobu Inoue case NI_QTYPE_NOOP: 142833841545SHajimu UMEMOTO nni6->ni_code = ICMP6_NI_SUCCESS; 142982cd038dSYoshinobu Inoue nni6->ni_flags = 0; 143082cd038dSYoshinobu Inoue break; 143182cd038dSYoshinobu Inoue case NI_QTYPE_SUPTYPES: 143233841545SHajimu UMEMOTO { 143333841545SHajimu UMEMOTO u_int32_t v; 143433841545SHajimu UMEMOTO nni6->ni_code = ICMP6_NI_SUCCESS; 143533841545SHajimu UMEMOTO nni6->ni_flags = htons(0x0000); /* raw bitmap */ 143633841545SHajimu UMEMOTO /* supports NOOP, SUPTYPES, FQDN, and NODEADDR */ 143733841545SHajimu UMEMOTO v = (u_int32_t)htonl(0x0000000f); 143833841545SHajimu UMEMOTO bcopy(&v, nni6 + 1, sizeof(u_int32_t)); 143982cd038dSYoshinobu Inoue break; 144033841545SHajimu UMEMOTO } 144182cd038dSYoshinobu Inoue case NI_QTYPE_FQDN: 144233841545SHajimu UMEMOTO nni6->ni_code = ICMP6_NI_SUCCESS; 144382cd038dSYoshinobu Inoue fqdn = (struct ni_reply_fqdn *)(mtod(n, caddr_t) + 144406cd0a3fSHajimu UMEMOTO sizeof(struct ip6_hdr) + sizeof(struct icmp6_nodeinfo)); 144582cd038dSYoshinobu Inoue nni6->ni_flags = 0; /* XXX: meaningless TTL */ 144682cd038dSYoshinobu Inoue fqdn->ni_fqdn_ttl = 0; /* ditto. */ 1447686cdd19SJun-ichiro itojun Hagino /* 144876ca6f88SJamie Gritton * XXX do we really have FQDN in hostname? 1449686cdd19SJun-ichiro itojun Hagino */ 145076ca6f88SJamie Gritton mtx_lock(&pr->pr_mtx); 1451c1f19219SJamie Gritton n->m_next = ni6_nametodns(pr->pr_hostname, 1452c1f19219SJamie Gritton strlen(pr->pr_hostname), oldfqdn); 145376ca6f88SJamie Gritton mtx_unlock(&pr->pr_mtx); 1454686cdd19SJun-ichiro itojun Hagino if (n->m_next == NULL) 1455686cdd19SJun-ichiro itojun Hagino goto bad; 1456686cdd19SJun-ichiro itojun Hagino /* XXX we assume that n->m_next is not a chain */ 1457686cdd19SJun-ichiro itojun Hagino if (n->m_next->m_next != NULL) 1458686cdd19SJun-ichiro itojun Hagino goto bad; 1459686cdd19SJun-ichiro itojun Hagino n->m_pkthdr.len += n->m_next->m_len; 146082cd038dSYoshinobu Inoue break; 146182cd038dSYoshinobu Inoue case NI_QTYPE_NODEADDR: 146282cd038dSYoshinobu Inoue { 146382cd038dSYoshinobu Inoue int lenlim, copied; 146482cd038dSYoshinobu Inoue 146533841545SHajimu UMEMOTO nni6->ni_code = ICMP6_NI_SUCCESS; 146633841545SHajimu UMEMOTO n->m_pkthdr.len = n->m_len = 146733841545SHajimu UMEMOTO sizeof(struct ip6_hdr) + sizeof(struct icmp6_nodeinfo); 146833841545SHajimu UMEMOTO lenlim = M_TRAILINGSPACE(n); 146982cd038dSYoshinobu Inoue copied = ni6_store_addrs(ni6, nni6, ifp, lenlim); 147082cd038dSYoshinobu Inoue /* XXX: reset mbuf length */ 147182cd038dSYoshinobu Inoue n->m_pkthdr.len = n->m_len = sizeof(struct ip6_hdr) + 147282cd038dSYoshinobu Inoue sizeof(struct icmp6_nodeinfo) + copied; 147382cd038dSYoshinobu Inoue break; 147482cd038dSYoshinobu Inoue } 147582cd038dSYoshinobu Inoue default: 147682cd038dSYoshinobu Inoue break; /* XXX impossible! */ 147782cd038dSYoshinobu Inoue } 147882cd038dSYoshinobu Inoue 147982cd038dSYoshinobu Inoue nni6->ni_type = ICMP6_NI_REPLY; 1480686cdd19SJun-ichiro itojun Hagino m_freem(m); 148182cd038dSYoshinobu Inoue return (n); 148282cd038dSYoshinobu Inoue 148382cd038dSYoshinobu Inoue bad: 1484686cdd19SJun-ichiro itojun Hagino m_freem(m); 148582cd038dSYoshinobu Inoue if (n) 148682cd038dSYoshinobu Inoue m_freem(n); 148782cd038dSYoshinobu Inoue return (NULL); 148882cd038dSYoshinobu Inoue } 148982cd038dSYoshinobu Inoue 149082cd038dSYoshinobu Inoue /* 1491686cdd19SJun-ichiro itojun Hagino * make a mbuf with DNS-encoded string. no compression support. 1492686cdd19SJun-ichiro itojun Hagino * 1493686cdd19SJun-ichiro itojun Hagino * XXX names with less than 2 dots (like "foo" or "foo.section") will be 1494686cdd19SJun-ichiro itojun Hagino * treated as truncated name (two \0 at the end). this is a wild guess. 14951272577eSXin LI * 14961272577eSXin LI * old - return pascal string if non-zero 1497686cdd19SJun-ichiro itojun Hagino */ 1498686cdd19SJun-ichiro itojun Hagino static struct mbuf * 14991272577eSXin LI ni6_nametodns(const char *name, int namelen, int old) 1500686cdd19SJun-ichiro itojun Hagino { 1501686cdd19SJun-ichiro itojun Hagino struct mbuf *m; 1502686cdd19SJun-ichiro itojun Hagino char *cp, *ep; 1503686cdd19SJun-ichiro itojun Hagino const char *p, *q; 1504686cdd19SJun-ichiro itojun Hagino int i, len, nterm; 1505686cdd19SJun-ichiro itojun Hagino 1506686cdd19SJun-ichiro itojun Hagino if (old) 1507686cdd19SJun-ichiro itojun Hagino len = namelen + 1; 1508686cdd19SJun-ichiro itojun Hagino else 1509686cdd19SJun-ichiro itojun Hagino len = MCLBYTES; 1510686cdd19SJun-ichiro itojun Hagino 15117b07d1beSGleb Smirnoff /* Because MAXHOSTNAMELEN is usually 256, we use cluster mbuf. */ 15127b07d1beSGleb Smirnoff if (len > MLEN) 15137b07d1beSGleb Smirnoff m = m_getcl(M_NOWAIT, MT_DATA, 0); 15147b07d1beSGleb Smirnoff else 15157b07d1beSGleb Smirnoff m = m_get(M_NOWAIT, MT_DATA); 15167b07d1beSGleb Smirnoff if (m == NULL) 1517686cdd19SJun-ichiro itojun Hagino goto fail; 1518686cdd19SJun-ichiro itojun Hagino 1519686cdd19SJun-ichiro itojun Hagino if (old) { 1520686cdd19SJun-ichiro itojun Hagino m->m_len = len; 1521686cdd19SJun-ichiro itojun Hagino *mtod(m, char *) = namelen; 1522686cdd19SJun-ichiro itojun Hagino bcopy(name, mtod(m, char *) + 1, namelen); 1523686cdd19SJun-ichiro itojun Hagino return m; 1524686cdd19SJun-ichiro itojun Hagino } else { 1525686cdd19SJun-ichiro itojun Hagino m->m_len = 0; 1526686cdd19SJun-ichiro itojun Hagino cp = mtod(m, char *); 1527686cdd19SJun-ichiro itojun Hagino ep = mtod(m, char *) + M_TRAILINGSPACE(m); 1528686cdd19SJun-ichiro itojun Hagino 1529686cdd19SJun-ichiro itojun Hagino /* if not certain about my name, return empty buffer */ 1530686cdd19SJun-ichiro itojun Hagino if (namelen == 0) 1531686cdd19SJun-ichiro itojun Hagino return m; 1532686cdd19SJun-ichiro itojun Hagino 1533686cdd19SJun-ichiro itojun Hagino /* 1534686cdd19SJun-ichiro itojun Hagino * guess if it looks like shortened hostname, or FQDN. 1535686cdd19SJun-ichiro itojun Hagino * shortened hostname needs two trailing "\0". 1536686cdd19SJun-ichiro itojun Hagino */ 1537686cdd19SJun-ichiro itojun Hagino i = 0; 1538686cdd19SJun-ichiro itojun Hagino for (p = name; p < name + namelen; p++) { 1539686cdd19SJun-ichiro itojun Hagino if (*p && *p == '.') 1540686cdd19SJun-ichiro itojun Hagino i++; 1541686cdd19SJun-ichiro itojun Hagino } 1542686cdd19SJun-ichiro itojun Hagino if (i < 2) 1543686cdd19SJun-ichiro itojun Hagino nterm = 2; 1544686cdd19SJun-ichiro itojun Hagino else 1545686cdd19SJun-ichiro itojun Hagino nterm = 1; 1546686cdd19SJun-ichiro itojun Hagino 1547686cdd19SJun-ichiro itojun Hagino p = name; 1548686cdd19SJun-ichiro itojun Hagino while (cp < ep && p < name + namelen) { 1549686cdd19SJun-ichiro itojun Hagino i = 0; 1550686cdd19SJun-ichiro itojun Hagino for (q = p; q < name + namelen && *q && *q != '.'; q++) 1551686cdd19SJun-ichiro itojun Hagino i++; 1552686cdd19SJun-ichiro itojun Hagino /* result does not fit into mbuf */ 1553686cdd19SJun-ichiro itojun Hagino if (cp + i + 1 >= ep) 1554686cdd19SJun-ichiro itojun Hagino goto fail; 1555610be6ceSHajimu UMEMOTO /* 1556610be6ceSHajimu UMEMOTO * DNS label length restriction, RFC1035 page 8. 1557610be6ceSHajimu UMEMOTO * "i == 0" case is included here to avoid returning 1558610be6ceSHajimu UMEMOTO * 0-length label on "foo..bar". 1559610be6ceSHajimu UMEMOTO */ 1560610be6ceSHajimu UMEMOTO if (i <= 0 || i >= 64) 1561686cdd19SJun-ichiro itojun Hagino goto fail; 1562686cdd19SJun-ichiro itojun Hagino *cp++ = i; 1563686cdd19SJun-ichiro itojun Hagino bcopy(p, cp, i); 1564686cdd19SJun-ichiro itojun Hagino cp += i; 1565686cdd19SJun-ichiro itojun Hagino p = q; 1566686cdd19SJun-ichiro itojun Hagino if (p < name + namelen && *p == '.') 1567686cdd19SJun-ichiro itojun Hagino p++; 1568686cdd19SJun-ichiro itojun Hagino } 1569686cdd19SJun-ichiro itojun Hagino /* termination */ 1570686cdd19SJun-ichiro itojun Hagino if (cp + nterm >= ep) 1571686cdd19SJun-ichiro itojun Hagino goto fail; 1572686cdd19SJun-ichiro itojun Hagino while (nterm-- > 0) 1573686cdd19SJun-ichiro itojun Hagino *cp++ = '\0'; 1574686cdd19SJun-ichiro itojun Hagino m->m_len = cp - mtod(m, char *); 1575686cdd19SJun-ichiro itojun Hagino return m; 1576686cdd19SJun-ichiro itojun Hagino } 1577686cdd19SJun-ichiro itojun Hagino 1578686cdd19SJun-ichiro itojun Hagino panic("should not reach here"); 1579686cdd19SJun-ichiro itojun Hagino /* NOTREACHED */ 1580686cdd19SJun-ichiro itojun Hagino 1581686cdd19SJun-ichiro itojun Hagino fail: 1582686cdd19SJun-ichiro itojun Hagino if (m) 1583686cdd19SJun-ichiro itojun Hagino m_freem(m); 1584686cdd19SJun-ichiro itojun Hagino return NULL; 1585686cdd19SJun-ichiro itojun Hagino } 1586686cdd19SJun-ichiro itojun Hagino 1587686cdd19SJun-ichiro itojun Hagino /* 1588686cdd19SJun-ichiro itojun Hagino * check if two DNS-encoded string matches. takes care of truncated 1589686cdd19SJun-ichiro itojun Hagino * form (with \0\0 at the end). no compression support. 159033841545SHajimu UMEMOTO * XXX upper/lowercase match (see RFC2065) 1591686cdd19SJun-ichiro itojun Hagino */ 1592686cdd19SJun-ichiro itojun Hagino static int 15931272577eSXin LI ni6_dnsmatch(const char *a, int alen, const char *b, int blen) 1594686cdd19SJun-ichiro itojun Hagino { 1595686cdd19SJun-ichiro itojun Hagino const char *a0, *b0; 1596686cdd19SJun-ichiro itojun Hagino int l; 1597686cdd19SJun-ichiro itojun Hagino 1598686cdd19SJun-ichiro itojun Hagino /* simplest case - need validation? */ 1599686cdd19SJun-ichiro itojun Hagino if (alen == blen && bcmp(a, b, alen) == 0) 1600686cdd19SJun-ichiro itojun Hagino return 1; 1601686cdd19SJun-ichiro itojun Hagino 1602686cdd19SJun-ichiro itojun Hagino a0 = a; 1603686cdd19SJun-ichiro itojun Hagino b0 = b; 1604686cdd19SJun-ichiro itojun Hagino 1605686cdd19SJun-ichiro itojun Hagino /* termination is mandatory */ 1606686cdd19SJun-ichiro itojun Hagino if (alen < 2 || blen < 2) 1607686cdd19SJun-ichiro itojun Hagino return 0; 1608686cdd19SJun-ichiro itojun Hagino if (a0[alen - 1] != '\0' || b0[blen - 1] != '\0') 1609686cdd19SJun-ichiro itojun Hagino return 0; 1610686cdd19SJun-ichiro itojun Hagino alen--; 1611686cdd19SJun-ichiro itojun Hagino blen--; 1612686cdd19SJun-ichiro itojun Hagino 1613686cdd19SJun-ichiro itojun Hagino while (a - a0 < alen && b - b0 < blen) { 1614686cdd19SJun-ichiro itojun Hagino if (a - a0 + 1 > alen || b - b0 + 1 > blen) 1615686cdd19SJun-ichiro itojun Hagino return 0; 1616686cdd19SJun-ichiro itojun Hagino 1617686cdd19SJun-ichiro itojun Hagino if ((signed char)a[0] < 0 || (signed char)b[0] < 0) 1618686cdd19SJun-ichiro itojun Hagino return 0; 1619686cdd19SJun-ichiro itojun Hagino /* we don't support compression yet */ 1620686cdd19SJun-ichiro itojun Hagino if (a[0] >= 64 || b[0] >= 64) 1621686cdd19SJun-ichiro itojun Hagino return 0; 1622686cdd19SJun-ichiro itojun Hagino 1623686cdd19SJun-ichiro itojun Hagino /* truncated case */ 1624686cdd19SJun-ichiro itojun Hagino if (a[0] == 0 && a - a0 == alen - 1) 1625686cdd19SJun-ichiro itojun Hagino return 1; 1626686cdd19SJun-ichiro itojun Hagino if (b[0] == 0 && b - b0 == blen - 1) 1627686cdd19SJun-ichiro itojun Hagino return 1; 1628686cdd19SJun-ichiro itojun Hagino if (a[0] == 0 || b[0] == 0) 1629686cdd19SJun-ichiro itojun Hagino return 0; 1630686cdd19SJun-ichiro itojun Hagino 1631686cdd19SJun-ichiro itojun Hagino if (a[0] != b[0]) 1632686cdd19SJun-ichiro itojun Hagino return 0; 1633686cdd19SJun-ichiro itojun Hagino l = a[0]; 1634686cdd19SJun-ichiro itojun Hagino if (a - a0 + 1 + l > alen || b - b0 + 1 + l > blen) 1635686cdd19SJun-ichiro itojun Hagino return 0; 1636686cdd19SJun-ichiro itojun Hagino if (bcmp(a + 1, b + 1, l) != 0) 1637686cdd19SJun-ichiro itojun Hagino return 0; 1638686cdd19SJun-ichiro itojun Hagino 1639686cdd19SJun-ichiro itojun Hagino a += 1 + l; 1640686cdd19SJun-ichiro itojun Hagino b += 1 + l; 1641686cdd19SJun-ichiro itojun Hagino } 1642686cdd19SJun-ichiro itojun Hagino 1643686cdd19SJun-ichiro itojun Hagino if (a - a0 == alen && b - b0 == blen) 1644686cdd19SJun-ichiro itojun Hagino return 1; 1645686cdd19SJun-ichiro itojun Hagino else 1646686cdd19SJun-ichiro itojun Hagino return 0; 1647686cdd19SJun-ichiro itojun Hagino } 1648686cdd19SJun-ichiro itojun Hagino 1649686cdd19SJun-ichiro itojun Hagino /* 165082cd038dSYoshinobu Inoue * calculate the number of addresses to be returned in the node info reply. 165182cd038dSYoshinobu Inoue */ 165282cd038dSYoshinobu Inoue static int 16531272577eSXin LI ni6_addrs(struct icmp6_nodeinfo *ni6, struct mbuf *m, struct ifnet **ifpp, 16541272577eSXin LI struct in6_addr *subj) 165582cd038dSYoshinobu Inoue { 165633841545SHajimu UMEMOTO struct ifnet *ifp; 165733841545SHajimu UMEMOTO struct in6_ifaddr *ifa6; 165833841545SHajimu UMEMOTO struct ifaddr *ifa; 165982cd038dSYoshinobu Inoue int addrs = 0, addrsofif, iffound = 0; 166033841545SHajimu UMEMOTO int niflags = ni6->ni_flags; 166133841545SHajimu UMEMOTO 1662b8a6e03fSGleb Smirnoff NET_EPOCH_ASSERT(); 1663b8a6e03fSGleb Smirnoff 166433841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_ALL) == 0) { 166533841545SHajimu UMEMOTO switch (ni6->ni_code) { 166633841545SHajimu UMEMOTO case ICMP6_NI_SUBJ_IPV6: 166733841545SHajimu UMEMOTO if (subj == NULL) /* must be impossible... */ 166833841545SHajimu UMEMOTO return (0); 166933841545SHajimu UMEMOTO break; 167033841545SHajimu UMEMOTO default: 167133841545SHajimu UMEMOTO /* 167233841545SHajimu UMEMOTO * XXX: we only support IPv6 subject address for 167333841545SHajimu UMEMOTO * this Qtype. 167433841545SHajimu UMEMOTO */ 167533841545SHajimu UMEMOTO return (0); 167633841545SHajimu UMEMOTO } 167733841545SHajimu UMEMOTO } 167882cd038dSYoshinobu Inoue 16794f6c66ccSMatt Macy CK_STAILQ_FOREACH(ifp, &V_ifnet, if_link) { 168082cd038dSYoshinobu Inoue addrsofif = 0; 1681d7c5a620SMatt Macy CK_STAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) { 168282cd038dSYoshinobu Inoue if (ifa->ifa_addr->sa_family != AF_INET6) 168382cd038dSYoshinobu Inoue continue; 168482cd038dSYoshinobu Inoue ifa6 = (struct in6_ifaddr *)ifa; 168582cd038dSYoshinobu Inoue 168633841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_ALL) == 0 && 1687c66b5feaSHajimu UMEMOTO IN6_ARE_ADDR_EQUAL(subj, &ifa6->ia_addr.sin6_addr)) 168882cd038dSYoshinobu Inoue iffound = 1; 168982cd038dSYoshinobu Inoue 1690686cdd19SJun-ichiro itojun Hagino /* 1691686cdd19SJun-ichiro itojun Hagino * IPv4-mapped addresses can only be returned by a 1692686cdd19SJun-ichiro itojun Hagino * Node Information proxy, since they represent 1693686cdd19SJun-ichiro itojun Hagino * addresses of IPv4-only nodes, which perforce do 1694686cdd19SJun-ichiro itojun Hagino * not implement this protocol. 169533841545SHajimu UMEMOTO * [icmp-name-lookups-07, Section 5.4] 1696686cdd19SJun-ichiro itojun Hagino * So we don't support NI_NODEADDR_FLAG_COMPAT in 1697686cdd19SJun-ichiro itojun Hagino * this function at this moment. 1698686cdd19SJun-ichiro itojun Hagino */ 1699686cdd19SJun-ichiro itojun Hagino 170082cd038dSYoshinobu Inoue /* What do we have to do about ::1? */ 170182cd038dSYoshinobu Inoue switch (in6_addrscope(&ifa6->ia_addr.sin6_addr)) { 170282cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_LINKLOCAL: 170333841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_LINKLOCAL) == 0) 170433841545SHajimu UMEMOTO continue; 170582cd038dSYoshinobu Inoue break; 170682cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_SITELOCAL: 170733841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_SITELOCAL) == 0) 170833841545SHajimu UMEMOTO continue; 170982cd038dSYoshinobu Inoue break; 171082cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_GLOBAL: 171133841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_GLOBAL) == 0) 171233841545SHajimu UMEMOTO continue; 171382cd038dSYoshinobu Inoue break; 171482cd038dSYoshinobu Inoue default: 171582cd038dSYoshinobu Inoue continue; 171682cd038dSYoshinobu Inoue } 171733841545SHajimu UMEMOTO 171833841545SHajimu UMEMOTO /* 171933841545SHajimu UMEMOTO * check if anycast is okay. 172033841545SHajimu UMEMOTO * XXX: just experimental. not in the spec. 172133841545SHajimu UMEMOTO */ 172233841545SHajimu UMEMOTO if ((ifa6->ia6_flags & IN6_IFF_ANYCAST) != 0 && 172333841545SHajimu UMEMOTO (niflags & NI_NODEADDR_FLAG_ANYCAST) == 0) 172433841545SHajimu UMEMOTO continue; /* we need only unicast addresses */ 172533841545SHajimu UMEMOTO if ((ifa6->ia6_flags & IN6_IFF_TEMPORARY) != 0 && 1726603724d3SBjoern A. Zeeb (V_icmp6_nodeinfo & ICMP6_NODEINFO_TMPADDROK) == 0) { 172733841545SHajimu UMEMOTO continue; 172833841545SHajimu UMEMOTO } 172933841545SHajimu UMEMOTO addrsofif++; /* count the address */ 173082cd038dSYoshinobu Inoue } 173182cd038dSYoshinobu Inoue if (iffound) { 173282cd038dSYoshinobu Inoue *ifpp = ifp; 173382cd038dSYoshinobu Inoue return (addrsofif); 173482cd038dSYoshinobu Inoue } 173582cd038dSYoshinobu Inoue 173682cd038dSYoshinobu Inoue addrs += addrsofif; 173782cd038dSYoshinobu Inoue } 173882cd038dSYoshinobu Inoue 173982cd038dSYoshinobu Inoue return (addrs); 174082cd038dSYoshinobu Inoue } 174182cd038dSYoshinobu Inoue 174282cd038dSYoshinobu Inoue static int 17431272577eSXin LI ni6_store_addrs(struct icmp6_nodeinfo *ni6, struct icmp6_nodeinfo *nni6, 17441272577eSXin LI struct ifnet *ifp0, int resid) 174582cd038dSYoshinobu Inoue { 174694e83133SJohn Baldwin struct ifnet *ifp; 174733841545SHajimu UMEMOTO struct in6_ifaddr *ifa6; 174833841545SHajimu UMEMOTO struct ifaddr *ifa; 174933841545SHajimu UMEMOTO struct ifnet *ifp_dep = NULL; 175033841545SHajimu UMEMOTO int copied = 0, allow_deprecated = 0; 175182cd038dSYoshinobu Inoue u_char *cp = (u_char *)(nni6 + 1); 175233841545SHajimu UMEMOTO int niflags = ni6->ni_flags; 175333841545SHajimu UMEMOTO u_int32_t ltime; 175482cd038dSYoshinobu Inoue 1755b8a6e03fSGleb Smirnoff NET_EPOCH_ASSERT(); 1756b8a6e03fSGleb Smirnoff 175733841545SHajimu UMEMOTO if (ifp0 == NULL && !(niflags & NI_NODEADDR_FLAG_ALL)) 175882cd038dSYoshinobu Inoue return (0); /* needless to copy */ 175982cd038dSYoshinobu Inoue 17604f6c66ccSMatt Macy ifp = ifp0 ? ifp0 : CK_STAILQ_FIRST(&V_ifnet); 176133841545SHajimu UMEMOTO again: 17620527d333SHajimu UMEMOTO 17634f6c66ccSMatt Macy for (; ifp; ifp = CK_STAILQ_NEXT(ifp, if_link)) { 1764d7c5a620SMatt Macy CK_STAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) { 176582cd038dSYoshinobu Inoue if (ifa->ifa_addr->sa_family != AF_INET6) 176682cd038dSYoshinobu Inoue continue; 176782cd038dSYoshinobu Inoue ifa6 = (struct in6_ifaddr *)ifa; 176882cd038dSYoshinobu Inoue 176933841545SHajimu UMEMOTO if ((ifa6->ia6_flags & IN6_IFF_DEPRECATED) != 0 && 177033841545SHajimu UMEMOTO allow_deprecated == 0) { 177133841545SHajimu UMEMOTO /* 177233841545SHajimu UMEMOTO * prefererred address should be put before 177333841545SHajimu UMEMOTO * deprecated addresses. 177433841545SHajimu UMEMOTO */ 177533841545SHajimu UMEMOTO 177633841545SHajimu UMEMOTO /* record the interface for later search */ 177733841545SHajimu UMEMOTO if (ifp_dep == NULL) 177833841545SHajimu UMEMOTO ifp_dep = ifp; 177933841545SHajimu UMEMOTO 178082cd038dSYoshinobu Inoue continue; 178106cd0a3fSHajimu UMEMOTO } else if ((ifa6->ia6_flags & IN6_IFF_DEPRECATED) == 0 && 178233841545SHajimu UMEMOTO allow_deprecated != 0) 178333841545SHajimu UMEMOTO continue; /* we now collect deprecated addrs */ 178482cd038dSYoshinobu Inoue 178582cd038dSYoshinobu Inoue /* What do we have to do about ::1? */ 178682cd038dSYoshinobu Inoue switch (in6_addrscope(&ifa6->ia_addr.sin6_addr)) { 178782cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_LINKLOCAL: 178833841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_LINKLOCAL) == 0) 178933841545SHajimu UMEMOTO continue; 179082cd038dSYoshinobu Inoue break; 179182cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_SITELOCAL: 179233841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_SITELOCAL) == 0) 179333841545SHajimu UMEMOTO continue; 179482cd038dSYoshinobu Inoue break; 179582cd038dSYoshinobu Inoue case IPV6_ADDR_SCOPE_GLOBAL: 179633841545SHajimu UMEMOTO if ((niflags & NI_NODEADDR_FLAG_GLOBAL) == 0) 179733841545SHajimu UMEMOTO continue; 179882cd038dSYoshinobu Inoue break; 179982cd038dSYoshinobu Inoue default: 180082cd038dSYoshinobu Inoue continue; 180182cd038dSYoshinobu Inoue } 180282cd038dSYoshinobu Inoue 180333841545SHajimu UMEMOTO /* 180433841545SHajimu UMEMOTO * check if anycast is okay. 180533841545SHajimu UMEMOTO * XXX: just experimental. not in the spec. 180633841545SHajimu UMEMOTO */ 180733841545SHajimu UMEMOTO if ((ifa6->ia6_flags & IN6_IFF_ANYCAST) != 0 && 180833841545SHajimu UMEMOTO (niflags & NI_NODEADDR_FLAG_ANYCAST) == 0) 180933841545SHajimu UMEMOTO continue; 181033841545SHajimu UMEMOTO if ((ifa6->ia6_flags & IN6_IFF_TEMPORARY) != 0 && 1811603724d3SBjoern A. Zeeb (V_icmp6_nodeinfo & ICMP6_NODEINFO_TMPADDROK) == 0) { 181233841545SHajimu UMEMOTO continue; 181333841545SHajimu UMEMOTO } 181433841545SHajimu UMEMOTO 181533841545SHajimu UMEMOTO /* now we can copy the address */ 181633841545SHajimu UMEMOTO if (resid < sizeof(struct in6_addr) + 181733841545SHajimu UMEMOTO sizeof(u_int32_t)) { 181882cd038dSYoshinobu Inoue /* 181982cd038dSYoshinobu Inoue * We give up much more copy. 182082cd038dSYoshinobu Inoue * Set the truncate flag and return. 182182cd038dSYoshinobu Inoue */ 182206cd0a3fSHajimu UMEMOTO nni6->ni_flags |= NI_NODEADDR_FLAG_TRUNCATE; 182382cd038dSYoshinobu Inoue return (copied); 182482cd038dSYoshinobu Inoue } 182533841545SHajimu UMEMOTO 182633841545SHajimu UMEMOTO /* 182733841545SHajimu UMEMOTO * Set the TTL of the address. 182833841545SHajimu UMEMOTO * The TTL value should be one of the following 182933841545SHajimu UMEMOTO * according to the specification: 183033841545SHajimu UMEMOTO * 183133841545SHajimu UMEMOTO * 1. The remaining lifetime of a DHCP lease on the 183233841545SHajimu UMEMOTO * address, or 183333841545SHajimu UMEMOTO * 2. The remaining Valid Lifetime of a prefix from 183433841545SHajimu UMEMOTO * which the address was derived through Stateless 183533841545SHajimu UMEMOTO * Autoconfiguration. 183633841545SHajimu UMEMOTO * 183733841545SHajimu UMEMOTO * Note that we currently do not support stateful 183833841545SHajimu UMEMOTO * address configuration by DHCPv6, so the former 183933841545SHajimu UMEMOTO * case can't happen. 184033841545SHajimu UMEMOTO */ 184133841545SHajimu UMEMOTO if (ifa6->ia6_lifetime.ia6t_expire == 0) 184233841545SHajimu UMEMOTO ltime = ND6_INFINITE_LIFETIME; 184333841545SHajimu UMEMOTO else { 184433841545SHajimu UMEMOTO if (ifa6->ia6_lifetime.ia6t_expire > 18457d26db17SHiroki Sato time_uptime) 18467d26db17SHiroki Sato ltime = htonl(ifa6->ia6_lifetime.ia6t_expire - time_uptime); 184733841545SHajimu UMEMOTO else 184833841545SHajimu UMEMOTO ltime = 0; 184933841545SHajimu UMEMOTO } 185033841545SHajimu UMEMOTO 185133841545SHajimu UMEMOTO bcopy(<ime, cp, sizeof(u_int32_t)); 185233841545SHajimu UMEMOTO cp += sizeof(u_int32_t); 185333841545SHajimu UMEMOTO 185433841545SHajimu UMEMOTO /* copy the address itself */ 185582cd038dSYoshinobu Inoue bcopy(&ifa6->ia_addr.sin6_addr, cp, 185682cd038dSYoshinobu Inoue sizeof(struct in6_addr)); 18579a4f9608SHajimu UMEMOTO in6_clearscope((struct in6_addr *)cp); /* XXX */ 185882cd038dSYoshinobu Inoue cp += sizeof(struct in6_addr); 185933841545SHajimu UMEMOTO 186033841545SHajimu UMEMOTO resid -= (sizeof(struct in6_addr) + sizeof(u_int32_t)); 186106cd0a3fSHajimu UMEMOTO copied += (sizeof(struct in6_addr) + sizeof(u_int32_t)); 186282cd038dSYoshinobu Inoue } 186382cd038dSYoshinobu Inoue if (ifp0) /* we need search only on the specified IF */ 186482cd038dSYoshinobu Inoue break; 186582cd038dSYoshinobu Inoue } 186682cd038dSYoshinobu Inoue 186733841545SHajimu UMEMOTO if (allow_deprecated == 0 && ifp_dep != NULL) { 186833841545SHajimu UMEMOTO ifp = ifp_dep; 186933841545SHajimu UMEMOTO allow_deprecated = 1; 187033841545SHajimu UMEMOTO 187133841545SHajimu UMEMOTO goto again; 187233841545SHajimu UMEMOTO } 187333841545SHajimu UMEMOTO 187482cd038dSYoshinobu Inoue return (copied); 187582cd038dSYoshinobu Inoue } 187682cd038dSYoshinobu Inoue 187782cd038dSYoshinobu Inoue /* 187882cd038dSYoshinobu Inoue * XXX almost dup'ed code with rip6_input. 187982cd038dSYoshinobu Inoue */ 188082cd038dSYoshinobu Inoue static int 18811272577eSXin LI icmp6_rip6_input(struct mbuf **mp, int off) 188282cd038dSYoshinobu Inoue { 188382cd038dSYoshinobu Inoue struct mbuf *m = *mp; 188433841545SHajimu UMEMOTO struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *); 18850ecd976eSBjoern A. Zeeb struct inpcb *inp; 1886fc384fa5SBjoern A. Zeeb struct inpcb *last = NULL; 18879a4f9608SHajimu UMEMOTO struct sockaddr_in6 fromsa; 188882cd038dSYoshinobu Inoue struct icmp6_hdr *icmp6; 188982cd038dSYoshinobu Inoue struct mbuf *opts = NULL; 189082cd038dSYoshinobu Inoue 1891cf377af6SGleb Smirnoff NET_EPOCH_ASSERT(); 1892cf377af6SGleb Smirnoff 1893a61b5cfbSBjoern A. Zeeb /* This is assumed to be safe; icmp6_input() does a pullup. */ 189482cd038dSYoshinobu Inoue icmp6 = (struct icmp6_hdr *)((caddr_t)ip6 + off); 189582cd038dSYoshinobu Inoue 1896a1f7e5f8SHajimu UMEMOTO /* 1897a1f7e5f8SHajimu UMEMOTO * XXX: the address may have embedded scope zone ID, which should be 1898a1f7e5f8SHajimu UMEMOTO * hidden from applications. 1899a1f7e5f8SHajimu UMEMOTO */ 19009a4f9608SHajimu UMEMOTO bzero(&fromsa, sizeof(fromsa)); 19019a4f9608SHajimu UMEMOTO fromsa.sin6_family = AF_INET6; 1902a1f7e5f8SHajimu UMEMOTO fromsa.sin6_len = sizeof(struct sockaddr_in6); 1903a1f7e5f8SHajimu UMEMOTO fromsa.sin6_addr = ip6->ip6_src; 1904a1f7e5f8SHajimu UMEMOTO if (sa6_recoverscope(&fromsa)) { 1905a1f7e5f8SHajimu UMEMOTO m_freem(m); 1906a8fe77d8SBjoern A. Zeeb *mp = NULL; 1907a1f7e5f8SHajimu UMEMOTO return (IPPROTO_DONE); 1908a1f7e5f8SHajimu UMEMOTO } 190982cd038dSYoshinobu Inoue 19100ecd976eSBjoern A. Zeeb CK_LIST_FOREACH(inp, &V_ripcb, inp_list) { 19110ecd976eSBjoern A. Zeeb if ((inp->inp_vflag & INP_IPV6) == 0) 191282cd038dSYoshinobu Inoue continue; 19130ecd976eSBjoern A. Zeeb if (inp->inp_ip_p != IPPROTO_ICMPV6) 1914b11e21aeSAlexander Motin continue; 19150ecd976eSBjoern A. Zeeb if (!IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr) && 19160ecd976eSBjoern A. Zeeb !IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr, &ip6->ip6_dst)) 1917b11e21aeSAlexander Motin continue; 19180ecd976eSBjoern A. Zeeb if (!IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_faddr) && 19190ecd976eSBjoern A. Zeeb !IN6_ARE_ADDR_EQUAL(&inp->in6p_faddr, &ip6->ip6_src)) 1920b11e21aeSAlexander Motin continue; 19210ecd976eSBjoern A. Zeeb INP_RLOCK(inp); 19220ecd976eSBjoern A. Zeeb if (__predict_false(inp->inp_flags2 & INP_FREED)) { 19230ecd976eSBjoern A. Zeeb INP_RUNLOCK(inp); 19246675bee8SBjoern A. Zeeb continue; 19256675bee8SBjoern A. Zeeb } 19262f1ff0cdSRobert Watson if (ICMP6_FILTER_WILLBLOCK(icmp6->icmp6_type, 19270ecd976eSBjoern A. Zeeb inp->in6p_icmp6filt)) { 19280ecd976eSBjoern A. Zeeb INP_RUNLOCK(inp); 1929b11e21aeSAlexander Motin continue; 19306c5bbf5cSAlexander Motin } 1931aba53ef0SKip Macy if (last != NULL) { 1932657db3c8SHajimu UMEMOTO struct mbuf *n = NULL; 1933657db3c8SHajimu UMEMOTO 1934657db3c8SHajimu UMEMOTO /* 1935657db3c8SHajimu UMEMOTO * Recent network drivers tend to allocate a single 1936657db3c8SHajimu UMEMOTO * mbuf cluster, rather than to make a couple of 1937657db3c8SHajimu UMEMOTO * mbufs without clusters. Also, since the IPv6 code 1938657db3c8SHajimu UMEMOTO * path tries to avoid m_pullup(), it is highly 1939657db3c8SHajimu UMEMOTO * probable that we still have an mbuf cluster here 1940657db3c8SHajimu UMEMOTO * even though the necessary length can be stored in an 1941657db3c8SHajimu UMEMOTO * mbuf's internal buffer. 1942657db3c8SHajimu UMEMOTO * Meanwhile, the default size of the receive socket 1943657db3c8SHajimu UMEMOTO * buffer for raw sockets is not so large. This means 1944657db3c8SHajimu UMEMOTO * the possibility of packet loss is relatively higher 1945657db3c8SHajimu UMEMOTO * than before. To avoid this scenario, we copy the 1946657db3c8SHajimu UMEMOTO * received data to a separate mbuf that does not use 1947657db3c8SHajimu UMEMOTO * a cluster, if possible. 1948657db3c8SHajimu UMEMOTO * XXX: it is better to copy the data after stripping 1949657db3c8SHajimu UMEMOTO * intermediate headers. 1950657db3c8SHajimu UMEMOTO */ 1951657db3c8SHajimu UMEMOTO if ((m->m_flags & M_EXT) && m->m_next == NULL && 1952657db3c8SHajimu UMEMOTO m->m_len <= MHLEN) { 19537b07d1beSGleb Smirnoff n = m_get(M_NOWAIT, m->m_type); 1954657db3c8SHajimu UMEMOTO if (n != NULL) { 1955c543ec4eSGeorge V. Neville-Neil if (m_dup_pkthdr(n, m, M_NOWAIT)) { 1956c543ec4eSGeorge V. Neville-Neil bcopy(m->m_data, n->m_data, 1957c543ec4eSGeorge V. Neville-Neil m->m_len); 1958657db3c8SHajimu UMEMOTO n->m_len = m->m_len; 1959c543ec4eSGeorge V. Neville-Neil } else { 1960c543ec4eSGeorge V. Neville-Neil m_free(n); 1961c543ec4eSGeorge V. Neville-Neil n = NULL; 1962c543ec4eSGeorge V. Neville-Neil } 1963657db3c8SHajimu UMEMOTO } 1964657db3c8SHajimu UMEMOTO } 1965657db3c8SHajimu UMEMOTO if (n != NULL || 1966c3bef61eSKevin Lo (n = m_copym(m, 0, M_COPYALL, M_NOWAIT)) != NULL) { 196797590249SBjoern A. Zeeb if (last->inp_flags & INP_CONTROLOPTS) 196811de19f4SHajimu UMEMOTO ip6_savecontrol(last, n, &opts); 196982cd038dSYoshinobu Inoue /* strip intermediate headers */ 197082cd038dSYoshinobu Inoue m_adj(n, off); 1971fc384fa5SBjoern A. Zeeb SOCKBUF_LOCK(&last->inp_socket->so_rcv); 1972c9db0fadSRobert Watson if (sbappendaddr_locked( 1973fc384fa5SBjoern A. Zeeb &last->inp_socket->so_rcv, 19749a4f9608SHajimu UMEMOTO (struct sockaddr *)&fromsa, n, opts) 197506cd0a3fSHajimu UMEMOTO == 0) { 197682cd038dSYoshinobu Inoue /* should notify about lost packet */ 197782cd038dSYoshinobu Inoue m_freem(n); 197833841545SHajimu UMEMOTO if (opts) { 197982cd038dSYoshinobu Inoue m_freem(opts); 198033841545SHajimu UMEMOTO } 1981c9db0fadSRobert Watson SOCKBUF_UNLOCK( 1982fc384fa5SBjoern A. Zeeb &last->inp_socket->so_rcv); 19834cc20ab1SSeigo Tanimura } else 1984fc384fa5SBjoern A. Zeeb sorwakeup_locked(last->inp_socket); 198582cd038dSYoshinobu Inoue opts = NULL; 198682cd038dSYoshinobu Inoue } 1987bb145f60SRobert Watson INP_RUNLOCK(last); 198882cd038dSYoshinobu Inoue } 19890ecd976eSBjoern A. Zeeb last = inp; 199082cd038dSYoshinobu Inoue } 1991aba53ef0SKip Macy if (last != NULL) { 199297590249SBjoern A. Zeeb if (last->inp_flags & INP_CONTROLOPTS) 199311de19f4SHajimu UMEMOTO ip6_savecontrol(last, m, &opts); 199482cd038dSYoshinobu Inoue /* strip intermediate headers */ 199582cd038dSYoshinobu Inoue m_adj(m, off); 1996657db3c8SHajimu UMEMOTO 1997657db3c8SHajimu UMEMOTO /* avoid using mbuf clusters if possible (see above) */ 1998657db3c8SHajimu UMEMOTO if ((m->m_flags & M_EXT) && m->m_next == NULL && 1999657db3c8SHajimu UMEMOTO m->m_len <= MHLEN) { 2000657db3c8SHajimu UMEMOTO struct mbuf *n; 2001657db3c8SHajimu UMEMOTO 20027b07d1beSGleb Smirnoff n = m_get(M_NOWAIT, m->m_type); 2003657db3c8SHajimu UMEMOTO if (n != NULL) { 2004c543ec4eSGeorge V. Neville-Neil if (m_dup_pkthdr(n, m, M_NOWAIT)) { 2005657db3c8SHajimu UMEMOTO bcopy(m->m_data, n->m_data, m->m_len); 2006657db3c8SHajimu UMEMOTO n->m_len = m->m_len; 2007657db3c8SHajimu UMEMOTO 2008657db3c8SHajimu UMEMOTO m_freem(m); 2009657db3c8SHajimu UMEMOTO m = n; 2010c543ec4eSGeorge V. Neville-Neil } else { 2011c543ec4eSGeorge V. Neville-Neil m_freem(n); 2012c543ec4eSGeorge V. Neville-Neil n = NULL; 2013c543ec4eSGeorge V. Neville-Neil } 2014657db3c8SHajimu UMEMOTO } 2015657db3c8SHajimu UMEMOTO } 2016fc384fa5SBjoern A. Zeeb SOCKBUF_LOCK(&last->inp_socket->so_rcv); 2017fc384fa5SBjoern A. Zeeb if (sbappendaddr_locked(&last->inp_socket->so_rcv, 20189a4f9608SHajimu UMEMOTO (struct sockaddr *)&fromsa, m, opts) == 0) { 201982cd038dSYoshinobu Inoue m_freem(m); 202082cd038dSYoshinobu Inoue if (opts) 202182cd038dSYoshinobu Inoue m_freem(opts); 2022fc384fa5SBjoern A. Zeeb SOCKBUF_UNLOCK(&last->inp_socket->so_rcv); 20234cc20ab1SSeigo Tanimura } else 2024fc384fa5SBjoern A. Zeeb sorwakeup_locked(last->inp_socket); 2025bb145f60SRobert Watson INP_RUNLOCK(last); 202682cd038dSYoshinobu Inoue } else { 202782cd038dSYoshinobu Inoue m_freem(m); 202833cde130SBruce M Simpson IP6STAT_DEC(ip6s_delivered); 202982cd038dSYoshinobu Inoue } 2030a8fe77d8SBjoern A. Zeeb *mp = NULL; 2031a8fe77d8SBjoern A. Zeeb return (IPPROTO_DONE); 203282cd038dSYoshinobu Inoue } 203382cd038dSYoshinobu Inoue 203482cd038dSYoshinobu Inoue /* 203582cd038dSYoshinobu Inoue * Reflect the ip6 packet back to the source. 2036686cdd19SJun-ichiro itojun Hagino * OFF points to the icmp6 header, counted from the top of the mbuf. 203782cd038dSYoshinobu Inoue */ 20380700d2c3SBjoern A. Zeeb static void 20391272577eSXin LI icmp6_reflect(struct mbuf *m, size_t off) 204082cd038dSYoshinobu Inoue { 2041ab861e6cSAlexander V. Chernikov struct in6_addr src6, *srcp; 2042686cdd19SJun-ichiro itojun Hagino struct ip6_hdr *ip6; 204382cd038dSYoshinobu Inoue struct icmp6_hdr *icmp6; 20448c0fec80SRobert Watson struct in6_ifaddr *ia = NULL; 20453e88eb90SAndrey V. Elsukov struct ifnet *outif = NULL; 2046686cdd19SJun-ichiro itojun Hagino int plen; 2047ab861e6cSAlexander V. Chernikov int type, code, hlim; 204882cd038dSYoshinobu Inoue 2049686cdd19SJun-ichiro itojun Hagino /* too short to reflect */ 2050686cdd19SJun-ichiro itojun Hagino if (off < sizeof(struct ip6_hdr)) { 205133841545SHajimu UMEMOTO nd6log((LOG_DEBUG, 205233841545SHajimu UMEMOTO "sanity fail: off=%lx, sizeof(ip6)=%lx in %s:%d\n", 2053686cdd19SJun-ichiro itojun Hagino (u_long)off, (u_long)sizeof(struct ip6_hdr), 205433841545SHajimu UMEMOTO __FILE__, __LINE__)); 2055686cdd19SJun-ichiro itojun Hagino goto bad; 2056686cdd19SJun-ichiro itojun Hagino } 2057686cdd19SJun-ichiro itojun Hagino 205882cd038dSYoshinobu Inoue /* 205982cd038dSYoshinobu Inoue * If there are extra headers between IPv6 and ICMPv6, strip 206082cd038dSYoshinobu Inoue * off that header first. 206182cd038dSYoshinobu Inoue */ 2062686cdd19SJun-ichiro itojun Hagino #ifdef DIAGNOSTIC 2063686cdd19SJun-ichiro itojun Hagino if (sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr) > MHLEN) 2064686cdd19SJun-ichiro itojun Hagino panic("assumption failed in icmp6_reflect"); 2065686cdd19SJun-ichiro itojun Hagino #endif 2066686cdd19SJun-ichiro itojun Hagino if (off > sizeof(struct ip6_hdr)) { 2067686cdd19SJun-ichiro itojun Hagino size_t l; 2068686cdd19SJun-ichiro itojun Hagino struct ip6_hdr nip6; 206982cd038dSYoshinobu Inoue 2070686cdd19SJun-ichiro itojun Hagino l = off - sizeof(struct ip6_hdr); 2071686cdd19SJun-ichiro itojun Hagino m_copydata(m, 0, sizeof(nip6), (caddr_t)&nip6); 2072686cdd19SJun-ichiro itojun Hagino m_adj(m, l); 2073686cdd19SJun-ichiro itojun Hagino l = sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr); 2074686cdd19SJun-ichiro itojun Hagino if (m->m_len < l) { 2075686cdd19SJun-ichiro itojun Hagino if ((m = m_pullup(m, l)) == NULL) 2076686cdd19SJun-ichiro itojun Hagino return; 207782cd038dSYoshinobu Inoue } 2078686cdd19SJun-ichiro itojun Hagino bcopy((caddr_t)&nip6, mtod(m, caddr_t), sizeof(nip6)); 2079686cdd19SJun-ichiro itojun Hagino } else /* off == sizeof(struct ip6_hdr) */ { 2080686cdd19SJun-ichiro itojun Hagino size_t l; 2081686cdd19SJun-ichiro itojun Hagino l = sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr); 2082686cdd19SJun-ichiro itojun Hagino if (m->m_len < l) { 2083686cdd19SJun-ichiro itojun Hagino if ((m = m_pullup(m, l)) == NULL) 2084686cdd19SJun-ichiro itojun Hagino return; 208582cd038dSYoshinobu Inoue } 2086686cdd19SJun-ichiro itojun Hagino } 2087686cdd19SJun-ichiro itojun Hagino plen = m->m_pkthdr.len - sizeof(struct ip6_hdr); 208882cd038dSYoshinobu Inoue ip6 = mtod(m, struct ip6_hdr *); 208982cd038dSYoshinobu Inoue ip6->ip6_nxt = IPPROTO_ICMPV6; 209082cd038dSYoshinobu Inoue icmp6 = (struct icmp6_hdr *)(ip6 + 1); 209182cd038dSYoshinobu Inoue type = icmp6->icmp6_type; /* keep type for statistics */ 209282cd038dSYoshinobu Inoue code = icmp6->icmp6_code; /* ditto. */ 2093ab861e6cSAlexander V. Chernikov hlim = 0; 2094ab861e6cSAlexander V. Chernikov srcp = NULL; 209582cd038dSYoshinobu Inoue 209682cd038dSYoshinobu Inoue /* 209782cd038dSYoshinobu Inoue * If the incoming packet was addressed directly to us (i.e. unicast), 209882cd038dSYoshinobu Inoue * use dst as the src for the reply. 209906cd0a3fSHajimu UMEMOTO * The IN6_IFF_NOTREADY case should be VERY rare, but is possible 2100686cdd19SJun-ichiro itojun Hagino * (for example) when we encounter an error while forwarding procedure 2101686cdd19SJun-ichiro itojun Hagino * destined to a duplicated address of ours. 210282cd038dSYoshinobu Inoue */ 21033e88eb90SAndrey V. Elsukov if (!IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst)) { 21043e88eb90SAndrey V. Elsukov ia = in6ifa_ifwithaddr(&ip6->ip6_dst, 0 /* XXX */); 21053e88eb90SAndrey V. Elsukov if (ia != NULL && !(ia->ia6_flags & 2106ab861e6cSAlexander V. Chernikov (IN6_IFF_ANYCAST|IN6_IFF_NOTREADY))) { 2107ab861e6cSAlexander V. Chernikov src6 = ia->ia_addr.sin6_addr; 2108ab861e6cSAlexander V. Chernikov srcp = &src6; 2109ab861e6cSAlexander V. Chernikov 2110ab861e6cSAlexander V. Chernikov if (m->m_pkthdr.rcvif != NULL) { 2111ab861e6cSAlexander V. Chernikov /* XXX: This may not be the outgoing interface */ 2112ab861e6cSAlexander V. Chernikov hlim = ND_IFINFO(m->m_pkthdr.rcvif)->chlim; 2113ab861e6cSAlexander V. Chernikov } else 2114ab861e6cSAlexander V. Chernikov hlim = V_ip6_defhlim; 2115ab861e6cSAlexander V. Chernikov } 2116ab861e6cSAlexander V. Chernikov if (ia != NULL) 2117ab861e6cSAlexander V. Chernikov ifa_free(&ia->ia_ifa); 211882cd038dSYoshinobu Inoue } 211982cd038dSYoshinobu Inoue 212088d166bfSBjoern A. Zeeb if (srcp == NULL) { 2121601c0b8bSAlexander V. Chernikov int error; 2122601c0b8bSAlexander V. Chernikov struct in6_addr dst6; 2123601c0b8bSAlexander V. Chernikov uint32_t scopeid; 212433841545SHajimu UMEMOTO 212582cd038dSYoshinobu Inoue /* 2126686cdd19SJun-ichiro itojun Hagino * This case matches to multicasts, our anycast, or unicasts 212733841545SHajimu UMEMOTO * that we do not own. Select a source address based on the 212833841545SHajimu UMEMOTO * source address of the erroneous packet. 212982cd038dSYoshinobu Inoue */ 21305a03e781SAndrey V. Elsukov in6_splitscope(&ip6->ip6_src, &dst6, &scopeid); 2131559b4296SAlan Somers error = in6_selectsrc_addr(M_GETFIB(m), &dst6, 2132601c0b8bSAlexander V. Chernikov scopeid, NULL, &src6, &hlim); 2133a1f7e5f8SHajimu UMEMOTO 2134601c0b8bSAlexander V. Chernikov if (error) { 21351d54aa3bSBjoern A. Zeeb char ip6buf[INET6_ADDRSTRLEN]; 213633841545SHajimu UMEMOTO nd6log((LOG_DEBUG, 213733841545SHajimu UMEMOTO "icmp6_reflect: source can't be determined: " 213833841545SHajimu UMEMOTO "dst=%s, error=%d\n", 2139601c0b8bSAlexander V. Chernikov ip6_sprintf(ip6buf, &ip6->ip6_dst), error)); 214082cd038dSYoshinobu Inoue goto bad; 214133841545SHajimu UMEMOTO } 2142ab861e6cSAlexander V. Chernikov srcp = &src6; 214333841545SHajimu UMEMOTO } 21443e88eb90SAndrey V. Elsukov /* 21453e88eb90SAndrey V. Elsukov * ip6_input() drops a packet if its src is multicast. 21463e88eb90SAndrey V. Elsukov * So, the src is never multicast. 21473e88eb90SAndrey V. Elsukov */ 21483e88eb90SAndrey V. Elsukov ip6->ip6_dst = ip6->ip6_src; 214988d166bfSBjoern A. Zeeb ip6->ip6_src = *srcp; 215082cd038dSYoshinobu Inoue ip6->ip6_flow = 0; 2151686cdd19SJun-ichiro itojun Hagino ip6->ip6_vfc &= ~IPV6_VERSION_MASK; 2152686cdd19SJun-ichiro itojun Hagino ip6->ip6_vfc |= IPV6_VERSION; 215382cd038dSYoshinobu Inoue ip6->ip6_nxt = IPPROTO_ICMPV6; 2154ab861e6cSAlexander V. Chernikov ip6->ip6_hlim = hlim; 215582cd038dSYoshinobu Inoue 215682cd038dSYoshinobu Inoue icmp6->icmp6_cksum = 0; 215782cd038dSYoshinobu Inoue icmp6->icmp6_cksum = in6_cksum(m, IPPROTO_ICMPV6, 215882cd038dSYoshinobu Inoue sizeof(struct ip6_hdr), plen); 215982cd038dSYoshinobu Inoue 216082cd038dSYoshinobu Inoue /* 216133841545SHajimu UMEMOTO * XXX option handling 216282cd038dSYoshinobu Inoue */ 216382cd038dSYoshinobu Inoue 216482cd038dSYoshinobu Inoue m->m_flags &= ~(M_BCAST|M_MCAST); 2165849eeaa5SAndrey V. Elsukov m->m_pkthdr.rcvif = NULL; 21665d846453SSam Leffler ip6_output(m, NULL, NULL, 0, NULL, &outif, NULL); 216782cd038dSYoshinobu Inoue if (outif) 216882cd038dSYoshinobu Inoue icmp6_ifoutstat_inc(outif, type, code); 216982cd038dSYoshinobu Inoue 217082cd038dSYoshinobu Inoue return; 217182cd038dSYoshinobu Inoue 217282cd038dSYoshinobu Inoue bad: 217382cd038dSYoshinobu Inoue m_freem(m); 217482cd038dSYoshinobu Inoue return; 217582cd038dSYoshinobu Inoue } 217682cd038dSYoshinobu Inoue 217782cd038dSYoshinobu Inoue void 21781272577eSXin LI icmp6_fasttimo(void) 217982cd038dSYoshinobu Inoue { 2180686cdd19SJun-ichiro itojun Hagino 218133cde130SBruce M Simpson mld_fasttimo(); 218233cde130SBruce M Simpson } 218333cde130SBruce M Simpson 218433cde130SBruce M Simpson void 218533cde130SBruce M Simpson icmp6_slowtimo(void) 218633cde130SBruce M Simpson { 218733cde130SBruce M Simpson 218833cde130SBruce M Simpson mld_slowtimo(); 218982cd038dSYoshinobu Inoue } 219082cd038dSYoshinobu Inoue 219182cd038dSYoshinobu Inoue static const char * 21921272577eSXin LI icmp6_redirect_diag(struct in6_addr *src6, struct in6_addr *dst6, 21931272577eSXin LI struct in6_addr *tgt6) 219482cd038dSYoshinobu Inoue { 219582cd038dSYoshinobu Inoue static char buf[1024]; 21961d54aa3bSBjoern A. Zeeb char ip6bufs[INET6_ADDRSTRLEN]; 21971d54aa3bSBjoern A. Zeeb char ip6bufd[INET6_ADDRSTRLEN]; 21981d54aa3bSBjoern A. Zeeb char ip6buft[INET6_ADDRSTRLEN]; 219982cd038dSYoshinobu Inoue snprintf(buf, sizeof(buf), "(src=%s dst=%s tgt=%s)", 22001d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6bufs, src6), ip6_sprintf(ip6bufd, dst6), 22011d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6buft, tgt6)); 220282cd038dSYoshinobu Inoue return buf; 220382cd038dSYoshinobu Inoue } 220482cd038dSYoshinobu Inoue 220582cd038dSYoshinobu Inoue void 22061272577eSXin LI icmp6_redirect_input(struct mbuf *m, int off) 220782cd038dSYoshinobu Inoue { 22082cb64cb2SGeorge V. Neville-Neil struct ifnet *ifp; 2209503f4e47SBjoern A. Zeeb struct ip6_hdr *ip6; 2210686cdd19SJun-ichiro itojun Hagino struct nd_redirect *nd_rd; 2211a61b5cfbSBjoern A. Zeeb struct in6_addr src6, redtgt6, reddst6; 221282cd038dSYoshinobu Inoue union nd_opts ndopts; 22131d54aa3bSBjoern A. Zeeb char ip6buf[INET6_ADDRSTRLEN]; 2214503f4e47SBjoern A. Zeeb char *lladdr; 2215503f4e47SBjoern A. Zeeb int icmp6len, is_onlink, is_router, lladdrlen; 221682cd038dSYoshinobu Inoue 221737c1ff48SGleb Smirnoff M_ASSERTPKTHDR(m); 221837c1ff48SGleb Smirnoff KASSERT(m->m_pkthdr.rcvif != NULL, ("%s: no rcvif", __func__)); 22192cb64cb2SGeorge V. Neville-Neil 222082cd038dSYoshinobu Inoue /* XXX if we are router, we don't update route by icmp6 redirect */ 2221603724d3SBjoern A. Zeeb if (V_ip6_forwarding) 2222686cdd19SJun-ichiro itojun Hagino goto freeit; 2223603724d3SBjoern A. Zeeb if (!V_icmp6_rediraccept) 2224686cdd19SJun-ichiro itojun Hagino goto freeit; 2225686cdd19SJun-ichiro itojun Hagino 2226a4061289SAndrey V. Elsukov /* RFC 6980: Nodes MUST silently ignore fragments */ 2227a4061289SAndrey V. Elsukov if(m->m_flags & M_FRAGMENTED) 2228a4061289SAndrey V. Elsukov goto freeit; 2229a4061289SAndrey V. Elsukov 2230503f4e47SBjoern A. Zeeb ip6 = mtod(m, struct ip6_hdr *); 2231503f4e47SBjoern A. Zeeb icmp6len = ntohs(ip6->ip6_plen); 2232a4adf6ccSBjoern A. Zeeb if (m->m_len < off + icmp6len) { 2233a61b5cfbSBjoern A. Zeeb m = m_pullup(m, off + icmp6len); 2234a61b5cfbSBjoern A. Zeeb if (m == NULL) { 2235a61b5cfbSBjoern A. Zeeb IP6STAT_INC(ip6s_exthdrtoolong); 223682cd038dSYoshinobu Inoue return; 2237686cdd19SJun-ichiro itojun Hagino } 2238a4adf6ccSBjoern A. Zeeb } 2239a61b5cfbSBjoern A. Zeeb ip6 = mtod(m, struct ip6_hdr *); 2240a61b5cfbSBjoern A. Zeeb nd_rd = (struct nd_redirect *)((caddr_t)ip6 + off); 2241503f4e47SBjoern A. Zeeb 2242503f4e47SBjoern A. Zeeb ifp = m->m_pkthdr.rcvif; 2243686cdd19SJun-ichiro itojun Hagino redtgt6 = nd_rd->nd_rd_target; 2244686cdd19SJun-ichiro itojun Hagino reddst6 = nd_rd->nd_rd_dst; 224582cd038dSYoshinobu Inoue 2246503f4e47SBjoern A. Zeeb if (in6_setscope(&redtgt6, ifp, NULL) || 2247503f4e47SBjoern A. Zeeb in6_setscope(&reddst6, ifp, NULL)) { 2248a1f7e5f8SHajimu UMEMOTO goto freeit; 2249a1f7e5f8SHajimu UMEMOTO } 225082cd038dSYoshinobu Inoue 225182cd038dSYoshinobu Inoue /* validation */ 2252503f4e47SBjoern A. Zeeb src6 = ip6->ip6_src; 225382cd038dSYoshinobu Inoue if (!IN6_IS_ADDR_LINKLOCAL(&src6)) { 225433841545SHajimu UMEMOTO nd6log((LOG_ERR, 225582cd038dSYoshinobu Inoue "ICMP6 redirect sent from %s rejected; " 225606cd0a3fSHajimu UMEMOTO "must be from linklocal\n", 22571d54aa3bSBjoern A. Zeeb ip6_sprintf(ip6buf, &src6))); 225833841545SHajimu UMEMOTO goto bad; 225982cd038dSYoshinobu Inoue } 22604caea9b1SMark Johnston if (__predict_false(ip6->ip6_hlim != 255)) { 22614caea9b1SMark Johnston ICMP6STAT_INC(icp6s_invlhlim); 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 */ 22706ad7446cSAlexander V. Chernikov struct nhop_object *nh; 22719977be4aSAlexander V. Chernikov struct in6_addr kdst; 22729977be4aSAlexander V. Chernikov uint32_t scopeid; 227382cd038dSYoshinobu Inoue 22749977be4aSAlexander V. Chernikov in6_splitscope(&reddst6, &kdst, &scopeid); 22756ad7446cSAlexander V. Chernikov NET_EPOCH_ASSERT(); 22766ad7446cSAlexander V. Chernikov nh = fib6_lookup(ifp->if_fib, &kdst, scopeid, 0, 0); 2277eddfb2e8SAlexander V. Chernikov if (nh != NULL) { 22786ad7446cSAlexander V. Chernikov struct in6_addr nh_addr; 22796ad7446cSAlexander V. Chernikov nh_addr = ifatoia6(nh->nh_ifa)->ia_addr.sin6_addr; 22806ad7446cSAlexander V. Chernikov if ((nh->nh_flags & NHF_GATEWAY) == 0) { 228133841545SHajimu UMEMOTO nd6log((LOG_ERR, 2282deebc913SHajimu UMEMOTO "ICMP6 redirect rejected; no route " 2283deebc913SHajimu UMEMOTO "with inet6 gateway found for redirect dst: %s\n", 228433841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 228533841545SHajimu UMEMOTO goto bad; 2286deebc913SHajimu UMEMOTO } 2287deebc913SHajimu UMEMOTO 228843105e58SEric van Gyzen /* 22896ad7446cSAlexander V. Chernikov * Embed scope zone id into next hop address. 229043105e58SEric van Gyzen */ 22916ad7446cSAlexander V. Chernikov nh_addr = nh->gw6_sa.sin6_addr; 229243105e58SEric van Gyzen 22936ad7446cSAlexander V. Chernikov if (IN6_ARE_ADDR_EQUAL(&src6, &nh_addr) == 0) { 229433841545SHajimu UMEMOTO nd6log((LOG_ERR, 229582cd038dSYoshinobu Inoue "ICMP6 redirect rejected; " 229682cd038dSYoshinobu Inoue "not equal to gw-for-src=%s (must be same): " 229782cd038dSYoshinobu Inoue "%s\n", 22986ad7446cSAlexander V. Chernikov ip6_sprintf(ip6buf, &nh_addr), 229933841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 230033841545SHajimu UMEMOTO goto bad; 230182cd038dSYoshinobu Inoue } 230282cd038dSYoshinobu Inoue } else { 230333841545SHajimu UMEMOTO nd6log((LOG_ERR, 230482cd038dSYoshinobu Inoue "ICMP6 redirect rejected; " 230582cd038dSYoshinobu Inoue "no route found for redirect dst: %s\n", 230633841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 230733841545SHajimu UMEMOTO goto bad; 230882cd038dSYoshinobu Inoue } 230982cd038dSYoshinobu Inoue } 231082cd038dSYoshinobu Inoue if (IN6_IS_ADDR_MULTICAST(&reddst6)) { 231133841545SHajimu UMEMOTO nd6log((LOG_ERR, 231282cd038dSYoshinobu Inoue "ICMP6 redirect rejected; " 231382cd038dSYoshinobu Inoue "redirect dst must be unicast: %s\n", 231433841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 231533841545SHajimu UMEMOTO goto bad; 231682cd038dSYoshinobu Inoue } 231782cd038dSYoshinobu Inoue 231882cd038dSYoshinobu Inoue is_router = is_onlink = 0; 231982cd038dSYoshinobu Inoue if (IN6_IS_ADDR_LINKLOCAL(&redtgt6)) 232082cd038dSYoshinobu Inoue is_router = 1; /* router case */ 232182cd038dSYoshinobu Inoue if (bcmp(&redtgt6, &reddst6, sizeof(redtgt6)) == 0) 232282cd038dSYoshinobu Inoue is_onlink = 1; /* on-link destination case */ 232382cd038dSYoshinobu Inoue if (!is_router && !is_onlink) { 232433841545SHajimu UMEMOTO nd6log((LOG_ERR, 232582cd038dSYoshinobu Inoue "ICMP6 redirect rejected; " 232682cd038dSYoshinobu Inoue "neither router case nor onlink case: %s\n", 232733841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 232833841545SHajimu UMEMOTO goto bad; 232982cd038dSYoshinobu Inoue } 233082cd038dSYoshinobu Inoue 233182cd038dSYoshinobu Inoue icmp6len -= sizeof(*nd_rd); 233282cd038dSYoshinobu Inoue nd6_option_init(nd_rd + 1, icmp6len, &ndopts); 233382cd038dSYoshinobu Inoue if (nd6_options(&ndopts) < 0) { 233437c1ff48SGleb Smirnoff nd6log((LOG_INFO, "%s: invalid ND option, rejected: %s\n", 233537c1ff48SGleb Smirnoff __func__, icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 233633841545SHajimu UMEMOTO /* nd6_options have incremented stats */ 2337686cdd19SJun-ichiro itojun Hagino goto freeit; 233882cd038dSYoshinobu Inoue } 233982cd038dSYoshinobu Inoue 2340503f4e47SBjoern A. Zeeb lladdr = NULL; 2341503f4e47SBjoern A. Zeeb lladdrlen = 0; 234282cd038dSYoshinobu Inoue if (ndopts.nd_opts_tgt_lladdr) { 234382cd038dSYoshinobu Inoue lladdr = (char *)(ndopts.nd_opts_tgt_lladdr + 1); 234482cd038dSYoshinobu Inoue lladdrlen = ndopts.nd_opts_tgt_lladdr->nd_opt_len << 3; 234582cd038dSYoshinobu Inoue } 234682cd038dSYoshinobu Inoue 234782cd038dSYoshinobu Inoue if (lladdr && ((ifp->if_addrlen + 2 + 7) & ~7) != lladdrlen) { 234837c1ff48SGleb Smirnoff nd6log((LOG_INFO, "%s: lladdrlen mismatch for %s " 234982cd038dSYoshinobu Inoue "(if %d, icmp6 packet %d): %s\n", 235037c1ff48SGleb Smirnoff __func__, ip6_sprintf(ip6buf, &redtgt6), 23511d54aa3bSBjoern A. Zeeb ifp->if_addrlen, lladdrlen - 2, 235233841545SHajimu UMEMOTO icmp6_redirect_diag(&src6, &reddst6, &redtgt6))); 235333841545SHajimu UMEMOTO goto bad; 235482cd038dSYoshinobu Inoue } 235582cd038dSYoshinobu Inoue 2356bfbc08b8SBjoern A. Zeeb /* Validation passed. */ 2357bfbc08b8SBjoern A. Zeeb 235882cd038dSYoshinobu Inoue /* RFC 2461 8.3 */ 235982cd038dSYoshinobu Inoue nd6_cache_lladdr(ifp, &redtgt6, lladdr, lladdrlen, ND_REDIRECT, 236082cd038dSYoshinobu Inoue is_onlink ? ND_REDIRECT_ONLINK : ND_REDIRECT_ROUTER); 236182cd038dSYoshinobu Inoue 236217a03656SEric van Gyzen /* 236317a03656SEric van Gyzen * Install a gateway route in the better-router case or an interface 236417a03656SEric van Gyzen * route in the on-link-destination case. 236517a03656SEric van Gyzen */ 236617a03656SEric van Gyzen { 236782cd038dSYoshinobu Inoue struct sockaddr_in6 sdst; 236882cd038dSYoshinobu Inoue struct sockaddr_in6 sgw; 236982cd038dSYoshinobu Inoue struct sockaddr_in6 ssrc; 237017a03656SEric van Gyzen struct sockaddr *gw; 237117a03656SEric van Gyzen int rt_flags; 237281d5d46bSBjoern A. Zeeb u_int fibnum; 237382cd038dSYoshinobu Inoue 237482cd038dSYoshinobu Inoue bzero(&sdst, sizeof(sdst)); 237582cd038dSYoshinobu Inoue bzero(&ssrc, sizeof(ssrc)); 237617a03656SEric van Gyzen sdst.sin6_family = ssrc.sin6_family = AF_INET6; 237717a03656SEric van Gyzen sdst.sin6_len = ssrc.sin6_len = sizeof(struct sockaddr_in6); 237882cd038dSYoshinobu Inoue bcopy(&reddst6, &sdst.sin6_addr, sizeof(struct in6_addr)); 237982cd038dSYoshinobu Inoue bcopy(&src6, &ssrc.sin6_addr, sizeof(struct in6_addr)); 238034a5582cSAlexander V. Chernikov rt_flags = 0; 238117a03656SEric van Gyzen if (is_router) { 238217a03656SEric van Gyzen bzero(&sgw, sizeof(sgw)); 238317a03656SEric van Gyzen sgw.sin6_family = AF_INET6; 238417a03656SEric van Gyzen sgw.sin6_len = sizeof(struct sockaddr_in6); 238517a03656SEric van Gyzen bcopy(&redtgt6, &sgw.sin6_addr, 238617a03656SEric van Gyzen sizeof(struct in6_addr)); 238717a03656SEric van Gyzen gw = (struct sockaddr *)&sgw; 238817a03656SEric van Gyzen rt_flags |= RTF_GATEWAY; 238917a03656SEric van Gyzen } else 239017a03656SEric van Gyzen gw = ifp->if_addr->ifa_addr; 239181d5d46bSBjoern A. Zeeb for (fibnum = 0; fibnum < rt_numfibs; fibnum++) 239234a5582cSAlexander V. Chernikov rib_add_redirect(fibnum, (struct sockaddr *)&sdst, gw, 239334a5582cSAlexander V. Chernikov (struct sockaddr *)&ssrc, ifp, rt_flags, 239434a5582cSAlexander V. Chernikov V_icmp6_redirtimeout); 239582cd038dSYoshinobu Inoue } 239682cd038dSYoshinobu Inoue /* finally update cached route in each socket via pfctlinput */ 239782cd038dSYoshinobu Inoue { 239882cd038dSYoshinobu Inoue struct sockaddr_in6 sdst; 239982cd038dSYoshinobu Inoue 240082cd038dSYoshinobu Inoue bzero(&sdst, sizeof(sdst)); 240182cd038dSYoshinobu Inoue sdst.sin6_family = AF_INET6; 240282cd038dSYoshinobu Inoue sdst.sin6_len = sizeof(struct sockaddr_in6); 240382cd038dSYoshinobu Inoue bcopy(&reddst6, &sdst.sin6_addr, sizeof(struct in6_addr)); 240482cd038dSYoshinobu Inoue pfctlinput(PRC_REDIRECT_HOST, (struct sockaddr *)&sdst); 240582cd038dSYoshinobu Inoue } 2406686cdd19SJun-ichiro itojun Hagino 2407686cdd19SJun-ichiro itojun Hagino freeit: 2408686cdd19SJun-ichiro itojun Hagino m_freem(m); 240933841545SHajimu UMEMOTO return; 241033841545SHajimu UMEMOTO 241133841545SHajimu UMEMOTO bad: 2412e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_badredirect); 241333841545SHajimu UMEMOTO m_freem(m); 241482cd038dSYoshinobu Inoue } 241582cd038dSYoshinobu Inoue 241682cd038dSYoshinobu Inoue void 24179ac7c6cfSAlexander V. Chernikov icmp6_redirect_output(struct mbuf *m0, struct nhop_object *nh) 241882cd038dSYoshinobu Inoue { 241982cd038dSYoshinobu Inoue struct ifnet *ifp; /* my outgoing interface */ 242082cd038dSYoshinobu Inoue struct in6_addr *ifp_ll6; 242182cd038dSYoshinobu Inoue struct in6_addr *router_ll6; 242282cd038dSYoshinobu Inoue struct ip6_hdr *sip6; /* m0 as struct ip6_hdr */ 242382cd038dSYoshinobu Inoue struct mbuf *m = NULL; /* newly allocated one */ 24241db8d1f8SAna Kukec struct m_tag *mtag; 242582cd038dSYoshinobu Inoue struct ip6_hdr *ip6; /* m as struct ip6_hdr */ 242682cd038dSYoshinobu Inoue struct nd_redirect *nd_rd; 242756c423b0SKip Macy struct llentry *ln = NULL; 242882cd038dSYoshinobu Inoue size_t maxlen; 242982cd038dSYoshinobu Inoue u_char *p; 243082cd038dSYoshinobu Inoue struct ifnet *outif = NULL; 2431686cdd19SJun-ichiro itojun Hagino struct sockaddr_in6 src_sa; 2432686cdd19SJun-ichiro itojun Hagino 243349dc650cSAndrey V. Elsukov icmp6_errcount(ND_REDIRECT, 0); 243482cd038dSYoshinobu Inoue 243582cd038dSYoshinobu Inoue /* if we are not router, we don't send icmp6 redirect */ 2436603724d3SBjoern A. Zeeb if (!V_ip6_forwarding) 243782cd038dSYoshinobu Inoue goto fail; 243882cd038dSYoshinobu Inoue 243982cd038dSYoshinobu Inoue /* sanity check */ 24409ac7c6cfSAlexander V. Chernikov if (!m0 || !nh || !(NH_IS_VALID(nh)) || !(ifp = nh->nh_ifp)) 244182cd038dSYoshinobu Inoue goto fail; 244282cd038dSYoshinobu Inoue 244382cd038dSYoshinobu Inoue /* 244482cd038dSYoshinobu Inoue * Address check: 244582cd038dSYoshinobu Inoue * the source address must identify a neighbor, and 244682cd038dSYoshinobu Inoue * the destination address must not be a multicast address 244782cd038dSYoshinobu Inoue * [RFC 2461, sec 8.2] 244882cd038dSYoshinobu Inoue */ 244982cd038dSYoshinobu Inoue sip6 = mtod(m0, struct ip6_hdr *); 2450686cdd19SJun-ichiro itojun Hagino bzero(&src_sa, sizeof(src_sa)); 2451686cdd19SJun-ichiro itojun Hagino src_sa.sin6_family = AF_INET6; 2452686cdd19SJun-ichiro itojun Hagino src_sa.sin6_len = sizeof(src_sa); 2453686cdd19SJun-ichiro itojun Hagino src_sa.sin6_addr = sip6->ip6_src; 2454686cdd19SJun-ichiro itojun Hagino if (nd6_is_addr_neighbor(&src_sa, ifp) == 0) 245582cd038dSYoshinobu Inoue goto fail; 245682cd038dSYoshinobu Inoue if (IN6_IS_ADDR_MULTICAST(&sip6->ip6_dst)) 245782cd038dSYoshinobu Inoue goto fail; /* what should we do here? */ 245882cd038dSYoshinobu Inoue 245982cd038dSYoshinobu Inoue /* rate limit */ 246082cd038dSYoshinobu Inoue if (icmp6_ratelimit(&sip6->ip6_src, ND_REDIRECT, 0)) 246182cd038dSYoshinobu Inoue goto fail; 246282cd038dSYoshinobu Inoue 246382cd038dSYoshinobu Inoue /* 246482cd038dSYoshinobu Inoue * Since we are going to append up to 1280 bytes (= IPV6_MMTU), 246582cd038dSYoshinobu Inoue * we almost always ask for an mbuf cluster for simplicity. 246682cd038dSYoshinobu Inoue * (MHLEN < IPV6_MMTU is almost always true) 246782cd038dSYoshinobu Inoue */ 2468686cdd19SJun-ichiro itojun Hagino #if IPV6_MMTU >= MCLBYTES 2469686cdd19SJun-ichiro itojun Hagino # error assumption failed about IPV6_MMTU and MCLBYTES 2470686cdd19SJun-ichiro itojun Hagino #endif 24717b07d1beSGleb Smirnoff m = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR); 24727b07d1beSGleb Smirnoff if (m == NULL) 247382cd038dSYoshinobu Inoue goto fail; 24749ac7c6cfSAlexander V. Chernikov M_SETFIB(m, M_GETFIB(m0)); 247533841545SHajimu UMEMOTO maxlen = M_TRAILINGSPACE(m); 247682cd038dSYoshinobu Inoue maxlen = min(IPV6_MMTU, maxlen); 247782cd038dSYoshinobu Inoue /* just for safety */ 2478686cdd19SJun-ichiro itojun Hagino if (maxlen < sizeof(struct ip6_hdr) + sizeof(struct icmp6_hdr) + 2479686cdd19SJun-ichiro itojun Hagino ((sizeof(struct nd_opt_hdr) + ifp->if_addrlen + 7) & ~7)) { 248082cd038dSYoshinobu Inoue goto fail; 2481686cdd19SJun-ichiro itojun Hagino } 248282cd038dSYoshinobu Inoue 248382cd038dSYoshinobu Inoue { 248482cd038dSYoshinobu Inoue /* get ip6 linklocal address for ifp(my outgoing interface). */ 2485686cdd19SJun-ichiro itojun Hagino struct in6_ifaddr *ia; 2486686cdd19SJun-ichiro itojun Hagino if ((ia = in6ifa_ifpforlinklocal(ifp, 2487686cdd19SJun-ichiro itojun Hagino IN6_IFF_NOTREADY| 2488686cdd19SJun-ichiro itojun Hagino IN6_IFF_ANYCAST)) == NULL) 248982cd038dSYoshinobu Inoue goto fail; 249082cd038dSYoshinobu Inoue ifp_ll6 = &ia->ia_addr.sin6_addr; 24918c0fec80SRobert Watson /* XXXRW: reference released prematurely. */ 24928c0fec80SRobert Watson ifa_free(&ia->ia_ifa); 249382cd038dSYoshinobu Inoue } 249482cd038dSYoshinobu Inoue 249582cd038dSYoshinobu Inoue /* get ip6 linklocal address for the router. */ 24969ac7c6cfSAlexander V. Chernikov if (nh->nh_flags & NHF_GATEWAY) { 249782cd038dSYoshinobu Inoue struct sockaddr_in6 *sin6; 24989ac7c6cfSAlexander V. Chernikov sin6 = &nh->gw6_sa; 249982cd038dSYoshinobu Inoue router_ll6 = &sin6->sin6_addr; 250082cd038dSYoshinobu Inoue if (!IN6_IS_ADDR_LINKLOCAL(router_ll6)) 250182cd038dSYoshinobu Inoue router_ll6 = (struct in6_addr *)NULL; 250282cd038dSYoshinobu Inoue } else 250382cd038dSYoshinobu Inoue router_ll6 = (struct in6_addr *)NULL; 250482cd038dSYoshinobu Inoue 250582cd038dSYoshinobu Inoue /* ip6 */ 250682cd038dSYoshinobu Inoue ip6 = mtod(m, struct ip6_hdr *); 250782cd038dSYoshinobu Inoue ip6->ip6_flow = 0; 2508686cdd19SJun-ichiro itojun Hagino ip6->ip6_vfc &= ~IPV6_VERSION_MASK; 2509686cdd19SJun-ichiro itojun Hagino ip6->ip6_vfc |= IPV6_VERSION; 251082cd038dSYoshinobu Inoue /* ip6->ip6_plen will be set later */ 251182cd038dSYoshinobu Inoue ip6->ip6_nxt = IPPROTO_ICMPV6; 251282cd038dSYoshinobu Inoue ip6->ip6_hlim = 255; 251382cd038dSYoshinobu Inoue /* ip6->ip6_src must be linklocal addr for my outgoing if. */ 251482cd038dSYoshinobu Inoue bcopy(ifp_ll6, &ip6->ip6_src, sizeof(struct in6_addr)); 251582cd038dSYoshinobu Inoue bcopy(&sip6->ip6_src, &ip6->ip6_dst, sizeof(struct in6_addr)); 251682cd038dSYoshinobu Inoue 251782cd038dSYoshinobu Inoue /* ND Redirect */ 251882cd038dSYoshinobu Inoue nd_rd = (struct nd_redirect *)(ip6 + 1); 251982cd038dSYoshinobu Inoue nd_rd->nd_rd_type = ND_REDIRECT; 252082cd038dSYoshinobu Inoue nd_rd->nd_rd_code = 0; 252182cd038dSYoshinobu Inoue nd_rd->nd_rd_reserved = 0; 25229ac7c6cfSAlexander V. Chernikov if (nh->nh_flags & NHF_GATEWAY) { 252382cd038dSYoshinobu Inoue /* 252482cd038dSYoshinobu Inoue * nd_rd->nd_rd_target must be a link-local address in 252582cd038dSYoshinobu Inoue * better router cases. 252682cd038dSYoshinobu Inoue */ 252782cd038dSYoshinobu Inoue if (!router_ll6) 252882cd038dSYoshinobu Inoue goto fail; 252982cd038dSYoshinobu Inoue bcopy(router_ll6, &nd_rd->nd_rd_target, 253082cd038dSYoshinobu Inoue sizeof(nd_rd->nd_rd_target)); 253182cd038dSYoshinobu Inoue bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_dst, 253282cd038dSYoshinobu Inoue sizeof(nd_rd->nd_rd_dst)); 253382cd038dSYoshinobu Inoue } else { 253482cd038dSYoshinobu Inoue /* make sure redtgt == reddst */ 253582cd038dSYoshinobu Inoue bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_target, 253682cd038dSYoshinobu Inoue sizeof(nd_rd->nd_rd_target)); 253782cd038dSYoshinobu Inoue bcopy(&sip6->ip6_dst, &nd_rd->nd_rd_dst, 253882cd038dSYoshinobu Inoue sizeof(nd_rd->nd_rd_dst)); 253982cd038dSYoshinobu Inoue } 254082cd038dSYoshinobu Inoue 254182cd038dSYoshinobu Inoue p = (u_char *)(nd_rd + 1); 254282cd038dSYoshinobu Inoue 254382cd038dSYoshinobu Inoue if (!router_ll6) 254482cd038dSYoshinobu Inoue goto nolladdropt; 254582cd038dSYoshinobu Inoue 254682cd038dSYoshinobu Inoue { 254782cd038dSYoshinobu Inoue /* target lladdr option */ 254882cd038dSYoshinobu Inoue int len; 254982cd038dSYoshinobu Inoue struct nd_opt_hdr *nd_opt; 255082cd038dSYoshinobu Inoue char *lladdr; 255182cd038dSYoshinobu Inoue 25526e6b3f7cSQing Li ln = nd6_lookup(router_ll6, 0, ifp); 255356c423b0SKip Macy if (ln == NULL) 255482cd038dSYoshinobu Inoue goto nolladdropt; 25556e6b3f7cSQing Li 2556686cdd19SJun-ichiro itojun Hagino len = sizeof(*nd_opt) + ifp->if_addrlen; 2557686cdd19SJun-ichiro itojun Hagino len = (len + 7) & ~7; /* round by 8 */ 2558686cdd19SJun-ichiro itojun Hagino /* safety check */ 2559686cdd19SJun-ichiro itojun Hagino if (len + (p - (u_char *)ip6) > maxlen) 2560686cdd19SJun-ichiro itojun Hagino goto nolladdropt; 25616e6b3f7cSQing Li 25626e6b3f7cSQing Li if (ln->la_flags & LLE_VALID) { 256382cd038dSYoshinobu Inoue nd_opt = (struct nd_opt_hdr *)p; 256482cd038dSYoshinobu Inoue nd_opt->nd_opt_type = ND_OPT_TARGET_LINKADDR; 256582cd038dSYoshinobu Inoue nd_opt->nd_opt_len = len >> 3; 256682cd038dSYoshinobu Inoue lladdr = (char *)(nd_opt + 1); 25674fb3a820SAlexander V. Chernikov bcopy(ln->ll_addr, lladdr, ifp->if_addrlen); 2568686cdd19SJun-ichiro itojun Hagino p += len; 256982cd038dSYoshinobu Inoue } 257082cd038dSYoshinobu Inoue } 257156c423b0SKip Macy nolladdropt: 257256c423b0SKip Macy if (ln != NULL) 257356c423b0SKip Macy LLE_RUNLOCK(ln); 257482cd038dSYoshinobu Inoue 257582cd038dSYoshinobu Inoue m->m_pkthdr.len = m->m_len = p - (u_char *)ip6; 257682cd038dSYoshinobu Inoue 257782cd038dSYoshinobu Inoue /* just to be safe */ 2578686cdd19SJun-ichiro itojun Hagino #ifdef M_DECRYPTED /*not openbsd*/ 257982cd038dSYoshinobu Inoue if (m0->m_flags & M_DECRYPTED) 258082cd038dSYoshinobu Inoue goto noredhdropt; 2581686cdd19SJun-ichiro itojun Hagino #endif 2582686cdd19SJun-ichiro itojun Hagino if (p - (u_char *)ip6 > maxlen) 2583686cdd19SJun-ichiro itojun Hagino goto noredhdropt; 258482cd038dSYoshinobu Inoue 258582cd038dSYoshinobu Inoue { 258682cd038dSYoshinobu Inoue /* redirected header option */ 258782cd038dSYoshinobu Inoue int len; 258882cd038dSYoshinobu Inoue struct nd_opt_rd_hdr *nd_opt_rh; 258982cd038dSYoshinobu Inoue 259082cd038dSYoshinobu Inoue /* 259182cd038dSYoshinobu Inoue * compute the maximum size for icmp6 redirect header option. 259282cd038dSYoshinobu Inoue * XXX room for auth header? 259382cd038dSYoshinobu Inoue */ 259482cd038dSYoshinobu Inoue len = maxlen - (p - (u_char *)ip6); 259582cd038dSYoshinobu Inoue len &= ~7; 259682cd038dSYoshinobu Inoue 259782cd038dSYoshinobu Inoue /* This is just for simplicity. */ 259882cd038dSYoshinobu Inoue if (m0->m_pkthdr.len != m0->m_len) { 259982cd038dSYoshinobu Inoue if (m0->m_next) { 260082cd038dSYoshinobu Inoue m_freem(m0->m_next); 260182cd038dSYoshinobu Inoue m0->m_next = NULL; 260282cd038dSYoshinobu Inoue } 260382cd038dSYoshinobu Inoue m0->m_pkthdr.len = m0->m_len; 260482cd038dSYoshinobu Inoue } 260582cd038dSYoshinobu Inoue 260682cd038dSYoshinobu Inoue /* 260782cd038dSYoshinobu Inoue * Redirected header option spec (RFC2461 4.6.3) talks nothing 260882cd038dSYoshinobu Inoue * about padding/truncate rule for the original IP packet. 260906cd0a3fSHajimu UMEMOTO * From the discussion on IPv6imp in Feb 1999, 261006cd0a3fSHajimu UMEMOTO * the consensus was: 261182cd038dSYoshinobu Inoue * - "attach as much as possible" is the goal 261206cd0a3fSHajimu UMEMOTO * - pad if not aligned (original size can be guessed by 261306cd0a3fSHajimu UMEMOTO * original ip6 header) 261482cd038dSYoshinobu Inoue * Following code adds the padding if it is simple enough, 261582cd038dSYoshinobu Inoue * and truncates if not. 261682cd038dSYoshinobu Inoue */ 261782cd038dSYoshinobu Inoue if (m0->m_next || m0->m_pkthdr.len != m0->m_len) 261806cd0a3fSHajimu UMEMOTO panic("assumption failed in %s:%d", __FILE__, 261906cd0a3fSHajimu UMEMOTO __LINE__); 262082cd038dSYoshinobu Inoue 262182cd038dSYoshinobu Inoue if (len - sizeof(*nd_opt_rh) < m0->m_pkthdr.len) { 262282cd038dSYoshinobu Inoue /* not enough room, truncate */ 262306cd0a3fSHajimu UMEMOTO m0->m_pkthdr.len = m0->m_len = len - 262406cd0a3fSHajimu UMEMOTO sizeof(*nd_opt_rh); 262582cd038dSYoshinobu Inoue } else { 262682cd038dSYoshinobu Inoue /* enough room, pad or truncate */ 262782cd038dSYoshinobu Inoue size_t extra; 262882cd038dSYoshinobu Inoue 262982cd038dSYoshinobu Inoue extra = m0->m_pkthdr.len % 8; 263082cd038dSYoshinobu Inoue if (extra) { 263182cd038dSYoshinobu Inoue /* pad if easy enough, truncate if not */ 263282cd038dSYoshinobu Inoue if (8 - extra <= M_TRAILINGSPACE(m0)) { 263382cd038dSYoshinobu Inoue /* pad */ 263482cd038dSYoshinobu Inoue m0->m_len += (8 - extra); 263582cd038dSYoshinobu Inoue m0->m_pkthdr.len += (8 - extra); 263682cd038dSYoshinobu Inoue } else { 263782cd038dSYoshinobu Inoue /* truncate */ 263882cd038dSYoshinobu Inoue m0->m_pkthdr.len -= extra; 263982cd038dSYoshinobu Inoue m0->m_len -= extra; 264082cd038dSYoshinobu Inoue } 264182cd038dSYoshinobu Inoue } 264282cd038dSYoshinobu Inoue len = m0->m_pkthdr.len + sizeof(*nd_opt_rh); 264306cd0a3fSHajimu UMEMOTO m0->m_pkthdr.len = m0->m_len = len - 264406cd0a3fSHajimu UMEMOTO sizeof(*nd_opt_rh); 264582cd038dSYoshinobu Inoue } 264682cd038dSYoshinobu Inoue 264782cd038dSYoshinobu Inoue nd_opt_rh = (struct nd_opt_rd_hdr *)p; 264882cd038dSYoshinobu Inoue bzero(nd_opt_rh, sizeof(*nd_opt_rh)); 264982cd038dSYoshinobu Inoue nd_opt_rh->nd_opt_rh_type = ND_OPT_REDIRECTED_HEADER; 265082cd038dSYoshinobu Inoue nd_opt_rh->nd_opt_rh_len = len >> 3; 265182cd038dSYoshinobu Inoue p += sizeof(*nd_opt_rh); 265282cd038dSYoshinobu Inoue m->m_pkthdr.len = m->m_len = p - (u_char *)ip6; 265382cd038dSYoshinobu Inoue 265482cd038dSYoshinobu Inoue /* connect m0 to m */ 2655db06e8a0SSUZUKI Shinsuke m_tag_delete_chain(m0, NULL); 2656db06e8a0SSUZUKI Shinsuke m0->m_flags &= ~M_PKTHDR; 265782cd038dSYoshinobu Inoue m->m_next = m0; 265882cd038dSYoshinobu Inoue m->m_pkthdr.len = m->m_len + m0->m_len; 2659db06e8a0SSUZUKI Shinsuke m0 = NULL; 266082cd038dSYoshinobu Inoue } 266182cd038dSYoshinobu Inoue noredhdropt:; 2662db06e8a0SSUZUKI Shinsuke if (m0) { 2663db06e8a0SSUZUKI Shinsuke m_freem(m0); 2664db06e8a0SSUZUKI Shinsuke m0 = NULL; 2665db06e8a0SSUZUKI Shinsuke } 266682cd038dSYoshinobu Inoue 26679a4f9608SHajimu UMEMOTO /* XXX: clear embedded link IDs in the inner header */ 26689a4f9608SHajimu UMEMOTO in6_clearscope(&sip6->ip6_src); 26699a4f9608SHajimu UMEMOTO in6_clearscope(&sip6->ip6_dst); 26709a4f9608SHajimu UMEMOTO in6_clearscope(&nd_rd->nd_rd_target); 26719a4f9608SHajimu UMEMOTO in6_clearscope(&nd_rd->nd_rd_dst); 267282cd038dSYoshinobu Inoue 267382cd038dSYoshinobu Inoue ip6->ip6_plen = htons(m->m_pkthdr.len - sizeof(struct ip6_hdr)); 267482cd038dSYoshinobu Inoue 267582cd038dSYoshinobu Inoue nd_rd->nd_rd_cksum = 0; 267606cd0a3fSHajimu UMEMOTO nd_rd->nd_rd_cksum = in6_cksum(m, IPPROTO_ICMPV6, 267706cd0a3fSHajimu UMEMOTO sizeof(*ip6), ntohs(ip6->ip6_plen)); 267882cd038dSYoshinobu Inoue 26791db8d1f8SAna Kukec if (send_sendso_input_hook != NULL) { 26801db8d1f8SAna Kukec mtag = m_tag_get(PACKET_TAG_ND_OUTGOING, sizeof(unsigned short), 26811db8d1f8SAna Kukec M_NOWAIT); 26821db8d1f8SAna Kukec if (mtag == NULL) 26831db8d1f8SAna Kukec goto fail; 26841db8d1f8SAna Kukec *(unsigned short *)(mtag + 1) = nd_rd->nd_rd_type; 26851db8d1f8SAna Kukec m_tag_prepend(m, mtag); 26861db8d1f8SAna Kukec } 26871db8d1f8SAna Kukec 268882cd038dSYoshinobu Inoue /* send the packet to outside... */ 26895d846453SSam Leffler ip6_output(m, NULL, NULL, 0, NULL, &outif, NULL); 269082cd038dSYoshinobu Inoue if (outif) { 269182cd038dSYoshinobu Inoue icmp6_ifstat_inc(outif, ifs6_out_msg); 269282cd038dSYoshinobu Inoue icmp6_ifstat_inc(outif, ifs6_out_redirect); 269382cd038dSYoshinobu Inoue } 2694e27b0c87SRobert Watson ICMP6STAT_INC(icp6s_outhist[ND_REDIRECT]); 269582cd038dSYoshinobu Inoue 269682cd038dSYoshinobu Inoue return; 269782cd038dSYoshinobu Inoue 269882cd038dSYoshinobu Inoue fail: 269982cd038dSYoshinobu Inoue if (m) 270082cd038dSYoshinobu Inoue m_freem(m); 270182cd038dSYoshinobu Inoue if (m0) 270282cd038dSYoshinobu Inoue m_freem(m0); 270382cd038dSYoshinobu Inoue } 270482cd038dSYoshinobu Inoue 270582cd038dSYoshinobu Inoue /* 270682cd038dSYoshinobu Inoue * ICMPv6 socket option processing. 270782cd038dSYoshinobu Inoue */ 270882cd038dSYoshinobu Inoue int 27091272577eSXin LI icmp6_ctloutput(struct socket *so, struct sockopt *sopt) 271082cd038dSYoshinobu Inoue { 271182cd038dSYoshinobu Inoue int error = 0; 271282cd038dSYoshinobu Inoue int optlen; 271333841545SHajimu UMEMOTO struct inpcb *inp = sotoinpcb(so); 271482cd038dSYoshinobu Inoue int level, op, optname; 271582cd038dSYoshinobu Inoue 271682cd038dSYoshinobu Inoue if (sopt) { 271782cd038dSYoshinobu Inoue level = sopt->sopt_level; 271882cd038dSYoshinobu Inoue op = sopt->sopt_dir; 271982cd038dSYoshinobu Inoue optname = sopt->sopt_name; 272082cd038dSYoshinobu Inoue optlen = sopt->sopt_valsize; 272182cd038dSYoshinobu Inoue } else 272282cd038dSYoshinobu Inoue level = op = optname = optlen = 0; 272333841545SHajimu UMEMOTO 272482cd038dSYoshinobu Inoue if (level != IPPROTO_ICMPV6) { 272582cd038dSYoshinobu Inoue return EINVAL; 272682cd038dSYoshinobu Inoue } 272782cd038dSYoshinobu Inoue 272882cd038dSYoshinobu Inoue switch (op) { 272982cd038dSYoshinobu Inoue case PRCO_SETOPT: 273082cd038dSYoshinobu Inoue switch (optname) { 273182cd038dSYoshinobu Inoue case ICMP6_FILTER: 273282cd038dSYoshinobu Inoue { 2733ae89d5a3SRobert Watson struct icmp6_filter ic6f; 273482cd038dSYoshinobu Inoue 2735ae89d5a3SRobert Watson if (optlen != sizeof(ic6f)) { 273682cd038dSYoshinobu Inoue error = EMSGSIZE; 273782cd038dSYoshinobu Inoue break; 273882cd038dSYoshinobu Inoue } 2739ae89d5a3SRobert Watson error = sooptcopyin(sopt, &ic6f, optlen, optlen); 2740ae89d5a3SRobert Watson if (error == 0) { 2741ae89d5a3SRobert Watson INP_WLOCK(inp); 2742ae89d5a3SRobert Watson *inp->in6p_icmp6filt = ic6f; 2743ae89d5a3SRobert Watson INP_WUNLOCK(inp); 2744ae89d5a3SRobert Watson } 274582cd038dSYoshinobu Inoue break; 274682cd038dSYoshinobu Inoue } 274782cd038dSYoshinobu Inoue 274882cd038dSYoshinobu Inoue default: 274982cd038dSYoshinobu Inoue error = ENOPROTOOPT; 275082cd038dSYoshinobu Inoue break; 275182cd038dSYoshinobu Inoue } 275282cd038dSYoshinobu Inoue break; 275382cd038dSYoshinobu Inoue 275482cd038dSYoshinobu Inoue case PRCO_GETOPT: 275582cd038dSYoshinobu Inoue switch (optname) { 275682cd038dSYoshinobu Inoue case ICMP6_FILTER: 275782cd038dSYoshinobu Inoue { 2758ae89d5a3SRobert Watson struct icmp6_filter ic6f; 2759ae89d5a3SRobert Watson 2760ae89d5a3SRobert Watson INP_RLOCK(inp); 2761ae89d5a3SRobert Watson ic6f = *inp->in6p_icmp6filt; 2762ae89d5a3SRobert Watson INP_RUNLOCK(inp); 2763ae89d5a3SRobert Watson error = sooptcopyout(sopt, &ic6f, sizeof(ic6f)); 276482cd038dSYoshinobu Inoue break; 276582cd038dSYoshinobu Inoue } 276682cd038dSYoshinobu Inoue 276782cd038dSYoshinobu Inoue default: 276882cd038dSYoshinobu Inoue error = ENOPROTOOPT; 276982cd038dSYoshinobu Inoue break; 277082cd038dSYoshinobu Inoue } 277182cd038dSYoshinobu Inoue break; 277282cd038dSYoshinobu Inoue } 277382cd038dSYoshinobu Inoue 277482cd038dSYoshinobu Inoue return (error); 277582cd038dSYoshinobu Inoue } 277682cd038dSYoshinobu Inoue 277782cd038dSYoshinobu Inoue /* 277882cd038dSYoshinobu Inoue * Perform rate limit check. 277982cd038dSYoshinobu Inoue * Returns 0 if it is okay to send the icmp6 packet. 278082cd038dSYoshinobu Inoue * Returns 1 if the router SHOULD NOT send this icmp6 packet due to rate 278182cd038dSYoshinobu Inoue * limitation. 278282cd038dSYoshinobu Inoue * 278382cd038dSYoshinobu Inoue * XXX per-destination/type check necessary? 27841272577eSXin LI * 27851272577eSXin LI * dst - not used at this moment 27861272577eSXin LI * type - not used at this moment 27871272577eSXin LI * code - not used at this moment 278882cd038dSYoshinobu Inoue */ 278982cd038dSYoshinobu Inoue static int 27901272577eSXin LI icmp6_ratelimit(const struct in6_addr *dst, const int type, 27911272577eSXin LI const int code) 279282cd038dSYoshinobu Inoue { 2793686cdd19SJun-ichiro itojun Hagino int ret; 279482cd038dSYoshinobu Inoue 2795686cdd19SJun-ichiro itojun Hagino ret = 0; /* okay to send */ 279682cd038dSYoshinobu Inoue 2797686cdd19SJun-ichiro itojun Hagino /* PPS limit */ 2798603724d3SBjoern A. Zeeb if (!ppsratecheck(&V_icmp6errppslim_last, &V_icmp6errpps_count, 2799603724d3SBjoern A. Zeeb V_icmp6errppslim)) { 280082cd038dSYoshinobu Inoue /* The packet is subject to rate limit */ 2801686cdd19SJun-ichiro itojun Hagino ret++; 280282cd038dSYoshinobu Inoue } 280382cd038dSYoshinobu Inoue 2804686cdd19SJun-ichiro itojun Hagino return ret; 280582cd038dSYoshinobu Inoue } 2806