xref: /freebsd/sys/netinet6/frag6.c (revision 686cdd19b1b182f2257bc158116e78c5fef84980)
1686cdd19SJun-ichiro itojun Hagino /*	$FreeBSD$	*/
2686cdd19SJun-ichiro itojun Hagino /*	$KAME: frag6.c,v 1.24 2000/03/25 07:23:41 sumikawa 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 
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>
5382cd038dSYoshinobu Inoue 
5482cd038dSYoshinobu Inoue #include <net/net_osdep.h>
5582cd038dSYoshinobu Inoue 
5682cd038dSYoshinobu Inoue /*
5782cd038dSYoshinobu Inoue  * Define it to get a correct behavior on per-interface statistics.
5882cd038dSYoshinobu Inoue  * You will need to perform an extra routing table lookup, per fragment,
5982cd038dSYoshinobu Inoue  * to do it.  This may, or may not be, a performance hit.
6082cd038dSYoshinobu Inoue  */
6182cd038dSYoshinobu Inoue #define IN6_IFSTAT_STRICT
6282cd038dSYoshinobu Inoue 
6382cd038dSYoshinobu Inoue static void frag6_enq __P((struct ip6asfrag *, struct ip6asfrag *));
6482cd038dSYoshinobu Inoue static void frag6_deq __P((struct ip6asfrag *));
6582cd038dSYoshinobu Inoue static void frag6_insque __P((struct ip6q *, struct ip6q *));
6682cd038dSYoshinobu Inoue static void frag6_remque __P((struct ip6q *));
6782cd038dSYoshinobu Inoue static void frag6_freef __P((struct ip6q *));
6882cd038dSYoshinobu Inoue 
6982cd038dSYoshinobu Inoue int frag6_doing_reass;
7082cd038dSYoshinobu Inoue u_int frag6_nfragpackets;
7182cd038dSYoshinobu Inoue struct	ip6q ip6q;	/* ip6 reassemble queue */
7282cd038dSYoshinobu Inoue 
73686cdd19SJun-ichiro itojun Hagino /* FreeBSD tweak */
7482cd038dSYoshinobu Inoue MALLOC_DEFINE(M_FTABLE, "fragment", "fragment reassembly header");
75686cdd19SJun-ichiro itojun Hagino 
76686cdd19SJun-ichiro itojun Hagino #ifndef offsetof		/* XXX */
77686cdd19SJun-ichiro itojun Hagino #define	offsetof(type, member)	((size_t)(&((type *)0)->member))
7882cd038dSYoshinobu Inoue #endif
7982cd038dSYoshinobu Inoue 
8082cd038dSYoshinobu Inoue /*
8182cd038dSYoshinobu Inoue  * Initialise reassembly queue and fragment identifier.
8282cd038dSYoshinobu Inoue  */
8382cd038dSYoshinobu Inoue void
8482cd038dSYoshinobu Inoue frag6_init()
8582cd038dSYoshinobu Inoue {
8682cd038dSYoshinobu Inoue 	struct timeval tv;
8782cd038dSYoshinobu Inoue 
8882cd038dSYoshinobu Inoue 	/*
8982cd038dSYoshinobu Inoue 	 * in many cases, random() here does NOT return random number
9082cd038dSYoshinobu Inoue 	 * as initialization during bootstrap time occur in fixed order.
9182cd038dSYoshinobu Inoue 	 */
9282cd038dSYoshinobu Inoue 	microtime(&tv);
9382cd038dSYoshinobu Inoue 	ip6_id = random() ^ tv.tv_usec;
94686cdd19SJun-ichiro itojun Hagino 	ip6q.ip6q_next = ip6q.ip6q_prev = &ip6q;
9582cd038dSYoshinobu Inoue }
9682cd038dSYoshinobu Inoue 
9782cd038dSYoshinobu Inoue /*
98686cdd19SJun-ichiro itojun Hagino  * In RFC2460, fragment and reassembly rule do not agree with each other,
99686cdd19SJun-ichiro itojun Hagino  * in terms of next header field handling in fragment header.
100686cdd19SJun-ichiro itojun Hagino  * While the sender will use the same value for all of the fragmented packets,
101686cdd19SJun-ichiro itojun Hagino  * receiver is suggested not to check the consistency.
102686cdd19SJun-ichiro itojun Hagino  *
103686cdd19SJun-ichiro itojun Hagino  * fragment rule (p20):
104686cdd19SJun-ichiro itojun Hagino  *	(2) A Fragment header containing:
105686cdd19SJun-ichiro itojun Hagino  *	The Next Header value that identifies the first header of
106686cdd19SJun-ichiro itojun Hagino  *	the Fragmentable Part of the original packet.
107686cdd19SJun-ichiro itojun Hagino  *		-> next header field is same for all fragments
108686cdd19SJun-ichiro itojun Hagino  *
109686cdd19SJun-ichiro itojun Hagino  * reassembly rule (p21):
110686cdd19SJun-ichiro itojun Hagino  *	The Next Header field of the last header of the Unfragmentable
111686cdd19SJun-ichiro itojun Hagino  *	Part is obtained from the Next Header field of the first
112686cdd19SJun-ichiro itojun Hagino  *	fragment's Fragment header.
113686cdd19SJun-ichiro itojun Hagino  *		-> should grab it from the first fragment only
114686cdd19SJun-ichiro itojun Hagino  *
115686cdd19SJun-ichiro itojun Hagino  * The following note also contradicts with fragment rule - noone is going to
116686cdd19SJun-ichiro itojun Hagino  * send different fragment with different next header field.
117686cdd19SJun-ichiro itojun Hagino  *
118686cdd19SJun-ichiro itojun Hagino  * additional note (p22):
119686cdd19SJun-ichiro itojun Hagino  *	The Next Header values in the Fragment headers of different
120686cdd19SJun-ichiro itojun Hagino  *	fragments of the same original packet may differ.  Only the value
121686cdd19SJun-ichiro itojun Hagino  *	from the Offset zero fragment packet is used for reassembly.
122686cdd19SJun-ichiro itojun Hagino  *		-> should grab it from the first fragment only
123686cdd19SJun-ichiro itojun Hagino  *
124686cdd19SJun-ichiro itojun Hagino  * There is no explicit reason given in the RFC.  Historical reason maybe?
125686cdd19SJun-ichiro itojun Hagino  */
126686cdd19SJun-ichiro itojun Hagino /*
12782cd038dSYoshinobu Inoue  * Fragment input
12882cd038dSYoshinobu Inoue  */
12982cd038dSYoshinobu Inoue int
13082cd038dSYoshinobu Inoue frag6_input(mp, offp, proto)
13182cd038dSYoshinobu Inoue 	struct mbuf **mp;
13282cd038dSYoshinobu Inoue 	int *offp, proto;
13382cd038dSYoshinobu Inoue {
13482cd038dSYoshinobu Inoue 	struct mbuf *m = *mp, *t;
13582cd038dSYoshinobu Inoue 	struct ip6_hdr *ip6;
13682cd038dSYoshinobu Inoue 	struct ip6_frag *ip6f;
13782cd038dSYoshinobu Inoue 	struct ip6q *q6;
138686cdd19SJun-ichiro itojun Hagino 	struct ip6asfrag *af6, *ip6af, *af6dwn;
13982cd038dSYoshinobu Inoue 	int offset = *offp, nxt, i, next;
14082cd038dSYoshinobu Inoue 	int first_frag = 0;
141686cdd19SJun-ichiro itojun Hagino 	int fragoff, frgpartlen;	/* must be larger than u_int16_t */
14282cd038dSYoshinobu Inoue 	struct ifnet *dstifp;
14382cd038dSYoshinobu Inoue #ifdef IN6_IFSTAT_STRICT
14482cd038dSYoshinobu Inoue 	static struct route_in6 ro;
14582cd038dSYoshinobu Inoue 	struct sockaddr_in6 *dst;
14682cd038dSYoshinobu Inoue #endif
14782cd038dSYoshinobu Inoue 
14882cd038dSYoshinobu Inoue 	ip6 = mtod(m, struct ip6_hdr *);
149686cdd19SJun-ichiro itojun Hagino #ifndef PULLDOWN_TEST
150686cdd19SJun-ichiro itojun Hagino 	IP6_EXTHDR_CHECK(m, offset, sizeof(struct ip6_frag), IPPROTO_DONE);
15182cd038dSYoshinobu Inoue 	ip6f = (struct ip6_frag *)((caddr_t)ip6 + offset);
152686cdd19SJun-ichiro itojun Hagino #else
153686cdd19SJun-ichiro itojun Hagino 	IP6_EXTHDR_GET(ip6f, struct ip6_frag *, m, offset, sizeof(*ip6f));
154686cdd19SJun-ichiro itojun Hagino 	if (ip6f == NULL)
155686cdd19SJun-ichiro itojun Hagino 		return IPPROTO_DONE;
156686cdd19SJun-ichiro itojun Hagino #endif
15782cd038dSYoshinobu Inoue 
15882cd038dSYoshinobu Inoue 	dstifp = NULL;
15982cd038dSYoshinobu Inoue #ifdef IN6_IFSTAT_STRICT
16082cd038dSYoshinobu Inoue 	/* find the destination interface of the packet. */
16182cd038dSYoshinobu Inoue 	dst = (struct sockaddr_in6 *)&ro.ro_dst;
16282cd038dSYoshinobu Inoue 	if (ro.ro_rt
16382cd038dSYoshinobu Inoue 	 && ((ro.ro_rt->rt_flags & RTF_UP) == 0
16482cd038dSYoshinobu Inoue 	  || !IN6_ARE_ADDR_EQUAL(&dst->sin6_addr, &ip6->ip6_dst))) {
16582cd038dSYoshinobu Inoue 		RTFREE(ro.ro_rt);
16682cd038dSYoshinobu Inoue 		ro.ro_rt = (struct rtentry *)0;
16782cd038dSYoshinobu Inoue 	}
16882cd038dSYoshinobu Inoue 	if (ro.ro_rt == NULL) {
16982cd038dSYoshinobu Inoue 		bzero(dst, sizeof(*dst));
17082cd038dSYoshinobu Inoue 		dst->sin6_family = AF_INET6;
17182cd038dSYoshinobu Inoue 		dst->sin6_len = sizeof(struct sockaddr_in6);
17282cd038dSYoshinobu Inoue 		dst->sin6_addr = ip6->ip6_dst;
17382cd038dSYoshinobu Inoue 	}
174ae5bcbffSYoshinobu Inoue 	rtalloc((struct route *)&ro);
17582cd038dSYoshinobu Inoue 	if (ro.ro_rt != NULL && ro.ro_rt->rt_ifa != NULL)
17682cd038dSYoshinobu Inoue 		dstifp = ((struct in6_ifaddr *)ro.ro_rt->rt_ifa)->ia_ifp;
17782cd038dSYoshinobu Inoue #else
17882cd038dSYoshinobu Inoue 	/* we are violating the spec, this is not the destination interface */
17982cd038dSYoshinobu Inoue 	if ((m->m_flags & M_PKTHDR) != 0)
18082cd038dSYoshinobu Inoue 		dstifp = m->m_pkthdr.rcvif;
18182cd038dSYoshinobu Inoue #endif
18282cd038dSYoshinobu Inoue 
18382cd038dSYoshinobu Inoue 	/* jumbo payload can't contain a fragment header */
18482cd038dSYoshinobu Inoue 	if (ip6->ip6_plen == 0) {
18582cd038dSYoshinobu Inoue 		icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER, offset);
18682cd038dSYoshinobu Inoue 		in6_ifstat_inc(dstifp, ifs6_reass_fail);
18782cd038dSYoshinobu Inoue 		return IPPROTO_DONE;
18882cd038dSYoshinobu Inoue 	}
18982cd038dSYoshinobu Inoue 
19082cd038dSYoshinobu Inoue 	/*
19182cd038dSYoshinobu Inoue 	 * check whether fragment packet's fragment length is
19282cd038dSYoshinobu Inoue 	 * multiple of 8 octets.
19382cd038dSYoshinobu Inoue 	 * sizeof(struct ip6_frag) == 8
19482cd038dSYoshinobu Inoue 	 * sizeof(struct ip6_hdr) = 40
19582cd038dSYoshinobu Inoue 	 */
19682cd038dSYoshinobu Inoue 	if ((ip6f->ip6f_offlg & IP6F_MORE_FRAG) &&
19782cd038dSYoshinobu Inoue 	    (((ntohs(ip6->ip6_plen) - offset) & 0x7) != 0)) {
19882cd038dSYoshinobu Inoue 		icmp6_error(m, ICMP6_PARAM_PROB,
19982cd038dSYoshinobu Inoue 			    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 
21182cd038dSYoshinobu Inoue 	for (q6 = ip6q.ip6q_next; q6 != &ip6q; q6 = q6->ip6q_next)
21282cd038dSYoshinobu Inoue 		if (ip6f->ip6f_ident == q6->ip6q_ident &&
21382cd038dSYoshinobu Inoue 		    IN6_ARE_ADDR_EQUAL(&ip6->ip6_src, &q6->ip6q_src) &&
21482cd038dSYoshinobu Inoue 		    IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst, &q6->ip6q_dst))
21582cd038dSYoshinobu Inoue 			break;
21682cd038dSYoshinobu Inoue 
21782cd038dSYoshinobu Inoue 	if (q6 == &ip6q) {
21882cd038dSYoshinobu Inoue 		/*
21982cd038dSYoshinobu Inoue 		 * the first fragment to arrive, create a reassembly queue.
22082cd038dSYoshinobu Inoue 		 */
22182cd038dSYoshinobu Inoue 		first_frag = 1;
22282cd038dSYoshinobu Inoue 		frag6_nfragpackets++;
22382cd038dSYoshinobu Inoue 
22482cd038dSYoshinobu Inoue 		/*
22582cd038dSYoshinobu Inoue 		 * Enforce upper bound on number of fragmented packets
22682cd038dSYoshinobu Inoue 		 * for which we attempt reassembly;
22782cd038dSYoshinobu Inoue 		 * If maxfrag is 0, never accept fragments.
22882cd038dSYoshinobu Inoue 		 * If maxfrag is -1, accept all fragments without limitation.
22982cd038dSYoshinobu Inoue 		 */
23082cd038dSYoshinobu Inoue 		if (frag6_nfragpackets >= (u_int)ip6_maxfragpackets) {
23182cd038dSYoshinobu Inoue 			ip6stat.ip6s_fragoverflow++;
23282cd038dSYoshinobu Inoue 			in6_ifstat_inc(dstifp, ifs6_reass_fail);
23382cd038dSYoshinobu Inoue 			frag6_freef(ip6q.ip6q_prev);
23482cd038dSYoshinobu Inoue 		}
23582cd038dSYoshinobu Inoue 		q6 = (struct ip6q *)malloc(sizeof(struct ip6q), M_FTABLE,
23682cd038dSYoshinobu Inoue 			M_DONTWAIT);
23782cd038dSYoshinobu Inoue 		if (q6 == NULL)
23882cd038dSYoshinobu Inoue 			goto dropfrag;
239686cdd19SJun-ichiro itojun Hagino 		bzero(q6, sizeof(*q6));
24082cd038dSYoshinobu Inoue 
24182cd038dSYoshinobu Inoue 		frag6_insque(q6, &ip6q);
24282cd038dSYoshinobu Inoue 
243686cdd19SJun-ichiro itojun Hagino 		/* ip6q_nxt will be filled afterwards, from 1st fragment */
24482cd038dSYoshinobu Inoue 		q6->ip6q_down	= q6->ip6q_up = (struct ip6asfrag *)q6;
245686cdd19SJun-ichiro itojun Hagino #ifdef notyet
246686cdd19SJun-ichiro itojun Hagino 		q6->ip6q_nxtp	= (u_char *)nxtp;
247686cdd19SJun-ichiro itojun Hagino #endif
24882cd038dSYoshinobu Inoue 		q6->ip6q_ident	= ip6f->ip6f_ident;
24982cd038dSYoshinobu Inoue 		q6->ip6q_arrive = 0; /* Is it used anywhere? */
25082cd038dSYoshinobu Inoue 		q6->ip6q_ttl 	= IPV6_FRAGTTL;
25182cd038dSYoshinobu Inoue 		q6->ip6q_src	= ip6->ip6_src;
25282cd038dSYoshinobu Inoue 		q6->ip6q_dst	= ip6->ip6_dst;
25382cd038dSYoshinobu Inoue 		q6->ip6q_unfrglen = -1;	/* The 1st fragment has not arrived. */
25482cd038dSYoshinobu Inoue 	}
25582cd038dSYoshinobu Inoue 
25682cd038dSYoshinobu Inoue 	/*
25782cd038dSYoshinobu Inoue 	 * If it's the 1st fragment, record the length of the
25882cd038dSYoshinobu Inoue 	 * unfragmentable part and the next header of the fragment header.
25982cd038dSYoshinobu Inoue 	 */
26082cd038dSYoshinobu Inoue 	fragoff = ntohs(ip6f->ip6f_offlg & IP6F_OFF_MASK);
26182cd038dSYoshinobu Inoue 	if (fragoff == 0) {
26282cd038dSYoshinobu Inoue 		q6->ip6q_unfrglen = offset - sizeof(struct ip6_hdr)
26382cd038dSYoshinobu Inoue 			- sizeof(struct ip6_frag);
26482cd038dSYoshinobu Inoue 		q6->ip6q_nxt = ip6f->ip6f_nxt;
26582cd038dSYoshinobu Inoue 	}
26682cd038dSYoshinobu Inoue 
26782cd038dSYoshinobu Inoue 	/*
26882cd038dSYoshinobu Inoue 	 * Check that the reassembled packet would not exceed 65535 bytes
26982cd038dSYoshinobu Inoue 	 * in size.
27082cd038dSYoshinobu Inoue 	 * If it would exceed, discard the fragment and return an ICMP error.
27182cd038dSYoshinobu Inoue 	 */
27282cd038dSYoshinobu Inoue 	frgpartlen = sizeof(struct ip6_hdr) + ntohs(ip6->ip6_plen) - offset;
27382cd038dSYoshinobu Inoue 	if (q6->ip6q_unfrglen >= 0) {
27482cd038dSYoshinobu Inoue 		/* The 1st fragment has already arrived. */
27582cd038dSYoshinobu Inoue 		if (q6->ip6q_unfrglen + fragoff + frgpartlen > IPV6_MAXPACKET) {
27682cd038dSYoshinobu Inoue 			icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER,
277686cdd19SJun-ichiro itojun Hagino 				    offset - sizeof(struct ip6_frag) +
278686cdd19SJun-ichiro itojun Hagino 					offsetof(struct ip6_frag, ip6f_offlg));
27982cd038dSYoshinobu Inoue 			return(IPPROTO_DONE);
28082cd038dSYoshinobu Inoue 		}
28182cd038dSYoshinobu Inoue 	}
28282cd038dSYoshinobu Inoue 	else if (fragoff + frgpartlen > IPV6_MAXPACKET) {
28382cd038dSYoshinobu Inoue 		icmp6_error(m, ICMP6_PARAM_PROB, ICMP6_PARAMPROB_HEADER,
284686cdd19SJun-ichiro itojun Hagino 			    offset - sizeof(struct ip6_frag) +
285686cdd19SJun-ichiro itojun Hagino 				offsetof(struct ip6_frag, ip6f_offlg));
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,
326686cdd19SJun-ichiro itojun Hagino 	    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) {
39882cd038dSYoshinobu Inoue 			log(LOG_ERR, "%d bytes of a fragment from %s "
39982cd038dSYoshinobu Inoue 			    "overlaps the previous fragment\n",
40082cd038dSYoshinobu Inoue 			    i, ip6_sprintf(&q6->ip6q_src));
40182cd038dSYoshinobu Inoue 			goto dropfrag;
40282cd038dSYoshinobu Inoue 		}
40382cd038dSYoshinobu Inoue 	}
40482cd038dSYoshinobu Inoue 	if (af6 != (struct ip6asfrag *)q6) {
40582cd038dSYoshinobu Inoue 		i = (ip6af->ip6af_off + ip6af->ip6af_frglen) - af6->ip6af_off;
40682cd038dSYoshinobu Inoue 		if (i > 0) {
40782cd038dSYoshinobu Inoue 			log(LOG_ERR, "%d bytes of a fragment from %s "
40882cd038dSYoshinobu Inoue 			    "overlaps the succeeding fragment",
40982cd038dSYoshinobu Inoue 			    i, ip6_sprintf(&q6->ip6q_src));
41082cd038dSYoshinobu Inoue 			goto dropfrag;
41182cd038dSYoshinobu Inoue 		}
41282cd038dSYoshinobu Inoue 	}
413686cdd19SJun-ichiro itojun Hagino #endif
41482cd038dSYoshinobu Inoue 
41582cd038dSYoshinobu Inoue insert:
41682cd038dSYoshinobu Inoue 
41782cd038dSYoshinobu Inoue 	/*
41882cd038dSYoshinobu Inoue 	 * Stick new segment in its place;
41982cd038dSYoshinobu Inoue 	 * check for complete reassembly.
42082cd038dSYoshinobu Inoue 	 * Move to front of packet queue, as we are
42182cd038dSYoshinobu Inoue 	 * the most recently active fragmented packet.
42282cd038dSYoshinobu Inoue 	 */
42382cd038dSYoshinobu Inoue 	frag6_enq(ip6af, af6->ip6af_up);
424686cdd19SJun-ichiro itojun Hagino #if 0 /* xxx */
425686cdd19SJun-ichiro itojun Hagino 	if (q6 != ip6q.ip6q_next) {
426686cdd19SJun-ichiro itojun Hagino 		frag6_remque(q6);
427686cdd19SJun-ichiro itojun Hagino 		frag6_insque(q6, &ip6q);
428686cdd19SJun-ichiro itojun Hagino 	}
429686cdd19SJun-ichiro itojun Hagino #endif
43082cd038dSYoshinobu Inoue 	next = 0;
43182cd038dSYoshinobu Inoue 	for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6;
43282cd038dSYoshinobu Inoue 	     af6 = af6->ip6af_down) {
43382cd038dSYoshinobu Inoue 		if (af6->ip6af_off != next) {
43482cd038dSYoshinobu Inoue 			frag6_doing_reass = 0;
43582cd038dSYoshinobu Inoue 			return IPPROTO_DONE;
43682cd038dSYoshinobu Inoue 		}
43782cd038dSYoshinobu Inoue 		next += af6->ip6af_frglen;
43882cd038dSYoshinobu Inoue 	}
43982cd038dSYoshinobu Inoue 	if (af6->ip6af_up->ip6af_mff) {
44082cd038dSYoshinobu Inoue 		frag6_doing_reass = 0;
44182cd038dSYoshinobu Inoue 		return IPPROTO_DONE;
44282cd038dSYoshinobu Inoue 	}
44382cd038dSYoshinobu Inoue 
44482cd038dSYoshinobu Inoue 	/*
44582cd038dSYoshinobu Inoue 	 * Reassembly is complete; concatenate fragments.
44682cd038dSYoshinobu Inoue 	 */
44782cd038dSYoshinobu Inoue 	ip6af = q6->ip6q_down;
44882cd038dSYoshinobu Inoue 	t = m = IP6_REASS_MBUF(ip6af);
44982cd038dSYoshinobu Inoue 	af6 = ip6af->ip6af_down;
450686cdd19SJun-ichiro itojun Hagino 	frag6_deq(ip6af);
45182cd038dSYoshinobu Inoue 	while (af6 != (struct ip6asfrag *)q6) {
452686cdd19SJun-ichiro itojun Hagino 		af6dwn = af6->ip6af_down;
453686cdd19SJun-ichiro itojun Hagino 		frag6_deq(af6);
45482cd038dSYoshinobu Inoue 		while (t->m_next)
45582cd038dSYoshinobu Inoue 			t = t->m_next;
45682cd038dSYoshinobu Inoue 		t->m_next = IP6_REASS_MBUF(af6);
457686cdd19SJun-ichiro itojun Hagino 		m_adj(t->m_next, af6->ip6af_offset);
458686cdd19SJun-ichiro itojun Hagino 		free(af6, M_FTABLE);
459686cdd19SJun-ichiro itojun Hagino 		af6 = af6dwn;
46082cd038dSYoshinobu Inoue 	}
46182cd038dSYoshinobu Inoue 
46282cd038dSYoshinobu Inoue 	/* adjust offset to point where the original next header starts */
46382cd038dSYoshinobu Inoue 	offset = ip6af->ip6af_offset - sizeof(struct ip6_frag);
464686cdd19SJun-ichiro itojun Hagino 	free(ip6af, M_FTABLE);
465686cdd19SJun-ichiro itojun Hagino 	ip6 = mtod(m, struct ip6_hdr *);
46682cd038dSYoshinobu Inoue 	ip6->ip6_plen = htons((u_short)next + offset - sizeof(struct ip6_hdr));
46782cd038dSYoshinobu Inoue 	ip6->ip6_src = q6->ip6q_src;
46882cd038dSYoshinobu Inoue 	ip6->ip6_dst = q6->ip6q_dst;
46982cd038dSYoshinobu Inoue 	nxt = q6->ip6q_nxt;
470686cdd19SJun-ichiro itojun Hagino #ifdef notyet
471686cdd19SJun-ichiro itojun Hagino 	*q6->ip6q_nxtp = (u_char)(nxt & 0xff);
472686cdd19SJun-ichiro itojun Hagino #endif
47382cd038dSYoshinobu Inoue 
47482cd038dSYoshinobu Inoue 	/*
47582cd038dSYoshinobu Inoue 	 * Delete frag6 header with as a few cost as possible.
47682cd038dSYoshinobu Inoue 	 */
477686cdd19SJun-ichiro itojun Hagino 	if (offset < m->m_len) {
47882cd038dSYoshinobu Inoue 		ovbcopy((caddr_t)ip6, (caddr_t)ip6 + sizeof(struct ip6_frag),
47982cd038dSYoshinobu Inoue 			offset);
480686cdd19SJun-ichiro itojun Hagino 		m->m_data += sizeof(struct ip6_frag);
481686cdd19SJun-ichiro itojun Hagino 		m->m_len -= sizeof(struct ip6_frag);
482686cdd19SJun-ichiro itojun Hagino 	} else {
483686cdd19SJun-ichiro itojun Hagino 		/* this comes with no copy if the boundary is on cluster */
484686cdd19SJun-ichiro itojun Hagino 		if ((t = m_split(m, offset, M_DONTWAIT)) == NULL) {
485686cdd19SJun-ichiro itojun Hagino 			frag6_remque(q6);
486686cdd19SJun-ichiro itojun Hagino 			free(q6, M_FTABLE);
487686cdd19SJun-ichiro itojun Hagino 			frag6_nfragpackets--;
488686cdd19SJun-ichiro itojun Hagino 			goto dropfrag;
48982cd038dSYoshinobu Inoue 		}
490686cdd19SJun-ichiro itojun Hagino 		m_adj(t, sizeof(struct ip6_frag));
491686cdd19SJun-ichiro itojun Hagino 		m_cat(m, t);
492686cdd19SJun-ichiro itojun Hagino 	}
49382cd038dSYoshinobu Inoue 
49482cd038dSYoshinobu Inoue 	/*
49582cd038dSYoshinobu Inoue 	 * Store NXT to the original.
49682cd038dSYoshinobu Inoue 	 */
49782cd038dSYoshinobu Inoue 	{
49882cd038dSYoshinobu Inoue 		char *prvnxtp = ip6_get_prevhdr(m, offset); /* XXX */
49982cd038dSYoshinobu Inoue 		*prvnxtp = nxt;
50082cd038dSYoshinobu Inoue 	}
50182cd038dSYoshinobu Inoue 
50282cd038dSYoshinobu Inoue 	frag6_remque(q6);
50382cd038dSYoshinobu Inoue 	free(q6, M_FTABLE);
50482cd038dSYoshinobu Inoue 	frag6_nfragpackets--;
50582cd038dSYoshinobu Inoue 
50682cd038dSYoshinobu Inoue 	if (m->m_flags & M_PKTHDR) { /* Isn't it always true? */
50782cd038dSYoshinobu Inoue 		int plen = 0;
50882cd038dSYoshinobu Inoue 		for (t = m; t; t = t->m_next)
50982cd038dSYoshinobu Inoue 			plen += t->m_len;
51082cd038dSYoshinobu Inoue 		m->m_pkthdr.len = plen;
51182cd038dSYoshinobu Inoue 	}
51282cd038dSYoshinobu Inoue 
51382cd038dSYoshinobu Inoue 	ip6stat.ip6s_reassembled++;
51482cd038dSYoshinobu Inoue 	in6_ifstat_inc(dstifp, ifs6_reass_ok);
51582cd038dSYoshinobu Inoue 
51682cd038dSYoshinobu Inoue 	/*
51782cd038dSYoshinobu Inoue 	 * Tell launch routine the next header
51882cd038dSYoshinobu Inoue 	 */
51982cd038dSYoshinobu Inoue 
52082cd038dSYoshinobu Inoue 	*mp = m;
52182cd038dSYoshinobu Inoue 	*offp = offset;
52282cd038dSYoshinobu Inoue 
52382cd038dSYoshinobu Inoue 	frag6_doing_reass = 0;
52482cd038dSYoshinobu Inoue 	return nxt;
52582cd038dSYoshinobu Inoue 
52682cd038dSYoshinobu Inoue  dropfrag:
52782cd038dSYoshinobu Inoue 	in6_ifstat_inc(dstifp, ifs6_reass_fail);
52882cd038dSYoshinobu Inoue 	ip6stat.ip6s_fragdropped++;
52982cd038dSYoshinobu Inoue 	m_freem(m);
53082cd038dSYoshinobu Inoue 	return IPPROTO_DONE;
53182cd038dSYoshinobu Inoue }
53282cd038dSYoshinobu Inoue 
53382cd038dSYoshinobu Inoue /*
53482cd038dSYoshinobu Inoue  * Free a fragment reassembly header and all
53582cd038dSYoshinobu Inoue  * associated datagrams.
53682cd038dSYoshinobu Inoue  */
53782cd038dSYoshinobu Inoue void
53882cd038dSYoshinobu Inoue frag6_freef(q6)
53982cd038dSYoshinobu Inoue 	struct ip6q *q6;
54082cd038dSYoshinobu Inoue {
54182cd038dSYoshinobu Inoue 	struct ip6asfrag *af6, *down6;
54282cd038dSYoshinobu Inoue 
54382cd038dSYoshinobu Inoue 	for (af6 = q6->ip6q_down; af6 != (struct ip6asfrag *)q6;
54482cd038dSYoshinobu Inoue 	     af6 = down6) {
54582cd038dSYoshinobu Inoue 		struct mbuf *m = IP6_REASS_MBUF(af6);
54682cd038dSYoshinobu Inoue 
54782cd038dSYoshinobu Inoue 		down6 = af6->ip6af_down;
54882cd038dSYoshinobu Inoue 		frag6_deq(af6);
54982cd038dSYoshinobu Inoue 
55082cd038dSYoshinobu Inoue 		/*
55182cd038dSYoshinobu Inoue 		 * Return ICMP time exceeded error for the 1st fragment.
55282cd038dSYoshinobu Inoue 		 * Just free other fragments.
55382cd038dSYoshinobu Inoue 		 */
55482cd038dSYoshinobu Inoue 		if (af6->ip6af_off == 0) {
55582cd038dSYoshinobu Inoue 			struct ip6_hdr *ip6;
55682cd038dSYoshinobu Inoue 
55782cd038dSYoshinobu Inoue 			/* adjust pointer */
55882cd038dSYoshinobu Inoue 			ip6 = mtod(m, struct ip6_hdr *);
55982cd038dSYoshinobu Inoue 
56082cd038dSYoshinobu Inoue 			/* restoure source and destination addresses */
56182cd038dSYoshinobu Inoue 			ip6->ip6_src = q6->ip6q_src;
56282cd038dSYoshinobu Inoue 			ip6->ip6_dst = q6->ip6q_dst;
56382cd038dSYoshinobu Inoue 
56482cd038dSYoshinobu Inoue 			icmp6_error(m, ICMP6_TIME_EXCEEDED,
56582cd038dSYoshinobu Inoue 				    ICMP6_TIME_EXCEED_REASSEMBLY, 0);
566686cdd19SJun-ichiro itojun Hagino 		} else
56782cd038dSYoshinobu Inoue 			m_freem(m);
568686cdd19SJun-ichiro itojun Hagino 		free(af6, M_FTABLE);
56982cd038dSYoshinobu Inoue 	}
57082cd038dSYoshinobu Inoue 	frag6_remque(q6);
57182cd038dSYoshinobu Inoue 	free(q6, M_FTABLE);
57282cd038dSYoshinobu Inoue 	frag6_nfragpackets--;
57382cd038dSYoshinobu Inoue }
57482cd038dSYoshinobu Inoue 
57582cd038dSYoshinobu Inoue /*
57682cd038dSYoshinobu Inoue  * Put an ip fragment on a reassembly chain.
57782cd038dSYoshinobu Inoue  * Like insque, but pointers in middle of structure.
57882cd038dSYoshinobu Inoue  */
57982cd038dSYoshinobu Inoue void
58082cd038dSYoshinobu Inoue frag6_enq(af6, up6)
58182cd038dSYoshinobu Inoue 	struct ip6asfrag *af6, *up6;
58282cd038dSYoshinobu Inoue {
58382cd038dSYoshinobu Inoue 	af6->ip6af_up = up6;
58482cd038dSYoshinobu Inoue 	af6->ip6af_down = up6->ip6af_down;
58582cd038dSYoshinobu Inoue 	up6->ip6af_down->ip6af_up = af6;
58682cd038dSYoshinobu Inoue 	up6->ip6af_down = af6;
58782cd038dSYoshinobu Inoue }
58882cd038dSYoshinobu Inoue 
58982cd038dSYoshinobu Inoue /*
59082cd038dSYoshinobu Inoue  * To frag6_enq as remque is to insque.
59182cd038dSYoshinobu Inoue  */
59282cd038dSYoshinobu Inoue void
59382cd038dSYoshinobu Inoue frag6_deq(af6)
59482cd038dSYoshinobu Inoue 	struct ip6asfrag *af6;
59582cd038dSYoshinobu Inoue {
59682cd038dSYoshinobu Inoue 	af6->ip6af_up->ip6af_down = af6->ip6af_down;
59782cd038dSYoshinobu Inoue 	af6->ip6af_down->ip6af_up = af6->ip6af_up;
59882cd038dSYoshinobu Inoue }
59982cd038dSYoshinobu Inoue 
60082cd038dSYoshinobu Inoue void
60182cd038dSYoshinobu Inoue frag6_insque(new, old)
60282cd038dSYoshinobu Inoue 	struct ip6q *new, *old;
60382cd038dSYoshinobu Inoue {
60482cd038dSYoshinobu Inoue 	new->ip6q_prev = old;
60582cd038dSYoshinobu Inoue 	new->ip6q_next = old->ip6q_next;
60682cd038dSYoshinobu Inoue 	old->ip6q_next->ip6q_prev= new;
60782cd038dSYoshinobu Inoue 	old->ip6q_next = new;
60882cd038dSYoshinobu Inoue }
60982cd038dSYoshinobu Inoue 
61082cd038dSYoshinobu Inoue void
61182cd038dSYoshinobu Inoue frag6_remque(p6)
61282cd038dSYoshinobu Inoue 	struct ip6q *p6;
61382cd038dSYoshinobu Inoue {
61482cd038dSYoshinobu Inoue 	p6->ip6q_prev->ip6q_next = p6->ip6q_next;
61582cd038dSYoshinobu Inoue 	p6->ip6q_next->ip6q_prev = p6->ip6q_prev;
61682cd038dSYoshinobu Inoue }
61782cd038dSYoshinobu Inoue 
61882cd038dSYoshinobu Inoue /*
61982cd038dSYoshinobu Inoue  * IP timer processing;
62082cd038dSYoshinobu Inoue  * if a timer expires on a reassembly
62182cd038dSYoshinobu Inoue  * queue, discard it.
62282cd038dSYoshinobu Inoue  */
62382cd038dSYoshinobu Inoue void
62482cd038dSYoshinobu Inoue frag6_slowtimo()
62582cd038dSYoshinobu Inoue {
62682cd038dSYoshinobu Inoue 	struct ip6q *q6;
62782cd038dSYoshinobu Inoue 	int s = splnet();
628686cdd19SJun-ichiro itojun Hagino #if 0
629686cdd19SJun-ichiro itojun Hagino 	extern struct	route_in6 ip6_forward_rt;
630686cdd19SJun-ichiro itojun Hagino #endif
63182cd038dSYoshinobu Inoue 
63282cd038dSYoshinobu Inoue 	frag6_doing_reass = 1;
63382cd038dSYoshinobu Inoue 	q6 = ip6q.ip6q_next;
63482cd038dSYoshinobu Inoue 	if (q6)
63582cd038dSYoshinobu Inoue 		while (q6 != &ip6q) {
63682cd038dSYoshinobu Inoue 			--q6->ip6q_ttl;
63782cd038dSYoshinobu Inoue 			q6 = q6->ip6q_next;
63882cd038dSYoshinobu Inoue 			if (q6->ip6q_prev->ip6q_ttl == 0) {
63982cd038dSYoshinobu Inoue 				ip6stat.ip6s_fragtimeout++;
64082cd038dSYoshinobu Inoue 				/* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */
64182cd038dSYoshinobu Inoue 				frag6_freef(q6->ip6q_prev);
64282cd038dSYoshinobu Inoue 			}
64382cd038dSYoshinobu Inoue 		}
64482cd038dSYoshinobu Inoue 	/*
64582cd038dSYoshinobu Inoue 	 * If we are over the maximum number of fragments
64682cd038dSYoshinobu Inoue 	 * (due to the limit being lowered), drain off
64782cd038dSYoshinobu Inoue 	 * enough to get down to the new limit.
64882cd038dSYoshinobu Inoue 	 */
64982cd038dSYoshinobu Inoue 	while (frag6_nfragpackets > (u_int)ip6_maxfragpackets) {
65082cd038dSYoshinobu Inoue 		ip6stat.ip6s_fragoverflow++;
65182cd038dSYoshinobu Inoue 		/* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */
65282cd038dSYoshinobu Inoue 		frag6_freef(ip6q.ip6q_prev);
65382cd038dSYoshinobu Inoue 	}
65482cd038dSYoshinobu Inoue 	frag6_doing_reass = 0;
655686cdd19SJun-ichiro itojun Hagino 
656686cdd19SJun-ichiro itojun Hagino #if 0
657686cdd19SJun-ichiro itojun Hagino 	/*
658686cdd19SJun-ichiro itojun Hagino 	 * Routing changes might produce a better route than we last used;
659686cdd19SJun-ichiro itojun Hagino 	 * make sure we notice eventually, even if forwarding only for one
660686cdd19SJun-ichiro itojun Hagino 	 * destination and the cache is never replaced.
661686cdd19SJun-ichiro itojun Hagino 	 */
662686cdd19SJun-ichiro itojun Hagino 	if (ip6_forward_rt.ro_rt) {
663686cdd19SJun-ichiro itojun Hagino 		RTFREE(ip6_forward_rt.ro_rt);
664686cdd19SJun-ichiro itojun Hagino 		ip6_forward_rt.ro_rt = 0;
665686cdd19SJun-ichiro itojun Hagino 	}
666686cdd19SJun-ichiro itojun Hagino 	if (ipsrcchk_rt.ro_rt) {
667686cdd19SJun-ichiro itojun Hagino 		RTFREE(ipsrcchk_rt.ro_rt);
668686cdd19SJun-ichiro itojun Hagino 		ipsrcchk_rt.ro_rt = 0;
669686cdd19SJun-ichiro itojun Hagino 	}
670686cdd19SJun-ichiro itojun Hagino #endif
671686cdd19SJun-ichiro itojun Hagino 
67282cd038dSYoshinobu Inoue 	splx(s);
67382cd038dSYoshinobu Inoue }
67482cd038dSYoshinobu Inoue 
67582cd038dSYoshinobu Inoue /*
67682cd038dSYoshinobu Inoue  * Drain off all datagram fragments.
67782cd038dSYoshinobu Inoue  */
67882cd038dSYoshinobu Inoue void
67982cd038dSYoshinobu Inoue frag6_drain()
68082cd038dSYoshinobu Inoue {
68182cd038dSYoshinobu Inoue 	if (frag6_doing_reass)
68282cd038dSYoshinobu Inoue 		return;
68382cd038dSYoshinobu Inoue 	while (ip6q.ip6q_next != &ip6q) {
68482cd038dSYoshinobu Inoue 		ip6stat.ip6s_fragdropped++;
68582cd038dSYoshinobu Inoue 		/* XXX in6_ifstat_inc(ifp, ifs6_reass_fail) */
68682cd038dSYoshinobu Inoue 		frag6_freef(ip6q.ip6q_next);
68782cd038dSYoshinobu Inoue 	}
68882cd038dSYoshinobu Inoue }
689