1686cdd19SJun-ichiro itojun Hagino /* $FreeBSD$ */ 288ff5695SSUZUKI Shinsuke /* $KAME: frag6.c,v 1.33 2002/01/07 11:34:48 kjc Exp $ */ 3686cdd19SJun-ichiro itojun Hagino 4caf43b02SWarner Losh /*- 582cd038dSYoshinobu Inoue * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 682cd038dSYoshinobu Inoue * All rights reserved. 782cd038dSYoshinobu Inoue * 882cd038dSYoshinobu Inoue * Redistribution and use in source and binary forms, with or without 982cd038dSYoshinobu Inoue * modification, are permitted provided that the following conditions 1082cd038dSYoshinobu Inoue * are met: 1182cd038dSYoshinobu Inoue * 1. Redistributions of source code must retain the above copyright 1282cd038dSYoshinobu Inoue * notice, this list of conditions and the following disclaimer. 1382cd038dSYoshinobu Inoue * 2. Redistributions in binary form must reproduce the above copyright 1482cd038dSYoshinobu Inoue * notice, this list of conditions and the following disclaimer in the 1582cd038dSYoshinobu Inoue * documentation and/or other materials provided with the distribution. 1682cd038dSYoshinobu Inoue * 3. Neither the name of the project nor the names of its contributors 1782cd038dSYoshinobu Inoue * may be used to endorse or promote products derived from this software 1882cd038dSYoshinobu Inoue * without specific prior written permission. 1982cd038dSYoshinobu Inoue * 2082cd038dSYoshinobu Inoue * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 2182cd038dSYoshinobu Inoue * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 2282cd038dSYoshinobu Inoue * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 2382cd038dSYoshinobu Inoue * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 2482cd038dSYoshinobu Inoue * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 2582cd038dSYoshinobu Inoue * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2682cd038dSYoshinobu Inoue * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2782cd038dSYoshinobu Inoue * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2882cd038dSYoshinobu Inoue * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2982cd038dSYoshinobu Inoue * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 3082cd038dSYoshinobu Inoue * SUCH DAMAGE. 3182cd038dSYoshinobu Inoue */ 3282cd038dSYoshinobu Inoue 3382cd038dSYoshinobu Inoue #include <sys/param.h> 3482cd038dSYoshinobu Inoue #include <sys/systm.h> 3582cd038dSYoshinobu Inoue #include <sys/malloc.h> 3682cd038dSYoshinobu Inoue #include <sys/mbuf.h> 3782cd038dSYoshinobu Inoue #include <sys/domain.h> 3882cd038dSYoshinobu Inoue #include <sys/protosw.h> 3982cd038dSYoshinobu Inoue #include <sys/socket.h> 4082cd038dSYoshinobu Inoue #include <sys/errno.h> 4182cd038dSYoshinobu Inoue #include <sys/time.h> 4282cd038dSYoshinobu Inoue #include <sys/kernel.h> 4382cd038dSYoshinobu Inoue #include <sys/syslog.h> 4482cd038dSYoshinobu Inoue 4582cd038dSYoshinobu Inoue #include <net/if.h> 4682cd038dSYoshinobu Inoue #include <net/route.h> 4782cd038dSYoshinobu Inoue 4882cd038dSYoshinobu Inoue #include <netinet/in.h> 4982cd038dSYoshinobu Inoue #include <netinet/in_var.h> 50686cdd19SJun-ichiro itojun Hagino #include <netinet/ip6.h> 5182cd038dSYoshinobu Inoue #include <netinet6/ip6_var.h> 52686cdd19SJun-ichiro itojun Hagino #include <netinet/icmp6.h> 5359dfcba4SHajimu UMEMOTO #include <netinet/in_systm.h> /* for ECN definitions */ 5459dfcba4SHajimu UMEMOTO #include <netinet/ip.h> /* for ECN definitions */ 5582cd038dSYoshinobu Inoue 5682cd038dSYoshinobu Inoue #include <net/net_osdep.h> 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 9982cd038dSYoshinobu Inoue frag6_init() 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 14582cd038dSYoshinobu Inoue frag6_input(mp, offp, proto) 14682cd038dSYoshinobu Inoue struct mbuf **mp; 14782cd038dSYoshinobu Inoue int *offp, proto; 14882cd038dSYoshinobu Inoue { 14982cd038dSYoshinobu Inoue struct mbuf *m = *mp, *t; 15082cd038dSYoshinobu Inoue struct ip6_hdr *ip6; 15182cd038dSYoshinobu Inoue struct ip6_frag *ip6f; 15282cd038dSYoshinobu Inoue struct ip6q *q6; 153686cdd19SJun-ichiro itojun Hagino struct ip6asfrag *af6, *ip6af, *af6dwn; 1542a5aafceSHajimu UMEMOTO #ifdef IN6_IFSTAT_STRICT 1552a5aafceSHajimu UMEMOTO struct in6_ifaddr *ia; 1562a5aafceSHajimu UMEMOTO #endif 15782cd038dSYoshinobu Inoue int offset = *offp, nxt, i, next; 15882cd038dSYoshinobu Inoue int first_frag = 0; 159686cdd19SJun-ichiro itojun Hagino int fragoff, frgpartlen; /* must be larger than u_int16_t */ 16082cd038dSYoshinobu Inoue struct ifnet *dstifp; 16159dfcba4SHajimu UMEMOTO u_int8_t ecn, ecn0; 16282cd038dSYoshinobu Inoue 16382cd038dSYoshinobu Inoue ip6 = mtod(m, struct ip6_hdr *); 164686cdd19SJun-ichiro itojun Hagino #ifndef PULLDOWN_TEST 165686cdd19SJun-ichiro itojun Hagino IP6_EXTHDR_CHECK(m, offset, sizeof(struct ip6_frag), IPPROTO_DONE); 16682cd038dSYoshinobu Inoue ip6f = (struct ip6_frag *)((caddr_t)ip6 + offset); 167686cdd19SJun-ichiro itojun Hagino #else 168686cdd19SJun-ichiro itojun Hagino IP6_EXTHDR_GET(ip6f, struct ip6_frag *, m, offset, sizeof(*ip6f)); 169686cdd19SJun-ichiro itojun Hagino if (ip6f == NULL) 17040e39bbbSHajimu UMEMOTO return (IPPROTO_DONE); 171686cdd19SJun-ichiro itojun Hagino #endif 17282cd038dSYoshinobu Inoue 17382cd038dSYoshinobu Inoue dstifp = NULL; 17482cd038dSYoshinobu Inoue #ifdef IN6_IFSTAT_STRICT 17582cd038dSYoshinobu Inoue /* find the destination interface of the packet. */ 1762a5aafceSHajimu UMEMOTO if ((ia = ip6_getdstifaddr(m)) != NULL) 1772a5aafceSHajimu UMEMOTO dstifp = ia->ia_ifp; 17882cd038dSYoshinobu Inoue #else 17982cd038dSYoshinobu Inoue /* we are violating the spec, this is not the destination interface */ 18082cd038dSYoshinobu Inoue if ((m->m_flags & M_PKTHDR) != 0) 18182cd038dSYoshinobu Inoue dstifp = m->m_pkthdr.rcvif; 18282cd038dSYoshinobu Inoue #endif 18382cd038dSYoshinobu Inoue 18482cd038dSYoshinobu Inoue /* jumbo payload can't contain a fragment header */ 18582cd038dSYoshinobu Inoue if (ip6->ip6_plen == 0) { 18682cd038dSYoshinobu Inoue icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, offset); 18782cd038dSYoshinobu Inoue in6_ifstat_inc(dstifp, ifs6_reass_fail); 18882cd038dSYoshinobu Inoue return IPPROTO_DONE; 18982cd038dSYoshinobu Inoue } 19082cd038dSYoshinobu Inoue 19182cd038dSYoshinobu Inoue /* 19282cd038dSYoshinobu Inoue * check whether fragment packet's fragment length is 19382cd038dSYoshinobu Inoue * multiple of 8 octets. 19482cd038dSYoshinobu Inoue * sizeof(struct ip6_frag) == 8 19582cd038dSYoshinobu Inoue * sizeof(struct ip6_hdr) = 40 19682cd038dSYoshinobu Inoue */ 19782cd038dSYoshinobu Inoue if ((ip6f->ip6f_offlg & IP6F_MORE_FRAG) && 19882cd038dSYoshinobu Inoue (((ntohs(ip6->ip6_plen) - offset) & 0x7) != 0)) { 19906cd0a3fSHajimu UMEMOTO icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, 200686cdd19SJun-ichiro itojun Hagino offsetof(struct ip6_hdr, ip6_plen)); 20182cd038dSYoshinobu Inoue in6_ifstat_inc(dstifp, ifs6_reass_fail); 20282cd038dSYoshinobu Inoue return IPPROTO_DONE; 20382cd038dSYoshinobu Inoue } 20482cd038dSYoshinobu Inoue 20582cd038dSYoshinobu Inoue ip6stat.ip6s_fragments++; 20682cd038dSYoshinobu Inoue in6_ifstat_inc(dstifp, ifs6_reass_reqd); 20782cd038dSYoshinobu Inoue 208686cdd19SJun-ichiro itojun Hagino /* offset now points to data portion */ 20982cd038dSYoshinobu Inoue offset += sizeof(struct ip6_frag); 21082cd038dSYoshinobu Inoue 2119888c401SHajimu UMEMOTO IP6Q_LOCK(); 2129888c401SHajimu UMEMOTO 2139888c401SHajimu UMEMOTO /* 2149888c401SHajimu UMEMOTO * Enforce upper bound on number of fragments. 2159888c401SHajimu UMEMOTO * If maxfrag is 0, never accept fragments. 2169888c401SHajimu UMEMOTO * If maxfrag is -1, accept all fragments without limitation. 2179888c401SHajimu UMEMOTO */ 2189888c401SHajimu UMEMOTO if (ip6_maxfrags < 0) 2199888c401SHajimu UMEMOTO ; 2209888c401SHajimu UMEMOTO else if (frag6_nfrags >= (u_int)ip6_maxfrags) 2219888c401SHajimu UMEMOTO goto dropfrag; 22233841545SHajimu UMEMOTO 22382cd038dSYoshinobu Inoue for (q6 = ip6q.ip6q_next; q6 != &ip6q; q6 = q6->ip6q_next) 22482cd038dSYoshinobu Inoue if (ip6f->ip6f_ident == q6->ip6q_ident && 22582cd038dSYoshinobu Inoue IN6_ARE_ADDR_EQUAL(&ip6->ip6_src, &q6->ip6q_src) && 22682cd038dSYoshinobu Inoue IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst, &q6->ip6q_dst)) 22782cd038dSYoshinobu Inoue break; 22882cd038dSYoshinobu Inoue 22982cd038dSYoshinobu Inoue if (q6 == &ip6q) { 23082cd038dSYoshinobu Inoue /* 23182cd038dSYoshinobu Inoue * the first fragment to arrive, create a reassembly queue. 23282cd038dSYoshinobu Inoue */ 23382cd038dSYoshinobu Inoue first_frag = 1; 23482cd038dSYoshinobu Inoue 23582cd038dSYoshinobu Inoue /* 23682cd038dSYoshinobu Inoue * Enforce upper bound on number of fragmented packets 23782cd038dSYoshinobu Inoue * for which we attempt reassembly; 2389888c401SHajimu UMEMOTO * If maxfragpackets is 0, never accept fragments. 2399888c401SHajimu UMEMOTO * If maxfragpackets is -1, accept all fragments without 2409888c401SHajimu UMEMOTO * limitation. 24182cd038dSYoshinobu Inoue */ 24233841545SHajimu UMEMOTO if (ip6_maxfragpackets < 0) 24333841545SHajimu UMEMOTO ; 24433841545SHajimu UMEMOTO else if (frag6_nfragpackets >= (u_int)ip6_maxfragpackets) 24533841545SHajimu UMEMOTO goto dropfrag; 24633841545SHajimu UMEMOTO frag6_nfragpackets++; 24782cd038dSYoshinobu Inoue q6 = (struct ip6q *)malloc(sizeof(struct ip6q), M_FTABLE, 2488c0dd0e4SHajimu UMEMOTO M_NOWAIT); 24982cd038dSYoshinobu Inoue if (q6 == NULL) 25082cd038dSYoshinobu Inoue goto dropfrag; 251686cdd19SJun-ichiro itojun Hagino bzero(q6, sizeof(*q6)); 25282cd038dSYoshinobu Inoue 25382cd038dSYoshinobu Inoue frag6_insque(q6, &ip6q); 25482cd038dSYoshinobu Inoue 255686cdd19SJun-ichiro itojun Hagino /* ip6q_nxt will be filled afterwards, from 1st fragment */ 25682cd038dSYoshinobu Inoue q6->ip6q_down = q6->ip6q_up = (struct ip6asfrag *)q6; 257686cdd19SJun-ichiro itojun Hagino #ifdef notyet 258686cdd19SJun-ichiro itojun Hagino q6->ip6q_nxtp = (u_char *)nxtp; 259686cdd19SJun-ichiro itojun Hagino #endif 26082cd038dSYoshinobu Inoue q6->ip6q_ident = ip6f->ip6f_ident; 26182cd038dSYoshinobu Inoue q6->ip6q_arrive = 0; /* Is it used anywhere? */ 26282cd038dSYoshinobu Inoue q6->ip6q_ttl = IPV6_FRAGTTL; 26382cd038dSYoshinobu Inoue q6->ip6q_src = ip6->ip6_src; 26482cd038dSYoshinobu Inoue q6->ip6q_dst = ip6->ip6_dst; 26582cd038dSYoshinobu Inoue q6->ip6q_unfrglen = -1; /* The 1st fragment has not arrived. */ 2669888c401SHajimu UMEMOTO 2679888c401SHajimu UMEMOTO q6->ip6q_nfrag = 0; 26882cd038dSYoshinobu Inoue } 26982cd038dSYoshinobu Inoue 27082cd038dSYoshinobu Inoue /* 27182cd038dSYoshinobu Inoue * If it's the 1st fragment, record the length of the 27282cd038dSYoshinobu Inoue * unfragmentable part and the next header of the fragment header. 27382cd038dSYoshinobu Inoue */ 27482cd038dSYoshinobu Inoue fragoff = ntohs(ip6f->ip6f_offlg & IP6F_OFF_MASK); 27582cd038dSYoshinobu Inoue if (fragoff == 0) { 27606cd0a3fSHajimu UMEMOTO q6->ip6q_unfrglen = offset - sizeof(struct ip6_hdr) - 27706cd0a3fSHajimu UMEMOTO sizeof(struct ip6_frag); 27882cd038dSYoshinobu Inoue q6->ip6q_nxt = ip6f->ip6f_nxt; 27982cd038dSYoshinobu Inoue } 28082cd038dSYoshinobu Inoue 28182cd038dSYoshinobu Inoue /* 28282cd038dSYoshinobu Inoue * Check that the reassembled packet would not exceed 65535 bytes 28382cd038dSYoshinobu Inoue * in size. 28482cd038dSYoshinobu Inoue * If it would exceed, discard the fragment and return an ICMP error. 28582cd038dSYoshinobu Inoue */ 28682cd038dSYoshinobu Inoue frgpartlen = sizeof(struct ip6_hdr) + ntohs(ip6->ip6_plen) - offset; 28782cd038dSYoshinobu Inoue if (q6->ip6q_unfrglen >= 0) { 28882cd038dSYoshinobu Inoue /* The 1st fragment has already arrived. */ 28982cd038dSYoshinobu Inoue if (q6->ip6q_unfrglen + fragoff + frgpartlen > IPV6_MAXPACKET) { 29082cd038dSYoshinobu Inoue icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, 291686cdd19SJun-ichiro itojun Hagino offset - sizeof(struct ip6_frag) + 292686cdd19SJun-ichiro itojun Hagino offsetof(struct ip6_frag, ip6f_offlg)); 2939888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 29482cd038dSYoshinobu Inoue return (IPPROTO_DONE); 29582cd038dSYoshinobu Inoue } 29606cd0a3fSHajimu UMEMOTO } else if (fragoff + frgpartlen > IPV6_MAXPACKET) { 29782cd038dSYoshinobu Inoue icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, 298686cdd19SJun-ichiro itojun Hagino offset - sizeof(struct ip6_frag) + 299686cdd19SJun-ichiro itojun Hagino offsetof(struct ip6_frag, ip6f_offlg)); 3009888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 30182cd038dSYoshinobu Inoue return (IPPROTO_DONE); 30282cd038dSYoshinobu Inoue } 30382cd038dSYoshinobu Inoue /* 30482cd038dSYoshinobu Inoue * If it's the first fragment, do the above check for each 30582cd038dSYoshinobu Inoue * fragment already stored in the reassembly queue. 30682cd038dSYoshinobu Inoue */ 30782cd038dSYoshinobu Inoue if (fragoff == 0) { 30882cd038dSYoshinobu Inoue for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6; 30982cd038dSYoshinobu Inoue af6 = af6dwn) { 31082cd038dSYoshinobu Inoue af6dwn = af6->ip6af_down; 31182cd038dSYoshinobu Inoue 31282cd038dSYoshinobu Inoue if (q6->ip6q_unfrglen + af6->ip6af_off + af6->ip6af_frglen > 31382cd038dSYoshinobu Inoue IPV6_MAXPACKET) { 31482cd038dSYoshinobu Inoue struct mbuf *merr = IP6_REASS_MBUF(af6); 31582cd038dSYoshinobu Inoue struct ip6_hdr *ip6err; 31682cd038dSYoshinobu Inoue int erroff = af6->ip6af_offset; 31782cd038dSYoshinobu Inoue 31882cd038dSYoshinobu Inoue /* dequeue the fragment. */ 31982cd038dSYoshinobu Inoue frag6_deq(af6); 320686cdd19SJun-ichiro itojun Hagino free(af6, M_FTABLE); 32182cd038dSYoshinobu Inoue 32282cd038dSYoshinobu Inoue /* adjust pointer. */ 32382cd038dSYoshinobu Inoue ip6err = mtod(merr, struct ip6_hdr *); 32482cd038dSYoshinobu Inoue 32582cd038dSYoshinobu Inoue /* 32682cd038dSYoshinobu Inoue * Restore source and destination addresses 32782cd038dSYoshinobu Inoue * in the erroneous IPv6 header. 32882cd038dSYoshinobu Inoue */ 32982cd038dSYoshinobu Inoue ip6err->ip6_src = q6->ip6q_src; 33082cd038dSYoshinobu Inoue ip6err->ip6_dst = q6->ip6q_dst; 33182cd038dSYoshinobu Inoue 33282cd038dSYoshinobu Inoue icmp6_error(merr, ICMP6_PARAM_PROB, 33382cd038dSYoshinobu Inoue ICMP6_PARAMPROB_HEADER, 334686cdd19SJun-ichiro itojun Hagino erroff - sizeof(struct ip6_frag) + 335686cdd19SJun-ichiro itojun Hagino offsetof(struct ip6_frag, ip6f_offlg)); 33682cd038dSYoshinobu Inoue } 33782cd038dSYoshinobu Inoue } 33882cd038dSYoshinobu Inoue } 33982cd038dSYoshinobu Inoue 340686cdd19SJun-ichiro itojun Hagino ip6af = (struct ip6asfrag *)malloc(sizeof(struct ip6asfrag), M_FTABLE, 3418c0dd0e4SHajimu UMEMOTO M_NOWAIT); 342686cdd19SJun-ichiro itojun Hagino if (ip6af == NULL) 343686cdd19SJun-ichiro itojun Hagino goto dropfrag; 344686cdd19SJun-ichiro itojun Hagino bzero(ip6af, sizeof(*ip6af)); 345686cdd19SJun-ichiro itojun Hagino ip6af->ip6af_head = ip6->ip6_flow; 346686cdd19SJun-ichiro itojun Hagino ip6af->ip6af_len = ip6->ip6_plen; 347686cdd19SJun-ichiro itojun Hagino ip6af->ip6af_nxt = ip6->ip6_nxt; 348686cdd19SJun-ichiro itojun Hagino ip6af->ip6af_hlim = ip6->ip6_hlim; 34982cd038dSYoshinobu Inoue ip6af->ip6af_mff = ip6f->ip6f_offlg & IP6F_MORE_FRAG; 35082cd038dSYoshinobu Inoue ip6af->ip6af_off = fragoff; 35182cd038dSYoshinobu Inoue ip6af->ip6af_frglen = frgpartlen; 35282cd038dSYoshinobu Inoue ip6af->ip6af_offset = offset; 35382cd038dSYoshinobu Inoue IP6_REASS_MBUF(ip6af) = m; 35482cd038dSYoshinobu Inoue 35582cd038dSYoshinobu Inoue if (first_frag) { 35682cd038dSYoshinobu Inoue af6 = (struct ip6asfrag *)q6; 35782cd038dSYoshinobu Inoue goto insert; 35882cd038dSYoshinobu Inoue } 35982cd038dSYoshinobu Inoue 36082cd038dSYoshinobu Inoue /* 36159dfcba4SHajimu UMEMOTO * Handle ECN by comparing this segment with the first one; 36259dfcba4SHajimu UMEMOTO * if CE is set, do not lose CE. 36359dfcba4SHajimu UMEMOTO * drop if CE and not-ECT are mixed for the same packet. 36459dfcba4SHajimu UMEMOTO */ 36559dfcba4SHajimu UMEMOTO ecn = (ntohl(ip6->ip6_flow) >> 20) & IPTOS_ECN_MASK; 36659dfcba4SHajimu UMEMOTO ecn0 = (ntohl(q6->ip6q_down->ip6af_head) >> 20) & IPTOS_ECN_MASK; 36759dfcba4SHajimu UMEMOTO if (ecn == IPTOS_ECN_CE) { 36859dfcba4SHajimu UMEMOTO if (ecn0 == IPTOS_ECN_NOTECT) { 36959dfcba4SHajimu UMEMOTO free(ip6af, M_FTABLE); 37059dfcba4SHajimu UMEMOTO goto dropfrag; 37159dfcba4SHajimu UMEMOTO } 37259dfcba4SHajimu UMEMOTO if (ecn0 != IPTOS_ECN_CE) 37359dfcba4SHajimu UMEMOTO q6->ip6q_down->ip6af_head |= htonl(IPTOS_ECN_CE << 20); 37459dfcba4SHajimu UMEMOTO } 37559dfcba4SHajimu UMEMOTO if (ecn == IPTOS_ECN_NOTECT && ecn0 != IPTOS_ECN_NOTECT) { 37659dfcba4SHajimu UMEMOTO free(ip6af, M_FTABLE); 37759dfcba4SHajimu UMEMOTO goto dropfrag; 37859dfcba4SHajimu UMEMOTO } 37959dfcba4SHajimu UMEMOTO 38059dfcba4SHajimu UMEMOTO /* 38182cd038dSYoshinobu Inoue * Find a segment which begins after this one does. 38282cd038dSYoshinobu Inoue */ 38382cd038dSYoshinobu Inoue for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6; 38482cd038dSYoshinobu Inoue af6 = af6->ip6af_down) 38582cd038dSYoshinobu Inoue if (af6->ip6af_off > ip6af->ip6af_off) 38682cd038dSYoshinobu Inoue break; 38782cd038dSYoshinobu Inoue 388686cdd19SJun-ichiro itojun Hagino #if 0 389686cdd19SJun-ichiro itojun Hagino /* 390686cdd19SJun-ichiro itojun Hagino * If there is a preceding segment, it may provide some of 391686cdd19SJun-ichiro itojun Hagino * our data already. If so, drop the data from the incoming 392686cdd19SJun-ichiro itojun Hagino * segment. If it provides all of our data, drop us. 393686cdd19SJun-ichiro itojun Hagino */ 394686cdd19SJun-ichiro itojun Hagino if (af6->ip6af_up != (struct ip6asfrag *)q6) { 395686cdd19SJun-ichiro itojun Hagino i = af6->ip6af_up->ip6af_off + af6->ip6af_up->ip6af_frglen 396686cdd19SJun-ichiro itojun Hagino - ip6af->ip6af_off; 397686cdd19SJun-ichiro itojun Hagino if (i > 0) { 398686cdd19SJun-ichiro itojun Hagino if (i >= ip6af->ip6af_frglen) 399686cdd19SJun-ichiro itojun Hagino goto dropfrag; 400686cdd19SJun-ichiro itojun Hagino m_adj(IP6_REASS_MBUF(ip6af), i); 401686cdd19SJun-ichiro itojun Hagino ip6af->ip6af_off += i; 402686cdd19SJun-ichiro itojun Hagino ip6af->ip6af_frglen -= i; 403686cdd19SJun-ichiro itojun Hagino } 404686cdd19SJun-ichiro itojun Hagino } 405686cdd19SJun-ichiro itojun Hagino 406686cdd19SJun-ichiro itojun Hagino /* 407686cdd19SJun-ichiro itojun Hagino * While we overlap succeeding segments trim them or, 408686cdd19SJun-ichiro itojun Hagino * if they are completely covered, dequeue them. 409686cdd19SJun-ichiro itojun Hagino */ 410686cdd19SJun-ichiro itojun Hagino while (af6 != (struct ip6asfrag *)q6 && 411686cdd19SJun-ichiro itojun Hagino ip6af->ip6af_off + ip6af->ip6af_frglen > af6->ip6af_off) { 412686cdd19SJun-ichiro itojun Hagino i = (ip6af->ip6af_off + ip6af->ip6af_frglen) - af6->ip6af_off; 413686cdd19SJun-ichiro itojun Hagino if (i < af6->ip6af_frglen) { 414686cdd19SJun-ichiro itojun Hagino af6->ip6af_frglen -= i; 415686cdd19SJun-ichiro itojun Hagino af6->ip6af_off += i; 416686cdd19SJun-ichiro itojun Hagino m_adj(IP6_REASS_MBUF(af6), i); 417686cdd19SJun-ichiro itojun Hagino break; 418686cdd19SJun-ichiro itojun Hagino } 419686cdd19SJun-ichiro itojun Hagino af6 = af6->ip6af_down; 420686cdd19SJun-ichiro itojun Hagino m_freem(IP6_REASS_MBUF(af6->ip6af_up)); 421686cdd19SJun-ichiro itojun Hagino frag6_deq(af6->ip6af_up); 422686cdd19SJun-ichiro itojun Hagino } 423686cdd19SJun-ichiro itojun Hagino #else 42482cd038dSYoshinobu Inoue /* 42582cd038dSYoshinobu Inoue * If the incoming framgent overlaps some existing fragments in 42682cd038dSYoshinobu Inoue * the reassembly queue, drop it, since it is dangerous to override 42782cd038dSYoshinobu Inoue * existing fragments from a security point of view. 4289888c401SHajimu UMEMOTO * We don't know which fragment is the bad guy - here we trust 4299888c401SHajimu UMEMOTO * fragment that came in earlier, with no real reason. 43082cd038dSYoshinobu Inoue */ 43182cd038dSYoshinobu Inoue if (af6->ip6af_up != (struct ip6asfrag *)q6) { 43282cd038dSYoshinobu Inoue i = af6->ip6af_up->ip6af_off + af6->ip6af_up->ip6af_frglen 43382cd038dSYoshinobu Inoue - ip6af->ip6af_off; 43482cd038dSYoshinobu Inoue if (i > 0) { 4352bf76779SMunechika SUMIKAWA #if 0 /* suppress the noisy log */ 43682cd038dSYoshinobu Inoue log(LOG_ERR, "%d bytes of a fragment from %s " 43782cd038dSYoshinobu Inoue "overlaps the previous fragment\n", 43882cd038dSYoshinobu Inoue i, ip6_sprintf(&q6->ip6q_src)); 4392bf76779SMunechika SUMIKAWA #endif 4402bf76779SMunechika SUMIKAWA free(ip6af, M_FTABLE); 44182cd038dSYoshinobu Inoue goto dropfrag; 44282cd038dSYoshinobu Inoue } 44382cd038dSYoshinobu Inoue } 44482cd038dSYoshinobu Inoue if (af6 != (struct ip6asfrag *)q6) { 44582cd038dSYoshinobu Inoue i = (ip6af->ip6af_off + ip6af->ip6af_frglen) - af6->ip6af_off; 44682cd038dSYoshinobu Inoue if (i > 0) { 4472bf76779SMunechika SUMIKAWA #if 0 /* suppress the noisy log */ 44882cd038dSYoshinobu Inoue log(LOG_ERR, "%d bytes of a fragment from %s " 44982cd038dSYoshinobu Inoue "overlaps the succeeding fragment", 45082cd038dSYoshinobu Inoue i, ip6_sprintf(&q6->ip6q_src)); 4512bf76779SMunechika SUMIKAWA #endif 4522bf76779SMunechika SUMIKAWA free(ip6af, M_FTABLE); 45382cd038dSYoshinobu Inoue goto dropfrag; 45482cd038dSYoshinobu Inoue } 45582cd038dSYoshinobu Inoue } 456686cdd19SJun-ichiro itojun Hagino #endif 45782cd038dSYoshinobu Inoue 45882cd038dSYoshinobu Inoue insert: 45982cd038dSYoshinobu Inoue 46082cd038dSYoshinobu Inoue /* 46182cd038dSYoshinobu Inoue * Stick new segment in its place; 46282cd038dSYoshinobu Inoue * check for complete reassembly. 46382cd038dSYoshinobu Inoue * Move to front of packet queue, as we are 46482cd038dSYoshinobu Inoue * the most recently active fragmented packet. 46582cd038dSYoshinobu Inoue */ 46682cd038dSYoshinobu Inoue frag6_enq(ip6af, af6->ip6af_up); 4679888c401SHajimu UMEMOTO frag6_nfrags++; 4689888c401SHajimu UMEMOTO q6->ip6q_nfrag++; 469686cdd19SJun-ichiro itojun Hagino #if 0 /* xxx */ 470686cdd19SJun-ichiro itojun Hagino if (q6 != ip6q.ip6q_next) { 471686cdd19SJun-ichiro itojun Hagino frag6_remque(q6); 472686cdd19SJun-ichiro itojun Hagino frag6_insque(q6, &ip6q); 473686cdd19SJun-ichiro itojun Hagino } 474686cdd19SJun-ichiro itojun Hagino #endif 47582cd038dSYoshinobu Inoue next = 0; 47682cd038dSYoshinobu Inoue for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6; 47782cd038dSYoshinobu Inoue af6 = af6->ip6af_down) { 47882cd038dSYoshinobu Inoue if (af6->ip6af_off != next) { 4799888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 48082cd038dSYoshinobu Inoue return IPPROTO_DONE; 48182cd038dSYoshinobu Inoue } 48282cd038dSYoshinobu Inoue next += af6->ip6af_frglen; 48382cd038dSYoshinobu Inoue } 48482cd038dSYoshinobu Inoue if (af6->ip6af_up->ip6af_mff) { 4859888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 48682cd038dSYoshinobu Inoue return IPPROTO_DONE; 48782cd038dSYoshinobu Inoue } 48882cd038dSYoshinobu Inoue 48982cd038dSYoshinobu Inoue /* 49082cd038dSYoshinobu Inoue * Reassembly is complete; concatenate fragments. 49182cd038dSYoshinobu Inoue */ 49282cd038dSYoshinobu Inoue ip6af = q6->ip6q_down; 49382cd038dSYoshinobu Inoue t = m = IP6_REASS_MBUF(ip6af); 49482cd038dSYoshinobu Inoue af6 = ip6af->ip6af_down; 495686cdd19SJun-ichiro itojun Hagino frag6_deq(ip6af); 49682cd038dSYoshinobu Inoue while (af6 != (struct ip6asfrag *)q6) { 497686cdd19SJun-ichiro itojun Hagino af6dwn = af6->ip6af_down; 498686cdd19SJun-ichiro itojun Hagino frag6_deq(af6); 49982cd038dSYoshinobu Inoue while (t->m_next) 50082cd038dSYoshinobu Inoue t = t->m_next; 50182cd038dSYoshinobu Inoue t->m_next = IP6_REASS_MBUF(af6); 502686cdd19SJun-ichiro itojun Hagino m_adj(t->m_next, af6->ip6af_offset); 503686cdd19SJun-ichiro itojun Hagino free(af6, M_FTABLE); 504686cdd19SJun-ichiro itojun Hagino af6 = af6dwn; 50582cd038dSYoshinobu Inoue } 50682cd038dSYoshinobu Inoue 50782cd038dSYoshinobu Inoue /* adjust offset to point where the original next header starts */ 50882cd038dSYoshinobu Inoue offset = ip6af->ip6af_offset - sizeof(struct ip6_frag); 509686cdd19SJun-ichiro itojun Hagino free(ip6af, M_FTABLE); 510686cdd19SJun-ichiro itojun Hagino ip6 = mtod(m, struct ip6_hdr *); 51182cd038dSYoshinobu Inoue ip6->ip6_plen = htons((u_short)next + offset - sizeof(struct ip6_hdr)); 51282cd038dSYoshinobu Inoue ip6->ip6_src = q6->ip6q_src; 51382cd038dSYoshinobu Inoue ip6->ip6_dst = q6->ip6q_dst; 51482cd038dSYoshinobu Inoue nxt = q6->ip6q_nxt; 515686cdd19SJun-ichiro itojun Hagino #ifdef notyet 516686cdd19SJun-ichiro itojun Hagino *q6->ip6q_nxtp = (u_char)(nxt & 0xff); 517686cdd19SJun-ichiro itojun Hagino #endif 51882cd038dSYoshinobu Inoue 51982cd038dSYoshinobu Inoue /* 52082cd038dSYoshinobu Inoue * Delete frag6 header with as a few cost as possible. 52182cd038dSYoshinobu Inoue */ 522686cdd19SJun-ichiro itojun Hagino if (offset < m->m_len) { 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 58682cd038dSYoshinobu Inoue frag6_freef(q6) 58782cd038dSYoshinobu Inoue struct ip6q *q6; 58882cd038dSYoshinobu Inoue { 58982cd038dSYoshinobu Inoue struct ip6asfrag *af6, *down6; 59082cd038dSYoshinobu Inoue 5919bcf770cSHajimu UMEMOTO IP6Q_LOCK_ASSERT(); 5929888c401SHajimu UMEMOTO 59382cd038dSYoshinobu Inoue for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6; 59482cd038dSYoshinobu Inoue af6 = down6) { 59582cd038dSYoshinobu Inoue struct mbuf *m = IP6_REASS_MBUF(af6); 59682cd038dSYoshinobu Inoue 59782cd038dSYoshinobu Inoue down6 = af6->ip6af_down; 59882cd038dSYoshinobu Inoue frag6_deq(af6); 59982cd038dSYoshinobu Inoue 60082cd038dSYoshinobu Inoue /* 60182cd038dSYoshinobu Inoue * Return ICMP time exceeded error for the 1st fragment. 60282cd038dSYoshinobu Inoue * Just free other fragments. 60382cd038dSYoshinobu Inoue */ 60482cd038dSYoshinobu Inoue if (af6->ip6af_off == 0) { 60582cd038dSYoshinobu Inoue struct ip6_hdr *ip6; 60682cd038dSYoshinobu Inoue 60782cd038dSYoshinobu Inoue /* adjust pointer */ 60882cd038dSYoshinobu Inoue ip6 = mtod(m, struct ip6_hdr *); 60982cd038dSYoshinobu Inoue 61006cd0a3fSHajimu UMEMOTO /* restore source and destination addresses */ 61182cd038dSYoshinobu Inoue ip6->ip6_src = q6->ip6q_src; 61282cd038dSYoshinobu Inoue ip6->ip6_dst = q6->ip6q_dst; 61382cd038dSYoshinobu Inoue 61482cd038dSYoshinobu Inoue icmp6_error(m, ICMP6_TIME_EXCEEDED, 61582cd038dSYoshinobu Inoue ICMP6_TIME_EXCEED_REASSEMBLY, 0); 616686cdd19SJun-ichiro itojun Hagino } else 61782cd038dSYoshinobu Inoue m_freem(m); 618686cdd19SJun-ichiro itojun Hagino free(af6, M_FTABLE); 61982cd038dSYoshinobu Inoue } 62082cd038dSYoshinobu Inoue frag6_remque(q6); 6219888c401SHajimu UMEMOTO frag6_nfrags -= q6->ip6q_nfrag; 62282cd038dSYoshinobu Inoue free(q6, M_FTABLE); 62382cd038dSYoshinobu Inoue frag6_nfragpackets--; 62482cd038dSYoshinobu Inoue } 62582cd038dSYoshinobu Inoue 62682cd038dSYoshinobu Inoue /* 62782cd038dSYoshinobu Inoue * Put an ip fragment on a reassembly chain. 62882cd038dSYoshinobu Inoue * Like insque, but pointers in middle of structure. 62982cd038dSYoshinobu Inoue */ 63082cd038dSYoshinobu Inoue void 63182cd038dSYoshinobu Inoue frag6_enq(af6, up6) 63282cd038dSYoshinobu Inoue struct ip6asfrag *af6, *up6; 63382cd038dSYoshinobu Inoue { 6349888c401SHajimu UMEMOTO 6359bcf770cSHajimu UMEMOTO IP6Q_LOCK_ASSERT(); 6369888c401SHajimu UMEMOTO 63782cd038dSYoshinobu Inoue af6->ip6af_up = up6; 63882cd038dSYoshinobu Inoue af6->ip6af_down = up6->ip6af_down; 63982cd038dSYoshinobu Inoue up6->ip6af_down->ip6af_up = af6; 64082cd038dSYoshinobu Inoue up6->ip6af_down = af6; 64182cd038dSYoshinobu Inoue } 64282cd038dSYoshinobu Inoue 64382cd038dSYoshinobu Inoue /* 64482cd038dSYoshinobu Inoue * To frag6_enq as remque is to insque. 64582cd038dSYoshinobu Inoue */ 64682cd038dSYoshinobu Inoue void 64782cd038dSYoshinobu Inoue frag6_deq(af6) 64882cd038dSYoshinobu Inoue struct ip6asfrag *af6; 64982cd038dSYoshinobu Inoue { 6509888c401SHajimu UMEMOTO 6519bcf770cSHajimu UMEMOTO IP6Q_LOCK_ASSERT(); 6529888c401SHajimu UMEMOTO 65382cd038dSYoshinobu Inoue af6->ip6af_up->ip6af_down = af6->ip6af_down; 65482cd038dSYoshinobu Inoue af6->ip6af_down->ip6af_up = af6->ip6af_up; 65582cd038dSYoshinobu Inoue } 65682cd038dSYoshinobu Inoue 65782cd038dSYoshinobu Inoue void 65882cd038dSYoshinobu Inoue frag6_insque(new, old) 65982cd038dSYoshinobu Inoue struct ip6q *new, *old; 66082cd038dSYoshinobu Inoue { 6619888c401SHajimu UMEMOTO 6629bcf770cSHajimu UMEMOTO IP6Q_LOCK_ASSERT(); 6639888c401SHajimu UMEMOTO 66482cd038dSYoshinobu Inoue new->ip6q_prev = old; 66582cd038dSYoshinobu Inoue new->ip6q_next = old->ip6q_next; 66682cd038dSYoshinobu Inoue old->ip6q_next->ip6q_prev= new; 66782cd038dSYoshinobu Inoue old->ip6q_next = new; 66882cd038dSYoshinobu Inoue } 66982cd038dSYoshinobu Inoue 67082cd038dSYoshinobu Inoue void 67182cd038dSYoshinobu Inoue frag6_remque(p6) 67282cd038dSYoshinobu Inoue struct ip6q *p6; 67382cd038dSYoshinobu Inoue { 6749888c401SHajimu UMEMOTO 6759bcf770cSHajimu UMEMOTO IP6Q_LOCK_ASSERT(); 6769888c401SHajimu UMEMOTO 67782cd038dSYoshinobu Inoue p6->ip6q_prev->ip6q_next = p6->ip6q_next; 67882cd038dSYoshinobu Inoue p6->ip6q_next->ip6q_prev = p6->ip6q_prev; 67982cd038dSYoshinobu Inoue } 68082cd038dSYoshinobu Inoue 68182cd038dSYoshinobu Inoue /* 68233841545SHajimu UMEMOTO * IPv6 reassembling timer processing; 68382cd038dSYoshinobu Inoue * if a timer expires on a reassembly 68482cd038dSYoshinobu Inoue * queue, discard it. 68582cd038dSYoshinobu Inoue */ 68682cd038dSYoshinobu Inoue void 68782cd038dSYoshinobu Inoue frag6_slowtimo() 68882cd038dSYoshinobu Inoue { 68982cd038dSYoshinobu Inoue struct ip6q *q6; 69082cd038dSYoshinobu Inoue 6919888c401SHajimu UMEMOTO IP6Q_LOCK(); 69282cd038dSYoshinobu Inoue q6 = ip6q.ip6q_next; 69382cd038dSYoshinobu Inoue if (q6) 69482cd038dSYoshinobu Inoue while (q6 != &ip6q) { 69582cd038dSYoshinobu Inoue --q6->ip6q_ttl; 69682cd038dSYoshinobu Inoue q6 = q6->ip6q_next; 69782cd038dSYoshinobu Inoue if (q6->ip6q_prev->ip6q_ttl == 0) { 69882cd038dSYoshinobu Inoue ip6stat.ip6s_fragtimeout++; 69982cd038dSYoshinobu Inoue /* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */ 70082cd038dSYoshinobu Inoue frag6_freef(q6->ip6q_prev); 70182cd038dSYoshinobu Inoue } 70282cd038dSYoshinobu Inoue } 70382cd038dSYoshinobu Inoue /* 70482cd038dSYoshinobu Inoue * If we are over the maximum number of fragments 70582cd038dSYoshinobu Inoue * (due to the limit being lowered), drain off 70682cd038dSYoshinobu Inoue * enough to get down to the new limit. 70782cd038dSYoshinobu Inoue */ 70833841545SHajimu UMEMOTO while (frag6_nfragpackets > (u_int)ip6_maxfragpackets && 70933841545SHajimu UMEMOTO ip6q.ip6q_prev) { 71082cd038dSYoshinobu Inoue ip6stat.ip6s_fragoverflow++; 71182cd038dSYoshinobu Inoue /* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */ 71282cd038dSYoshinobu Inoue frag6_freef(ip6q.ip6q_prev); 71382cd038dSYoshinobu Inoue } 7149888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 715686cdd19SJun-ichiro itojun Hagino 716686cdd19SJun-ichiro itojun Hagino #if 0 717686cdd19SJun-ichiro itojun Hagino /* 718686cdd19SJun-ichiro itojun Hagino * Routing changes might produce a better route than we last used; 719686cdd19SJun-ichiro itojun Hagino * make sure we notice eventually, even if forwarding only for one 720686cdd19SJun-ichiro itojun Hagino * destination and the cache is never replaced. 721686cdd19SJun-ichiro itojun Hagino */ 722686cdd19SJun-ichiro itojun Hagino if (ip6_forward_rt.ro_rt) { 723686cdd19SJun-ichiro itojun Hagino RTFREE(ip6_forward_rt.ro_rt); 724686cdd19SJun-ichiro itojun Hagino ip6_forward_rt.ro_rt = 0; 725686cdd19SJun-ichiro itojun Hagino } 726686cdd19SJun-ichiro itojun Hagino if (ipsrcchk_rt.ro_rt) { 727686cdd19SJun-ichiro itojun Hagino RTFREE(ipsrcchk_rt.ro_rt); 728686cdd19SJun-ichiro itojun Hagino ipsrcchk_rt.ro_rt = 0; 729686cdd19SJun-ichiro itojun Hagino } 730686cdd19SJun-ichiro itojun Hagino #endif 73182cd038dSYoshinobu Inoue } 73282cd038dSYoshinobu Inoue 73382cd038dSYoshinobu Inoue /* 73482cd038dSYoshinobu Inoue * Drain off all datagram fragments. 73582cd038dSYoshinobu Inoue */ 73682cd038dSYoshinobu Inoue void 73782cd038dSYoshinobu Inoue frag6_drain() 73882cd038dSYoshinobu Inoue { 7399888c401SHajimu UMEMOTO 74031e8f7e5SHajimu UMEMOTO if (IP6Q_TRYLOCK() == 0) 74182cd038dSYoshinobu Inoue return; 74282cd038dSYoshinobu Inoue while (ip6q.ip6q_next != &ip6q) { 74382cd038dSYoshinobu Inoue ip6stat.ip6s_fragdropped++; 74482cd038dSYoshinobu Inoue /* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */ 74582cd038dSYoshinobu Inoue frag6_freef(ip6q.ip6q_next); 74682cd038dSYoshinobu Inoue } 7479888c401SHajimu UMEMOTO IP6Q_UNLOCK(); 74882cd038dSYoshinobu Inoue } 749