xref: /freebsd/sys/netinet6/frag6.c (revision 40e39bbb)
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 
482cd038dSYoshinobu Inoue /*
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 
33de27a78aSHajimu UMEMOTO #include "opt_random_ip_id.h"
34de27a78aSHajimu UMEMOTO 
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>
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 
7133841545SHajimu UMEMOTO /* XXX we eventually need splreass6, or some real semaphore */
7282cd038dSYoshinobu Inoue int frag6_doing_reass;
7382cd038dSYoshinobu Inoue u_int frag6_nfragpackets;
7482cd038dSYoshinobu Inoue struct	ip6q ip6q;	/* ip6 reassemble queue */
7582cd038dSYoshinobu Inoue 
76686cdd19SJun-ichiro itojun Hagino /* FreeBSD tweak */
77959b7375SPoul-Henning Kamp static MALLOC_DEFINE(M_FTABLE, "fragment", "fragment reassembly header");
78686cdd19SJun-ichiro itojun Hagino 
7982cd038dSYoshinobu Inoue /*
8082cd038dSYoshinobu Inoue  * Initialise reassembly queue and fragment identifier.
8182cd038dSYoshinobu Inoue  */
8282cd038dSYoshinobu Inoue void
8382cd038dSYoshinobu Inoue frag6_init()
8482cd038dSYoshinobu Inoue {
8582cd038dSYoshinobu Inoue 
8696c2b042SJesper Skriver 	ip6_maxfragpackets = nmbclusters / 4;
8796c2b042SJesper Skriver 
88de27a78aSHajimu UMEMOTO #ifndef RANDOM_IP_ID
8918193b6fSHajimu UMEMOTO 	ip6_id = arc4random();
908513854dSHajimu UMEMOTO #endif
91686cdd19SJun-ichiro itojun Hagino 	ip6q.ip6q_next = ip6q.ip6q_prev = &ip6q;
9282cd038dSYoshinobu Inoue }
9382cd038dSYoshinobu Inoue 
9482cd038dSYoshinobu Inoue /*
95686cdd19SJun-ichiro itojun Hagino  * In RFC2460, fragment and reassembly rule do not agree with each other,
96686cdd19SJun-ichiro itojun Hagino  * in terms of next header field handling in fragment header.
97686cdd19SJun-ichiro itojun Hagino  * While the sender will use the same value for all of the fragmented packets,
98686cdd19SJun-ichiro itojun Hagino  * receiver is suggested not to check the consistency.
99686cdd19SJun-ichiro itojun Hagino  *
100686cdd19SJun-ichiro itojun Hagino  * fragment rule (p20):
101686cdd19SJun-ichiro itojun Hagino  *	(2) A Fragment header containing:
102686cdd19SJun-ichiro itojun Hagino  *	The Next Header value that identifies the first header of
103686cdd19SJun-ichiro itojun Hagino  *	the Fragmentable Part of the original packet.
104686cdd19SJun-ichiro itojun Hagino  *		-> next header field is same for all fragments
105686cdd19SJun-ichiro itojun Hagino  *
106686cdd19SJun-ichiro itojun Hagino  * reassembly rule (p21):
107686cdd19SJun-ichiro itojun Hagino  *	The Next Header field of the last header of the Unfragmentable
108686cdd19SJun-ichiro itojun Hagino  *	Part is obtained from the Next Header field of the first
109686cdd19SJun-ichiro itojun Hagino  *	fragment's Fragment header.
110686cdd19SJun-ichiro itojun Hagino  *		-> should grab it from the first fragment only
111686cdd19SJun-ichiro itojun Hagino  *
112686cdd19SJun-ichiro itojun Hagino  * The following note also contradicts with fragment rule - noone is going to
113686cdd19SJun-ichiro itojun Hagino  * send different fragment with different next header field.
114686cdd19SJun-ichiro itojun Hagino  *
115686cdd19SJun-ichiro itojun Hagino  * additional note (p22):
116686cdd19SJun-ichiro itojun Hagino  *	The Next Header values in the Fragment headers of different
117686cdd19SJun-ichiro itojun Hagino  *	fragments of the same original packet may differ.  Only the value
118686cdd19SJun-ichiro itojun Hagino  *	from the Offset zero fragment packet is used for reassembly.
119686cdd19SJun-ichiro itojun Hagino  *		-> should grab it from the first fragment only
120686cdd19SJun-ichiro itojun Hagino  *
121686cdd19SJun-ichiro itojun Hagino  * There is no explicit reason given in the RFC.  Historical reason maybe?
122686cdd19SJun-ichiro itojun Hagino  */
123686cdd19SJun-ichiro itojun Hagino /*
12482cd038dSYoshinobu Inoue  * Fragment input
12582cd038dSYoshinobu Inoue  */
12682cd038dSYoshinobu Inoue int
12782cd038dSYoshinobu Inoue frag6_input(mp, offp, proto)
12882cd038dSYoshinobu Inoue 	struct mbuf **mp;
12982cd038dSYoshinobu Inoue 	int *offp, proto;
13082cd038dSYoshinobu Inoue {
13182cd038dSYoshinobu Inoue 	struct mbuf *m = *mp, *t;
13282cd038dSYoshinobu Inoue 	struct ip6_hdr *ip6;
13382cd038dSYoshinobu Inoue 	struct ip6_frag *ip6f;
13482cd038dSYoshinobu Inoue 	struct ip6q *q6;
135686cdd19SJun-ichiro itojun Hagino 	struct ip6asfrag *af6, *ip6af, *af6dwn;
13682cd038dSYoshinobu Inoue 	int offset = *offp, nxt, i, next;
13782cd038dSYoshinobu Inoue 	int first_frag = 0;
138686cdd19SJun-ichiro itojun Hagino 	int fragoff, frgpartlen;	/* must be larger than u_int16_t */
13982cd038dSYoshinobu Inoue 	struct ifnet *dstifp;
14082cd038dSYoshinobu Inoue #ifdef IN6_IFSTAT_STRICT
14182cd038dSYoshinobu Inoue 	static struct route_in6 ro;
14282cd038dSYoshinobu Inoue 	struct sockaddr_in6 *dst;
14382cd038dSYoshinobu Inoue #endif
14482cd038dSYoshinobu Inoue 
14582cd038dSYoshinobu Inoue 	ip6 = mtod(m, struct ip6_hdr *);
146686cdd19SJun-ichiro itojun Hagino #ifndef PULLDOWN_TEST
147686cdd19SJun-ichiro itojun Hagino 	IP6_EXTHDR_CHECK(m, offset, sizeof(struct ip6_frag), IPPROTO_DONE);
14882cd038dSYoshinobu Inoue 	ip6f = (struct ip6_frag *)((caddr_t)ip6 + offset);
149686cdd19SJun-ichiro itojun Hagino #else
150686cdd19SJun-ichiro itojun Hagino 	IP6_EXTHDR_GET(ip6f, struct ip6_frag *, m, offset, sizeof(*ip6f));
151686cdd19SJun-ichiro itojun Hagino 	if (ip6f == NULL)
15240e39bbbSHajimu UMEMOTO 		return (IPPROTO_DONE);
153686cdd19SJun-ichiro itojun Hagino #endif
15482cd038dSYoshinobu Inoue 
15582cd038dSYoshinobu Inoue 	dstifp = NULL;
15682cd038dSYoshinobu Inoue #ifdef IN6_IFSTAT_STRICT
15782cd038dSYoshinobu Inoue 	/* find the destination interface of the packet. */
15882cd038dSYoshinobu Inoue 	dst = (struct sockaddr_in6 *)&ro.ro_dst;
15982cd038dSYoshinobu Inoue 	if (ro.ro_rt
16082cd038dSYoshinobu Inoue 	 && ((ro.ro_rt->rt_flags & RTF_UP) == 0
16182cd038dSYoshinobu Inoue 	  || !IN6_ARE_ADDR_EQUAL(&dst->sin6_addr, &ip6->ip6_dst))) {
16282cd038dSYoshinobu Inoue 		RTFREE(ro.ro_rt);
16382cd038dSYoshinobu Inoue 		ro.ro_rt = (struct rtentry *)0;
16482cd038dSYoshinobu Inoue 	}
16582cd038dSYoshinobu Inoue 	if (ro.ro_rt == NULL) {
16682cd038dSYoshinobu Inoue 		bzero(dst, sizeof(*dst));
16782cd038dSYoshinobu Inoue 		dst->sin6_family = AF_INET6;
16882cd038dSYoshinobu Inoue 		dst->sin6_len = sizeof(struct sockaddr_in6);
16982cd038dSYoshinobu Inoue 		dst->sin6_addr = ip6->ip6_dst;
17082cd038dSYoshinobu Inoue 	}
171ae5bcbffSYoshinobu Inoue 	rtalloc((struct route *)&ro);
17282cd038dSYoshinobu Inoue 	if (ro.ro_rt != NULL && ro.ro_rt->rt_ifa != NULL)
17382cd038dSYoshinobu Inoue 		dstifp = ((struct in6_ifaddr *)ro.ro_rt->rt_ifa)->ia_ifp;
17482cd038dSYoshinobu Inoue #else
17582cd038dSYoshinobu Inoue 	/* we are violating the spec, this is not the destination interface */
17682cd038dSYoshinobu Inoue 	if ((m->m_flags & M_PKTHDR) != 0)
17782cd038dSYoshinobu Inoue 		dstifp = m->m_pkthdr.rcvif;
17882cd038dSYoshinobu Inoue #endif
17982cd038dSYoshinobu Inoue 
18082cd038dSYoshinobu Inoue 	/* jumbo payload can't contain a fragment header */
18182cd038dSYoshinobu Inoue 	if (ip6->ip6_plen == 0) {
18282cd038dSYoshinobu Inoue 		icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, offset);
18382cd038dSYoshinobu Inoue 		in6_ifstat_inc(dstifp, ifs6_reass_fail);
18482cd038dSYoshinobu Inoue 		return IPPROTO_DONE;
18582cd038dSYoshinobu Inoue 	}
18682cd038dSYoshinobu Inoue 
18782cd038dSYoshinobu Inoue 	/*
18882cd038dSYoshinobu Inoue 	 * check whether fragment packet's fragment length is
18982cd038dSYoshinobu Inoue 	 * multiple of 8 octets.
19082cd038dSYoshinobu Inoue 	 * sizeof(struct ip6_frag) == 8
19182cd038dSYoshinobu Inoue 	 * sizeof(struct ip6_hdr) = 40
19282cd038dSYoshinobu Inoue 	 */
19382cd038dSYoshinobu Inoue 	if ((ip6f->ip6f_offlg & IP6F_MORE_FRAG) &&
19482cd038dSYoshinobu Inoue 	    (((ntohs(ip6->ip6_plen) - offset) & 0x7) != 0)) {
19582cd038dSYoshinobu Inoue 		icmp6_error(m, ICMP6_PARAM_PROB,
19682cd038dSYoshinobu Inoue 			    ICMP6_PARAMPROB_HEADER,
197686cdd19SJun-ichiro itojun Hagino 			    offsetof(struct ip6_hdr, ip6_plen));
19882cd038dSYoshinobu Inoue 		in6_ifstat_inc(dstifp, ifs6_reass_fail);
19982cd038dSYoshinobu Inoue 		return IPPROTO_DONE;
20082cd038dSYoshinobu Inoue 	}
20182cd038dSYoshinobu Inoue 
20282cd038dSYoshinobu Inoue 	ip6stat.ip6s_fragments++;
20382cd038dSYoshinobu Inoue 	in6_ifstat_inc(dstifp, ifs6_reass_reqd);
20482cd038dSYoshinobu Inoue 
205686cdd19SJun-ichiro itojun Hagino 	/* offset now points to data portion */
20682cd038dSYoshinobu Inoue 	offset += sizeof(struct ip6_frag);
20782cd038dSYoshinobu Inoue 
20833841545SHajimu UMEMOTO 	frag6_doing_reass = 1;
20933841545SHajimu UMEMOTO 
21082cd038dSYoshinobu Inoue 	for (q6 = ip6q.ip6q_next; q6 != &ip6q; q6 = q6->ip6q_next)
21182cd038dSYoshinobu Inoue 		if (ip6f->ip6f_ident == q6->ip6q_ident &&
21282cd038dSYoshinobu Inoue 		    IN6_ARE_ADDR_EQUAL(&ip6->ip6_src, &q6->ip6q_src) &&
21382cd038dSYoshinobu Inoue 		    IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst, &q6->ip6q_dst))
21482cd038dSYoshinobu Inoue 			break;
21582cd038dSYoshinobu Inoue 
21682cd038dSYoshinobu Inoue 	if (q6 == &ip6q) {
21782cd038dSYoshinobu Inoue 		/*
21882cd038dSYoshinobu Inoue 		 * the first fragment to arrive, create a reassembly queue.
21982cd038dSYoshinobu Inoue 		 */
22082cd038dSYoshinobu Inoue 		first_frag = 1;
22182cd038dSYoshinobu Inoue 
22282cd038dSYoshinobu Inoue 		/*
22382cd038dSYoshinobu Inoue 		 * Enforce upper bound on number of fragmented packets
22482cd038dSYoshinobu Inoue 		 * for which we attempt reassembly;
22582cd038dSYoshinobu Inoue 		 * If maxfrag is 0, never accept fragments.
22682cd038dSYoshinobu Inoue 		 * If maxfrag is -1, accept all fragments without limitation.
22782cd038dSYoshinobu Inoue 		 */
22833841545SHajimu UMEMOTO 		if (ip6_maxfragpackets < 0)
22933841545SHajimu UMEMOTO 			;
23033841545SHajimu UMEMOTO 		else if (frag6_nfragpackets >= (u_int)ip6_maxfragpackets)
23133841545SHajimu UMEMOTO 			goto dropfrag;
23233841545SHajimu UMEMOTO 		frag6_nfragpackets++;
23382cd038dSYoshinobu Inoue 		q6 = (struct ip6q *)malloc(sizeof(struct ip6q), M_FTABLE,
234a163d034SWarner Losh 			M_DONTWAIT);
23582cd038dSYoshinobu Inoue 		if (q6 == NULL)
23682cd038dSYoshinobu Inoue 			goto dropfrag;
237686cdd19SJun-ichiro itojun Hagino 		bzero(q6, sizeof(*q6));
23882cd038dSYoshinobu Inoue 
23982cd038dSYoshinobu Inoue 		frag6_insque(q6, &ip6q);
24082cd038dSYoshinobu Inoue 
241686cdd19SJun-ichiro itojun Hagino 		/* ip6q_nxt will be filled afterwards, from 1st fragment */
24282cd038dSYoshinobu Inoue 		q6->ip6q_down	= q6->ip6q_up = (struct ip6asfrag *)q6;
243686cdd19SJun-ichiro itojun Hagino #ifdef notyet
244686cdd19SJun-ichiro itojun Hagino 		q6->ip6q_nxtp	= (u_char *)nxtp;
245686cdd19SJun-ichiro itojun Hagino #endif
24682cd038dSYoshinobu Inoue 		q6->ip6q_ident	= ip6f->ip6f_ident;
24782cd038dSYoshinobu Inoue 		q6->ip6q_arrive = 0; /* Is it used anywhere? */
24882cd038dSYoshinobu Inoue 		q6->ip6q_ttl 	= IPV6_FRAGTTL;
24982cd038dSYoshinobu Inoue 		q6->ip6q_src	= ip6->ip6_src;
25082cd038dSYoshinobu Inoue 		q6->ip6q_dst	= ip6->ip6_dst;
25182cd038dSYoshinobu Inoue 		q6->ip6q_unfrglen = -1;	/* The 1st fragment has not arrived. */
25282cd038dSYoshinobu Inoue 	}
25382cd038dSYoshinobu Inoue 
25482cd038dSYoshinobu Inoue 	/*
25582cd038dSYoshinobu Inoue 	 * If it's the 1st fragment, record the length of the
25682cd038dSYoshinobu Inoue 	 * unfragmentable part and the next header of the fragment header.
25782cd038dSYoshinobu Inoue 	 */
25882cd038dSYoshinobu Inoue 	fragoff = ntohs(ip6f->ip6f_offlg & IP6F_OFF_MASK);
25982cd038dSYoshinobu Inoue 	if (fragoff == 0) {
26082cd038dSYoshinobu Inoue 		q6->ip6q_unfrglen = offset - sizeof(struct ip6_hdr)
26182cd038dSYoshinobu Inoue 			- sizeof(struct ip6_frag);
26282cd038dSYoshinobu Inoue 		q6->ip6q_nxt = ip6f->ip6f_nxt;
26382cd038dSYoshinobu Inoue 	}
26482cd038dSYoshinobu Inoue 
26582cd038dSYoshinobu Inoue 	/*
26682cd038dSYoshinobu Inoue 	 * Check that the reassembled packet would not exceed 65535 bytes
26782cd038dSYoshinobu Inoue 	 * in size.
26882cd038dSYoshinobu Inoue 	 * If it would exceed, discard the fragment and return an ICMP error.
26982cd038dSYoshinobu Inoue 	 */
27082cd038dSYoshinobu Inoue 	frgpartlen = sizeof(struct ip6_hdr) + ntohs(ip6->ip6_plen) - offset;
27182cd038dSYoshinobu Inoue 	if (q6->ip6q_unfrglen >= 0) {
27282cd038dSYoshinobu Inoue 		/* The 1st fragment has already arrived. */
27382cd038dSYoshinobu Inoue 		if (q6->ip6q_unfrglen + fragoff + frgpartlen > IPV6_MAXPACKET) {
27482cd038dSYoshinobu Inoue 			icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER,
275686cdd19SJun-ichiro itojun Hagino 				    offset - sizeof(struct ip6_frag) +
276686cdd19SJun-ichiro itojun Hagino 					offsetof(struct ip6_frag, ip6f_offlg));
27733841545SHajimu UMEMOTO 			frag6_doing_reass = 0;
27882cd038dSYoshinobu Inoue 			return (IPPROTO_DONE);
27982cd038dSYoshinobu Inoue 		}
28082cd038dSYoshinobu Inoue 	}
28182cd038dSYoshinobu Inoue 	else if (fragoff + frgpartlen > IPV6_MAXPACKET) {
28282cd038dSYoshinobu Inoue 		icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER,
283686cdd19SJun-ichiro itojun Hagino 			    offset - sizeof(struct ip6_frag) +
284686cdd19SJun-ichiro itojun Hagino 				offsetof(struct ip6_frag, ip6f_offlg));
28533841545SHajimu UMEMOTO 		frag6_doing_reass = 0;
28682cd038dSYoshinobu Inoue 		return (IPPROTO_DONE);
28782cd038dSYoshinobu Inoue 	}
28882cd038dSYoshinobu Inoue 	/*
28982cd038dSYoshinobu Inoue 	 * If it's the first fragment, do the above check for each
29082cd038dSYoshinobu Inoue 	 * fragment already stored in the reassembly queue.
29182cd038dSYoshinobu Inoue 	 */
29282cd038dSYoshinobu Inoue 	if (fragoff == 0) {
29382cd038dSYoshinobu Inoue 		for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6;
29482cd038dSYoshinobu Inoue 		     af6 = af6dwn) {
29582cd038dSYoshinobu Inoue 			af6dwn = af6->ip6af_down;
29682cd038dSYoshinobu Inoue 
29782cd038dSYoshinobu Inoue 			if (q6->ip6q_unfrglen + af6->ip6af_off + af6->ip6af_frglen >
29882cd038dSYoshinobu Inoue 			    IPV6_MAXPACKET) {
29982cd038dSYoshinobu Inoue 				struct mbuf *merr = IP6_REASS_MBUF(af6);
30082cd038dSYoshinobu Inoue 				struct ip6_hdr *ip6err;
30182cd038dSYoshinobu Inoue 				int erroff = af6->ip6af_offset;
30282cd038dSYoshinobu Inoue 
30382cd038dSYoshinobu Inoue 				/* dequeue the fragment. */
30482cd038dSYoshinobu Inoue 				frag6_deq(af6);
305686cdd19SJun-ichiro itojun Hagino 				free(af6, M_FTABLE);
30682cd038dSYoshinobu Inoue 
30782cd038dSYoshinobu Inoue 				/* adjust pointer. */
30882cd038dSYoshinobu Inoue 				ip6err = mtod(merr, struct ip6_hdr *);
30982cd038dSYoshinobu Inoue 
31082cd038dSYoshinobu Inoue 				/*
31182cd038dSYoshinobu Inoue 				 * Restore source and destination addresses
31282cd038dSYoshinobu Inoue 				 * in the erroneous IPv6 header.
31382cd038dSYoshinobu Inoue 				 */
31482cd038dSYoshinobu Inoue 				ip6err->ip6_src = q6->ip6q_src;
31582cd038dSYoshinobu Inoue 				ip6err->ip6_dst = q6->ip6q_dst;
31682cd038dSYoshinobu Inoue 
31782cd038dSYoshinobu Inoue 				icmp6_error(merr, ICMP6_PARAM_PROB,
31882cd038dSYoshinobu Inoue 					    ICMP6_PARAMPROB_HEADER,
319686cdd19SJun-ichiro itojun Hagino 					    erroff - sizeof(struct ip6_frag) +
320686cdd19SJun-ichiro itojun Hagino 						offsetof(struct ip6_frag, ip6f_offlg));
32182cd038dSYoshinobu Inoue 			}
32282cd038dSYoshinobu Inoue 		}
32382cd038dSYoshinobu Inoue 	}
32482cd038dSYoshinobu Inoue 
325686cdd19SJun-ichiro itojun Hagino 	ip6af = (struct ip6asfrag *)malloc(sizeof(struct ip6asfrag), M_FTABLE,
326a163d034SWarner Losh 	    M_DONTWAIT);
327686cdd19SJun-ichiro itojun Hagino 	if (ip6af == NULL)
328686cdd19SJun-ichiro itojun Hagino 		goto dropfrag;
329686cdd19SJun-ichiro itojun Hagino 	bzero(ip6af, sizeof(*ip6af));
330686cdd19SJun-ichiro itojun Hagino 	ip6af->ip6af_head = ip6->ip6_flow;
331686cdd19SJun-ichiro itojun Hagino 	ip6af->ip6af_len = ip6->ip6_plen;
332686cdd19SJun-ichiro itojun Hagino 	ip6af->ip6af_nxt = ip6->ip6_nxt;
333686cdd19SJun-ichiro itojun Hagino 	ip6af->ip6af_hlim = ip6->ip6_hlim;
33482cd038dSYoshinobu Inoue 	ip6af->ip6af_mff = ip6f->ip6f_offlg & IP6F_MORE_FRAG;
33582cd038dSYoshinobu Inoue 	ip6af->ip6af_off = fragoff;
33682cd038dSYoshinobu Inoue 	ip6af->ip6af_frglen = frgpartlen;
33782cd038dSYoshinobu Inoue 	ip6af->ip6af_offset = offset;
33882cd038dSYoshinobu Inoue 	IP6_REASS_MBUF(ip6af) = m;
33982cd038dSYoshinobu Inoue 
34082cd038dSYoshinobu Inoue 	if (first_frag) {
34182cd038dSYoshinobu Inoue 		af6 = (struct ip6asfrag *)q6;
34282cd038dSYoshinobu Inoue 		goto insert;
34382cd038dSYoshinobu Inoue 	}
34482cd038dSYoshinobu Inoue 
34582cd038dSYoshinobu Inoue 	/*
34682cd038dSYoshinobu Inoue 	 * Find a segment which begins after this one does.
34782cd038dSYoshinobu Inoue 	 */
34882cd038dSYoshinobu Inoue 	for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6;
34982cd038dSYoshinobu Inoue 	     af6 = af6->ip6af_down)
35082cd038dSYoshinobu Inoue 		if (af6->ip6af_off > ip6af->ip6af_off)
35182cd038dSYoshinobu Inoue 			break;
35282cd038dSYoshinobu Inoue 
353686cdd19SJun-ichiro itojun Hagino #if 0
354686cdd19SJun-ichiro itojun Hagino 	/*
355686cdd19SJun-ichiro itojun Hagino 	 * If there is a preceding segment, it may provide some of
356686cdd19SJun-ichiro itojun Hagino 	 * our data already.  If so, drop the data from the incoming
357686cdd19SJun-ichiro itojun Hagino 	 * segment.  If it provides all of our data, drop us.
358686cdd19SJun-ichiro itojun Hagino 	 */
359686cdd19SJun-ichiro itojun Hagino 	if (af6->ip6af_up != (struct ip6asfrag *)q6) {
360686cdd19SJun-ichiro itojun Hagino 		i = af6->ip6af_up->ip6af_off + af6->ip6af_up->ip6af_frglen
361686cdd19SJun-ichiro itojun Hagino 			- ip6af->ip6af_off;
362686cdd19SJun-ichiro itojun Hagino 		if (i > 0) {
363686cdd19SJun-ichiro itojun Hagino 			if (i >= ip6af->ip6af_frglen)
364686cdd19SJun-ichiro itojun Hagino 				goto dropfrag;
365686cdd19SJun-ichiro itojun Hagino 			m_adj(IP6_REASS_MBUF(ip6af), i);
366686cdd19SJun-ichiro itojun Hagino 			ip6af->ip6af_off += i;
367686cdd19SJun-ichiro itojun Hagino 			ip6af->ip6af_frglen -= i;
368686cdd19SJun-ichiro itojun Hagino 		}
369686cdd19SJun-ichiro itojun Hagino 	}
370686cdd19SJun-ichiro itojun Hagino 
371686cdd19SJun-ichiro itojun Hagino 	/*
372686cdd19SJun-ichiro itojun Hagino 	 * While we overlap succeeding segments trim them or,
373686cdd19SJun-ichiro itojun Hagino 	 * if they are completely covered, dequeue them.
374686cdd19SJun-ichiro itojun Hagino 	 */
375686cdd19SJun-ichiro itojun Hagino 	while (af6 != (struct ip6asfrag *)q6 &&
376686cdd19SJun-ichiro itojun Hagino 	       ip6af->ip6af_off + ip6af->ip6af_frglen > af6->ip6af_off) {
377686cdd19SJun-ichiro itojun Hagino 		i = (ip6af->ip6af_off + ip6af->ip6af_frglen) - af6->ip6af_off;
378686cdd19SJun-ichiro itojun Hagino 		if (i < af6->ip6af_frglen) {
379686cdd19SJun-ichiro itojun Hagino 			af6->ip6af_frglen -= i;
380686cdd19SJun-ichiro itojun Hagino 			af6->ip6af_off += i;
381686cdd19SJun-ichiro itojun Hagino 			m_adj(IP6_REASS_MBUF(af6), i);
382686cdd19SJun-ichiro itojun Hagino 			break;
383686cdd19SJun-ichiro itojun Hagino 		}
384686cdd19SJun-ichiro itojun Hagino 		af6 = af6->ip6af_down;
385686cdd19SJun-ichiro itojun Hagino 		m_freem(IP6_REASS_MBUF(af6->ip6af_up));
386686cdd19SJun-ichiro itojun Hagino 		frag6_deq(af6->ip6af_up);
387686cdd19SJun-ichiro itojun Hagino 	}
388686cdd19SJun-ichiro itojun Hagino #else
38982cd038dSYoshinobu Inoue 	/*
39082cd038dSYoshinobu Inoue 	 * If the incoming framgent overlaps some existing fragments in
39182cd038dSYoshinobu Inoue 	 * the reassembly queue, drop it, since it is dangerous to override
39282cd038dSYoshinobu Inoue 	 * existing fragments from a security point of view.
39382cd038dSYoshinobu Inoue 	 */
39482cd038dSYoshinobu Inoue 	if (af6->ip6af_up != (struct ip6asfrag *)q6) {
39582cd038dSYoshinobu Inoue 		i = af6->ip6af_up->ip6af_off + af6->ip6af_up->ip6af_frglen
39682cd038dSYoshinobu Inoue 			- ip6af->ip6af_off;
39782cd038dSYoshinobu Inoue 		if (i > 0) {
3982bf76779SMunechika SUMIKAWA #if 0				/* suppress the noisy log */
39982cd038dSYoshinobu Inoue 			log(LOG_ERR, "%d bytes of a fragment from %s "
40082cd038dSYoshinobu Inoue 			    "overlaps the previous fragment\n",
40182cd038dSYoshinobu Inoue 			    i, ip6_sprintf(&q6->ip6q_src));
4022bf76779SMunechika SUMIKAWA #endif
4032bf76779SMunechika SUMIKAWA 			free(ip6af, M_FTABLE);
40482cd038dSYoshinobu Inoue 			goto dropfrag;
40582cd038dSYoshinobu Inoue 		}
40682cd038dSYoshinobu Inoue 	}
40782cd038dSYoshinobu Inoue 	if (af6 != (struct ip6asfrag *)q6) {
40882cd038dSYoshinobu Inoue 		i = (ip6af->ip6af_off + ip6af->ip6af_frglen) - af6->ip6af_off;
40982cd038dSYoshinobu Inoue 		if (i > 0) {
4102bf76779SMunechika SUMIKAWA #if 0				/* suppress the noisy log */
41182cd038dSYoshinobu Inoue 			log(LOG_ERR, "%d bytes of a fragment from %s "
41282cd038dSYoshinobu Inoue 			    "overlaps the succeeding fragment",
41382cd038dSYoshinobu Inoue 			    i, ip6_sprintf(&q6->ip6q_src));
4142bf76779SMunechika SUMIKAWA #endif
4152bf76779SMunechika SUMIKAWA 			free(ip6af, M_FTABLE);
41682cd038dSYoshinobu Inoue 			goto dropfrag;
41782cd038dSYoshinobu Inoue 		}
41882cd038dSYoshinobu Inoue 	}
419686cdd19SJun-ichiro itojun Hagino #endif
42082cd038dSYoshinobu Inoue 
42182cd038dSYoshinobu Inoue insert:
42282cd038dSYoshinobu Inoue 
42382cd038dSYoshinobu Inoue 	/*
42482cd038dSYoshinobu Inoue 	 * Stick new segment in its place;
42582cd038dSYoshinobu Inoue 	 * check for complete reassembly.
42682cd038dSYoshinobu Inoue 	 * Move to front of packet queue, as we are
42782cd038dSYoshinobu Inoue 	 * the most recently active fragmented packet.
42882cd038dSYoshinobu Inoue 	 */
42982cd038dSYoshinobu Inoue 	frag6_enq(ip6af, af6->ip6af_up);
430686cdd19SJun-ichiro itojun Hagino #if 0 /* xxx */
431686cdd19SJun-ichiro itojun Hagino 	if (q6 != ip6q.ip6q_next) {
432686cdd19SJun-ichiro itojun Hagino 		frag6_remque(q6);
433686cdd19SJun-ichiro itojun Hagino 		frag6_insque(q6, &ip6q);
434686cdd19SJun-ichiro itojun Hagino 	}
435686cdd19SJun-ichiro itojun Hagino #endif
43682cd038dSYoshinobu Inoue 	next = 0;
43782cd038dSYoshinobu Inoue 	for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6;
43882cd038dSYoshinobu Inoue 	     af6 = af6->ip6af_down) {
43982cd038dSYoshinobu Inoue 		if (af6->ip6af_off != next) {
44082cd038dSYoshinobu Inoue 			frag6_doing_reass = 0;
44182cd038dSYoshinobu Inoue 			return IPPROTO_DONE;
44282cd038dSYoshinobu Inoue 		}
44382cd038dSYoshinobu Inoue 		next += af6->ip6af_frglen;
44482cd038dSYoshinobu Inoue 	}
44582cd038dSYoshinobu Inoue 	if (af6->ip6af_up->ip6af_mff) {
44682cd038dSYoshinobu Inoue 		frag6_doing_reass = 0;
44782cd038dSYoshinobu Inoue 		return IPPROTO_DONE;
44882cd038dSYoshinobu Inoue 	}
44982cd038dSYoshinobu Inoue 
45082cd038dSYoshinobu Inoue 	/*
45182cd038dSYoshinobu Inoue 	 * Reassembly is complete; concatenate fragments.
45282cd038dSYoshinobu Inoue 	 */
45382cd038dSYoshinobu Inoue 	ip6af = q6->ip6q_down;
45482cd038dSYoshinobu Inoue 	t = m = IP6_REASS_MBUF(ip6af);
45582cd038dSYoshinobu Inoue 	af6 = ip6af->ip6af_down;
456686cdd19SJun-ichiro itojun Hagino 	frag6_deq(ip6af);
45782cd038dSYoshinobu Inoue 	while (af6 != (struct ip6asfrag *)q6) {
458686cdd19SJun-ichiro itojun Hagino 		af6dwn = af6->ip6af_down;
459686cdd19SJun-ichiro itojun Hagino 		frag6_deq(af6);
46082cd038dSYoshinobu Inoue 		while (t->m_next)
46182cd038dSYoshinobu Inoue 			t = t->m_next;
46282cd038dSYoshinobu Inoue 		t->m_next = IP6_REASS_MBUF(af6);
463686cdd19SJun-ichiro itojun Hagino 		m_adj(t->m_next, af6->ip6af_offset);
464686cdd19SJun-ichiro itojun Hagino 		free(af6, M_FTABLE);
465686cdd19SJun-ichiro itojun Hagino 		af6 = af6dwn;
46682cd038dSYoshinobu Inoue 	}
46782cd038dSYoshinobu Inoue 
46882cd038dSYoshinobu Inoue 	/* adjust offset to point where the original next header starts */
46982cd038dSYoshinobu Inoue 	offset = ip6af->ip6af_offset - sizeof(struct ip6_frag);
470686cdd19SJun-ichiro itojun Hagino 	free(ip6af, M_FTABLE);
471686cdd19SJun-ichiro itojun Hagino 	ip6 = mtod(m, struct ip6_hdr *);
47282cd038dSYoshinobu Inoue 	ip6->ip6_plen = htons((u_short)next + offset - sizeof(struct ip6_hdr));
47382cd038dSYoshinobu Inoue 	ip6->ip6_src = q6->ip6q_src;
47482cd038dSYoshinobu Inoue 	ip6->ip6_dst = q6->ip6q_dst;
47582cd038dSYoshinobu Inoue 	nxt = q6->ip6q_nxt;
476686cdd19SJun-ichiro itojun Hagino #ifdef notyet
477686cdd19SJun-ichiro itojun Hagino 	*q6->ip6q_nxtp = (u_char)(nxt & 0xff);
478686cdd19SJun-ichiro itojun Hagino #endif
47982cd038dSYoshinobu Inoue 
48082cd038dSYoshinobu Inoue 	/*
48182cd038dSYoshinobu Inoue 	 * Delete frag6 header with as a few cost as possible.
48282cd038dSYoshinobu Inoue 	 */
483686cdd19SJun-ichiro itojun Hagino 	if (offset < m->m_len) {
48482cd038dSYoshinobu Inoue 		ovbcopy((caddr_t)ip6, (caddr_t)ip6 + sizeof(struct ip6_frag),
48582cd038dSYoshinobu Inoue 			offset);
486686cdd19SJun-ichiro itojun Hagino 		m->m_data += sizeof(struct ip6_frag);
487686cdd19SJun-ichiro itojun Hagino 		m->m_len -= sizeof(struct ip6_frag);
488686cdd19SJun-ichiro itojun Hagino 	} else {
489686cdd19SJun-ichiro itojun Hagino 		/* this comes with no copy if the boundary is on cluster */
490a163d034SWarner Losh 		if ((t = m_split(m, offset, M_DONTWAIT)) == NULL) {
491686cdd19SJun-ichiro itojun Hagino 			frag6_remque(q6);
492686cdd19SJun-ichiro itojun Hagino 			free(q6, M_FTABLE);
493686cdd19SJun-ichiro itojun Hagino 			frag6_nfragpackets--;
494686cdd19SJun-ichiro itojun Hagino 			goto dropfrag;
49582cd038dSYoshinobu Inoue 		}
496686cdd19SJun-ichiro itojun Hagino 		m_adj(t, sizeof(struct ip6_frag));
497686cdd19SJun-ichiro itojun Hagino 		m_cat(m, t);
498686cdd19SJun-ichiro itojun Hagino 	}
49982cd038dSYoshinobu Inoue 
50082cd038dSYoshinobu Inoue 	/*
50182cd038dSYoshinobu Inoue 	 * Store NXT to the original.
50282cd038dSYoshinobu Inoue 	 */
50382cd038dSYoshinobu Inoue 	{
50482cd038dSYoshinobu Inoue 		char *prvnxtp = ip6_get_prevhdr(m, offset); /* XXX */
50582cd038dSYoshinobu Inoue 		*prvnxtp = nxt;
50682cd038dSYoshinobu Inoue 	}
50782cd038dSYoshinobu Inoue 
50882cd038dSYoshinobu Inoue 	frag6_remque(q6);
50982cd038dSYoshinobu Inoue 	free(q6, M_FTABLE);
51082cd038dSYoshinobu Inoue 	frag6_nfragpackets--;
51182cd038dSYoshinobu Inoue 
51282cd038dSYoshinobu Inoue 	if (m->m_flags & M_PKTHDR) { /* Isn't it always true? */
51382cd038dSYoshinobu Inoue 		int plen = 0;
51482cd038dSYoshinobu Inoue 		for (t = m; t; t = t->m_next)
51582cd038dSYoshinobu Inoue 			plen += t->m_len;
51682cd038dSYoshinobu Inoue 		m->m_pkthdr.len = plen;
51782cd038dSYoshinobu Inoue 	}
51882cd038dSYoshinobu Inoue 
51982cd038dSYoshinobu Inoue 	ip6stat.ip6s_reassembled++;
52082cd038dSYoshinobu Inoue 	in6_ifstat_inc(dstifp, ifs6_reass_ok);
52182cd038dSYoshinobu Inoue 
52282cd038dSYoshinobu Inoue 	/*
52382cd038dSYoshinobu Inoue 	 * Tell launch routine the next header
52482cd038dSYoshinobu Inoue 	 */
52582cd038dSYoshinobu Inoue 
52682cd038dSYoshinobu Inoue 	*mp = m;
52782cd038dSYoshinobu Inoue 	*offp = offset;
52882cd038dSYoshinobu Inoue 
52982cd038dSYoshinobu Inoue 	frag6_doing_reass = 0;
53082cd038dSYoshinobu Inoue 	return nxt;
53182cd038dSYoshinobu Inoue 
53282cd038dSYoshinobu Inoue  dropfrag:
53382cd038dSYoshinobu Inoue 	in6_ifstat_inc(dstifp, ifs6_reass_fail);
53482cd038dSYoshinobu Inoue 	ip6stat.ip6s_fragdropped++;
53582cd038dSYoshinobu Inoue 	m_freem(m);
53633841545SHajimu UMEMOTO 	frag6_doing_reass = 0;
53782cd038dSYoshinobu Inoue 	return IPPROTO_DONE;
53882cd038dSYoshinobu Inoue }
53982cd038dSYoshinobu Inoue 
54082cd038dSYoshinobu Inoue /*
54182cd038dSYoshinobu Inoue  * Free a fragment reassembly header and all
54282cd038dSYoshinobu Inoue  * associated datagrams.
54382cd038dSYoshinobu Inoue  */
54482cd038dSYoshinobu Inoue void
54582cd038dSYoshinobu Inoue frag6_freef(q6)
54682cd038dSYoshinobu Inoue 	struct ip6q *q6;
54782cd038dSYoshinobu Inoue {
54882cd038dSYoshinobu Inoue 	struct ip6asfrag *af6, *down6;
54982cd038dSYoshinobu Inoue 
55082cd038dSYoshinobu Inoue 	for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6;
55182cd038dSYoshinobu Inoue 	     af6 = down6) {
55282cd038dSYoshinobu Inoue 		struct mbuf *m = IP6_REASS_MBUF(af6);
55382cd038dSYoshinobu Inoue 
55482cd038dSYoshinobu Inoue 		down6 = af6->ip6af_down;
55582cd038dSYoshinobu Inoue 		frag6_deq(af6);
55682cd038dSYoshinobu Inoue 
55782cd038dSYoshinobu Inoue 		/*
55882cd038dSYoshinobu Inoue 		 * Return ICMP time exceeded error for the 1st fragment.
55982cd038dSYoshinobu Inoue 		 * Just free other fragments.
56082cd038dSYoshinobu Inoue 		 */
56182cd038dSYoshinobu Inoue 		if (af6->ip6af_off == 0) {
56282cd038dSYoshinobu Inoue 			struct ip6_hdr *ip6;
56382cd038dSYoshinobu Inoue 
56482cd038dSYoshinobu Inoue 			/* adjust pointer */
56582cd038dSYoshinobu Inoue 			ip6 = mtod(m, struct ip6_hdr *);
56682cd038dSYoshinobu Inoue 
56782cd038dSYoshinobu Inoue 			/* restoure source and destination addresses */
56882cd038dSYoshinobu Inoue 			ip6->ip6_src = q6->ip6q_src;
56982cd038dSYoshinobu Inoue 			ip6->ip6_dst = q6->ip6q_dst;
57082cd038dSYoshinobu Inoue 
57182cd038dSYoshinobu Inoue 			icmp6_error(m, ICMP6_TIME_EXCEEDED,
57282cd038dSYoshinobu Inoue 				    ICMP6_TIME_EXCEED_REASSEMBLY, 0);
573686cdd19SJun-ichiro itojun Hagino 		} else
57482cd038dSYoshinobu Inoue 			m_freem(m);
575686cdd19SJun-ichiro itojun Hagino 		free(af6, M_FTABLE);
57682cd038dSYoshinobu Inoue 	}
57782cd038dSYoshinobu Inoue 	frag6_remque(q6);
57882cd038dSYoshinobu Inoue 	free(q6, M_FTABLE);
57982cd038dSYoshinobu Inoue 	frag6_nfragpackets--;
58082cd038dSYoshinobu Inoue }
58182cd038dSYoshinobu Inoue 
58282cd038dSYoshinobu Inoue /*
58382cd038dSYoshinobu Inoue  * Put an ip fragment on a reassembly chain.
58482cd038dSYoshinobu Inoue  * Like insque, but pointers in middle of structure.
58582cd038dSYoshinobu Inoue  */
58682cd038dSYoshinobu Inoue void
58782cd038dSYoshinobu Inoue frag6_enq(af6, up6)
58882cd038dSYoshinobu Inoue 	struct ip6asfrag *af6, *up6;
58982cd038dSYoshinobu Inoue {
59082cd038dSYoshinobu Inoue 	af6->ip6af_up = up6;
59182cd038dSYoshinobu Inoue 	af6->ip6af_down = up6->ip6af_down;
59282cd038dSYoshinobu Inoue 	up6->ip6af_down->ip6af_up = af6;
59382cd038dSYoshinobu Inoue 	up6->ip6af_down = af6;
59482cd038dSYoshinobu Inoue }
59582cd038dSYoshinobu Inoue 
59682cd038dSYoshinobu Inoue /*
59782cd038dSYoshinobu Inoue  * To frag6_enq as remque is to insque.
59882cd038dSYoshinobu Inoue  */
59982cd038dSYoshinobu Inoue void
60082cd038dSYoshinobu Inoue frag6_deq(af6)
60182cd038dSYoshinobu Inoue 	struct ip6asfrag *af6;
60282cd038dSYoshinobu Inoue {
60382cd038dSYoshinobu Inoue 	af6->ip6af_up->ip6af_down = af6->ip6af_down;
60482cd038dSYoshinobu Inoue 	af6->ip6af_down->ip6af_up = af6->ip6af_up;
60582cd038dSYoshinobu Inoue }
60682cd038dSYoshinobu Inoue 
60782cd038dSYoshinobu Inoue void
60882cd038dSYoshinobu Inoue frag6_insque(new, old)
60982cd038dSYoshinobu Inoue 	struct ip6q *new, *old;
61082cd038dSYoshinobu Inoue {
61182cd038dSYoshinobu Inoue 	new->ip6q_prev = old;
61282cd038dSYoshinobu Inoue 	new->ip6q_next = old->ip6q_next;
61382cd038dSYoshinobu Inoue 	old->ip6q_next->ip6q_prev= new;
61482cd038dSYoshinobu Inoue 	old->ip6q_next = new;
61582cd038dSYoshinobu Inoue }
61682cd038dSYoshinobu Inoue 
61782cd038dSYoshinobu Inoue void
61882cd038dSYoshinobu Inoue frag6_remque(p6)
61982cd038dSYoshinobu Inoue 	struct ip6q *p6;
62082cd038dSYoshinobu Inoue {
62182cd038dSYoshinobu Inoue 	p6->ip6q_prev->ip6q_next = p6->ip6q_next;
62282cd038dSYoshinobu Inoue 	p6->ip6q_next->ip6q_prev = p6->ip6q_prev;
62382cd038dSYoshinobu Inoue }
62482cd038dSYoshinobu Inoue 
62582cd038dSYoshinobu Inoue /*
62633841545SHajimu UMEMOTO  * IPv6 reassembling timer processing;
62782cd038dSYoshinobu Inoue  * if a timer expires on a reassembly
62882cd038dSYoshinobu Inoue  * queue, discard it.
62982cd038dSYoshinobu Inoue  */
63082cd038dSYoshinobu Inoue void
63182cd038dSYoshinobu Inoue frag6_slowtimo()
63282cd038dSYoshinobu Inoue {
63382cd038dSYoshinobu Inoue 	struct ip6q *q6;
63482cd038dSYoshinobu Inoue 	int s = splnet();
63582cd038dSYoshinobu Inoue 
63682cd038dSYoshinobu Inoue 	frag6_doing_reass = 1;
63782cd038dSYoshinobu Inoue 	q6 = ip6q.ip6q_next;
63882cd038dSYoshinobu Inoue 	if (q6)
63982cd038dSYoshinobu Inoue 		while (q6 != &ip6q) {
64082cd038dSYoshinobu Inoue 			--q6->ip6q_ttl;
64182cd038dSYoshinobu Inoue 			q6 = q6->ip6q_next;
64282cd038dSYoshinobu Inoue 			if (q6->ip6q_prev->ip6q_ttl == 0) {
64382cd038dSYoshinobu Inoue 				ip6stat.ip6s_fragtimeout++;
64482cd038dSYoshinobu Inoue 				/* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */
64582cd038dSYoshinobu Inoue 				frag6_freef(q6->ip6q_prev);
64682cd038dSYoshinobu Inoue 			}
64782cd038dSYoshinobu Inoue 		}
64882cd038dSYoshinobu Inoue 	/*
64982cd038dSYoshinobu Inoue 	 * If we are over the maximum number of fragments
65082cd038dSYoshinobu Inoue 	 * (due to the limit being lowered), drain off
65182cd038dSYoshinobu Inoue 	 * enough to get down to the new limit.
65282cd038dSYoshinobu Inoue 	 */
65333841545SHajimu UMEMOTO 	while (frag6_nfragpackets > (u_int)ip6_maxfragpackets &&
65433841545SHajimu UMEMOTO 	    ip6q.ip6q_prev) {
65582cd038dSYoshinobu Inoue 		ip6stat.ip6s_fragoverflow++;
65682cd038dSYoshinobu Inoue 		/* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */
65782cd038dSYoshinobu Inoue 		frag6_freef(ip6q.ip6q_prev);
65882cd038dSYoshinobu Inoue 	}
65982cd038dSYoshinobu Inoue 	frag6_doing_reass = 0;
660686cdd19SJun-ichiro itojun Hagino 
661686cdd19SJun-ichiro itojun Hagino #if 0
662686cdd19SJun-ichiro itojun Hagino 	/*
663686cdd19SJun-ichiro itojun Hagino 	 * Routing changes might produce a better route than we last used;
664686cdd19SJun-ichiro itojun Hagino 	 * make sure we notice eventually, even if forwarding only for one
665686cdd19SJun-ichiro itojun Hagino 	 * destination and the cache is never replaced.
666686cdd19SJun-ichiro itojun Hagino 	 */
667686cdd19SJun-ichiro itojun Hagino 	if (ip6_forward_rt.ro_rt) {
668686cdd19SJun-ichiro itojun Hagino 		RTFREE(ip6_forward_rt.ro_rt);
669686cdd19SJun-ichiro itojun Hagino 		ip6_forward_rt.ro_rt = 0;
670686cdd19SJun-ichiro itojun Hagino 	}
671686cdd19SJun-ichiro itojun Hagino 	if (ipsrcchk_rt.ro_rt) {
672686cdd19SJun-ichiro itojun Hagino 		RTFREE(ipsrcchk_rt.ro_rt);
673686cdd19SJun-ichiro itojun Hagino 		ipsrcchk_rt.ro_rt = 0;
674686cdd19SJun-ichiro itojun Hagino 	}
675686cdd19SJun-ichiro itojun Hagino #endif
676686cdd19SJun-ichiro itojun Hagino 
67782cd038dSYoshinobu Inoue 	splx(s);
67882cd038dSYoshinobu Inoue }
67982cd038dSYoshinobu Inoue 
68082cd038dSYoshinobu Inoue /*
68182cd038dSYoshinobu Inoue  * Drain off all datagram fragments.
68282cd038dSYoshinobu Inoue  */
68382cd038dSYoshinobu Inoue void
68482cd038dSYoshinobu Inoue frag6_drain()
68582cd038dSYoshinobu Inoue {
68682cd038dSYoshinobu Inoue 	if (frag6_doing_reass)
68782cd038dSYoshinobu Inoue 		return;
68882cd038dSYoshinobu Inoue 	while (ip6q.ip6q_next != &ip6q) {
68982cd038dSYoshinobu Inoue 		ip6stat.ip6s_fragdropped++;
69082cd038dSYoshinobu Inoue 		/* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */
69182cd038dSYoshinobu Inoue 		frag6_freef(ip6q.ip6q_next);
69282cd038dSYoshinobu Inoue 	}
69382cd038dSYoshinobu Inoue }
694