xref: /freebsd/sys/netinet6/frag6.c (revision 4b908c8bb4b13eccb45b0fdb4ffcb8abcb086814)
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 
354b908c8bSRobert Watson #include "opt_mac.h"
364b908c8bSRobert Watson 
3782cd038dSYoshinobu Inoue #include <sys/param.h>
3882cd038dSYoshinobu Inoue #include <sys/systm.h>
3982cd038dSYoshinobu Inoue #include <sys/malloc.h>
4082cd038dSYoshinobu Inoue #include <sys/mbuf.h>
4182cd038dSYoshinobu Inoue #include <sys/domain.h>
4282cd038dSYoshinobu Inoue #include <sys/protosw.h>
4382cd038dSYoshinobu Inoue #include <sys/socket.h>
4482cd038dSYoshinobu Inoue #include <sys/errno.h>
4582cd038dSYoshinobu Inoue #include <sys/time.h>
4682cd038dSYoshinobu Inoue #include <sys/kernel.h>
4782cd038dSYoshinobu Inoue #include <sys/syslog.h>
48603724d3SBjoern A. Zeeb #include <sys/vimage.h>
4982cd038dSYoshinobu Inoue 
5082cd038dSYoshinobu Inoue #include <net/if.h>
5182cd038dSYoshinobu Inoue #include <net/route.h>
5282cd038dSYoshinobu Inoue 
5382cd038dSYoshinobu Inoue #include <netinet/in.h>
5482cd038dSYoshinobu Inoue #include <netinet/in_var.h>
55686cdd19SJun-ichiro itojun Hagino #include <netinet/ip6.h>
5682cd038dSYoshinobu Inoue #include <netinet6/ip6_var.h>
57686cdd19SJun-ichiro itojun Hagino #include <netinet/icmp6.h>
5859dfcba4SHajimu UMEMOTO #include <netinet/in_systm.h>	/* for ECN definitions */
5959dfcba4SHajimu UMEMOTO #include <netinet/ip.h>		/* for ECN definitions */
6082cd038dSYoshinobu Inoue 
614b908c8bSRobert Watson #include <security/mac/mac_framework.h>
624b908c8bSRobert Watson 
6382cd038dSYoshinobu Inoue /*
6482cd038dSYoshinobu Inoue  * Define it to get a correct behavior on per-interface statistics.
6582cd038dSYoshinobu Inoue  * You will need to perform an extra routing table lookup, per fragment,
6682cd038dSYoshinobu Inoue  * to do it.  This may, or may not be, a performance hit.
6782cd038dSYoshinobu Inoue  */
6882cd038dSYoshinobu Inoue #define IN6_IFSTAT_STRICT
6982cd038dSYoshinobu Inoue 
709233d8f3SDavid E. O'Brien static void frag6_enq(struct ip6asfrag *, struct ip6asfrag *);
719233d8f3SDavid E. O'Brien static void frag6_deq(struct ip6asfrag *);
729233d8f3SDavid E. O'Brien static void frag6_insque(struct ip6q *, struct ip6q *);
739233d8f3SDavid E. O'Brien static void frag6_remque(struct ip6q *);
749233d8f3SDavid E. O'Brien static void frag6_freef(struct ip6q *);
7582cd038dSYoshinobu Inoue 
7631e8f7e5SHajimu UMEMOTO static struct mtx ip6qlock;
7731e8f7e5SHajimu UMEMOTO /*
7831e8f7e5SHajimu UMEMOTO  * These fields all protected by ip6qlock.
7931e8f7e5SHajimu UMEMOTO  */
8031e8f7e5SHajimu UMEMOTO static u_int frag6_nfragpackets;
8131e8f7e5SHajimu UMEMOTO static u_int frag6_nfrags;
8231e8f7e5SHajimu UMEMOTO static struct	ip6q ip6q;	/* ip6 reassemble queue */
8382cd038dSYoshinobu Inoue 
8431e8f7e5SHajimu UMEMOTO #define	IP6Q_LOCK_INIT()	mtx_init(&ip6qlock, "ip6qlock", NULL, MTX_DEF);
8531e8f7e5SHajimu UMEMOTO #define	IP6Q_LOCK()		mtx_lock(&ip6qlock)
8631e8f7e5SHajimu UMEMOTO #define	IP6Q_TRYLOCK()		mtx_trylock(&ip6qlock)
879bcf770cSHajimu UMEMOTO #define	IP6Q_LOCK_ASSERT()	mtx_assert(&ip6qlock, MA_OWNED)
8831e8f7e5SHajimu UMEMOTO #define	IP6Q_UNLOCK()		mtx_unlock(&ip6qlock)
899888c401SHajimu UMEMOTO 
90959b7375SPoul-Henning Kamp static MALLOC_DEFINE(M_FTABLE, "fragment", "fragment reassembly header");
91686cdd19SJun-ichiro itojun Hagino 
9282cd038dSYoshinobu Inoue /*
9382cd038dSYoshinobu Inoue  * Initialise reassembly queue and fragment identifier.
9482cd038dSYoshinobu Inoue  */
954f590175SPaul Saab static void
964f590175SPaul Saab frag6_change(void *tag)
974f590175SPaul Saab {
988b615593SMarko Zec 	INIT_VNET_INET6(curvnet);
994f590175SPaul Saab 
100603724d3SBjoern A. Zeeb 	V_ip6_maxfragpackets = nmbclusters / 4;
101603724d3SBjoern A. Zeeb 	V_ip6_maxfrags = nmbclusters / 4;
1024f590175SPaul Saab }
1034f590175SPaul Saab 
10482cd038dSYoshinobu Inoue void
1051272577eSXin LI frag6_init(void)
10682cd038dSYoshinobu Inoue {
1078b615593SMarko Zec 	INIT_VNET_INET6(curvnet);
10882cd038dSYoshinobu Inoue 
109603724d3SBjoern A. Zeeb 	V_ip6_maxfragpackets = nmbclusters / 4;
110603724d3SBjoern A. Zeeb 	V_ip6_maxfrags = nmbclusters / 4;
1114f590175SPaul Saab 	EVENTHANDLER_REGISTER(nmbclusters_change,
1124f590175SPaul Saab 	    frag6_change, NULL, EVENTHANDLER_PRI_ANY);
11396c2b042SJesper Skriver 
11431e8f7e5SHajimu UMEMOTO 	IP6Q_LOCK_INIT();
11531e8f7e5SHajimu UMEMOTO 
116603724d3SBjoern A. Zeeb 	V_ip6q.ip6q_next = V_ip6q.ip6q_prev = &V_ip6q;
11782cd038dSYoshinobu Inoue }
11882cd038dSYoshinobu Inoue 
11982cd038dSYoshinobu Inoue /*
120686cdd19SJun-ichiro itojun Hagino  * In RFC2460, fragment and reassembly rule do not agree with each other,
121686cdd19SJun-ichiro itojun Hagino  * in terms of next header field handling in fragment header.
122686cdd19SJun-ichiro itojun Hagino  * While the sender will use the same value for all of the fragmented packets,
123686cdd19SJun-ichiro itojun Hagino  * receiver is suggested not to check the consistency.
124686cdd19SJun-ichiro itojun Hagino  *
125686cdd19SJun-ichiro itojun Hagino  * fragment rule (p20):
126686cdd19SJun-ichiro itojun Hagino  *	(2) A Fragment header containing:
127686cdd19SJun-ichiro itojun Hagino  *	The Next Header value that identifies the first header of
128686cdd19SJun-ichiro itojun Hagino  *	the Fragmentable Part of the original packet.
129686cdd19SJun-ichiro itojun Hagino  *		-> next header field is same for all fragments
130686cdd19SJun-ichiro itojun Hagino  *
131686cdd19SJun-ichiro itojun Hagino  * reassembly rule (p21):
132686cdd19SJun-ichiro itojun Hagino  *	The Next Header field of the last header of the Unfragmentable
133686cdd19SJun-ichiro itojun Hagino  *	Part is obtained from the Next Header field of the first
134686cdd19SJun-ichiro itojun Hagino  *	fragment's Fragment header.
135686cdd19SJun-ichiro itojun Hagino  *		-> should grab it from the first fragment only
136686cdd19SJun-ichiro itojun Hagino  *
137686cdd19SJun-ichiro itojun Hagino  * The following note also contradicts with fragment rule - noone is going to
138686cdd19SJun-ichiro itojun Hagino  * send different fragment with different next header field.
139686cdd19SJun-ichiro itojun Hagino  *
140686cdd19SJun-ichiro itojun Hagino  * additional note (p22):
141686cdd19SJun-ichiro itojun Hagino  *	The Next Header values in the Fragment headers of different
142686cdd19SJun-ichiro itojun Hagino  *	fragments of the same original packet may differ.  Only the value
143686cdd19SJun-ichiro itojun Hagino  *	from the Offset zero fragment packet is used for reassembly.
144686cdd19SJun-ichiro itojun Hagino  *		-> should grab it from the first fragment only
145686cdd19SJun-ichiro itojun Hagino  *
146686cdd19SJun-ichiro itojun Hagino  * There is no explicit reason given in the RFC.  Historical reason maybe?
147686cdd19SJun-ichiro itojun Hagino  */
148686cdd19SJun-ichiro itojun Hagino /*
14982cd038dSYoshinobu Inoue  * Fragment input
15082cd038dSYoshinobu Inoue  */
15182cd038dSYoshinobu Inoue int
1521272577eSXin LI frag6_input(struct mbuf **mp, int *offp, int proto)
15382cd038dSYoshinobu Inoue {
1548b615593SMarko Zec 	INIT_VNET_INET6(curvnet);
15582cd038dSYoshinobu Inoue 	struct mbuf *m = *mp, *t;
15682cd038dSYoshinobu Inoue 	struct ip6_hdr *ip6;
15782cd038dSYoshinobu Inoue 	struct ip6_frag *ip6f;
15882cd038dSYoshinobu Inoue 	struct ip6q *q6;
159686cdd19SJun-ichiro itojun Hagino 	struct ip6asfrag *af6, *ip6af, *af6dwn;
1602a5aafceSHajimu UMEMOTO #ifdef IN6_IFSTAT_STRICT
1612a5aafceSHajimu UMEMOTO 	struct in6_ifaddr *ia;
1622a5aafceSHajimu UMEMOTO #endif
16382cd038dSYoshinobu Inoue 	int offset = *offp, nxt, i, next;
16482cd038dSYoshinobu Inoue 	int first_frag = 0;
165686cdd19SJun-ichiro itojun Hagino 	int fragoff, frgpartlen;	/* must be larger than u_int16_t */
16682cd038dSYoshinobu Inoue 	struct ifnet *dstifp;
16759dfcba4SHajimu UMEMOTO 	u_int8_t ecn, ecn0;
1681d54aa3bSBjoern A. Zeeb #if 0
1691d54aa3bSBjoern A. Zeeb 	char ip6buf[INET6_ADDRSTRLEN];
1701d54aa3bSBjoern A. Zeeb #endif
17182cd038dSYoshinobu Inoue 
17282cd038dSYoshinobu Inoue 	ip6 = mtod(m, struct ip6_hdr *);
173686cdd19SJun-ichiro itojun Hagino #ifndef PULLDOWN_TEST
174686cdd19SJun-ichiro itojun Hagino 	IP6_EXTHDR_CHECK(m, offset, sizeof(struct ip6_frag), IPPROTO_DONE);
17582cd038dSYoshinobu Inoue 	ip6f = (struct ip6_frag *)((caddr_t)ip6 + offset);
176686cdd19SJun-ichiro itojun Hagino #else
177686cdd19SJun-ichiro itojun Hagino 	IP6_EXTHDR_GET(ip6f, struct ip6_frag *, m, offset, sizeof(*ip6f));
178686cdd19SJun-ichiro itojun Hagino 	if (ip6f == NULL)
17940e39bbbSHajimu UMEMOTO 		return (IPPROTO_DONE);
180686cdd19SJun-ichiro itojun Hagino #endif
18182cd038dSYoshinobu Inoue 
18282cd038dSYoshinobu Inoue 	dstifp = NULL;
18382cd038dSYoshinobu Inoue #ifdef IN6_IFSTAT_STRICT
18482cd038dSYoshinobu Inoue 	/* find the destination interface of the packet. */
1852a5aafceSHajimu UMEMOTO 	if ((ia = ip6_getdstifaddr(m)) != NULL)
1862a5aafceSHajimu UMEMOTO 		dstifp = ia->ia_ifp;
18782cd038dSYoshinobu Inoue #else
18882cd038dSYoshinobu Inoue 	/* we are violating the spec, this is not the destination interface */
18982cd038dSYoshinobu Inoue 	if ((m->m_flags & M_PKTHDR) != 0)
19082cd038dSYoshinobu Inoue 		dstifp = m->m_pkthdr.rcvif;
19182cd038dSYoshinobu Inoue #endif
19282cd038dSYoshinobu Inoue 
19382cd038dSYoshinobu Inoue 	/* jumbo payload can't contain a fragment header */
19482cd038dSYoshinobu Inoue 	if (ip6->ip6_plen == 0) {
19582cd038dSYoshinobu Inoue 		icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, offset);
19682cd038dSYoshinobu Inoue 		in6_ifstat_inc(dstifp, ifs6_reass_fail);
19782cd038dSYoshinobu Inoue 		return IPPROTO_DONE;
19882cd038dSYoshinobu Inoue 	}
19982cd038dSYoshinobu Inoue 
20082cd038dSYoshinobu Inoue 	/*
20182cd038dSYoshinobu Inoue 	 * check whether fragment packet's fragment length is
20282cd038dSYoshinobu Inoue 	 * multiple of 8 octets.
20382cd038dSYoshinobu Inoue 	 * sizeof(struct ip6_frag) == 8
20482cd038dSYoshinobu Inoue 	 * sizeof(struct ip6_hdr) = 40
20582cd038dSYoshinobu Inoue 	 */
20682cd038dSYoshinobu Inoue 	if ((ip6f->ip6f_offlg & IP6F_MORE_FRAG) &&
20782cd038dSYoshinobu Inoue 	    (((ntohs(ip6->ip6_plen) - offset) & 0x7) != 0)) {
20806cd0a3fSHajimu UMEMOTO 		icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER,
209686cdd19SJun-ichiro itojun Hagino 		    offsetof(struct ip6_hdr, ip6_plen));
21082cd038dSYoshinobu Inoue 		in6_ifstat_inc(dstifp, ifs6_reass_fail);
21182cd038dSYoshinobu Inoue 		return IPPROTO_DONE;
21282cd038dSYoshinobu Inoue 	}
21382cd038dSYoshinobu Inoue 
214603724d3SBjoern A. Zeeb 	V_ip6stat.ip6s_fragments++;
21582cd038dSYoshinobu Inoue 	in6_ifstat_inc(dstifp, ifs6_reass_reqd);
21682cd038dSYoshinobu Inoue 
217686cdd19SJun-ichiro itojun Hagino 	/* offset now points to data portion */
21882cd038dSYoshinobu Inoue 	offset += sizeof(struct ip6_frag);
21982cd038dSYoshinobu Inoue 
2209888c401SHajimu UMEMOTO 	IP6Q_LOCK();
2219888c401SHajimu UMEMOTO 
2229888c401SHajimu UMEMOTO 	/*
2239888c401SHajimu UMEMOTO 	 * Enforce upper bound on number of fragments.
2249888c401SHajimu UMEMOTO 	 * If maxfrag is 0, never accept fragments.
2259888c401SHajimu UMEMOTO 	 * If maxfrag is -1, accept all fragments without limitation.
2269888c401SHajimu UMEMOTO 	 */
227603724d3SBjoern A. Zeeb 	if (V_ip6_maxfrags < 0)
2289888c401SHajimu UMEMOTO 		;
229603724d3SBjoern A. Zeeb 	else if (V_frag6_nfrags >= (u_int)V_ip6_maxfrags)
2309888c401SHajimu UMEMOTO 		goto dropfrag;
23133841545SHajimu UMEMOTO 
232603724d3SBjoern A. Zeeb 	for (q6 = V_ip6q.ip6q_next; q6 != &V_ip6q; q6 = q6->ip6q_next)
23382cd038dSYoshinobu Inoue 		if (ip6f->ip6f_ident == q6->ip6q_ident &&
23482cd038dSYoshinobu Inoue 		    IN6_ARE_ADDR_EQUAL(&ip6->ip6_src, &q6->ip6q_src) &&
2354b908c8bSRobert Watson 		    IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst, &q6->ip6q_dst)
2364b908c8bSRobert Watson #ifdef MAC
2374b908c8bSRobert Watson 		    && mac_ip6q_match(m, q6)
2384b908c8bSRobert Watson #endif
2394b908c8bSRobert Watson 		    )
24082cd038dSYoshinobu Inoue 			break;
24182cd038dSYoshinobu Inoue 
242603724d3SBjoern A. Zeeb 	if (q6 == &V_ip6q) {
24382cd038dSYoshinobu Inoue 		/*
24482cd038dSYoshinobu Inoue 		 * the first fragment to arrive, create a reassembly queue.
24582cd038dSYoshinobu Inoue 		 */
24682cd038dSYoshinobu Inoue 		first_frag = 1;
24782cd038dSYoshinobu Inoue 
24882cd038dSYoshinobu Inoue 		/*
24982cd038dSYoshinobu Inoue 		 * Enforce upper bound on number of fragmented packets
25082cd038dSYoshinobu Inoue 		 * for which we attempt reassembly;
2519888c401SHajimu UMEMOTO 		 * If maxfragpackets is 0, never accept fragments.
2529888c401SHajimu UMEMOTO 		 * If maxfragpackets is -1, accept all fragments without
2539888c401SHajimu UMEMOTO 		 * limitation.
25482cd038dSYoshinobu Inoue 		 */
255603724d3SBjoern A. Zeeb 		if (V_ip6_maxfragpackets < 0)
25633841545SHajimu UMEMOTO 			;
257603724d3SBjoern A. Zeeb 		else if (V_frag6_nfragpackets >= (u_int)V_ip6_maxfragpackets)
25833841545SHajimu UMEMOTO 			goto dropfrag;
259603724d3SBjoern A. Zeeb 		V_frag6_nfragpackets++;
26082cd038dSYoshinobu Inoue 		q6 = (struct ip6q *)malloc(sizeof(struct ip6q), M_FTABLE,
2618c0dd0e4SHajimu UMEMOTO 		    M_NOWAIT);
26282cd038dSYoshinobu Inoue 		if (q6 == NULL)
26382cd038dSYoshinobu Inoue 			goto dropfrag;
264686cdd19SJun-ichiro itojun Hagino 		bzero(q6, sizeof(*q6));
2654b908c8bSRobert Watson #ifdef MAC
2664b908c8bSRobert Watson 		if (mac_ip6q_init(q6, M_NOWAIT) != 0) {
2674b908c8bSRobert Watson 			free(q6, M_FTABLE);
2684b908c8bSRobert Watson 			goto dropfrag;
2694b908c8bSRobert Watson 		}
2704b908c8bSRobert Watson 		mac_ip6q_create(m, q6);
2714b908c8bSRobert Watson #endif
272603724d3SBjoern A. Zeeb 		frag6_insque(q6, &V_ip6q);
27382cd038dSYoshinobu Inoue 
274686cdd19SJun-ichiro itojun Hagino 		/* ip6q_nxt will be filled afterwards, from 1st fragment */
27582cd038dSYoshinobu Inoue 		q6->ip6q_down	= q6->ip6q_up = (struct ip6asfrag *)q6;
276686cdd19SJun-ichiro itojun Hagino #ifdef notyet
277686cdd19SJun-ichiro itojun Hagino 		q6->ip6q_nxtp	= (u_char *)nxtp;
278686cdd19SJun-ichiro itojun Hagino #endif
27982cd038dSYoshinobu Inoue 		q6->ip6q_ident	= ip6f->ip6f_ident;
28082cd038dSYoshinobu Inoue 		q6->ip6q_ttl	= IPV6_FRAGTTL;
28182cd038dSYoshinobu Inoue 		q6->ip6q_src	= ip6->ip6_src;
28282cd038dSYoshinobu Inoue 		q6->ip6q_dst	= ip6->ip6_dst;
2835e9510e3SJINMEI Tatuya 		q6->ip6q_ecn	=
2845e9510e3SJINMEI Tatuya 		    (ntohl(ip6->ip6_flow) >> 20) & IPTOS_ECN_MASK;
28582cd038dSYoshinobu Inoue 		q6->ip6q_unfrglen = -1;	/* The 1st fragment has not arrived. */
2869888c401SHajimu UMEMOTO 
2879888c401SHajimu UMEMOTO 		q6->ip6q_nfrag = 0;
28882cd038dSYoshinobu Inoue 	}
28982cd038dSYoshinobu Inoue 
29082cd038dSYoshinobu Inoue 	/*
29182cd038dSYoshinobu Inoue 	 * If it's the 1st fragment, record the length of the
29282cd038dSYoshinobu Inoue 	 * unfragmentable part and the next header of the fragment header.
29382cd038dSYoshinobu Inoue 	 */
29482cd038dSYoshinobu Inoue 	fragoff = ntohs(ip6f->ip6f_offlg & IP6F_OFF_MASK);
29582cd038dSYoshinobu Inoue 	if (fragoff == 0) {
29606cd0a3fSHajimu UMEMOTO 		q6->ip6q_unfrglen = offset - sizeof(struct ip6_hdr) -
29706cd0a3fSHajimu UMEMOTO 		    sizeof(struct ip6_frag);
29882cd038dSYoshinobu Inoue 		q6->ip6q_nxt = ip6f->ip6f_nxt;
29982cd038dSYoshinobu Inoue 	}
30082cd038dSYoshinobu Inoue 
30182cd038dSYoshinobu Inoue 	/*
30282cd038dSYoshinobu Inoue 	 * Check that the reassembled packet would not exceed 65535 bytes
30382cd038dSYoshinobu Inoue 	 * in size.
30482cd038dSYoshinobu Inoue 	 * If it would exceed, discard the fragment and return an ICMP error.
30582cd038dSYoshinobu Inoue 	 */
30682cd038dSYoshinobu Inoue 	frgpartlen = sizeof(struct ip6_hdr) + ntohs(ip6->ip6_plen) - offset;
30782cd038dSYoshinobu Inoue 	if (q6->ip6q_unfrglen >= 0) {
30882cd038dSYoshinobu Inoue 		/* The 1st fragment has already arrived. */
30982cd038dSYoshinobu Inoue 		if (q6->ip6q_unfrglen + fragoff + frgpartlen > IPV6_MAXPACKET) {
31082cd038dSYoshinobu Inoue 			icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER,
311686cdd19SJun-ichiro itojun Hagino 			    offset - sizeof(struct ip6_frag) +
312686cdd19SJun-ichiro itojun Hagino 			    offsetof(struct ip6_frag, ip6f_offlg));
3139888c401SHajimu UMEMOTO 			IP6Q_UNLOCK();
31482cd038dSYoshinobu Inoue 			return (IPPROTO_DONE);
31582cd038dSYoshinobu Inoue 		}
31606cd0a3fSHajimu UMEMOTO 	} else if (fragoff + frgpartlen > IPV6_MAXPACKET) {
31782cd038dSYoshinobu Inoue 		icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER,
318686cdd19SJun-ichiro itojun Hagino 		    offset - sizeof(struct ip6_frag) +
319686cdd19SJun-ichiro itojun Hagino 		    offsetof(struct ip6_frag, ip6f_offlg));
3209888c401SHajimu UMEMOTO 		IP6Q_UNLOCK();
32182cd038dSYoshinobu Inoue 		return (IPPROTO_DONE);
32282cd038dSYoshinobu Inoue 	}
32382cd038dSYoshinobu Inoue 	/*
32482cd038dSYoshinobu Inoue 	 * If it's the first fragment, do the above check for each
32582cd038dSYoshinobu Inoue 	 * fragment already stored in the reassembly queue.
32682cd038dSYoshinobu Inoue 	 */
32782cd038dSYoshinobu Inoue 	if (fragoff == 0) {
32882cd038dSYoshinobu Inoue 		for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6;
32982cd038dSYoshinobu Inoue 		     af6 = af6dwn) {
33082cd038dSYoshinobu Inoue 			af6dwn = af6->ip6af_down;
33182cd038dSYoshinobu Inoue 
33282cd038dSYoshinobu Inoue 			if (q6->ip6q_unfrglen + af6->ip6af_off + af6->ip6af_frglen >
33382cd038dSYoshinobu Inoue 			    IPV6_MAXPACKET) {
33482cd038dSYoshinobu Inoue 				struct mbuf *merr = IP6_REASS_MBUF(af6);
33582cd038dSYoshinobu Inoue 				struct ip6_hdr *ip6err;
33682cd038dSYoshinobu Inoue 				int erroff = af6->ip6af_offset;
33782cd038dSYoshinobu Inoue 
33882cd038dSYoshinobu Inoue 				/* dequeue the fragment. */
33982cd038dSYoshinobu Inoue 				frag6_deq(af6);
340686cdd19SJun-ichiro itojun Hagino 				free(af6, M_FTABLE);
34182cd038dSYoshinobu Inoue 
34282cd038dSYoshinobu Inoue 				/* adjust pointer. */
34382cd038dSYoshinobu Inoue 				ip6err = mtod(merr, struct ip6_hdr *);
34482cd038dSYoshinobu Inoue 
34582cd038dSYoshinobu Inoue 				/*
34682cd038dSYoshinobu Inoue 				 * Restore source and destination addresses
34782cd038dSYoshinobu Inoue 				 * in the erroneous IPv6 header.
34882cd038dSYoshinobu Inoue 				 */
34982cd038dSYoshinobu Inoue 				ip6err->ip6_src = q6->ip6q_src;
35082cd038dSYoshinobu Inoue 				ip6err->ip6_dst = q6->ip6q_dst;
35182cd038dSYoshinobu Inoue 
35282cd038dSYoshinobu Inoue 				icmp6_error(merr, ICMP6_PARAM_PROB,
35382cd038dSYoshinobu Inoue 				    ICMP6_PARAMPROB_HEADER,
354686cdd19SJun-ichiro itojun Hagino 				    erroff - sizeof(struct ip6_frag) +
355686cdd19SJun-ichiro itojun Hagino 				    offsetof(struct ip6_frag, ip6f_offlg));
35682cd038dSYoshinobu Inoue 			}
35782cd038dSYoshinobu Inoue 		}
35882cd038dSYoshinobu Inoue 	}
35982cd038dSYoshinobu Inoue 
360686cdd19SJun-ichiro itojun Hagino 	ip6af = (struct ip6asfrag *)malloc(sizeof(struct ip6asfrag), M_FTABLE,
3618c0dd0e4SHajimu UMEMOTO 	    M_NOWAIT);
362686cdd19SJun-ichiro itojun Hagino 	if (ip6af == NULL)
363686cdd19SJun-ichiro itojun Hagino 		goto dropfrag;
364686cdd19SJun-ichiro itojun Hagino 	bzero(ip6af, sizeof(*ip6af));
36582cd038dSYoshinobu Inoue 	ip6af->ip6af_mff = ip6f->ip6f_offlg & IP6F_MORE_FRAG;
36682cd038dSYoshinobu Inoue 	ip6af->ip6af_off = fragoff;
36782cd038dSYoshinobu Inoue 	ip6af->ip6af_frglen = frgpartlen;
36882cd038dSYoshinobu Inoue 	ip6af->ip6af_offset = offset;
36982cd038dSYoshinobu Inoue 	IP6_REASS_MBUF(ip6af) = m;
37082cd038dSYoshinobu Inoue 
37182cd038dSYoshinobu Inoue 	if (first_frag) {
37282cd038dSYoshinobu Inoue 		af6 = (struct ip6asfrag *)q6;
37382cd038dSYoshinobu Inoue 		goto insert;
37482cd038dSYoshinobu Inoue 	}
37582cd038dSYoshinobu Inoue 
37682cd038dSYoshinobu Inoue 	/*
37759dfcba4SHajimu UMEMOTO 	 * Handle ECN by comparing this segment with the first one;
37859dfcba4SHajimu UMEMOTO 	 * if CE is set, do not lose CE.
37959dfcba4SHajimu UMEMOTO 	 * drop if CE and not-ECT are mixed for the same packet.
38059dfcba4SHajimu UMEMOTO 	 */
38159dfcba4SHajimu UMEMOTO 	ecn = (ntohl(ip6->ip6_flow) >> 20) & IPTOS_ECN_MASK;
3825e9510e3SJINMEI Tatuya 	ecn0 = q6->ip6q_ecn;
38359dfcba4SHajimu UMEMOTO 	if (ecn == IPTOS_ECN_CE) {
38459dfcba4SHajimu UMEMOTO 		if (ecn0 == IPTOS_ECN_NOTECT) {
38559dfcba4SHajimu UMEMOTO 			free(ip6af, M_FTABLE);
38659dfcba4SHajimu UMEMOTO 			goto dropfrag;
38759dfcba4SHajimu UMEMOTO 		}
38859dfcba4SHajimu UMEMOTO 		if (ecn0 != IPTOS_ECN_CE)
3895e9510e3SJINMEI Tatuya 			q6->ip6q_ecn = IPTOS_ECN_CE;
39059dfcba4SHajimu UMEMOTO 	}
39159dfcba4SHajimu UMEMOTO 	if (ecn == IPTOS_ECN_NOTECT && ecn0 != IPTOS_ECN_NOTECT) {
39259dfcba4SHajimu UMEMOTO 		free(ip6af, M_FTABLE);
39359dfcba4SHajimu UMEMOTO 		goto dropfrag;
39459dfcba4SHajimu UMEMOTO 	}
39559dfcba4SHajimu UMEMOTO 
39659dfcba4SHajimu UMEMOTO 	/*
39782cd038dSYoshinobu Inoue 	 * Find a segment which begins after this one does.
39882cd038dSYoshinobu Inoue 	 */
39982cd038dSYoshinobu Inoue 	for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6;
40082cd038dSYoshinobu Inoue 	     af6 = af6->ip6af_down)
40182cd038dSYoshinobu Inoue 		if (af6->ip6af_off > ip6af->ip6af_off)
40282cd038dSYoshinobu Inoue 			break;
40382cd038dSYoshinobu Inoue 
404686cdd19SJun-ichiro itojun Hagino #if 0
405686cdd19SJun-ichiro itojun Hagino 	/*
406686cdd19SJun-ichiro itojun Hagino 	 * If there is a preceding segment, it may provide some of
407686cdd19SJun-ichiro itojun Hagino 	 * our data already.  If so, drop the data from the incoming
408686cdd19SJun-ichiro itojun Hagino 	 * segment.  If it provides all of our data, drop us.
409686cdd19SJun-ichiro itojun Hagino 	 */
410686cdd19SJun-ichiro itojun Hagino 	if (af6->ip6af_up != (struct ip6asfrag *)q6) {
411686cdd19SJun-ichiro itojun Hagino 		i = af6->ip6af_up->ip6af_off + af6->ip6af_up->ip6af_frglen
412686cdd19SJun-ichiro itojun Hagino 			- ip6af->ip6af_off;
413686cdd19SJun-ichiro itojun Hagino 		if (i > 0) {
414686cdd19SJun-ichiro itojun Hagino 			if (i >= ip6af->ip6af_frglen)
415686cdd19SJun-ichiro itojun Hagino 				goto dropfrag;
416686cdd19SJun-ichiro itojun Hagino 			m_adj(IP6_REASS_MBUF(ip6af), i);
417686cdd19SJun-ichiro itojun Hagino 			ip6af->ip6af_off += i;
418686cdd19SJun-ichiro itojun Hagino 			ip6af->ip6af_frglen -= i;
419686cdd19SJun-ichiro itojun Hagino 		}
420686cdd19SJun-ichiro itojun Hagino 	}
421686cdd19SJun-ichiro itojun Hagino 
422686cdd19SJun-ichiro itojun Hagino 	/*
423686cdd19SJun-ichiro itojun Hagino 	 * While we overlap succeeding segments trim them or,
424686cdd19SJun-ichiro itojun Hagino 	 * if they are completely covered, dequeue them.
425686cdd19SJun-ichiro itojun Hagino 	 */
426686cdd19SJun-ichiro itojun Hagino 	while (af6 != (struct ip6asfrag *)q6 &&
427686cdd19SJun-ichiro itojun Hagino 	       ip6af->ip6af_off + ip6af->ip6af_frglen > af6->ip6af_off) {
428686cdd19SJun-ichiro itojun Hagino 		i = (ip6af->ip6af_off + ip6af->ip6af_frglen) - af6->ip6af_off;
429686cdd19SJun-ichiro itojun Hagino 		if (i < af6->ip6af_frglen) {
430686cdd19SJun-ichiro itojun Hagino 			af6->ip6af_frglen -= i;
431686cdd19SJun-ichiro itojun Hagino 			af6->ip6af_off += i;
432686cdd19SJun-ichiro itojun Hagino 			m_adj(IP6_REASS_MBUF(af6), i);
433686cdd19SJun-ichiro itojun Hagino 			break;
434686cdd19SJun-ichiro itojun Hagino 		}
435686cdd19SJun-ichiro itojun Hagino 		af6 = af6->ip6af_down;
436686cdd19SJun-ichiro itojun Hagino 		m_freem(IP6_REASS_MBUF(af6->ip6af_up));
437686cdd19SJun-ichiro itojun Hagino 		frag6_deq(af6->ip6af_up);
438686cdd19SJun-ichiro itojun Hagino 	}
439686cdd19SJun-ichiro itojun Hagino #else
44082cd038dSYoshinobu Inoue 	/*
44182cd038dSYoshinobu Inoue 	 * If the incoming framgent overlaps some existing fragments in
44282cd038dSYoshinobu Inoue 	 * the reassembly queue, drop it, since it is dangerous to override
44382cd038dSYoshinobu Inoue 	 * existing fragments from a security point of view.
4449888c401SHajimu UMEMOTO 	 * We don't know which fragment is the bad guy - here we trust
4459888c401SHajimu UMEMOTO 	 * fragment that came in earlier, with no real reason.
4465e9510e3SJINMEI Tatuya 	 *
4475e9510e3SJINMEI Tatuya 	 * Note: due to changes after disabling this part, mbuf passed to
4485e9510e3SJINMEI Tatuya 	 * m_adj() below now does not meet the requirement.
44982cd038dSYoshinobu Inoue 	 */
45082cd038dSYoshinobu Inoue 	if (af6->ip6af_up != (struct ip6asfrag *)q6) {
45182cd038dSYoshinobu Inoue 		i = af6->ip6af_up->ip6af_off + af6->ip6af_up->ip6af_frglen
45282cd038dSYoshinobu Inoue 			- ip6af->ip6af_off;
45382cd038dSYoshinobu Inoue 		if (i > 0) {
4542bf76779SMunechika SUMIKAWA #if 0				/* suppress the noisy log */
45582cd038dSYoshinobu Inoue 			log(LOG_ERR, "%d bytes of a fragment from %s "
45682cd038dSYoshinobu Inoue 			    "overlaps the previous fragment\n",
4571d54aa3bSBjoern A. Zeeb 			    i, ip6_sprintf(ip6buf, &q6->ip6q_src));
4582bf76779SMunechika SUMIKAWA #endif
4592bf76779SMunechika SUMIKAWA 			free(ip6af, M_FTABLE);
46082cd038dSYoshinobu Inoue 			goto dropfrag;
46182cd038dSYoshinobu Inoue 		}
46282cd038dSYoshinobu Inoue 	}
46382cd038dSYoshinobu Inoue 	if (af6 != (struct ip6asfrag *)q6) {
46482cd038dSYoshinobu Inoue 		i = (ip6af->ip6af_off + ip6af->ip6af_frglen) - af6->ip6af_off;
46582cd038dSYoshinobu Inoue 		if (i > 0) {
4662bf76779SMunechika SUMIKAWA #if 0				/* suppress the noisy log */
46782cd038dSYoshinobu Inoue 			log(LOG_ERR, "%d bytes of a fragment from %s "
46882cd038dSYoshinobu Inoue 			    "overlaps the succeeding fragment",
4691d54aa3bSBjoern A. Zeeb 			    i, ip6_sprintf(ip6buf, &q6->ip6q_src));
4702bf76779SMunechika SUMIKAWA #endif
4712bf76779SMunechika SUMIKAWA 			free(ip6af, M_FTABLE);
47282cd038dSYoshinobu Inoue 			goto dropfrag;
47382cd038dSYoshinobu Inoue 		}
47482cd038dSYoshinobu Inoue 	}
475686cdd19SJun-ichiro itojun Hagino #endif
47682cd038dSYoshinobu Inoue 
47782cd038dSYoshinobu Inoue insert:
4784b908c8bSRobert Watson #ifdef MAC
4794b908c8bSRobert Watson 	if (!first_frag)
4804b908c8bSRobert Watson 		mac_ip6q_update(m, q6);
4814b908c8bSRobert Watson #endif
48282cd038dSYoshinobu Inoue 
48382cd038dSYoshinobu Inoue 	/*
48482cd038dSYoshinobu Inoue 	 * Stick new segment in its place;
48582cd038dSYoshinobu Inoue 	 * check for complete reassembly.
48682cd038dSYoshinobu Inoue 	 * Move to front of packet queue, as we are
48782cd038dSYoshinobu Inoue 	 * the most recently active fragmented packet.
48882cd038dSYoshinobu Inoue 	 */
48982cd038dSYoshinobu Inoue 	frag6_enq(ip6af, af6->ip6af_up);
490603724d3SBjoern A. Zeeb 	V_frag6_nfrags++;
4919888c401SHajimu UMEMOTO 	q6->ip6q_nfrag++;
492686cdd19SJun-ichiro itojun Hagino #if 0 /* xxx */
493603724d3SBjoern A. Zeeb 	if (q6 != V_ip6q.ip6q_next) {
494686cdd19SJun-ichiro itojun Hagino 		frag6_remque(q6);
495603724d3SBjoern A. Zeeb 		frag6_insque(q6, &V_ip6q);
496686cdd19SJun-ichiro itojun Hagino 	}
497686cdd19SJun-ichiro itojun Hagino #endif
49882cd038dSYoshinobu Inoue 	next = 0;
49982cd038dSYoshinobu Inoue 	for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6;
50082cd038dSYoshinobu Inoue 	     af6 = af6->ip6af_down) {
50182cd038dSYoshinobu Inoue 		if (af6->ip6af_off != next) {
5029888c401SHajimu UMEMOTO 			IP6Q_UNLOCK();
50382cd038dSYoshinobu Inoue 			return IPPROTO_DONE;
50482cd038dSYoshinobu Inoue 		}
50582cd038dSYoshinobu Inoue 		next += af6->ip6af_frglen;
50682cd038dSYoshinobu Inoue 	}
50782cd038dSYoshinobu Inoue 	if (af6->ip6af_up->ip6af_mff) {
5089888c401SHajimu UMEMOTO 		IP6Q_UNLOCK();
50982cd038dSYoshinobu Inoue 		return IPPROTO_DONE;
51082cd038dSYoshinobu Inoue 	}
51182cd038dSYoshinobu Inoue 
51282cd038dSYoshinobu Inoue 	/*
51382cd038dSYoshinobu Inoue 	 * Reassembly is complete; concatenate fragments.
51482cd038dSYoshinobu Inoue 	 */
51582cd038dSYoshinobu Inoue 	ip6af = q6->ip6q_down;
51682cd038dSYoshinobu Inoue 	t = m = IP6_REASS_MBUF(ip6af);
51782cd038dSYoshinobu Inoue 	af6 = ip6af->ip6af_down;
518686cdd19SJun-ichiro itojun Hagino 	frag6_deq(ip6af);
51982cd038dSYoshinobu Inoue 	while (af6 != (struct ip6asfrag *)q6) {
520686cdd19SJun-ichiro itojun Hagino 		af6dwn = af6->ip6af_down;
521686cdd19SJun-ichiro itojun Hagino 		frag6_deq(af6);
52282cd038dSYoshinobu Inoue 		while (t->m_next)
52382cd038dSYoshinobu Inoue 			t = t->m_next;
52482cd038dSYoshinobu Inoue 		t->m_next = IP6_REASS_MBUF(af6);
525686cdd19SJun-ichiro itojun Hagino 		m_adj(t->m_next, af6->ip6af_offset);
526686cdd19SJun-ichiro itojun Hagino 		free(af6, M_FTABLE);
527686cdd19SJun-ichiro itojun Hagino 		af6 = af6dwn;
52882cd038dSYoshinobu Inoue 	}
52982cd038dSYoshinobu Inoue 
53082cd038dSYoshinobu Inoue 	/* adjust offset to point where the original next header starts */
53182cd038dSYoshinobu Inoue 	offset = ip6af->ip6af_offset - sizeof(struct ip6_frag);
532686cdd19SJun-ichiro itojun Hagino 	free(ip6af, M_FTABLE);
533686cdd19SJun-ichiro itojun Hagino 	ip6 = mtod(m, struct ip6_hdr *);
53482cd038dSYoshinobu Inoue 	ip6->ip6_plen = htons((u_short)next + offset - sizeof(struct ip6_hdr));
5355e9510e3SJINMEI Tatuya 	if (q6->ip6q_ecn == IPTOS_ECN_CE)
5365e9510e3SJINMEI Tatuya 		ip6->ip6_flow |= htonl(IPTOS_ECN_CE << 20);
53782cd038dSYoshinobu Inoue 	nxt = q6->ip6q_nxt;
538686cdd19SJun-ichiro itojun Hagino #ifdef notyet
539686cdd19SJun-ichiro itojun Hagino 	*q6->ip6q_nxtp = (u_char)(nxt & 0xff);
540686cdd19SJun-ichiro itojun Hagino #endif
54182cd038dSYoshinobu Inoue 
5425e9510e3SJINMEI Tatuya 	/* Delete frag6 header */
5435e9510e3SJINMEI Tatuya 	if (m->m_len >= offset + sizeof(struct ip6_frag)) {
5445e9510e3SJINMEI Tatuya 		/* This is the only possible case with !PULLDOWN_TEST */
54582cd038dSYoshinobu Inoue 		ovbcopy((caddr_t)ip6, (caddr_t)ip6 + sizeof(struct ip6_frag),
54682cd038dSYoshinobu Inoue 		    offset);
547686cdd19SJun-ichiro itojun Hagino 		m->m_data += sizeof(struct ip6_frag);
548686cdd19SJun-ichiro itojun Hagino 		m->m_len -= sizeof(struct ip6_frag);
549686cdd19SJun-ichiro itojun Hagino 	} else {
550686cdd19SJun-ichiro itojun Hagino 		/* this comes with no copy if the boundary is on cluster */
551a163d034SWarner Losh 		if ((t = m_split(m, offset, M_DONTWAIT)) == NULL) {
552686cdd19SJun-ichiro itojun Hagino 			frag6_remque(q6);
553603724d3SBjoern A. Zeeb 			V_frag6_nfrags -= q6->ip6q_nfrag;
5544b908c8bSRobert Watson #ifdef MAC
5554b908c8bSRobert Watson 			mac_ip6q_destroy(q6);
5564b908c8bSRobert Watson #endif
557686cdd19SJun-ichiro itojun Hagino 			free(q6, M_FTABLE);
558603724d3SBjoern A. Zeeb 			V_frag6_nfragpackets--;
559686cdd19SJun-ichiro itojun Hagino 			goto dropfrag;
56082cd038dSYoshinobu Inoue 		}
561686cdd19SJun-ichiro itojun Hagino 		m_adj(t, sizeof(struct ip6_frag));
562686cdd19SJun-ichiro itojun Hagino 		m_cat(m, t);
563686cdd19SJun-ichiro itojun Hagino 	}
56482cd038dSYoshinobu Inoue 
56582cd038dSYoshinobu Inoue 	/*
56682cd038dSYoshinobu Inoue 	 * Store NXT to the original.
56782cd038dSYoshinobu Inoue 	 */
56882cd038dSYoshinobu Inoue 	{
56982cd038dSYoshinobu Inoue 		char *prvnxtp = ip6_get_prevhdr(m, offset); /* XXX */
57082cd038dSYoshinobu Inoue 		*prvnxtp = nxt;
57182cd038dSYoshinobu Inoue 	}
57282cd038dSYoshinobu Inoue 
57382cd038dSYoshinobu Inoue 	frag6_remque(q6);
574603724d3SBjoern A. Zeeb 	V_frag6_nfrags -= q6->ip6q_nfrag;
5754b908c8bSRobert Watson #ifdef MAC
5764b908c8bSRobert Watson 	mac_ip6q_reassemble(q6, m);
5774b908c8bSRobert Watson 	mac_ip6q_destroy(q6);
5784b908c8bSRobert Watson #endif
57982cd038dSYoshinobu Inoue 	free(q6, M_FTABLE);
580603724d3SBjoern A. Zeeb 	V_frag6_nfragpackets--;
58182cd038dSYoshinobu Inoue 
58282cd038dSYoshinobu Inoue 	if (m->m_flags & M_PKTHDR) { /* Isn't it always true? */
58382cd038dSYoshinobu Inoue 		int plen = 0;
58482cd038dSYoshinobu Inoue 		for (t = m; t; t = t->m_next)
58582cd038dSYoshinobu Inoue 			plen += t->m_len;
58682cd038dSYoshinobu Inoue 		m->m_pkthdr.len = plen;
58782cd038dSYoshinobu Inoue 	}
58882cd038dSYoshinobu Inoue 
589603724d3SBjoern A. Zeeb 	V_ip6stat.ip6s_reassembled++;
59082cd038dSYoshinobu Inoue 	in6_ifstat_inc(dstifp, ifs6_reass_ok);
59182cd038dSYoshinobu Inoue 
59282cd038dSYoshinobu Inoue 	/*
59382cd038dSYoshinobu Inoue 	 * Tell launch routine the next header
59482cd038dSYoshinobu Inoue 	 */
59582cd038dSYoshinobu Inoue 
59682cd038dSYoshinobu Inoue 	*mp = m;
59782cd038dSYoshinobu Inoue 	*offp = offset;
59882cd038dSYoshinobu Inoue 
5999888c401SHajimu UMEMOTO 	IP6Q_UNLOCK();
60082cd038dSYoshinobu Inoue 	return nxt;
60182cd038dSYoshinobu Inoue 
60282cd038dSYoshinobu Inoue  dropfrag:
60331e8f7e5SHajimu UMEMOTO 	IP6Q_UNLOCK();
60482cd038dSYoshinobu Inoue 	in6_ifstat_inc(dstifp, ifs6_reass_fail);
605603724d3SBjoern A. Zeeb 	V_ip6stat.ip6s_fragdropped++;
60682cd038dSYoshinobu Inoue 	m_freem(m);
60782cd038dSYoshinobu Inoue 	return IPPROTO_DONE;
60882cd038dSYoshinobu Inoue }
60982cd038dSYoshinobu Inoue 
61082cd038dSYoshinobu Inoue /*
61182cd038dSYoshinobu Inoue  * Free a fragment reassembly header and all
61282cd038dSYoshinobu Inoue  * associated datagrams.
61382cd038dSYoshinobu Inoue  */
61482cd038dSYoshinobu Inoue void
6151272577eSXin LI frag6_freef(struct ip6q *q6)
61682cd038dSYoshinobu Inoue {
6178b615593SMarko Zec 	INIT_VNET_INET6(curvnet);
61882cd038dSYoshinobu Inoue 	struct ip6asfrag *af6, *down6;
61982cd038dSYoshinobu Inoue 
6209bcf770cSHajimu UMEMOTO 	IP6Q_LOCK_ASSERT();
6219888c401SHajimu UMEMOTO 
62282cd038dSYoshinobu Inoue 	for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6;
62382cd038dSYoshinobu Inoue 	     af6 = down6) {
62482cd038dSYoshinobu Inoue 		struct mbuf *m = IP6_REASS_MBUF(af6);
62582cd038dSYoshinobu Inoue 
62682cd038dSYoshinobu Inoue 		down6 = af6->ip6af_down;
62782cd038dSYoshinobu Inoue 		frag6_deq(af6);
62882cd038dSYoshinobu Inoue 
62982cd038dSYoshinobu Inoue 		/*
63082cd038dSYoshinobu Inoue 		 * Return ICMP time exceeded error for the 1st fragment.
63182cd038dSYoshinobu Inoue 		 * Just free other fragments.
63282cd038dSYoshinobu Inoue 		 */
63382cd038dSYoshinobu Inoue 		if (af6->ip6af_off == 0) {
63482cd038dSYoshinobu Inoue 			struct ip6_hdr *ip6;
63582cd038dSYoshinobu Inoue 
63682cd038dSYoshinobu Inoue 			/* adjust pointer */
63782cd038dSYoshinobu Inoue 			ip6 = mtod(m, struct ip6_hdr *);
63882cd038dSYoshinobu Inoue 
63906cd0a3fSHajimu UMEMOTO 			/* restore source and destination addresses */
64082cd038dSYoshinobu Inoue 			ip6->ip6_src = q6->ip6q_src;
64182cd038dSYoshinobu Inoue 			ip6->ip6_dst = q6->ip6q_dst;
64282cd038dSYoshinobu Inoue 
64382cd038dSYoshinobu Inoue 			icmp6_error(m, ICMP6_TIME_EXCEEDED,
64482cd038dSYoshinobu Inoue 				    ICMP6_TIME_EXCEED_REASSEMBLY, 0);
645686cdd19SJun-ichiro itojun Hagino 		} else
64682cd038dSYoshinobu Inoue 			m_freem(m);
647686cdd19SJun-ichiro itojun Hagino 		free(af6, M_FTABLE);
64882cd038dSYoshinobu Inoue 	}
64982cd038dSYoshinobu Inoue 	frag6_remque(q6);
650603724d3SBjoern A. Zeeb 	V_frag6_nfrags -= q6->ip6q_nfrag;
6514b908c8bSRobert Watson #ifdef MAC
6524b908c8bSRobert Watson 	mac_ip6q_destroy(q6);
6534b908c8bSRobert Watson #endif
65482cd038dSYoshinobu Inoue 	free(q6, M_FTABLE);
655603724d3SBjoern A. Zeeb 	V_frag6_nfragpackets--;
65682cd038dSYoshinobu Inoue }
65782cd038dSYoshinobu Inoue 
65882cd038dSYoshinobu Inoue /*
65982cd038dSYoshinobu Inoue  * Put an ip fragment on a reassembly chain.
66082cd038dSYoshinobu Inoue  * Like insque, but pointers in middle of structure.
66182cd038dSYoshinobu Inoue  */
66282cd038dSYoshinobu Inoue void
6631272577eSXin LI frag6_enq(struct ip6asfrag *af6, struct ip6asfrag *up6)
66482cd038dSYoshinobu Inoue {
6659888c401SHajimu UMEMOTO 
6669bcf770cSHajimu UMEMOTO 	IP6Q_LOCK_ASSERT();
6679888c401SHajimu UMEMOTO 
66882cd038dSYoshinobu Inoue 	af6->ip6af_up = up6;
66982cd038dSYoshinobu Inoue 	af6->ip6af_down = up6->ip6af_down;
67082cd038dSYoshinobu Inoue 	up6->ip6af_down->ip6af_up = af6;
67182cd038dSYoshinobu Inoue 	up6->ip6af_down = af6;
67282cd038dSYoshinobu Inoue }
67382cd038dSYoshinobu Inoue 
67482cd038dSYoshinobu Inoue /*
67582cd038dSYoshinobu Inoue  * To frag6_enq as remque is to insque.
67682cd038dSYoshinobu Inoue  */
67782cd038dSYoshinobu Inoue void
6781272577eSXin LI frag6_deq(struct ip6asfrag *af6)
67982cd038dSYoshinobu Inoue {
6809888c401SHajimu UMEMOTO 
6819bcf770cSHajimu UMEMOTO 	IP6Q_LOCK_ASSERT();
6829888c401SHajimu UMEMOTO 
68382cd038dSYoshinobu Inoue 	af6->ip6af_up->ip6af_down = af6->ip6af_down;
68482cd038dSYoshinobu Inoue 	af6->ip6af_down->ip6af_up = af6->ip6af_up;
68582cd038dSYoshinobu Inoue }
68682cd038dSYoshinobu Inoue 
68782cd038dSYoshinobu Inoue void
6881272577eSXin LI frag6_insque(struct ip6q *new, struct ip6q *old)
68982cd038dSYoshinobu Inoue {
6909888c401SHajimu UMEMOTO 
6919bcf770cSHajimu UMEMOTO 	IP6Q_LOCK_ASSERT();
6929888c401SHajimu UMEMOTO 
69382cd038dSYoshinobu Inoue 	new->ip6q_prev = old;
69482cd038dSYoshinobu Inoue 	new->ip6q_next = old->ip6q_next;
69582cd038dSYoshinobu Inoue 	old->ip6q_next->ip6q_prev= new;
69682cd038dSYoshinobu Inoue 	old->ip6q_next = new;
69782cd038dSYoshinobu Inoue }
69882cd038dSYoshinobu Inoue 
69982cd038dSYoshinobu Inoue void
7001272577eSXin LI frag6_remque(struct ip6q *p6)
70182cd038dSYoshinobu Inoue {
7029888c401SHajimu UMEMOTO 
7039bcf770cSHajimu UMEMOTO 	IP6Q_LOCK_ASSERT();
7049888c401SHajimu UMEMOTO 
70582cd038dSYoshinobu Inoue 	p6->ip6q_prev->ip6q_next = p6->ip6q_next;
70682cd038dSYoshinobu Inoue 	p6->ip6q_next->ip6q_prev = p6->ip6q_prev;
70782cd038dSYoshinobu Inoue }
70882cd038dSYoshinobu Inoue 
70982cd038dSYoshinobu Inoue /*
71033841545SHajimu UMEMOTO  * IPv6 reassembling timer processing;
71182cd038dSYoshinobu Inoue  * if a timer expires on a reassembly
71282cd038dSYoshinobu Inoue  * queue, discard it.
71382cd038dSYoshinobu Inoue  */
71482cd038dSYoshinobu Inoue void
7151272577eSXin LI frag6_slowtimo(void)
71682cd038dSYoshinobu Inoue {
7178b615593SMarko Zec 	VNET_ITERATOR_DECL(vnet_iter);
71882cd038dSYoshinobu Inoue 	struct ip6q *q6;
71982cd038dSYoshinobu Inoue 
7209888c401SHajimu UMEMOTO 	IP6Q_LOCK();
7218b615593SMarko Zec 	VNET_LIST_RLOCK();
7228b615593SMarko Zec 	VNET_FOREACH(vnet_iter) {
7238b615593SMarko Zec 		CURVNET_SET(vnet_iter);
7248b615593SMarko Zec 		INIT_VNET_INET6(vnet_iter);
725603724d3SBjoern A. Zeeb 		q6 = V_ip6q.ip6q_next;
72682cd038dSYoshinobu Inoue 		if (q6)
727603724d3SBjoern A. Zeeb 			while (q6 != &V_ip6q) {
72882cd038dSYoshinobu Inoue 				--q6->ip6q_ttl;
72982cd038dSYoshinobu Inoue 				q6 = q6->ip6q_next;
73082cd038dSYoshinobu Inoue 				if (q6->ip6q_prev->ip6q_ttl == 0) {
731603724d3SBjoern A. Zeeb 					V_ip6stat.ip6s_fragtimeout++;
73282cd038dSYoshinobu Inoue 					/* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */
73382cd038dSYoshinobu Inoue 					frag6_freef(q6->ip6q_prev);
73482cd038dSYoshinobu Inoue 				}
73582cd038dSYoshinobu Inoue 			}
73682cd038dSYoshinobu Inoue 		/*
73782cd038dSYoshinobu Inoue 		 * If we are over the maximum number of fragments
73882cd038dSYoshinobu Inoue 		 * (due to the limit being lowered), drain off
73982cd038dSYoshinobu Inoue 		 * enough to get down to the new limit.
74082cd038dSYoshinobu Inoue 		 */
741603724d3SBjoern A. Zeeb 		while (V_frag6_nfragpackets > (u_int)V_ip6_maxfragpackets &&
742603724d3SBjoern A. Zeeb 		    V_ip6q.ip6q_prev) {
743603724d3SBjoern A. Zeeb 			V_ip6stat.ip6s_fragoverflow++;
74482cd038dSYoshinobu Inoue 			/* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */
745603724d3SBjoern A. Zeeb 			frag6_freef(V_ip6q.ip6q_prev);
74682cd038dSYoshinobu Inoue 		}
7478b615593SMarko Zec 		CURVNET_RESTORE();
7488b615593SMarko Zec 	}
7498b615593SMarko Zec 	VNET_LIST_RUNLOCK();
7509888c401SHajimu UMEMOTO 	IP6Q_UNLOCK();
751686cdd19SJun-ichiro itojun Hagino 
752686cdd19SJun-ichiro itojun Hagino #if 0
753686cdd19SJun-ichiro itojun Hagino 	/*
754686cdd19SJun-ichiro itojun Hagino 	 * Routing changes might produce a better route than we last used;
755686cdd19SJun-ichiro itojun Hagino 	 * make sure we notice eventually, even if forwarding only for one
756686cdd19SJun-ichiro itojun Hagino 	 * destination and the cache is never replaced.
757686cdd19SJun-ichiro itojun Hagino 	 */
758603724d3SBjoern A. Zeeb 	if (V_ip6_forward_rt.ro_rt) {
759603724d3SBjoern A. Zeeb 		RTFREE(V_ip6_forward_rt.ro_rt);
760603724d3SBjoern A. Zeeb 		V_ip6_forward_rt.ro_rt = 0;
761686cdd19SJun-ichiro itojun Hagino 	}
762686cdd19SJun-ichiro itojun Hagino 	if (ipsrcchk_rt.ro_rt) {
763686cdd19SJun-ichiro itojun Hagino 		RTFREE(ipsrcchk_rt.ro_rt);
764686cdd19SJun-ichiro itojun Hagino 		ipsrcchk_rt.ro_rt = 0;
765686cdd19SJun-ichiro itojun Hagino 	}
766686cdd19SJun-ichiro itojun Hagino #endif
76782cd038dSYoshinobu Inoue }
76882cd038dSYoshinobu Inoue 
76982cd038dSYoshinobu Inoue /*
77082cd038dSYoshinobu Inoue  * Drain off all datagram fragments.
77182cd038dSYoshinobu Inoue  */
77282cd038dSYoshinobu Inoue void
7731272577eSXin LI frag6_drain(void)
77482cd038dSYoshinobu Inoue {
7758b615593SMarko Zec 	VNET_ITERATOR_DECL(vnet_iter);
7769888c401SHajimu UMEMOTO 
77731e8f7e5SHajimu UMEMOTO 	if (IP6Q_TRYLOCK() == 0)
77882cd038dSYoshinobu Inoue 		return;
7798b615593SMarko Zec 	VNET_LIST_RLOCK();
7808b615593SMarko Zec 	VNET_FOREACH(vnet_iter) {
7818b615593SMarko Zec 		CURVNET_SET(vnet_iter);
7828b615593SMarko Zec 		INIT_VNET_INET6(vnet_iter);
783603724d3SBjoern A. Zeeb 		while (V_ip6q.ip6q_next != &V_ip6q) {
784603724d3SBjoern A. Zeeb 			V_ip6stat.ip6s_fragdropped++;
78582cd038dSYoshinobu Inoue 			/* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */
786603724d3SBjoern A. Zeeb 			frag6_freef(V_ip6q.ip6q_next);
78782cd038dSYoshinobu Inoue 		}
7888b615593SMarko Zec 		CURVNET_RESTORE();
7898b615593SMarko Zec 	}
7908b615593SMarko Zec 	VNET_LIST_RUNLOCK();
7919888c401SHajimu UMEMOTO 	IP6Q_UNLOCK();
79282cd038dSYoshinobu Inoue }
793