1caf43b02SWarner Losh /*- 282cd038dSYoshinobu Inoue * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 382cd038dSYoshinobu Inoue * All rights reserved. 482cd038dSYoshinobu Inoue * 582cd038dSYoshinobu Inoue * Redistribution and use in source and binary forms, with or without 682cd038dSYoshinobu Inoue * modification, are permitted provided that the following conditions 782cd038dSYoshinobu Inoue * are met: 882cd038dSYoshinobu Inoue * 1. Redistributions of source code must retain the above copyright 982cd038dSYoshinobu Inoue * notice, this list of conditions and the following disclaimer. 1082cd038dSYoshinobu Inoue * 2. Redistributions in binary form must reproduce the above copyright 1182cd038dSYoshinobu Inoue * notice, this list of conditions and the following disclaimer in the 1282cd038dSYoshinobu Inoue * documentation and/or other materials provided with the distribution. 1382cd038dSYoshinobu Inoue * 3. Neither the name of the project nor the names of its contributors 1482cd038dSYoshinobu Inoue * may be used to endorse or promote products derived from this software 1582cd038dSYoshinobu Inoue * without specific prior written permission. 1682cd038dSYoshinobu Inoue * 1782cd038dSYoshinobu Inoue * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 1882cd038dSYoshinobu Inoue * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1982cd038dSYoshinobu Inoue * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 2082cd038dSYoshinobu Inoue * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 2182cd038dSYoshinobu Inoue * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2282cd038dSYoshinobu Inoue * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2382cd038dSYoshinobu Inoue * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2482cd038dSYoshinobu Inoue * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2582cd038dSYoshinobu Inoue * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2682cd038dSYoshinobu Inoue * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2782cd038dSYoshinobu Inoue * SUCH DAMAGE. 28b48287a3SDavid E. O'Brien * 29b48287a3SDavid E. O'Brien * $KAME: frag6.c,v 1.33 2002/01/07 11:34:48 kjc Exp $ 3082cd038dSYoshinobu Inoue */ 3182cd038dSYoshinobu Inoue 32b48287a3SDavid E. O'Brien #include <sys/cdefs.h> 33b48287a3SDavid E. O'Brien __FBSDID("$FreeBSD$"); 34b48287a3SDavid E. O'Brien 3582cd038dSYoshinobu Inoue #include <sys/param.h> 3682cd038dSYoshinobu Inoue #include <sys/systm.h> 3782cd038dSYoshinobu Inoue #include <sys/malloc.h> 3882cd038dSYoshinobu Inoue #include <sys/mbuf.h> 3982cd038dSYoshinobu Inoue #include <sys/domain.h> 4082cd038dSYoshinobu Inoue #include <sys/protosw.h> 4182cd038dSYoshinobu Inoue #include <sys/socket.h> 4282cd038dSYoshinobu Inoue #include <sys/errno.h> 4382cd038dSYoshinobu Inoue #include <sys/time.h> 4482cd038dSYoshinobu Inoue #include <sys/kernel.h> 4582cd038dSYoshinobu Inoue #include <sys/syslog.h> 4682cd038dSYoshinobu Inoue 4782cd038dSYoshinobu Inoue #include <net/if.h> 4882cd038dSYoshinobu Inoue #include <net/route.h> 4982cd038dSYoshinobu Inoue 5082cd038dSYoshinobu Inoue #include <netinet/in.h> 5182cd038dSYoshinobu Inoue #include <netinet/in_var.h> 52686cdd19SJun-ichiro itojun Hagino #include <netinet/ip6.h> 5382cd038dSYoshinobu Inoue #include <netinet6/ip6_var.h> 54686cdd19SJun-ichiro itojun Hagino #include <netinet/icmp6.h> 5559dfcba4SHajimu UMEMOTO #include <netinet/in_systm.h> /* for ECN definitions */ 5659dfcba4SHajimu UMEMOTO #include <netinet/ip.h> /* for ECN definitions */ 5782cd038dSYoshinobu Inoue 5882cd038dSYoshinobu Inoue /* 5982cd038dSYoshinobu Inoue * Define it to get a correct behavior on per-interface statistics. 6082cd038dSYoshinobu Inoue * You will need to perform an extra routing table lookup, per fragment, 6182cd038dSYoshinobu Inoue * to do it. This may, or may not be, a performance hit. 6282cd038dSYoshinobu Inoue */ 6382cd038dSYoshinobu Inoue #define IN6_IFSTAT_STRICT 6482cd038dSYoshinobu Inoue 6582cd038dSYoshinobu Inoue static void frag6_enq __P((struct ip6asfrag *, struct ip6asfrag *)); 6682cd038dSYoshinobu Inoue static void frag6_deq __P((struct ip6asfrag *)); 6782cd038dSYoshinobu Inoue static void frag6_insque __P((struct ip6q *, struct ip6q *)); 6882cd038dSYoshinobu Inoue static void frag6_remque __P((struct ip6q *)); 6982cd038dSYoshinobu Inoue static void frag6_freef __P((struct ip6q *)); 7082cd038dSYoshinobu Inoue 7131e8f7e5SHajimu UMEMOTO static struct mtx ip6qlock; 7231e8f7e5SHajimu UMEMOTO /* 7331e8f7e5SHajimu UMEMOTO * These fields all protected by ip6qlock. 7431e8f7e5SHajimu UMEMOTO */ 7531e8f7e5SHajimu UMEMOTO static u_int frag6_nfragpackets; 7631e8f7e5SHajimu UMEMOTO static u_int frag6_nfrags; 7731e8f7e5SHajimu UMEMOTO static struct ip6q ip6q; /* ip6 reassemble queue */ 7882cd038dSYoshinobu Inoue 7931e8f7e5SHajimu UMEMOTO #define IP6Q_LOCK_INIT() mtx_init(&ip6qlock, "ip6qlock", NULL, MTX_DEF); 8031e8f7e5SHajimu UMEMOTO #define IP6Q_LOCK() mtx_lock(&ip6qlock) 8131e8f7e5SHajimu UMEMOTO #define IP6Q_TRYLOCK() mtx_trylock(&ip6qlock) 829bcf770cSHajimu UMEMOTO #define IP6Q_LOCK_ASSERT() mtx_assert(&ip6qlock, MA_OWNED) 8331e8f7e5SHajimu UMEMOTO #define IP6Q_UNLOCK() mtx_unlock(&ip6qlock) 849888c401SHajimu UMEMOTO 85959b7375SPoul-Henning Kamp static MALLOC_DEFINE(M_FTABLE, "fragment", "fragment reassembly header"); 86686cdd19SJun-ichiro itojun Hagino 8782cd038dSYoshinobu Inoue /* 8882cd038dSYoshinobu Inoue * Initialise reassembly queue and fragment identifier. 8982cd038dSYoshinobu Inoue */ 904f590175SPaul Saab static void 914f590175SPaul Saab frag6_change(void *tag) 924f590175SPaul Saab { 934f590175SPaul Saab 944f590175SPaul Saab ip6_maxfragpackets = nmbclusters / 4; 954f590175SPaul Saab ip6_maxfrags = nmbclusters / 4; 964f590175SPaul Saab } 974f590175SPaul Saab 9882cd038dSYoshinobu Inoue void 991272577eSXin LI frag6_init(void) 10082cd038dSYoshinobu Inoue { 10182cd038dSYoshinobu Inoue 10296c2b042SJesper Skriver ip6_maxfragpackets = nmbclusters / 4; 1039888c401SHajimu UMEMOTO ip6_maxfrags = nmbclusters / 4; 1044f590175SPaul Saab EVENTHANDLER_REGISTER(nmbclusters_change, 1054f590175SPaul Saab frag6_change, NULL, EVENTHANDLER_PRI_ANY); 10696c2b042SJesper Skriver 10731e8f7e5SHajimu UMEMOTO IP6Q_LOCK_INIT(); 10831e8f7e5SHajimu UMEMOTO 109686cdd19SJun-ichiro itojun Hagino ip6q.ip6q_next = ip6q.ip6q_prev = &ip6q; 11082cd038dSYoshinobu Inoue } 11182cd038dSYoshinobu Inoue 11282cd038dSYoshinobu Inoue /* 113686cdd19SJun-ichiro itojun Hagino * In RFC2460, fragment and reassembly rule do not agree with each other, 114686cdd19SJun-ichiro itojun Hagino * in terms of next header field handling in fragment header. 115686cdd19SJun-ichiro itojun Hagino * While the sender will use the same value for all of the fragmented packets, 116686cdd19SJun-ichiro itojun Hagino * receiver is suggested not to check the consistency. 117686cdd19SJun-ichiro itojun Hagino * 118686cdd19SJun-ichiro itojun Hagino * fragment rule (p20): 119686cdd19SJun-ichiro itojun Hagino * (2) A Fragment header containing: 120686cdd19SJun-ichiro itojun Hagino * The Next Header value that identifies the first header of 121686cdd19SJun-ichiro itojun Hagino * the Fragmentable Part of the original packet. 122686cdd19SJun-ichiro itojun Hagino * -> next header field is same for all fragments 123686cdd19SJun-ichiro itojun Hagino * 124686cdd19SJun-ichiro itojun Hagino * reassembly rule (p21): 125686cdd19SJun-ichiro itojun Hagino * The Next Header field of the last header of the Unfragmentable 126686cdd19SJun-ichiro itojun Hagino * Part is obtained from the Next Header field of the first 127686cdd19SJun-ichiro itojun Hagino * fragment's Fragment header. 128686cdd19SJun-ichiro itojun Hagino * -> should grab it from the first fragment only 129686cdd19SJun-ichiro itojun Hagino * 130686cdd19SJun-ichiro itojun Hagino * The following note also contradicts with fragment rule - noone is going to 131686cdd19SJun-ichiro itojun Hagino * send different fragment with different next header field. 132686cdd19SJun-ichiro itojun Hagino * 133686cdd19SJun-ichiro itojun Hagino * additional note (p22): 134686cdd19SJun-ichiro itojun Hagino * The Next Header values in the Fragment headers of different 135686cdd19SJun-ichiro itojun Hagino * fragments of the same original packet may differ. Only the value 136686cdd19SJun-ichiro itojun Hagino * from the Offset zero fragment packet is used for reassembly. 137686cdd19SJun-ichiro itojun Hagino * -> should grab it from the first fragment only 138686cdd19SJun-ichiro itojun Hagino * 139686cdd19SJun-ichiro itojun Hagino * There is no explicit reason given in the RFC. Historical reason maybe? 140686cdd19SJun-ichiro itojun Hagino */ 141686cdd19SJun-ichiro itojun Hagino /* 14282cd038dSYoshinobu Inoue * Fragment input 14382cd038dSYoshinobu Inoue */ 14482cd038dSYoshinobu Inoue int 1451272577eSXin LI frag6_input(struct mbuf **mp, int *offp, int proto) 14682cd038dSYoshinobu Inoue { 14782cd038dSYoshinobu Inoue struct mbuf *m = *mp, *t; 14882cd038dSYoshinobu Inoue struct ip6_hdr *ip6; 14982cd038dSYoshinobu Inoue struct ip6_frag *ip6f; 15082cd038dSYoshinobu Inoue struct ip6q *q6; 151686cdd19SJun-ichiro itojun Hagino struct ip6asfrag *af6, *ip6af, *af6dwn; 1522a5aafceSHajimu UMEMOTO #ifdef IN6_IFSTAT_STRICT 1532a5aafceSHajimu UMEMOTO struct in6_ifaddr *ia; 1542a5aafceSHajimu UMEMOTO #endif 15582cd038dSYoshinobu Inoue int offset = *offp, nxt, i, next; 15682cd038dSYoshinobu Inoue int first_frag = 0; 157686cdd19SJun-ichiro itojun Hagino int fragoff, frgpartlen; /* must be larger than u_int16_t */ 15882cd038dSYoshinobu Inoue struct ifnet *dstifp; 15959dfcba4SHajimu UMEMOTO u_int8_t ecn, ecn0; 1601d54aa3bSBjoern A. Zeeb #if 0 1611d54aa3bSBjoern A. Zeeb char ip6buf[INET6_ADDRSTRLEN]; 1621d54aa3bSBjoern A. Zeeb #endif 16382cd038dSYoshinobu Inoue 16482cd038dSYoshinobu Inoue ip6 = mtod(m, struct ip6_hdr *); 165686cdd19SJun-ichiro itojun Hagino #ifndef PULLDOWN_TEST 166686cdd19SJun-ichiro itojun Hagino IP6_EXTHDR_CHECK(m, offset, sizeof(struct ip6_frag), IPPROTO_DONE); 16782cd038dSYoshinobu Inoue ip6f = (struct ip6_frag *)((caddr_t)ip6 + offset); 168686cdd19SJun-ichiro itojun Hagino #else 169686cdd19SJun-ichiro itojun Hagino IP6_EXTHDR_GET(ip6f, struct ip6_frag *, m, offset, sizeof(*ip6f)); 170686cdd19SJun-ichiro itojun Hagino if (ip6f == NULL) 17140e39bbbSHajimu UMEMOTO return (IPPROTO_DONE); 172686cdd19SJun-ichiro itojun Hagino #endif 17382cd038dSYoshinobu Inoue 17482cd038dSYoshinobu Inoue dstifp = NULL; 17582cd038dSYoshinobu Inoue #ifdef IN6_IFSTAT_STRICT 17682cd038dSYoshinobu Inoue /* find the destination interface of the packet. */ 1772a5aafceSHajimu UMEMOTO if ((ia = ip6_getdstifaddr(m)) != NULL) 1782a5aafceSHajimu UMEMOTO dstifp = ia->ia_ifp; 17982cd038dSYoshinobu Inoue #else 18082cd038dSYoshinobu Inoue /* we are violating the spec, this is not the destination interface */ 18182cd038dSYoshinobu Inoue if ((m->m_flags & M_PKTHDR) != 0) 18282cd038dSYoshinobu Inoue dstifp = m->m_pkthdr.rcvif; 18382cd038dSYoshinobu Inoue #endif 18482cd038dSYoshinobu Inoue 18582cd038dSYoshinobu Inoue /* jumbo payload can't contain a fragment header */ 18682cd038dSYoshinobu Inoue if (ip6->ip6_plen == 0) { 18782cd038dSYoshinobu Inoue icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, offset); 18882cd038dSYoshinobu Inoue in6_ifstat_inc(dstifp, ifs6_reass_fail); 18982cd038dSYoshinobu Inoue return IPPROTO_DONE; 19082cd038dSYoshinobu Inoue } 19182cd038dSYoshinobu Inoue 19282cd038dSYoshinobu Inoue /* 19382cd038dSYoshinobu Inoue * check whether fragment packet's fragment length is 19482cd038dSYoshinobu Inoue * multiple of 8 octets. 19582cd038dSYoshinobu Inoue * sizeof(struct ip6_frag) == 8 19682cd038dSYoshinobu Inoue * sizeof(struct ip6_hdr) = 40 19782cd038dSYoshinobu Inoue */ 19882cd038dSYoshinobu Inoue if ((ip6f->ip6f_offlg & IP6F_MORE_FRAG) && 19982cd038dSYoshinobu Inoue (((ntohs(ip6->ip6_plen) - offset) & 0x7) != 0)) { 20006cd0a3fSHajimu UMEMOTO icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, 201686cdd19SJun-ichiro itojun Hagino offsetof(struct ip6_hdr, ip6_plen)); 20282cd038dSYoshinobu Inoue in6_ifstat_inc(dstifp, ifs6_reass_fail); 20382cd038dSYoshinobu Inoue return IPPROTO_DONE; 20482cd038dSYoshinobu Inoue } 20582cd038dSYoshinobu Inoue 20682cd038dSYoshinobu Inoue ip6stat.ip6s_fragments++; 20782cd038dSYoshinobu Inoue in6_ifstat_inc(dstifp, ifs6_reass_reqd); 20882cd038dSYoshinobu Inoue 209686cdd19SJun-ichiro itojun Hagino /* offset now points to data portion */ 21082cd038dSYoshinobu Inoue offset += sizeof(struct ip6_frag); 21182cd038dSYoshinobu Inoue 2129888c401SHajimu UMEMOTO IP6Q_LOCK(); 2139888c401SHajimu UMEMOTO 2149888c401SHajimu UMEMOTO /* 2159888c401SHajimu UMEMOTO * Enforce upper bound on number of fragments. 2169888c401SHajimu UMEMOTO * If maxfrag is 0, never accept fragments. 2179888c401SHajimu UMEMOTO * If maxfrag is -1, accept all fragments without limitation. 2189888c401SHajimu UMEMOTO */ 2199888c401SHajimu UMEMOTO if (ip6_maxfrags < 0) 2209888c401SHajimu UMEMOTO ; 2219888c401SHajimu UMEMOTO else if (frag6_nfrags >= (u_int)ip6_maxfrags) 2229888c401SHajimu UMEMOTO goto dropfrag; 22333841545SHajimu UMEMOTO 22482cd038dSYoshinobu Inoue for (q6 = ip6q.ip6q_next; q6 != &ip6q; q6 = q6->ip6q_next) 22582cd038dSYoshinobu Inoue if (ip6f->ip6f_ident == q6->ip6q_ident && 22682cd038dSYoshinobu Inoue IN6_ARE_ADDR_EQUAL(&ip6->ip6_src, &q6->ip6q_src) && 22782cd038dSYoshinobu Inoue IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst, &q6->ip6q_dst)) 22882cd038dSYoshinobu Inoue break; 22982cd038dSYoshinobu Inoue 23082cd038dSYoshinobu Inoue if (q6 == &ip6q) { 23182cd038dSYoshinobu Inoue /* 23282cd038dSYoshinobu Inoue * the first fragment to arrive, create a reassembly queue. 23382cd038dSYoshinobu Inoue */ 23482cd038dSYoshinobu Inoue first_frag = 1; 23582cd038dSYoshinobu Inoue 23682cd038dSYoshinobu Inoue /* 23782cd038dSYoshinobu Inoue * Enforce upper bound on number of fragmented packets 23882cd038dSYoshinobu Inoue * for which we attempt reassembly; 2399888c401SHajimu UMEMOTO * If maxfragpackets is 0, never accept fragments. 2409888c401SHajimu UMEMOTO * If maxfragpackets is -1, accept all fragments without 2419888c401SHajimu UMEMOTO * limitation. 24282cd038dSYoshinobu Inoue */ 24333841545SHajimu UMEMOTO if (ip6_maxfragpackets < 0) 24433841545SHajimu UMEMOTO ; 24533841545SHajimu UMEMOTO else if (frag6_nfragpackets >= (u_int)ip6_maxfragpackets) 24633841545SHajimu UMEMOTO goto dropfrag; 24733841545SHajimu UMEMOTO frag6_nfragpackets++; 24882cd038dSYoshinobu Inoue q6 = (struct ip6q *)malloc(sizeof(struct ip6q), M_FTABLE, 2498c0dd0e4SHajimu UMEMOTO M_NOWAIT); 25082cd038dSYoshinobu Inoue if (q6 == NULL) 25182cd038dSYoshinobu Inoue goto dropfrag; 252686cdd19SJun-ichiro itojun Hagino bzero(q6, sizeof(*q6)); 25382cd038dSYoshinobu Inoue 25482cd038dSYoshinobu Inoue frag6_insque(q6, &ip6q); 25582cd038dSYoshinobu Inoue 256686cdd19SJun-ichiro itojun Hagino /* ip6q_nxt will be filled afterwards, from 1st fragment */ 25782cd038dSYoshinobu Inoue q6->ip6q_down = q6->ip6q_up = (struct ip6asfrag *)q6; 258686cdd19SJun-ichiro itojun Hagino #ifdef notyet 259686cdd19SJun-ichiro itojun Hagino q6->ip6q_nxtp = (u_char *)nxtp; 260686cdd19SJun-ichiro itojun Hagino #endif 26182cd038dSYoshinobu Inoue q6->ip6q_ident = ip6f->ip6f_ident; 26282cd038dSYoshinobu Inoue q6->ip6q_ttl = IPV6_FRAGTTL; 26382cd038dSYoshinobu Inoue q6->ip6q_src = ip6->ip6_src; 26482cd038dSYoshinobu Inoue q6->ip6q_dst = ip6->ip6_dst; 2655e9510e3SJINMEI Tatuya q6->ip6q_ecn = 2665e9510e3SJINMEI Tatuya (ntohl(ip6->ip6_flow) >> 20) & IPTOS_ECN_MASK; 26782cd038dSYoshinobu Inoue q6->ip6q_unfrglen = -1; /* The 1st fragment has not arrived. */ 2689888c401SHajimu UMEMOTO 2699888c401SHajimu UMEMOTO q6->ip6q_nfrag = 0; 27082cd038dSYoshinobu Inoue } 27182cd038dSYoshinobu Inoue 27282cd038dSYoshinobu Inoue /* 27382cd038dSYoshinobu Inoue * If it's the 1st fragment, record the length of the 27482cd038dSYoshinobu Inoue * unfragmentable part and the next header of the fragment header. 27582cd038dSYoshinobu Inoue */ 27682cd038dSYoshinobu Inoue fragoff = ntohs(ip6f->ip6f_offlg & IP6F_OFF_MASK); 27782cd038dSYoshinobu Inoue if (fragoff == 0) { 27806cd0a3fSHajimu UMEMOTO q6->ip6q_unfrglen = offset - sizeof(struct ip6_hdr) - 27906cd0a3fSHajimu UMEMOTO sizeof(struct ip6_frag); 28082cd038dSYoshinobu Inoue q6->ip6q_nxt = ip6f->ip6f_nxt; 28182cd038dSYoshinobu Inoue } 28282cd038dSYoshinobu Inoue 28382cd038dSYoshinobu Inoue /* 28482cd038dSYoshinobu Inoue * Check that the reassembled packet would not exceed 65535 bytes 28582cd038dSYoshinobu Inoue * in size. 28682cd038dSYoshinobu Inoue * If it would exceed, discard the fragment and return an ICMP error. 28782cd038dSYoshinobu Inoue */ 28882cd038dSYoshinobu Inoue frgpartlen = sizeof(struct ip6_hdr) + ntohs(ip6->ip6_plen) - offset; 28982cd038dSYoshinobu Inoue if (q6->ip6q_unfrglen >= 0) { 29082cd038dSYoshinobu Inoue /* The 1st fragment has already arrived. */ 29182cd038dSYoshinobu Inoue if (q6->ip6q_unfrglen + fragoff + frgpartlen > IPV6_MAXPACKET) { 29282cd038dSYoshinobu Inoue icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, 293686cdd19SJun-ichiro itojun Hagino offset - sizeof(struct ip6_frag) + 294686cdd19SJun-ichiro itojun Hagino offsetof(struct ip6_frag, ip6f_offlg)); 2959888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 29682cd038dSYoshinobu Inoue return (IPPROTO_DONE); 29782cd038dSYoshinobu Inoue } 29806cd0a3fSHajimu UMEMOTO } else if (fragoff + frgpartlen > IPV6_MAXPACKET) { 29982cd038dSYoshinobu Inoue icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, 300686cdd19SJun-ichiro itojun Hagino offset - sizeof(struct ip6_frag) + 301686cdd19SJun-ichiro itojun Hagino offsetof(struct ip6_frag, ip6f_offlg)); 3029888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 30382cd038dSYoshinobu Inoue return (IPPROTO_DONE); 30482cd038dSYoshinobu Inoue } 30582cd038dSYoshinobu Inoue /* 30682cd038dSYoshinobu Inoue * If it's the first fragment, do the above check for each 30782cd038dSYoshinobu Inoue * fragment already stored in the reassembly queue. 30882cd038dSYoshinobu Inoue */ 30982cd038dSYoshinobu Inoue if (fragoff == 0) { 31082cd038dSYoshinobu Inoue for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6; 31182cd038dSYoshinobu Inoue af6 = af6dwn) { 31282cd038dSYoshinobu Inoue af6dwn = af6->ip6af_down; 31382cd038dSYoshinobu Inoue 31482cd038dSYoshinobu Inoue if (q6->ip6q_unfrglen + af6->ip6af_off + af6->ip6af_frglen > 31582cd038dSYoshinobu Inoue IPV6_MAXPACKET) { 31682cd038dSYoshinobu Inoue struct mbuf *merr = IP6_REASS_MBUF(af6); 31782cd038dSYoshinobu Inoue struct ip6_hdr *ip6err; 31882cd038dSYoshinobu Inoue int erroff = af6->ip6af_offset; 31982cd038dSYoshinobu Inoue 32082cd038dSYoshinobu Inoue /* dequeue the fragment. */ 32182cd038dSYoshinobu Inoue frag6_deq(af6); 322686cdd19SJun-ichiro itojun Hagino free(af6, M_FTABLE); 32382cd038dSYoshinobu Inoue 32482cd038dSYoshinobu Inoue /* adjust pointer. */ 32582cd038dSYoshinobu Inoue ip6err = mtod(merr, struct ip6_hdr *); 32682cd038dSYoshinobu Inoue 32782cd038dSYoshinobu Inoue /* 32882cd038dSYoshinobu Inoue * Restore source and destination addresses 32982cd038dSYoshinobu Inoue * in the erroneous IPv6 header. 33082cd038dSYoshinobu Inoue */ 33182cd038dSYoshinobu Inoue ip6err->ip6_src = q6->ip6q_src; 33282cd038dSYoshinobu Inoue ip6err->ip6_dst = q6->ip6q_dst; 33382cd038dSYoshinobu Inoue 33482cd038dSYoshinobu Inoue icmp6_error(merr, ICMP6_PARAM_PROB, 33582cd038dSYoshinobu Inoue ICMP6_PARAMPROB_HEADER, 336686cdd19SJun-ichiro itojun Hagino erroff - sizeof(struct ip6_frag) + 337686cdd19SJun-ichiro itojun Hagino offsetof(struct ip6_frag, ip6f_offlg)); 33882cd038dSYoshinobu Inoue } 33982cd038dSYoshinobu Inoue } 34082cd038dSYoshinobu Inoue } 34182cd038dSYoshinobu Inoue 342686cdd19SJun-ichiro itojun Hagino ip6af = (struct ip6asfrag *)malloc(sizeof(struct ip6asfrag), M_FTABLE, 3438c0dd0e4SHajimu UMEMOTO M_NOWAIT); 344686cdd19SJun-ichiro itojun Hagino if (ip6af == NULL) 345686cdd19SJun-ichiro itojun Hagino goto dropfrag; 346686cdd19SJun-ichiro itojun Hagino bzero(ip6af, sizeof(*ip6af)); 34782cd038dSYoshinobu Inoue ip6af->ip6af_mff = ip6f->ip6f_offlg & IP6F_MORE_FRAG; 34882cd038dSYoshinobu Inoue ip6af->ip6af_off = fragoff; 34982cd038dSYoshinobu Inoue ip6af->ip6af_frglen = frgpartlen; 35082cd038dSYoshinobu Inoue ip6af->ip6af_offset = offset; 35182cd038dSYoshinobu Inoue IP6_REASS_MBUF(ip6af) = m; 35282cd038dSYoshinobu Inoue 35382cd038dSYoshinobu Inoue if (first_frag) { 35482cd038dSYoshinobu Inoue af6 = (struct ip6asfrag *)q6; 35582cd038dSYoshinobu Inoue goto insert; 35682cd038dSYoshinobu Inoue } 35782cd038dSYoshinobu Inoue 35882cd038dSYoshinobu Inoue /* 35959dfcba4SHajimu UMEMOTO * Handle ECN by comparing this segment with the first one; 36059dfcba4SHajimu UMEMOTO * if CE is set, do not lose CE. 36159dfcba4SHajimu UMEMOTO * drop if CE and not-ECT are mixed for the same packet. 36259dfcba4SHajimu UMEMOTO */ 36359dfcba4SHajimu UMEMOTO ecn = (ntohl(ip6->ip6_flow) >> 20) & IPTOS_ECN_MASK; 3645e9510e3SJINMEI Tatuya ecn0 = q6->ip6q_ecn; 36559dfcba4SHajimu UMEMOTO if (ecn == IPTOS_ECN_CE) { 36659dfcba4SHajimu UMEMOTO if (ecn0 == IPTOS_ECN_NOTECT) { 36759dfcba4SHajimu UMEMOTO free(ip6af, M_FTABLE); 36859dfcba4SHajimu UMEMOTO goto dropfrag; 36959dfcba4SHajimu UMEMOTO } 37059dfcba4SHajimu UMEMOTO if (ecn0 != IPTOS_ECN_CE) 3715e9510e3SJINMEI Tatuya q6->ip6q_ecn = IPTOS_ECN_CE; 37259dfcba4SHajimu UMEMOTO } 37359dfcba4SHajimu UMEMOTO if (ecn == IPTOS_ECN_NOTECT && ecn0 != IPTOS_ECN_NOTECT) { 37459dfcba4SHajimu UMEMOTO free(ip6af, M_FTABLE); 37559dfcba4SHajimu UMEMOTO goto dropfrag; 37659dfcba4SHajimu UMEMOTO } 37759dfcba4SHajimu UMEMOTO 37859dfcba4SHajimu UMEMOTO /* 37982cd038dSYoshinobu Inoue * Find a segment which begins after this one does. 38082cd038dSYoshinobu Inoue */ 38182cd038dSYoshinobu Inoue for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6; 38282cd038dSYoshinobu Inoue af6 = af6->ip6af_down) 38382cd038dSYoshinobu Inoue if (af6->ip6af_off > ip6af->ip6af_off) 38482cd038dSYoshinobu Inoue break; 38582cd038dSYoshinobu Inoue 386686cdd19SJun-ichiro itojun Hagino #if 0 387686cdd19SJun-ichiro itojun Hagino /* 388686cdd19SJun-ichiro itojun Hagino * If there is a preceding segment, it may provide some of 389686cdd19SJun-ichiro itojun Hagino * our data already. If so, drop the data from the incoming 390686cdd19SJun-ichiro itojun Hagino * segment. If it provides all of our data, drop us. 391686cdd19SJun-ichiro itojun Hagino */ 392686cdd19SJun-ichiro itojun Hagino if (af6->ip6af_up != (struct ip6asfrag *)q6) { 393686cdd19SJun-ichiro itojun Hagino i = af6->ip6af_up->ip6af_off + af6->ip6af_up->ip6af_frglen 394686cdd19SJun-ichiro itojun Hagino - ip6af->ip6af_off; 395686cdd19SJun-ichiro itojun Hagino if (i > 0) { 396686cdd19SJun-ichiro itojun Hagino if (i >= ip6af->ip6af_frglen) 397686cdd19SJun-ichiro itojun Hagino goto dropfrag; 398686cdd19SJun-ichiro itojun Hagino m_adj(IP6_REASS_MBUF(ip6af), i); 399686cdd19SJun-ichiro itojun Hagino ip6af->ip6af_off += i; 400686cdd19SJun-ichiro itojun Hagino ip6af->ip6af_frglen -= i; 401686cdd19SJun-ichiro itojun Hagino } 402686cdd19SJun-ichiro itojun Hagino } 403686cdd19SJun-ichiro itojun Hagino 404686cdd19SJun-ichiro itojun Hagino /* 405686cdd19SJun-ichiro itojun Hagino * While we overlap succeeding segments trim them or, 406686cdd19SJun-ichiro itojun Hagino * if they are completely covered, dequeue them. 407686cdd19SJun-ichiro itojun Hagino */ 408686cdd19SJun-ichiro itojun Hagino while (af6 != (struct ip6asfrag *)q6 && 409686cdd19SJun-ichiro itojun Hagino ip6af->ip6af_off + ip6af->ip6af_frglen > af6->ip6af_off) { 410686cdd19SJun-ichiro itojun Hagino i = (ip6af->ip6af_off + ip6af->ip6af_frglen) - af6->ip6af_off; 411686cdd19SJun-ichiro itojun Hagino if (i < af6->ip6af_frglen) { 412686cdd19SJun-ichiro itojun Hagino af6->ip6af_frglen -= i; 413686cdd19SJun-ichiro itojun Hagino af6->ip6af_off += i; 414686cdd19SJun-ichiro itojun Hagino m_adj(IP6_REASS_MBUF(af6), i); 415686cdd19SJun-ichiro itojun Hagino break; 416686cdd19SJun-ichiro itojun Hagino } 417686cdd19SJun-ichiro itojun Hagino af6 = af6->ip6af_down; 418686cdd19SJun-ichiro itojun Hagino m_freem(IP6_REASS_MBUF(af6->ip6af_up)); 419686cdd19SJun-ichiro itojun Hagino frag6_deq(af6->ip6af_up); 420686cdd19SJun-ichiro itojun Hagino } 421686cdd19SJun-ichiro itojun Hagino #else 42282cd038dSYoshinobu Inoue /* 42382cd038dSYoshinobu Inoue * If the incoming framgent overlaps some existing fragments in 42482cd038dSYoshinobu Inoue * the reassembly queue, drop it, since it is dangerous to override 42582cd038dSYoshinobu Inoue * existing fragments from a security point of view. 4269888c401SHajimu UMEMOTO * We don't know which fragment is the bad guy - here we trust 4279888c401SHajimu UMEMOTO * fragment that came in earlier, with no real reason. 4285e9510e3SJINMEI Tatuya * 4295e9510e3SJINMEI Tatuya * Note: due to changes after disabling this part, mbuf passed to 4305e9510e3SJINMEI Tatuya * m_adj() below now does not meet the requirement. 43182cd038dSYoshinobu Inoue */ 43282cd038dSYoshinobu Inoue if (af6->ip6af_up != (struct ip6asfrag *)q6) { 43382cd038dSYoshinobu Inoue i = af6->ip6af_up->ip6af_off + af6->ip6af_up->ip6af_frglen 43482cd038dSYoshinobu Inoue - ip6af->ip6af_off; 43582cd038dSYoshinobu Inoue if (i > 0) { 4362bf76779SMunechika SUMIKAWA #if 0 /* suppress the noisy log */ 43782cd038dSYoshinobu Inoue log(LOG_ERR, "%d bytes of a fragment from %s " 43882cd038dSYoshinobu Inoue "overlaps the previous fragment\n", 4391d54aa3bSBjoern A. Zeeb i, ip6_sprintf(ip6buf, &q6->ip6q_src)); 4402bf76779SMunechika SUMIKAWA #endif 4412bf76779SMunechika SUMIKAWA free(ip6af, M_FTABLE); 44282cd038dSYoshinobu Inoue goto dropfrag; 44382cd038dSYoshinobu Inoue } 44482cd038dSYoshinobu Inoue } 44582cd038dSYoshinobu Inoue if (af6 != (struct ip6asfrag *)q6) { 44682cd038dSYoshinobu Inoue i = (ip6af->ip6af_off + ip6af->ip6af_frglen) - af6->ip6af_off; 44782cd038dSYoshinobu Inoue if (i > 0) { 4482bf76779SMunechika SUMIKAWA #if 0 /* suppress the noisy log */ 44982cd038dSYoshinobu Inoue log(LOG_ERR, "%d bytes of a fragment from %s " 45082cd038dSYoshinobu Inoue "overlaps the succeeding fragment", 4511d54aa3bSBjoern A. Zeeb i, ip6_sprintf(ip6buf, &q6->ip6q_src)); 4522bf76779SMunechika SUMIKAWA #endif 4532bf76779SMunechika SUMIKAWA free(ip6af, M_FTABLE); 45482cd038dSYoshinobu Inoue goto dropfrag; 45582cd038dSYoshinobu Inoue } 45682cd038dSYoshinobu Inoue } 457686cdd19SJun-ichiro itojun Hagino #endif 45882cd038dSYoshinobu Inoue 45982cd038dSYoshinobu Inoue insert: 46082cd038dSYoshinobu Inoue 46182cd038dSYoshinobu Inoue /* 46282cd038dSYoshinobu Inoue * Stick new segment in its place; 46382cd038dSYoshinobu Inoue * check for complete reassembly. 46482cd038dSYoshinobu Inoue * Move to front of packet queue, as we are 46582cd038dSYoshinobu Inoue * the most recently active fragmented packet. 46682cd038dSYoshinobu Inoue */ 46782cd038dSYoshinobu Inoue frag6_enq(ip6af, af6->ip6af_up); 4689888c401SHajimu UMEMOTO frag6_nfrags++; 4699888c401SHajimu UMEMOTO q6->ip6q_nfrag++; 470686cdd19SJun-ichiro itojun Hagino #if 0 /* xxx */ 471686cdd19SJun-ichiro itojun Hagino if (q6 != ip6q.ip6q_next) { 472686cdd19SJun-ichiro itojun Hagino frag6_remque(q6); 473686cdd19SJun-ichiro itojun Hagino frag6_insque(q6, &ip6q); 474686cdd19SJun-ichiro itojun Hagino } 475686cdd19SJun-ichiro itojun Hagino #endif 47682cd038dSYoshinobu Inoue next = 0; 47782cd038dSYoshinobu Inoue for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6; 47882cd038dSYoshinobu Inoue af6 = af6->ip6af_down) { 47982cd038dSYoshinobu Inoue if (af6->ip6af_off != next) { 4809888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 48182cd038dSYoshinobu Inoue return IPPROTO_DONE; 48282cd038dSYoshinobu Inoue } 48382cd038dSYoshinobu Inoue next += af6->ip6af_frglen; 48482cd038dSYoshinobu Inoue } 48582cd038dSYoshinobu Inoue if (af6->ip6af_up->ip6af_mff) { 4869888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 48782cd038dSYoshinobu Inoue return IPPROTO_DONE; 48882cd038dSYoshinobu Inoue } 48982cd038dSYoshinobu Inoue 49082cd038dSYoshinobu Inoue /* 49182cd038dSYoshinobu Inoue * Reassembly is complete; concatenate fragments. 49282cd038dSYoshinobu Inoue */ 49382cd038dSYoshinobu Inoue ip6af = q6->ip6q_down; 49482cd038dSYoshinobu Inoue t = m = IP6_REASS_MBUF(ip6af); 49582cd038dSYoshinobu Inoue af6 = ip6af->ip6af_down; 496686cdd19SJun-ichiro itojun Hagino frag6_deq(ip6af); 49782cd038dSYoshinobu Inoue while (af6 != (struct ip6asfrag *)q6) { 498686cdd19SJun-ichiro itojun Hagino af6dwn = af6->ip6af_down; 499686cdd19SJun-ichiro itojun Hagino frag6_deq(af6); 50082cd038dSYoshinobu Inoue while (t->m_next) 50182cd038dSYoshinobu Inoue t = t->m_next; 50282cd038dSYoshinobu Inoue t->m_next = IP6_REASS_MBUF(af6); 503686cdd19SJun-ichiro itojun Hagino m_adj(t->m_next, af6->ip6af_offset); 504686cdd19SJun-ichiro itojun Hagino free(af6, M_FTABLE); 505686cdd19SJun-ichiro itojun Hagino af6 = af6dwn; 50682cd038dSYoshinobu Inoue } 50782cd038dSYoshinobu Inoue 50882cd038dSYoshinobu Inoue /* adjust offset to point where the original next header starts */ 50982cd038dSYoshinobu Inoue offset = ip6af->ip6af_offset - sizeof(struct ip6_frag); 510686cdd19SJun-ichiro itojun Hagino free(ip6af, M_FTABLE); 511686cdd19SJun-ichiro itojun Hagino ip6 = mtod(m, struct ip6_hdr *); 51282cd038dSYoshinobu Inoue ip6->ip6_plen = htons((u_short)next + offset - sizeof(struct ip6_hdr)); 5135e9510e3SJINMEI Tatuya if (q6->ip6q_ecn == IPTOS_ECN_CE) 5145e9510e3SJINMEI Tatuya ip6->ip6_flow |= htonl(IPTOS_ECN_CE << 20); 51582cd038dSYoshinobu Inoue nxt = q6->ip6q_nxt; 516686cdd19SJun-ichiro itojun Hagino #ifdef notyet 517686cdd19SJun-ichiro itojun Hagino *q6->ip6q_nxtp = (u_char)(nxt & 0xff); 518686cdd19SJun-ichiro itojun Hagino #endif 51982cd038dSYoshinobu Inoue 5205e9510e3SJINMEI Tatuya /* Delete frag6 header */ 5215e9510e3SJINMEI Tatuya if (m->m_len >= offset + sizeof(struct ip6_frag)) { 5225e9510e3SJINMEI Tatuya /* This is the only possible case with !PULLDOWN_TEST */ 52382cd038dSYoshinobu Inoue ovbcopy((caddr_t)ip6, (caddr_t)ip6 + sizeof(struct ip6_frag), 52482cd038dSYoshinobu Inoue offset); 525686cdd19SJun-ichiro itojun Hagino m->m_data += sizeof(struct ip6_frag); 526686cdd19SJun-ichiro itojun Hagino m->m_len -= sizeof(struct ip6_frag); 527686cdd19SJun-ichiro itojun Hagino } else { 528686cdd19SJun-ichiro itojun Hagino /* this comes with no copy if the boundary is on cluster */ 529a163d034SWarner Losh if ((t = m_split(m, offset, M_DONTWAIT)) == NULL) { 530686cdd19SJun-ichiro itojun Hagino frag6_remque(q6); 5319888c401SHajimu UMEMOTO frag6_nfrags -= q6->ip6q_nfrag; 532686cdd19SJun-ichiro itojun Hagino free(q6, M_FTABLE); 533686cdd19SJun-ichiro itojun Hagino frag6_nfragpackets--; 534686cdd19SJun-ichiro itojun Hagino goto dropfrag; 53582cd038dSYoshinobu Inoue } 536686cdd19SJun-ichiro itojun Hagino m_adj(t, sizeof(struct ip6_frag)); 537686cdd19SJun-ichiro itojun Hagino m_cat(m, t); 538686cdd19SJun-ichiro itojun Hagino } 53982cd038dSYoshinobu Inoue 54082cd038dSYoshinobu Inoue /* 54182cd038dSYoshinobu Inoue * Store NXT to the original. 54282cd038dSYoshinobu Inoue */ 54382cd038dSYoshinobu Inoue { 54482cd038dSYoshinobu Inoue char *prvnxtp = ip6_get_prevhdr(m, offset); /* XXX */ 54582cd038dSYoshinobu Inoue *prvnxtp = nxt; 54682cd038dSYoshinobu Inoue } 54782cd038dSYoshinobu Inoue 54882cd038dSYoshinobu Inoue frag6_remque(q6); 5499888c401SHajimu UMEMOTO frag6_nfrags -= q6->ip6q_nfrag; 55082cd038dSYoshinobu Inoue free(q6, M_FTABLE); 55182cd038dSYoshinobu Inoue frag6_nfragpackets--; 55282cd038dSYoshinobu Inoue 55382cd038dSYoshinobu Inoue if (m->m_flags & M_PKTHDR) { /* Isn't it always true? */ 55482cd038dSYoshinobu Inoue int plen = 0; 55582cd038dSYoshinobu Inoue for (t = m; t; t = t->m_next) 55682cd038dSYoshinobu Inoue plen += t->m_len; 55782cd038dSYoshinobu Inoue m->m_pkthdr.len = plen; 55882cd038dSYoshinobu Inoue } 55982cd038dSYoshinobu Inoue 56082cd038dSYoshinobu Inoue ip6stat.ip6s_reassembled++; 56182cd038dSYoshinobu Inoue in6_ifstat_inc(dstifp, ifs6_reass_ok); 56282cd038dSYoshinobu Inoue 56382cd038dSYoshinobu Inoue /* 56482cd038dSYoshinobu Inoue * Tell launch routine the next header 56582cd038dSYoshinobu Inoue */ 56682cd038dSYoshinobu Inoue 56782cd038dSYoshinobu Inoue *mp = m; 56882cd038dSYoshinobu Inoue *offp = offset; 56982cd038dSYoshinobu Inoue 5709888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 57182cd038dSYoshinobu Inoue return nxt; 57282cd038dSYoshinobu Inoue 57382cd038dSYoshinobu Inoue dropfrag: 57431e8f7e5SHajimu UMEMOTO IP6Q_UNLOCK(); 57582cd038dSYoshinobu Inoue in6_ifstat_inc(dstifp, ifs6_reass_fail); 57682cd038dSYoshinobu Inoue ip6stat.ip6s_fragdropped++; 57782cd038dSYoshinobu Inoue m_freem(m); 57882cd038dSYoshinobu Inoue return IPPROTO_DONE; 57982cd038dSYoshinobu Inoue } 58082cd038dSYoshinobu Inoue 58182cd038dSYoshinobu Inoue /* 58282cd038dSYoshinobu Inoue * Free a fragment reassembly header and all 58382cd038dSYoshinobu Inoue * associated datagrams. 58482cd038dSYoshinobu Inoue */ 58582cd038dSYoshinobu Inoue void 5861272577eSXin LI frag6_freef(struct ip6q *q6) 58782cd038dSYoshinobu Inoue { 58882cd038dSYoshinobu Inoue struct ip6asfrag *af6, *down6; 58982cd038dSYoshinobu Inoue 5909bcf770cSHajimu UMEMOTO IP6Q_LOCK_ASSERT(); 5919888c401SHajimu UMEMOTO 59282cd038dSYoshinobu Inoue for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6; 59382cd038dSYoshinobu Inoue af6 = down6) { 59482cd038dSYoshinobu Inoue struct mbuf *m = IP6_REASS_MBUF(af6); 59582cd038dSYoshinobu Inoue 59682cd038dSYoshinobu Inoue down6 = af6->ip6af_down; 59782cd038dSYoshinobu Inoue frag6_deq(af6); 59882cd038dSYoshinobu Inoue 59982cd038dSYoshinobu Inoue /* 60082cd038dSYoshinobu Inoue * Return ICMP time exceeded error for the 1st fragment. 60182cd038dSYoshinobu Inoue * Just free other fragments. 60282cd038dSYoshinobu Inoue */ 60382cd038dSYoshinobu Inoue if (af6->ip6af_off == 0) { 60482cd038dSYoshinobu Inoue struct ip6_hdr *ip6; 60582cd038dSYoshinobu Inoue 60682cd038dSYoshinobu Inoue /* adjust pointer */ 60782cd038dSYoshinobu Inoue ip6 = mtod(m, struct ip6_hdr *); 60882cd038dSYoshinobu Inoue 60906cd0a3fSHajimu UMEMOTO /* restore source and destination addresses */ 61082cd038dSYoshinobu Inoue ip6->ip6_src = q6->ip6q_src; 61182cd038dSYoshinobu Inoue ip6->ip6_dst = q6->ip6q_dst; 61282cd038dSYoshinobu Inoue 61382cd038dSYoshinobu Inoue icmp6_error(m, ICMP6_TIME_EXCEEDED, 61482cd038dSYoshinobu Inoue ICMP6_TIME_EXCEED_REASSEMBLY, 0); 615686cdd19SJun-ichiro itojun Hagino } else 61682cd038dSYoshinobu Inoue m_freem(m); 617686cdd19SJun-ichiro itojun Hagino free(af6, M_FTABLE); 61882cd038dSYoshinobu Inoue } 61982cd038dSYoshinobu Inoue frag6_remque(q6); 6209888c401SHajimu UMEMOTO frag6_nfrags -= q6->ip6q_nfrag; 62182cd038dSYoshinobu Inoue free(q6, M_FTABLE); 62282cd038dSYoshinobu Inoue frag6_nfragpackets--; 62382cd038dSYoshinobu Inoue } 62482cd038dSYoshinobu Inoue 62582cd038dSYoshinobu Inoue /* 62682cd038dSYoshinobu Inoue * Put an ip fragment on a reassembly chain. 62782cd038dSYoshinobu Inoue * Like insque, but pointers in middle of structure. 62882cd038dSYoshinobu Inoue */ 62982cd038dSYoshinobu Inoue void 6301272577eSXin LI frag6_enq(struct ip6asfrag *af6, struct ip6asfrag *up6) 63182cd038dSYoshinobu Inoue { 6329888c401SHajimu UMEMOTO 6339bcf770cSHajimu UMEMOTO IP6Q_LOCK_ASSERT(); 6349888c401SHajimu UMEMOTO 63582cd038dSYoshinobu Inoue af6->ip6af_up = up6; 63682cd038dSYoshinobu Inoue af6->ip6af_down = up6->ip6af_down; 63782cd038dSYoshinobu Inoue up6->ip6af_down->ip6af_up = af6; 63882cd038dSYoshinobu Inoue up6->ip6af_down = af6; 63982cd038dSYoshinobu Inoue } 64082cd038dSYoshinobu Inoue 64182cd038dSYoshinobu Inoue /* 64282cd038dSYoshinobu Inoue * To frag6_enq as remque is to insque. 64382cd038dSYoshinobu Inoue */ 64482cd038dSYoshinobu Inoue void 6451272577eSXin LI frag6_deq(struct ip6asfrag *af6) 64682cd038dSYoshinobu Inoue { 6479888c401SHajimu UMEMOTO 6489bcf770cSHajimu UMEMOTO IP6Q_LOCK_ASSERT(); 6499888c401SHajimu UMEMOTO 65082cd038dSYoshinobu Inoue af6->ip6af_up->ip6af_down = af6->ip6af_down; 65182cd038dSYoshinobu Inoue af6->ip6af_down->ip6af_up = af6->ip6af_up; 65282cd038dSYoshinobu Inoue } 65382cd038dSYoshinobu Inoue 65482cd038dSYoshinobu Inoue void 6551272577eSXin LI frag6_insque(struct ip6q *new, struct ip6q *old) 65682cd038dSYoshinobu Inoue { 6579888c401SHajimu UMEMOTO 6589bcf770cSHajimu UMEMOTO IP6Q_LOCK_ASSERT(); 6599888c401SHajimu UMEMOTO 66082cd038dSYoshinobu Inoue new->ip6q_prev = old; 66182cd038dSYoshinobu Inoue new->ip6q_next = old->ip6q_next; 66282cd038dSYoshinobu Inoue old->ip6q_next->ip6q_prev= new; 66382cd038dSYoshinobu Inoue old->ip6q_next = new; 66482cd038dSYoshinobu Inoue } 66582cd038dSYoshinobu Inoue 66682cd038dSYoshinobu Inoue void 6671272577eSXin LI frag6_remque(struct ip6q *p6) 66882cd038dSYoshinobu Inoue { 6699888c401SHajimu UMEMOTO 6709bcf770cSHajimu UMEMOTO IP6Q_LOCK_ASSERT(); 6719888c401SHajimu UMEMOTO 67282cd038dSYoshinobu Inoue p6->ip6q_prev->ip6q_next = p6->ip6q_next; 67382cd038dSYoshinobu Inoue p6->ip6q_next->ip6q_prev = p6->ip6q_prev; 67482cd038dSYoshinobu Inoue } 67582cd038dSYoshinobu Inoue 67682cd038dSYoshinobu Inoue /* 67733841545SHajimu UMEMOTO * IPv6 reassembling timer processing; 67882cd038dSYoshinobu Inoue * if a timer expires on a reassembly 67982cd038dSYoshinobu Inoue * queue, discard it. 68082cd038dSYoshinobu Inoue */ 68182cd038dSYoshinobu Inoue void 6821272577eSXin LI frag6_slowtimo(void) 68382cd038dSYoshinobu Inoue { 68482cd038dSYoshinobu Inoue struct ip6q *q6; 68582cd038dSYoshinobu Inoue 6861b34a059SBjoern A. Zeeb #if 0 6871b34a059SBjoern A. Zeeb GIANT_REQUIRED; /* XXX bz: ip6_forward_rt */ 6881b34a059SBjoern A. Zeeb #endif 6891b34a059SBjoern A. Zeeb 6909888c401SHajimu UMEMOTO IP6Q_LOCK(); 69182cd038dSYoshinobu Inoue q6 = ip6q.ip6q_next; 69282cd038dSYoshinobu Inoue if (q6) 69382cd038dSYoshinobu Inoue while (q6 != &ip6q) { 69482cd038dSYoshinobu Inoue --q6->ip6q_ttl; 69582cd038dSYoshinobu Inoue q6 = q6->ip6q_next; 69682cd038dSYoshinobu Inoue if (q6->ip6q_prev->ip6q_ttl == 0) { 69782cd038dSYoshinobu Inoue ip6stat.ip6s_fragtimeout++; 69882cd038dSYoshinobu Inoue /* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */ 69982cd038dSYoshinobu Inoue frag6_freef(q6->ip6q_prev); 70082cd038dSYoshinobu Inoue } 70182cd038dSYoshinobu Inoue } 70282cd038dSYoshinobu Inoue /* 70382cd038dSYoshinobu Inoue * If we are over the maximum number of fragments 70482cd038dSYoshinobu Inoue * (due to the limit being lowered), drain off 70582cd038dSYoshinobu Inoue * enough to get down to the new limit. 70682cd038dSYoshinobu Inoue */ 70733841545SHajimu UMEMOTO while (frag6_nfragpackets > (u_int)ip6_maxfragpackets && 70833841545SHajimu UMEMOTO ip6q.ip6q_prev) { 70982cd038dSYoshinobu Inoue ip6stat.ip6s_fragoverflow++; 71082cd038dSYoshinobu Inoue /* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */ 71182cd038dSYoshinobu Inoue frag6_freef(ip6q.ip6q_prev); 71282cd038dSYoshinobu Inoue } 7139888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 714686cdd19SJun-ichiro itojun Hagino 715686cdd19SJun-ichiro itojun Hagino #if 0 716686cdd19SJun-ichiro itojun Hagino /* 717686cdd19SJun-ichiro itojun Hagino * Routing changes might produce a better route than we last used; 718686cdd19SJun-ichiro itojun Hagino * make sure we notice eventually, even if forwarding only for one 719686cdd19SJun-ichiro itojun Hagino * destination and the cache is never replaced. 720686cdd19SJun-ichiro itojun Hagino */ 721686cdd19SJun-ichiro itojun Hagino if (ip6_forward_rt.ro_rt) { 722686cdd19SJun-ichiro itojun Hagino RTFREE(ip6_forward_rt.ro_rt); 723686cdd19SJun-ichiro itojun Hagino ip6_forward_rt.ro_rt = 0; 724686cdd19SJun-ichiro itojun Hagino } 725686cdd19SJun-ichiro itojun Hagino if (ipsrcchk_rt.ro_rt) { 726686cdd19SJun-ichiro itojun Hagino RTFREE(ipsrcchk_rt.ro_rt); 727686cdd19SJun-ichiro itojun Hagino ipsrcchk_rt.ro_rt = 0; 728686cdd19SJun-ichiro itojun Hagino } 729686cdd19SJun-ichiro itojun Hagino #endif 73082cd038dSYoshinobu Inoue } 73182cd038dSYoshinobu Inoue 73282cd038dSYoshinobu Inoue /* 73382cd038dSYoshinobu Inoue * Drain off all datagram fragments. 73482cd038dSYoshinobu Inoue */ 73582cd038dSYoshinobu Inoue void 7361272577eSXin LI frag6_drain(void) 73782cd038dSYoshinobu Inoue { 7389888c401SHajimu UMEMOTO 73931e8f7e5SHajimu UMEMOTO if (IP6Q_TRYLOCK() == 0) 74082cd038dSYoshinobu Inoue return; 74182cd038dSYoshinobu Inoue while (ip6q.ip6q_next != &ip6q) { 74282cd038dSYoshinobu Inoue ip6stat.ip6s_fragdropped++; 74382cd038dSYoshinobu Inoue /* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */ 74482cd038dSYoshinobu Inoue frag6_freef(ip6q.ip6q_next); 74582cd038dSYoshinobu Inoue } 7469888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 74782cd038dSYoshinobu Inoue } 748