xref: /openbmc/linux/net/ipv6/reassembly.c (revision d6bebca92c663fb216c072193945946f3807ca7f)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  *	IPv6 fragment reassembly
31da177e4SLinus Torvalds  *	Linux INET6 implementation
41da177e4SLinus Torvalds  *
51da177e4SLinus Torvalds  *	Authors:
61da177e4SLinus Torvalds  *	Pedro Roque		<roque@di.fc.ul.pt>
71da177e4SLinus Torvalds  *
81da177e4SLinus Torvalds  *	Based on: net/ipv4/ip_fragment.c
91da177e4SLinus Torvalds  *
101da177e4SLinus Torvalds  *	This program is free software; you can redistribute it and/or
111da177e4SLinus Torvalds  *      modify it under the terms of the GNU General Public License
121da177e4SLinus Torvalds  *      as published by the Free Software Foundation; either version
131da177e4SLinus Torvalds  *      2 of the License, or (at your option) any later version.
141da177e4SLinus Torvalds  */
151da177e4SLinus Torvalds 
161da177e4SLinus Torvalds /*
171da177e4SLinus Torvalds  *	Fixes:
181da177e4SLinus Torvalds  *	Andi Kleen	Make it work with multiple hosts.
191da177e4SLinus Torvalds  *			More RFC compliance.
201da177e4SLinus Torvalds  *
211da177e4SLinus Torvalds  *      Horst von Brand Add missing #include <linux/string.h>
221da177e4SLinus Torvalds  *	Alexey Kuznetsov	SMP races, threading, cleanup.
231da177e4SLinus Torvalds  *	Patrick McHardy		LRU queue of frag heads for evictor.
241da177e4SLinus Torvalds  *	Mitsuru KANDA @USAGI	Register inet6_protocol{}.
251da177e4SLinus Torvalds  *	David Stevens and
261da177e4SLinus Torvalds  *	YOSHIFUJI,H. @USAGI	Always remove fragment header to
271da177e4SLinus Torvalds  *				calculate ICV correctly.
281da177e4SLinus Torvalds  */
291da177e4SLinus Torvalds #include <linux/errno.h>
301da177e4SLinus Torvalds #include <linux/types.h>
311da177e4SLinus Torvalds #include <linux/string.h>
321da177e4SLinus Torvalds #include <linux/socket.h>
331da177e4SLinus Torvalds #include <linux/sockios.h>
341da177e4SLinus Torvalds #include <linux/jiffies.h>
351da177e4SLinus Torvalds #include <linux/net.h>
361da177e4SLinus Torvalds #include <linux/list.h>
371da177e4SLinus Torvalds #include <linux/netdevice.h>
381da177e4SLinus Torvalds #include <linux/in6.h>
391da177e4SLinus Torvalds #include <linux/ipv6.h>
401da177e4SLinus Torvalds #include <linux/icmpv6.h>
411da177e4SLinus Torvalds #include <linux/random.h>
421da177e4SLinus Torvalds #include <linux/jhash.h>
43f61944efSHerbert Xu #include <linux/skbuff.h>
445a0e3ad6STejun Heo #include <linux/slab.h>
451da177e4SLinus Torvalds 
461da177e4SLinus Torvalds #include <net/sock.h>
471da177e4SLinus Torvalds #include <net/snmp.h>
481da177e4SLinus Torvalds 
491da177e4SLinus Torvalds #include <net/ipv6.h>
50a11d206dSYOSHIFUJI Hideaki #include <net/ip6_route.h>
511da177e4SLinus Torvalds #include <net/protocol.h>
521da177e4SLinus Torvalds #include <net/transp_v6.h>
531da177e4SLinus Torvalds #include <net/rawv6.h>
541da177e4SLinus Torvalds #include <net/ndisc.h>
551da177e4SLinus Torvalds #include <net/addrconf.h>
565ab11c98SPavel Emelyanov #include <net/inet_frag.h>
571da177e4SLinus Torvalds 
581da177e4SLinus Torvalds struct ip6frag_skb_cb
591da177e4SLinus Torvalds {
601da177e4SLinus Torvalds 	struct inet6_skb_parm	h;
611da177e4SLinus Torvalds 	int			offset;
621da177e4SLinus Torvalds };
631da177e4SLinus Torvalds 
641da177e4SLinus Torvalds #define FRAG6_CB(skb)	((struct ip6frag_skb_cb*)((skb)->cb))
651da177e4SLinus Torvalds 
661da177e4SLinus Torvalds 
671da177e4SLinus Torvalds /*
681da177e4SLinus Torvalds  *	Equivalent of ipv4 struct ipq
691da177e4SLinus Torvalds  */
701da177e4SLinus Torvalds 
711da177e4SLinus Torvalds struct frag_queue
721da177e4SLinus Torvalds {
735ab11c98SPavel Emelyanov 	struct inet_frag_queue	q;
741da177e4SLinus Torvalds 
75e69a4adcSAl Viro 	__be32			id;		/* fragment id		*/
760b5ccb2eSPatrick McHardy 	u32			user;
771da177e4SLinus Torvalds 	struct in6_addr		saddr;
781da177e4SLinus Torvalds 	struct in6_addr		daddr;
791da177e4SLinus Torvalds 
801da177e4SLinus Torvalds 	int			iif;
811da177e4SLinus Torvalds 	unsigned int		csum;
821da177e4SLinus Torvalds 	__u16			nhoffset;
831da177e4SLinus Torvalds };
841da177e4SLinus Torvalds 
857eb95156SPavel Emelyanov static struct inet_frags ip6_frags;
861da177e4SLinus Torvalds 
87e5a2bb84SPavel Emelyanov int ip6_frag_nqueues(struct net *net)
887eb95156SPavel Emelyanov {
89e5a2bb84SPavel Emelyanov 	return net->ipv6.frags.nqueues;
907eb95156SPavel Emelyanov }
911da177e4SLinus Torvalds 
926ddc0822SPavel Emelyanov int ip6_frag_mem(struct net *net)
937eb95156SPavel Emelyanov {
946ddc0822SPavel Emelyanov 	return atomic_read(&net->ipv6.frags.mem);
957eb95156SPavel Emelyanov }
961da177e4SLinus Torvalds 
97f61944efSHerbert Xu static int ip6_frag_reasm(struct frag_queue *fq, struct sk_buff *prev,
98f61944efSHerbert Xu 			  struct net_device *dev);
99f61944efSHerbert Xu 
100f6596f9dSZach Brown /*
101f6596f9dSZach Brown  * callers should be careful not to use the hash value outside the ipfrag_lock
102f6596f9dSZach Brown  * as doing so could race with ipfrag_hash_rnd being recalculated.
103f6596f9dSZach Brown  */
10493c8b90fSIlpo Järvinen unsigned int inet6_hash_frag(__be32 id, const struct in6_addr *saddr,
10593c8b90fSIlpo Järvinen 			     const struct in6_addr *daddr, u32 rnd)
1061da177e4SLinus Torvalds {
1071da177e4SLinus Torvalds 	u32 a, b, c;
1081da177e4SLinus Torvalds 
109e69a4adcSAl Viro 	a = (__force u32)saddr->s6_addr32[0];
110e69a4adcSAl Viro 	b = (__force u32)saddr->s6_addr32[1];
111e69a4adcSAl Viro 	c = (__force u32)saddr->s6_addr32[2];
1121da177e4SLinus Torvalds 
1131da177e4SLinus Torvalds 	a += JHASH_GOLDEN_RATIO;
1141da177e4SLinus Torvalds 	b += JHASH_GOLDEN_RATIO;
11593c8b90fSIlpo Järvinen 	c += rnd;
1161da177e4SLinus Torvalds 	__jhash_mix(a, b, c);
1171da177e4SLinus Torvalds 
118e69a4adcSAl Viro 	a += (__force u32)saddr->s6_addr32[3];
119e69a4adcSAl Viro 	b += (__force u32)daddr->s6_addr32[0];
120e69a4adcSAl Viro 	c += (__force u32)daddr->s6_addr32[1];
1211da177e4SLinus Torvalds 	__jhash_mix(a, b, c);
1221da177e4SLinus Torvalds 
123e69a4adcSAl Viro 	a += (__force u32)daddr->s6_addr32[2];
124e69a4adcSAl Viro 	b += (__force u32)daddr->s6_addr32[3];
125e69a4adcSAl Viro 	c += (__force u32)id;
1261da177e4SLinus Torvalds 	__jhash_mix(a, b, c);
1271da177e4SLinus Torvalds 
1287eb95156SPavel Emelyanov 	return c & (INETFRAGS_HASHSZ - 1);
1291da177e4SLinus Torvalds }
13093c8b90fSIlpo Järvinen EXPORT_SYMBOL_GPL(inet6_hash_frag);
1311da177e4SLinus Torvalds 
132321a3a99SPavel Emelyanov static unsigned int ip6_hashfn(struct inet_frag_queue *q)
1331da177e4SLinus Torvalds {
134321a3a99SPavel Emelyanov 	struct frag_queue *fq;
1351da177e4SLinus Torvalds 
136321a3a99SPavel Emelyanov 	fq = container_of(q, struct frag_queue, q);
13793c8b90fSIlpo Järvinen 	return inet6_hash_frag(fq->id, &fq->saddr, &fq->daddr, ip6_frags.rnd);
1381da177e4SLinus Torvalds }
1391da177e4SLinus Torvalds 
140abd6523dSPavel Emelyanov int ip6_frag_match(struct inet_frag_queue *q, void *a)
141abd6523dSPavel Emelyanov {
142abd6523dSPavel Emelyanov 	struct frag_queue *fq;
143abd6523dSPavel Emelyanov 	struct ip6_create_arg *arg = a;
144abd6523dSPavel Emelyanov 
145abd6523dSPavel Emelyanov 	fq = container_of(q, struct frag_queue, q);
1460b5ccb2eSPatrick McHardy 	return (fq->id == arg->id && fq->user == arg->user &&
147abd6523dSPavel Emelyanov 			ipv6_addr_equal(&fq->saddr, arg->src) &&
148abd6523dSPavel Emelyanov 			ipv6_addr_equal(&fq->daddr, arg->dst));
149abd6523dSPavel Emelyanov }
150abd6523dSPavel Emelyanov EXPORT_SYMBOL(ip6_frag_match);
151abd6523dSPavel Emelyanov 
1521da177e4SLinus Torvalds /* Memory Tracking Functions. */
153a95d8c88SEric Dumazet static void frag_kfree_skb(struct netns_frags *nf, struct sk_buff *skb)
1541da177e4SLinus Torvalds {
1556ddc0822SPavel Emelyanov 	atomic_sub(skb->truesize, &nf->mem);
1561da177e4SLinus Torvalds 	kfree_skb(skb);
1571da177e4SLinus Torvalds }
1581da177e4SLinus Torvalds 
159c6fda282SPavel Emelyanov void ip6_frag_init(struct inet_frag_queue *q, void *a)
160c6fda282SPavel Emelyanov {
161c6fda282SPavel Emelyanov 	struct frag_queue *fq = container_of(q, struct frag_queue, q);
162c6fda282SPavel Emelyanov 	struct ip6_create_arg *arg = a;
163c6fda282SPavel Emelyanov 
164c6fda282SPavel Emelyanov 	fq->id = arg->id;
1650b5ccb2eSPatrick McHardy 	fq->user = arg->user;
166c6fda282SPavel Emelyanov 	ipv6_addr_copy(&fq->saddr, arg->src);
167c6fda282SPavel Emelyanov 	ipv6_addr_copy(&fq->daddr, arg->dst);
168c6fda282SPavel Emelyanov }
169c6fda282SPavel Emelyanov EXPORT_SYMBOL(ip6_frag_init);
170c6fda282SPavel Emelyanov 
1711da177e4SLinus Torvalds /* Destruction primitives. */
1721da177e4SLinus Torvalds 
1734b6cb5d8SPavel Emelyanov static __inline__ void fq_put(struct frag_queue *fq)
1741da177e4SLinus Torvalds {
175762cc408SPavel Emelyanov 	inet_frag_put(&fq->q, &ip6_frags);
1761da177e4SLinus Torvalds }
1771da177e4SLinus Torvalds 
1781da177e4SLinus Torvalds /* Kill fq entry. It is not destroyed immediately,
1791da177e4SLinus Torvalds  * because caller (and someone more) holds reference count.
1801da177e4SLinus Torvalds  */
1811da177e4SLinus Torvalds static __inline__ void fq_kill(struct frag_queue *fq)
1821da177e4SLinus Torvalds {
183277e650dSPavel Emelyanov 	inet_frag_kill(&fq->q, &ip6_frags);
1841da177e4SLinus Torvalds }
1851da177e4SLinus Torvalds 
1866ddc0822SPavel Emelyanov static void ip6_evictor(struct net *net, struct inet6_dev *idev)
1871da177e4SLinus Torvalds {
1888e7999c4SPavel Emelyanov 	int evicted;
1891da177e4SLinus Torvalds 
1906ddc0822SPavel Emelyanov 	evicted = inet_frag_evictor(&net->ipv6.frags, &ip6_frags);
1918e7999c4SPavel Emelyanov 	if (evicted)
192821d5777SDenis V. Lunev 		IP6_ADD_STATS_BH(net, idev, IPSTATS_MIB_REASMFAILS, evicted);
1931da177e4SLinus Torvalds }
1941da177e4SLinus Torvalds 
1951da177e4SLinus Torvalds static void ip6_frag_expire(unsigned long data)
1961da177e4SLinus Torvalds {
197e521db9dSPavel Emelyanov 	struct frag_queue *fq;
198a11d206dSYOSHIFUJI Hideaki 	struct net_device *dev = NULL;
1994ac2ccd0SDaniel Lezcano 	struct net *net;
2001da177e4SLinus Torvalds 
201e521db9dSPavel Emelyanov 	fq = container_of((struct inet_frag_queue *)data, struct frag_queue, q);
202e521db9dSPavel Emelyanov 
2035ab11c98SPavel Emelyanov 	spin_lock(&fq->q.lock);
2041da177e4SLinus Torvalds 
205bc578a54SJoe Perches 	if (fq->q.last_in & INET_FRAG_COMPLETE)
2061da177e4SLinus Torvalds 		goto out;
2071da177e4SLinus Torvalds 
2081da177e4SLinus Torvalds 	fq_kill(fq);
2091da177e4SLinus Torvalds 
2104ac2ccd0SDaniel Lezcano 	net = container_of(fq->q.net, struct net, ipv6.frags);
211a11d206dSYOSHIFUJI Hideaki 	rcu_read_lock();
21269df9d59SEric Dumazet 	dev = dev_get_by_index_rcu(net, fq->iif);
21369df9d59SEric Dumazet 	if (!dev)
21469df9d59SEric Dumazet 		goto out_rcu_unlock;
21569df9d59SEric Dumazet 
216483a47d2SDenis V. Lunev 	IP6_INC_STATS_BH(net, __in6_dev_get(dev), IPSTATS_MIB_REASMTIMEOUT);
217483a47d2SDenis V. Lunev 	IP6_INC_STATS_BH(net, __in6_dev_get(dev), IPSTATS_MIB_REASMFAILS);
2181da177e4SLinus Torvalds 
21978c784c4SIngo Oeser 	/* Don't send error if the first segment did not arrive. */
220bc578a54SJoe Perches 	if (!(fq->q.last_in & INET_FRAG_FIRST_IN) || !fq->q.fragments)
22169df9d59SEric Dumazet 		goto out_rcu_unlock;
22278c784c4SIngo Oeser 
2231da177e4SLinus Torvalds 	/*
2241da177e4SLinus Torvalds 	   But use as source device on which LAST ARRIVED
2251da177e4SLinus Torvalds 	   segment was received. And do not use fq->dev
2261da177e4SLinus Torvalds 	   pointer directly, device might already disappeared.
2271da177e4SLinus Torvalds 	 */
2285ab11c98SPavel Emelyanov 	fq->q.fragments->dev = dev;
2293ffe533cSAlexey Dobriyan 	icmpv6_send(fq->q.fragments, ICMPV6_TIME_EXCEED, ICMPV6_EXC_FRAGTIME, 0);
23069df9d59SEric Dumazet out_rcu_unlock:
23169df9d59SEric Dumazet 	rcu_read_unlock();
2321da177e4SLinus Torvalds out:
2335ab11c98SPavel Emelyanov 	spin_unlock(&fq->q.lock);
2344b6cb5d8SPavel Emelyanov 	fq_put(fq);
2351da177e4SLinus Torvalds }
2361da177e4SLinus Torvalds 
237abd6523dSPavel Emelyanov static __inline__ struct frag_queue *
2389546377cSShan Wei fq_find(struct net *net, __be32 id, struct in6_addr *src, struct in6_addr *dst)
2391da177e4SLinus Torvalds {
240c6fda282SPavel Emelyanov 	struct inet_frag_queue *q;
241c6fda282SPavel Emelyanov 	struct ip6_create_arg arg;
242abd6523dSPavel Emelyanov 	unsigned int hash;
2431da177e4SLinus Torvalds 
244c6fda282SPavel Emelyanov 	arg.id = id;
2450b5ccb2eSPatrick McHardy 	arg.user = IP6_DEFRAG_LOCAL_DELIVER;
246c6fda282SPavel Emelyanov 	arg.src = src;
247c6fda282SPavel Emelyanov 	arg.dst = dst;
2489a375803SPavel Emelyanov 
2499a375803SPavel Emelyanov 	read_lock(&ip6_frags.lock);
25093c8b90fSIlpo Järvinen 	hash = inet6_hash_frag(id, src, dst, ip6_frags.rnd);
251c6fda282SPavel Emelyanov 
252ac18e750SPavel Emelyanov 	q = inet_frag_find(&net->ipv6.frags, &ip6_frags, &arg, hash);
253c6fda282SPavel Emelyanov 	if (q == NULL)
2549546377cSShan Wei 		return NULL;
2551da177e4SLinus Torvalds 
256c6fda282SPavel Emelyanov 	return container_of(q, struct frag_queue, q);
2571da177e4SLinus Torvalds }
2581da177e4SLinus Torvalds 
259f61944efSHerbert Xu static int ip6_frag_queue(struct frag_queue *fq, struct sk_buff *skb,
2601da177e4SLinus Torvalds 			   struct frag_hdr *fhdr, int nhoff)
2611da177e4SLinus Torvalds {
2621da177e4SLinus Torvalds 	struct sk_buff *prev, *next;
263f61944efSHerbert Xu 	struct net_device *dev;
2641da177e4SLinus Torvalds 	int offset, end;
265adf30907SEric Dumazet 	struct net *net = dev_net(skb_dst(skb)->dev);
2661da177e4SLinus Torvalds 
267bc578a54SJoe Perches 	if (fq->q.last_in & INET_FRAG_COMPLETE)
2681da177e4SLinus Torvalds 		goto err;
2691da177e4SLinus Torvalds 
2701da177e4SLinus Torvalds 	offset = ntohs(fhdr->frag_off) & ~0x7;
2710660e03fSArnaldo Carvalho de Melo 	end = offset + (ntohs(ipv6_hdr(skb)->payload_len) -
2720660e03fSArnaldo Carvalho de Melo 			((u8 *)(fhdr + 1) - (u8 *)(ipv6_hdr(skb) + 1)));
2731da177e4SLinus Torvalds 
2741da177e4SLinus Torvalds 	if ((unsigned int)end > IPV6_MAXPLEN) {
275adf30907SEric Dumazet 		IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
276a11d206dSYOSHIFUJI Hideaki 				 IPSTATS_MIB_INHDRERRORS);
277d56f90a7SArnaldo Carvalho de Melo 		icmpv6_param_prob(skb, ICMPV6_HDR_FIELD,
278d56f90a7SArnaldo Carvalho de Melo 				  ((u8 *)&fhdr->frag_off -
279d56f90a7SArnaldo Carvalho de Melo 				   skb_network_header(skb)));
280f61944efSHerbert Xu 		return -1;
2811da177e4SLinus Torvalds 	}
2821da177e4SLinus Torvalds 
283d56f90a7SArnaldo Carvalho de Melo 	if (skb->ip_summed == CHECKSUM_COMPLETE) {
284d56f90a7SArnaldo Carvalho de Melo 		const unsigned char *nh = skb_network_header(skb);
2851da177e4SLinus Torvalds 		skb->csum = csum_sub(skb->csum,
286d56f90a7SArnaldo Carvalho de Melo 				     csum_partial(nh, (u8 *)(fhdr + 1) - nh,
287d56f90a7SArnaldo Carvalho de Melo 						  0));
288d56f90a7SArnaldo Carvalho de Melo 	}
2891da177e4SLinus Torvalds 
2901da177e4SLinus Torvalds 	/* Is this the final fragment? */
2911da177e4SLinus Torvalds 	if (!(fhdr->frag_off & htons(IP6_MF))) {
2921da177e4SLinus Torvalds 		/* If we already have some bits beyond end
2931da177e4SLinus Torvalds 		 * or have different end, the segment is corrupted.
2941da177e4SLinus Torvalds 		 */
2955ab11c98SPavel Emelyanov 		if (end < fq->q.len ||
296bc578a54SJoe Perches 		    ((fq->q.last_in & INET_FRAG_LAST_IN) && end != fq->q.len))
2971da177e4SLinus Torvalds 			goto err;
298bc578a54SJoe Perches 		fq->q.last_in |= INET_FRAG_LAST_IN;
2995ab11c98SPavel Emelyanov 		fq->q.len = end;
3001da177e4SLinus Torvalds 	} else {
3011da177e4SLinus Torvalds 		/* Check if the fragment is rounded to 8 bytes.
3021da177e4SLinus Torvalds 		 * Required by the RFC.
3031da177e4SLinus Torvalds 		 */
3041da177e4SLinus Torvalds 		if (end & 0x7) {
3051da177e4SLinus Torvalds 			/* RFC2460 says always send parameter problem in
3061da177e4SLinus Torvalds 			 * this case. -DaveM
3071da177e4SLinus Torvalds 			 */
308adf30907SEric Dumazet 			IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)),
309a11d206dSYOSHIFUJI Hideaki 					 IPSTATS_MIB_INHDRERRORS);
3101da177e4SLinus Torvalds 			icmpv6_param_prob(skb, ICMPV6_HDR_FIELD,
3111da177e4SLinus Torvalds 					  offsetof(struct ipv6hdr, payload_len));
312f61944efSHerbert Xu 			return -1;
3131da177e4SLinus Torvalds 		}
3145ab11c98SPavel Emelyanov 		if (end > fq->q.len) {
3151da177e4SLinus Torvalds 			/* Some bits beyond end -> corruption. */
316bc578a54SJoe Perches 			if (fq->q.last_in & INET_FRAG_LAST_IN)
3171da177e4SLinus Torvalds 				goto err;
3185ab11c98SPavel Emelyanov 			fq->q.len = end;
3191da177e4SLinus Torvalds 		}
3201da177e4SLinus Torvalds 	}
3211da177e4SLinus Torvalds 
3221da177e4SLinus Torvalds 	if (end == offset)
3231da177e4SLinus Torvalds 		goto err;
3241da177e4SLinus Torvalds 
3251da177e4SLinus Torvalds 	/* Point into the IP datagram 'data' part. */
3261da177e4SLinus Torvalds 	if (!pskb_pull(skb, (u8 *) (fhdr + 1) - skb->data))
3271da177e4SLinus Torvalds 		goto err;
32842ca89c1SStephen Hemminger 
32942ca89c1SStephen Hemminger 	if (pskb_trim_rcsum(skb, end - offset))
3301da177e4SLinus Torvalds 		goto err;
3311da177e4SLinus Torvalds 
3321da177e4SLinus Torvalds 	/* Find out which fragments are in front and at the back of us
3331da177e4SLinus Torvalds 	 * in the chain of fragments so far.  We must know where to put
3341da177e4SLinus Torvalds 	 * this fragment, right?
3351da177e4SLinus Torvalds 	 */
336*d6bebca9SChangli Gao 	prev = fq->q.fragments_tail;
337*d6bebca9SChangli Gao 	if (!prev || FRAG6_CB(prev)->offset < offset) {
338*d6bebca9SChangli Gao 		next = NULL;
339*d6bebca9SChangli Gao 		goto found;
340*d6bebca9SChangli Gao 	}
3411da177e4SLinus Torvalds 	prev = NULL;
3425ab11c98SPavel Emelyanov 	for(next = fq->q.fragments; next != NULL; next = next->next) {
3431da177e4SLinus Torvalds 		if (FRAG6_CB(next)->offset >= offset)
3441da177e4SLinus Torvalds 			break;	/* bingo! */
3451da177e4SLinus Torvalds 		prev = next;
3461da177e4SLinus Torvalds 	}
3471da177e4SLinus Torvalds 
348*d6bebca9SChangli Gao found:
3491da177e4SLinus Torvalds 	/* We found where to put this one.  Check for overlap with
3501da177e4SLinus Torvalds 	 * preceding fragment, and, if needed, align things so that
3511da177e4SLinus Torvalds 	 * any overlaps are eliminated.
3521da177e4SLinus Torvalds 	 */
3531da177e4SLinus Torvalds 	if (prev) {
3541da177e4SLinus Torvalds 		int i = (FRAG6_CB(prev)->offset + prev->len) - offset;
3551da177e4SLinus Torvalds 
3561da177e4SLinus Torvalds 		if (i > 0) {
3571da177e4SLinus Torvalds 			offset += i;
3581da177e4SLinus Torvalds 			if (end <= offset)
3591da177e4SLinus Torvalds 				goto err;
3601da177e4SLinus Torvalds 			if (!pskb_pull(skb, i))
3611da177e4SLinus Torvalds 				goto err;
3621da177e4SLinus Torvalds 			if (skb->ip_summed != CHECKSUM_UNNECESSARY)
3631da177e4SLinus Torvalds 				skb->ip_summed = CHECKSUM_NONE;
3641da177e4SLinus Torvalds 		}
3651da177e4SLinus Torvalds 	}
3661da177e4SLinus Torvalds 
3671da177e4SLinus Torvalds 	/* Look for overlap with succeeding segments.
3681da177e4SLinus Torvalds 	 * If we can merge fragments, do it.
3691da177e4SLinus Torvalds 	 */
3701da177e4SLinus Torvalds 	while (next && FRAG6_CB(next)->offset < end) {
3711da177e4SLinus Torvalds 		int i = end - FRAG6_CB(next)->offset; /* overlap is 'i' bytes */
3721da177e4SLinus Torvalds 
3731da177e4SLinus Torvalds 		if (i < next->len) {
3741da177e4SLinus Torvalds 			/* Eat head of the next overlapped fragment
3751da177e4SLinus Torvalds 			 * and leave the loop. The next ones cannot overlap.
3761da177e4SLinus Torvalds 			 */
3771da177e4SLinus Torvalds 			if (!pskb_pull(next, i))
3781da177e4SLinus Torvalds 				goto err;
3791da177e4SLinus Torvalds 			FRAG6_CB(next)->offset += i;	/* next fragment */
3805ab11c98SPavel Emelyanov 			fq->q.meat -= i;
3811da177e4SLinus Torvalds 			if (next->ip_summed != CHECKSUM_UNNECESSARY)
3821da177e4SLinus Torvalds 				next->ip_summed = CHECKSUM_NONE;
3831da177e4SLinus Torvalds 			break;
3841da177e4SLinus Torvalds 		} else {
3851da177e4SLinus Torvalds 			struct sk_buff *free_it = next;
3861da177e4SLinus Torvalds 
3871da177e4SLinus Torvalds 			/* Old fragment is completely overridden with
3881da177e4SLinus Torvalds 			 * new one drop it.
3891da177e4SLinus Torvalds 			 */
3901da177e4SLinus Torvalds 			next = next->next;
3911da177e4SLinus Torvalds 
3921da177e4SLinus Torvalds 			if (prev)
3931da177e4SLinus Torvalds 				prev->next = next;
3941da177e4SLinus Torvalds 			else
3955ab11c98SPavel Emelyanov 				fq->q.fragments = next;
3961da177e4SLinus Torvalds 
3975ab11c98SPavel Emelyanov 			fq->q.meat -= free_it->len;
398a95d8c88SEric Dumazet 			frag_kfree_skb(fq->q.net, free_it);
3991da177e4SLinus Torvalds 		}
4001da177e4SLinus Torvalds 	}
4011da177e4SLinus Torvalds 
4021da177e4SLinus Torvalds 	FRAG6_CB(skb)->offset = offset;
4031da177e4SLinus Torvalds 
4041da177e4SLinus Torvalds 	/* Insert this fragment in the chain of fragments. */
4051da177e4SLinus Torvalds 	skb->next = next;
406*d6bebca9SChangli Gao 	if (!next)
407*d6bebca9SChangli Gao 		fq->q.fragments_tail = skb;
4081da177e4SLinus Torvalds 	if (prev)
4091da177e4SLinus Torvalds 		prev->next = skb;
4101da177e4SLinus Torvalds 	else
4115ab11c98SPavel Emelyanov 		fq->q.fragments = skb;
4121da177e4SLinus Torvalds 
413f61944efSHerbert Xu 	dev = skb->dev;
414f61944efSHerbert Xu 	if (dev) {
415f61944efSHerbert Xu 		fq->iif = dev->ifindex;
4161da177e4SLinus Torvalds 		skb->dev = NULL;
417f61944efSHerbert Xu 	}
4185ab11c98SPavel Emelyanov 	fq->q.stamp = skb->tstamp;
4195ab11c98SPavel Emelyanov 	fq->q.meat += skb->len;
4206ddc0822SPavel Emelyanov 	atomic_add(skb->truesize, &fq->q.net->mem);
4211da177e4SLinus Torvalds 
4221da177e4SLinus Torvalds 	/* The first fragment.
4231da177e4SLinus Torvalds 	 * nhoffset is obtained from the first fragment, of course.
4241da177e4SLinus Torvalds 	 */
4251da177e4SLinus Torvalds 	if (offset == 0) {
4261da177e4SLinus Torvalds 		fq->nhoffset = nhoff;
427bc578a54SJoe Perches 		fq->q.last_in |= INET_FRAG_FIRST_IN;
4281da177e4SLinus Torvalds 	}
429f61944efSHerbert Xu 
430bc578a54SJoe Perches 	if (fq->q.last_in == (INET_FRAG_FIRST_IN | INET_FRAG_LAST_IN) &&
431bc578a54SJoe Perches 	    fq->q.meat == fq->q.len)
432f61944efSHerbert Xu 		return ip6_frag_reasm(fq, prev, dev);
433f61944efSHerbert Xu 
4347eb95156SPavel Emelyanov 	write_lock(&ip6_frags.lock);
4353140c25cSPavel Emelyanov 	list_move_tail(&fq->q.lru_list, &fq->q.net->lru_list);
4367eb95156SPavel Emelyanov 	write_unlock(&ip6_frags.lock);
437f61944efSHerbert Xu 	return -1;
4381da177e4SLinus Torvalds 
4391da177e4SLinus Torvalds err:
440adf30907SEric Dumazet 	IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
4413bd653c8SDenis V. Lunev 		      IPSTATS_MIB_REASMFAILS);
4421da177e4SLinus Torvalds 	kfree_skb(skb);
443f61944efSHerbert Xu 	return -1;
4441da177e4SLinus Torvalds }
4451da177e4SLinus Torvalds 
4461da177e4SLinus Torvalds /*
4471da177e4SLinus Torvalds  *	Check if this packet is complete.
4481da177e4SLinus Torvalds  *	Returns NULL on failure by any reason, and pointer
4491da177e4SLinus Torvalds  *	to current nexthdr field in reassembled frame.
4501da177e4SLinus Torvalds  *
4511da177e4SLinus Torvalds  *	It is called with locked fq, and caller must check that
4521da177e4SLinus Torvalds  *	queue is eligible for reassembly i.e. it is not COMPLETE,
4531da177e4SLinus Torvalds  *	the last and the first frames arrived and all the bits are here.
4541da177e4SLinus Torvalds  */
455f61944efSHerbert Xu static int ip6_frag_reasm(struct frag_queue *fq, struct sk_buff *prev,
4561da177e4SLinus Torvalds 			  struct net_device *dev)
4571da177e4SLinus Torvalds {
4582bad35b7SJorge Boncompte [DTI2] 	struct net *net = container_of(fq->q.net, struct net, ipv6.frags);
4595ab11c98SPavel Emelyanov 	struct sk_buff *fp, *head = fq->q.fragments;
4601da177e4SLinus Torvalds 	int    payload_len;
4611da177e4SLinus Torvalds 	unsigned int nhoff;
4621da177e4SLinus Torvalds 
4631da177e4SLinus Torvalds 	fq_kill(fq);
4641da177e4SLinus Torvalds 
465f61944efSHerbert Xu 	/* Make the one we just received the head. */
466f61944efSHerbert Xu 	if (prev) {
467f61944efSHerbert Xu 		head = prev->next;
468f61944efSHerbert Xu 		fp = skb_clone(head, GFP_ATOMIC);
469f61944efSHerbert Xu 
470f61944efSHerbert Xu 		if (!fp)
471f61944efSHerbert Xu 			goto out_oom;
472f61944efSHerbert Xu 
473f61944efSHerbert Xu 		fp->next = head->next;
474*d6bebca9SChangli Gao 		if (!fp->next)
475*d6bebca9SChangli Gao 			fq->q.fragments_tail = fp;
476f61944efSHerbert Xu 		prev->next = fp;
477f61944efSHerbert Xu 
4785ab11c98SPavel Emelyanov 		skb_morph(head, fq->q.fragments);
4795ab11c98SPavel Emelyanov 		head->next = fq->q.fragments->next;
480f61944efSHerbert Xu 
4815ab11c98SPavel Emelyanov 		kfree_skb(fq->q.fragments);
4825ab11c98SPavel Emelyanov 		fq->q.fragments = head;
483f61944efSHerbert Xu 	}
484f61944efSHerbert Xu 
485547b792cSIlpo Järvinen 	WARN_ON(head == NULL);
486547b792cSIlpo Järvinen 	WARN_ON(FRAG6_CB(head)->offset != 0);
4871da177e4SLinus Torvalds 
4881da177e4SLinus Torvalds 	/* Unfragmented part is taken from the first segment. */
489d56f90a7SArnaldo Carvalho de Melo 	payload_len = ((head->data - skb_network_header(head)) -
4905ab11c98SPavel Emelyanov 		       sizeof(struct ipv6hdr) + fq->q.len -
491d56f90a7SArnaldo Carvalho de Melo 		       sizeof(struct frag_hdr));
4921da177e4SLinus Torvalds 	if (payload_len > IPV6_MAXPLEN)
4931da177e4SLinus Torvalds 		goto out_oversize;
4941da177e4SLinus Torvalds 
4951da177e4SLinus Torvalds 	/* Head of list must not be cloned. */
4961da177e4SLinus Torvalds 	if (skb_cloned(head) && pskb_expand_head(head, 0, 0, GFP_ATOMIC))
4971da177e4SLinus Torvalds 		goto out_oom;
4981da177e4SLinus Torvalds 
4991da177e4SLinus Torvalds 	/* If the first fragment is fragmented itself, we split
5001da177e4SLinus Torvalds 	 * it to two chunks: the first with data and paged part
5011da177e4SLinus Torvalds 	 * and the second, holding only fragments. */
5024d9092bbSDavid S. Miller 	if (skb_has_frags(head)) {
5031da177e4SLinus Torvalds 		struct sk_buff *clone;
5041da177e4SLinus Torvalds 		int i, plen = 0;
5051da177e4SLinus Torvalds 
5061da177e4SLinus Torvalds 		if ((clone = alloc_skb(0, GFP_ATOMIC)) == NULL)
5071da177e4SLinus Torvalds 			goto out_oom;
5081da177e4SLinus Torvalds 		clone->next = head->next;
5091da177e4SLinus Torvalds 		head->next = clone;
5101da177e4SLinus Torvalds 		skb_shinfo(clone)->frag_list = skb_shinfo(head)->frag_list;
5114d9092bbSDavid S. Miller 		skb_frag_list_init(head);
5121da177e4SLinus Torvalds 		for (i=0; i<skb_shinfo(head)->nr_frags; i++)
5131da177e4SLinus Torvalds 			plen += skb_shinfo(head)->frags[i].size;
5141da177e4SLinus Torvalds 		clone->len = clone->data_len = head->data_len - plen;
5151da177e4SLinus Torvalds 		head->data_len -= clone->len;
5161da177e4SLinus Torvalds 		head->len -= clone->len;
5171da177e4SLinus Torvalds 		clone->csum = 0;
5181da177e4SLinus Torvalds 		clone->ip_summed = head->ip_summed;
5196ddc0822SPavel Emelyanov 		atomic_add(clone->truesize, &fq->q.net->mem);
5201da177e4SLinus Torvalds 	}
5211da177e4SLinus Torvalds 
5221da177e4SLinus Torvalds 	/* We have to remove fragment header from datagram and to relocate
5231da177e4SLinus Torvalds 	 * header in order to calculate ICV correctly. */
5241da177e4SLinus Torvalds 	nhoff = fq->nhoffset;
525b0e380b1SArnaldo Carvalho de Melo 	skb_network_header(head)[nhoff] = skb_transport_header(head)[0];
5261da177e4SLinus Torvalds 	memmove(head->head + sizeof(struct frag_hdr), head->head,
5271da177e4SLinus Torvalds 		(head->data - head->head) - sizeof(struct frag_hdr));
528b0e380b1SArnaldo Carvalho de Melo 	head->mac_header += sizeof(struct frag_hdr);
529b0e380b1SArnaldo Carvalho de Melo 	head->network_header += sizeof(struct frag_hdr);
5301da177e4SLinus Torvalds 
5311da177e4SLinus Torvalds 	skb_shinfo(head)->frag_list = head->next;
532badff6d0SArnaldo Carvalho de Melo 	skb_reset_transport_header(head);
533d56f90a7SArnaldo Carvalho de Melo 	skb_push(head, head->data - skb_network_header(head));
5341da177e4SLinus Torvalds 
5351da177e4SLinus Torvalds 	for (fp=head->next; fp; fp = fp->next) {
5361da177e4SLinus Torvalds 		head->data_len += fp->len;
5371da177e4SLinus Torvalds 		head->len += fp->len;
5381da177e4SLinus Torvalds 		if (head->ip_summed != fp->ip_summed)
5391da177e4SLinus Torvalds 			head->ip_summed = CHECKSUM_NONE;
54084fa7933SPatrick McHardy 		else if (head->ip_summed == CHECKSUM_COMPLETE)
5411da177e4SLinus Torvalds 			head->csum = csum_add(head->csum, fp->csum);
5421da177e4SLinus Torvalds 		head->truesize += fp->truesize;
5431da177e4SLinus Torvalds 	}
544d27f9b35SEric Dumazet 	atomic_sub(head->truesize, &fq->q.net->mem);
5451da177e4SLinus Torvalds 
5461da177e4SLinus Torvalds 	head->next = NULL;
5471da177e4SLinus Torvalds 	head->dev = dev;
5485ab11c98SPavel Emelyanov 	head->tstamp = fq->q.stamp;
5490660e03fSArnaldo Carvalho de Melo 	ipv6_hdr(head)->payload_len = htons(payload_len);
550951dbc8aSPatrick McHardy 	IP6CB(head)->nhoff = nhoff;
5511da177e4SLinus Torvalds 
5521da177e4SLinus Torvalds 	/* Yes, and fold redundant checksum back. 8) */
55384fa7933SPatrick McHardy 	if (head->ip_summed == CHECKSUM_COMPLETE)
554d56f90a7SArnaldo Carvalho de Melo 		head->csum = csum_partial(skb_network_header(head),
555cfe1fc77SArnaldo Carvalho de Melo 					  skb_network_header_len(head),
556d56f90a7SArnaldo Carvalho de Melo 					  head->csum);
5571da177e4SLinus Torvalds 
558a11d206dSYOSHIFUJI Hideaki 	rcu_read_lock();
5592bad35b7SJorge Boncompte [DTI2] 	IP6_INC_STATS_BH(net, __in6_dev_get(dev), IPSTATS_MIB_REASMOKS);
560a11d206dSYOSHIFUJI Hideaki 	rcu_read_unlock();
5615ab11c98SPavel Emelyanov 	fq->q.fragments = NULL;
562*d6bebca9SChangli Gao 	fq->q.fragments_tail = NULL;
5631da177e4SLinus Torvalds 	return 1;
5641da177e4SLinus Torvalds 
5651da177e4SLinus Torvalds out_oversize:
5661da177e4SLinus Torvalds 	if (net_ratelimit())
5671da177e4SLinus Torvalds 		printk(KERN_DEBUG "ip6_frag_reasm: payload len = %d\n", payload_len);
5681da177e4SLinus Torvalds 	goto out_fail;
5691da177e4SLinus Torvalds out_oom:
5701da177e4SLinus Torvalds 	if (net_ratelimit())
5711da177e4SLinus Torvalds 		printk(KERN_DEBUG "ip6_frag_reasm: no memory for reassembly\n");
5721da177e4SLinus Torvalds out_fail:
573a11d206dSYOSHIFUJI Hideaki 	rcu_read_lock();
5742bad35b7SJorge Boncompte [DTI2] 	IP6_INC_STATS_BH(net, __in6_dev_get(dev), IPSTATS_MIB_REASMFAILS);
575a11d206dSYOSHIFUJI Hideaki 	rcu_read_unlock();
5761da177e4SLinus Torvalds 	return -1;
5771da177e4SLinus Torvalds }
5781da177e4SLinus Torvalds 
579e5bbef20SHerbert Xu static int ipv6_frag_rcv(struct sk_buff *skb)
5801da177e4SLinus Torvalds {
5811da177e4SLinus Torvalds 	struct frag_hdr *fhdr;
5821da177e4SLinus Torvalds 	struct frag_queue *fq;
5830660e03fSArnaldo Carvalho de Melo 	struct ipv6hdr *hdr = ipv6_hdr(skb);
584adf30907SEric Dumazet 	struct net *net = dev_net(skb_dst(skb)->dev);
5851da177e4SLinus Torvalds 
586adf30907SEric Dumazet 	IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_REASMREQDS);
5871da177e4SLinus Torvalds 
5881da177e4SLinus Torvalds 	/* Jumbo payload inhibits frag. header */
58998b3377cSDenis V. Lunev 	if (hdr->payload_len==0)
59098b3377cSDenis V. Lunev 		goto fail_hdr;
59198b3377cSDenis V. Lunev 
592ea2ae17dSArnaldo Carvalho de Melo 	if (!pskb_may_pull(skb, (skb_transport_offset(skb) +
59398b3377cSDenis V. Lunev 				 sizeof(struct frag_hdr))))
59498b3377cSDenis V. Lunev 		goto fail_hdr;
5951da177e4SLinus Torvalds 
5960660e03fSArnaldo Carvalho de Melo 	hdr = ipv6_hdr(skb);
5979c70220bSArnaldo Carvalho de Melo 	fhdr = (struct frag_hdr *)skb_transport_header(skb);
5981da177e4SLinus Torvalds 
5991da177e4SLinus Torvalds 	if (!(fhdr->frag_off & htons(0xFFF9))) {
6001da177e4SLinus Torvalds 		/* It is not a fragmented frame */
601b0e380b1SArnaldo Carvalho de Melo 		skb->transport_header += sizeof(struct frag_hdr);
602483a47d2SDenis V. Lunev 		IP6_INC_STATS_BH(net,
603adf30907SEric Dumazet 				 ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_REASMOKS);
6041da177e4SLinus Torvalds 
605d56f90a7SArnaldo Carvalho de Melo 		IP6CB(skb)->nhoff = (u8 *)fhdr - skb_network_header(skb);
6061da177e4SLinus Torvalds 		return 1;
6071da177e4SLinus Torvalds 	}
6081da177e4SLinus Torvalds 
609e31e0bdcSPavel Emelyanov 	if (atomic_read(&net->ipv6.frags.mem) > net->ipv6.frags.high_thresh)
610adf30907SEric Dumazet 		ip6_evictor(net, ip6_dst_idev(skb_dst(skb)));
6111da177e4SLinus Torvalds 
6129546377cSShan Wei 	fq = fq_find(net, fhdr->identification, &hdr->saddr, &hdr->daddr);
6139546377cSShan Wei 	if (fq != NULL) {
614f61944efSHerbert Xu 		int ret;
6151da177e4SLinus Torvalds 
6165ab11c98SPavel Emelyanov 		spin_lock(&fq->q.lock);
6171da177e4SLinus Torvalds 
618f61944efSHerbert Xu 		ret = ip6_frag_queue(fq, skb, fhdr, IP6CB(skb)->nhoff);
6191da177e4SLinus Torvalds 
6205ab11c98SPavel Emelyanov 		spin_unlock(&fq->q.lock);
6214b6cb5d8SPavel Emelyanov 		fq_put(fq);
6221da177e4SLinus Torvalds 		return ret;
6231da177e4SLinus Torvalds 	}
6241da177e4SLinus Torvalds 
625adf30907SEric Dumazet 	IP6_INC_STATS_BH(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_REASMFAILS);
6261da177e4SLinus Torvalds 	kfree_skb(skb);
6271da177e4SLinus Torvalds 	return -1;
62898b3377cSDenis V. Lunev 
62998b3377cSDenis V. Lunev fail_hdr:
630adf30907SEric Dumazet 	IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_INHDRERRORS);
63198b3377cSDenis V. Lunev 	icmpv6_param_prob(skb, ICMPV6_HDR_FIELD, skb_network_header_len(skb));
63298b3377cSDenis V. Lunev 	return -1;
6331da177e4SLinus Torvalds }
6341da177e4SLinus Torvalds 
63541135cc8SAlexey Dobriyan static const struct inet6_protocol frag_protocol =
6361da177e4SLinus Torvalds {
6371da177e4SLinus Torvalds 	.handler	=	ipv6_frag_rcv,
6381da177e4SLinus Torvalds 	.flags		=	INET6_PROTO_NOPOLICY,
6391da177e4SLinus Torvalds };
6401da177e4SLinus Torvalds 
6418d8354d2SPavel Emelyanov #ifdef CONFIG_SYSCTL
6420a64b4b8SPavel Emelyanov static struct ctl_table ip6_frags_ns_ctl_table[] = {
643e71e0349SDaniel Lezcano 	{
6448d8354d2SPavel Emelyanov 		.procname	= "ip6frag_high_thresh",
645e31e0bdcSPavel Emelyanov 		.data		= &init_net.ipv6.frags.high_thresh,
6468d8354d2SPavel Emelyanov 		.maxlen		= sizeof(int),
6478d8354d2SPavel Emelyanov 		.mode		= 0644,
6486d9f239aSAlexey Dobriyan 		.proc_handler	= proc_dointvec
6498d8354d2SPavel Emelyanov 	},
6508d8354d2SPavel Emelyanov 	{
6518d8354d2SPavel Emelyanov 		.procname	= "ip6frag_low_thresh",
652e31e0bdcSPavel Emelyanov 		.data		= &init_net.ipv6.frags.low_thresh,
6538d8354d2SPavel Emelyanov 		.maxlen		= sizeof(int),
6548d8354d2SPavel Emelyanov 		.mode		= 0644,
6556d9f239aSAlexey Dobriyan 		.proc_handler	= proc_dointvec
6568d8354d2SPavel Emelyanov 	},
6578d8354d2SPavel Emelyanov 	{
6588d8354d2SPavel Emelyanov 		.procname	= "ip6frag_time",
659b2fd5321SPavel Emelyanov 		.data		= &init_net.ipv6.frags.timeout,
6608d8354d2SPavel Emelyanov 		.maxlen		= sizeof(int),
6618d8354d2SPavel Emelyanov 		.mode		= 0644,
6626d9f239aSAlexey Dobriyan 		.proc_handler	= proc_dointvec_jiffies,
6638d8354d2SPavel Emelyanov 	},
6647d291ebbSPavel Emelyanov 	{ }
6657d291ebbSPavel Emelyanov };
6667d291ebbSPavel Emelyanov 
6677d291ebbSPavel Emelyanov static struct ctl_table ip6_frags_ctl_table[] = {
6688d8354d2SPavel Emelyanov 	{
6698d8354d2SPavel Emelyanov 		.procname	= "ip6frag_secret_interval",
6703b4bc4a2SPavel Emelyanov 		.data		= &ip6_frags.secret_interval,
6718d8354d2SPavel Emelyanov 		.maxlen		= sizeof(int),
6728d8354d2SPavel Emelyanov 		.mode		= 0644,
6736d9f239aSAlexey Dobriyan 		.proc_handler	= proc_dointvec_jiffies,
6748d8354d2SPavel Emelyanov 	},
6758d8354d2SPavel Emelyanov 	{ }
6768d8354d2SPavel Emelyanov };
6777d460db9SDaniel Lezcano 
6782c8c1e72SAlexey Dobriyan static int __net_init ip6_frags_ns_sysctl_register(struct net *net)
6798d8354d2SPavel Emelyanov {
680e4a2d5c2SPavel Emelyanov 	struct ctl_table *table;
6818d8354d2SPavel Emelyanov 	struct ctl_table_header *hdr;
6828d8354d2SPavel Emelyanov 
6830a64b4b8SPavel Emelyanov 	table = ip6_frags_ns_ctl_table;
68409ad9bc7SOctavian Purdila 	if (!net_eq(net, &init_net)) {
6850a64b4b8SPavel Emelyanov 		table = kmemdup(table, sizeof(ip6_frags_ns_ctl_table), GFP_KERNEL);
686e4a2d5c2SPavel Emelyanov 		if (table == NULL)
687e4a2d5c2SPavel Emelyanov 			goto err_alloc;
688e4a2d5c2SPavel Emelyanov 
689e31e0bdcSPavel Emelyanov 		table[0].data = &net->ipv6.frags.high_thresh;
690e31e0bdcSPavel Emelyanov 		table[1].data = &net->ipv6.frags.low_thresh;
691b2fd5321SPavel Emelyanov 		table[2].data = &net->ipv6.frags.timeout;
692e4a2d5c2SPavel Emelyanov 	}
693e4a2d5c2SPavel Emelyanov 
694e4a2d5c2SPavel Emelyanov 	hdr = register_net_sysctl_table(net, net_ipv6_ctl_path, table);
695e4a2d5c2SPavel Emelyanov 	if (hdr == NULL)
696e4a2d5c2SPavel Emelyanov 		goto err_reg;
697e4a2d5c2SPavel Emelyanov 
698e4a2d5c2SPavel Emelyanov 	net->ipv6.sysctl.frags_hdr = hdr;
699e4a2d5c2SPavel Emelyanov 	return 0;
700e4a2d5c2SPavel Emelyanov 
701e4a2d5c2SPavel Emelyanov err_reg:
70209ad9bc7SOctavian Purdila 	if (!net_eq(net, &init_net))
703e4a2d5c2SPavel Emelyanov 		kfree(table);
704e4a2d5c2SPavel Emelyanov err_alloc:
705e4a2d5c2SPavel Emelyanov 	return -ENOMEM;
706e4a2d5c2SPavel Emelyanov }
707e4a2d5c2SPavel Emelyanov 
7082c8c1e72SAlexey Dobriyan static void __net_exit ip6_frags_ns_sysctl_unregister(struct net *net)
709e4a2d5c2SPavel Emelyanov {
710e4a2d5c2SPavel Emelyanov 	struct ctl_table *table;
711e4a2d5c2SPavel Emelyanov 
712e4a2d5c2SPavel Emelyanov 	table = net->ipv6.sysctl.frags_hdr->ctl_table_arg;
713e4a2d5c2SPavel Emelyanov 	unregister_net_sysctl_table(net->ipv6.sysctl.frags_hdr);
7143705e11aSYang Hongyang 	if (!net_eq(net, &init_net))
715e4a2d5c2SPavel Emelyanov 		kfree(table);
7168d8354d2SPavel Emelyanov }
7177d291ebbSPavel Emelyanov 
7187d291ebbSPavel Emelyanov static struct ctl_table_header *ip6_ctl_header;
7197d291ebbSPavel Emelyanov 
7207d291ebbSPavel Emelyanov static int ip6_frags_sysctl_register(void)
7217d291ebbSPavel Emelyanov {
7227d291ebbSPavel Emelyanov 	ip6_ctl_header = register_net_sysctl_rotable(net_ipv6_ctl_path,
7237d291ebbSPavel Emelyanov 			ip6_frags_ctl_table);
7247d291ebbSPavel Emelyanov 	return ip6_ctl_header == NULL ? -ENOMEM : 0;
7257d291ebbSPavel Emelyanov }
7267d291ebbSPavel Emelyanov 
7277d291ebbSPavel Emelyanov static void ip6_frags_sysctl_unregister(void)
7287d291ebbSPavel Emelyanov {
7297d291ebbSPavel Emelyanov 	unregister_net_sysctl_table(ip6_ctl_header);
7307d291ebbSPavel Emelyanov }
7318d8354d2SPavel Emelyanov #else
7320a64b4b8SPavel Emelyanov static inline int ip6_frags_ns_sysctl_register(struct net *net)
7338d8354d2SPavel Emelyanov {
7348d8354d2SPavel Emelyanov 	return 0;
7358d8354d2SPavel Emelyanov }
736e4a2d5c2SPavel Emelyanov 
7370a64b4b8SPavel Emelyanov static inline void ip6_frags_ns_sysctl_unregister(struct net *net)
738e4a2d5c2SPavel Emelyanov {
739e4a2d5c2SPavel Emelyanov }
7407d291ebbSPavel Emelyanov 
7417d291ebbSPavel Emelyanov static inline int ip6_frags_sysctl_register(void)
7427d291ebbSPavel Emelyanov {
7437d291ebbSPavel Emelyanov 	return 0;
7447d291ebbSPavel Emelyanov }
7457d291ebbSPavel Emelyanov 
7467d291ebbSPavel Emelyanov static inline void ip6_frags_sysctl_unregister(void)
7477d291ebbSPavel Emelyanov {
7487d291ebbSPavel Emelyanov }
7498d8354d2SPavel Emelyanov #endif
7508d8354d2SPavel Emelyanov 
7512c8c1e72SAlexey Dobriyan static int __net_init ipv6_frags_init_net(struct net *net)
7528d8354d2SPavel Emelyanov {
7537c070aa9SShan Wei 	net->ipv6.frags.high_thresh = IPV6_FRAG_HIGH_THRESH;
7547c070aa9SShan Wei 	net->ipv6.frags.low_thresh = IPV6_FRAG_LOW_THRESH;
755b2fd5321SPavel Emelyanov 	net->ipv6.frags.timeout = IPV6_FRAG_TIMEOUT;
7568d8354d2SPavel Emelyanov 
757e5a2bb84SPavel Emelyanov 	inet_frags_init_net(&net->ipv6.frags);
758e5a2bb84SPavel Emelyanov 
7590a64b4b8SPavel Emelyanov 	return ip6_frags_ns_sysctl_register(net);
760e71e0349SDaniel Lezcano }
761e71e0349SDaniel Lezcano 
7622c8c1e72SAlexey Dobriyan static void __net_exit ipv6_frags_exit_net(struct net *net)
76381566e83SPavel Emelyanov {
7640a64b4b8SPavel Emelyanov 	ip6_frags_ns_sysctl_unregister(net);
76581566e83SPavel Emelyanov 	inet_frags_exit_net(&net->ipv6.frags, &ip6_frags);
76681566e83SPavel Emelyanov }
76781566e83SPavel Emelyanov 
76881566e83SPavel Emelyanov static struct pernet_operations ip6_frags_ops = {
76981566e83SPavel Emelyanov 	.init = ipv6_frags_init_net,
77081566e83SPavel Emelyanov 	.exit = ipv6_frags_exit_net,
77181566e83SPavel Emelyanov };
77281566e83SPavel Emelyanov 
773853cbbaaSDaniel Lezcano int __init ipv6_frag_init(void)
7741da177e4SLinus Torvalds {
775853cbbaaSDaniel Lezcano 	int ret;
7761da177e4SLinus Torvalds 
777853cbbaaSDaniel Lezcano 	ret = inet6_add_protocol(&frag_protocol, IPPROTO_FRAGMENT);
778853cbbaaSDaniel Lezcano 	if (ret)
779853cbbaaSDaniel Lezcano 		goto out;
780e71e0349SDaniel Lezcano 
7817d291ebbSPavel Emelyanov 	ret = ip6_frags_sysctl_register();
7827d291ebbSPavel Emelyanov 	if (ret)
7837d291ebbSPavel Emelyanov 		goto err_sysctl;
7847d291ebbSPavel Emelyanov 
7850002c630SPavel Emelyanov 	ret = register_pernet_subsys(&ip6_frags_ops);
7860002c630SPavel Emelyanov 	if (ret)
7870002c630SPavel Emelyanov 		goto err_pernet;
7888d8354d2SPavel Emelyanov 
789321a3a99SPavel Emelyanov 	ip6_frags.hashfn = ip6_hashfn;
790c6fda282SPavel Emelyanov 	ip6_frags.constructor = ip6_frag_init;
791c9547709SPavel Emelyanov 	ip6_frags.destructor = NULL;
7921e4b8287SPavel Emelyanov 	ip6_frags.skb_free = NULL;
7931e4b8287SPavel Emelyanov 	ip6_frags.qsize = sizeof(struct frag_queue);
794abd6523dSPavel Emelyanov 	ip6_frags.match = ip6_frag_match;
795e521db9dSPavel Emelyanov 	ip6_frags.frag_expire = ip6_frag_expire;
7963b4bc4a2SPavel Emelyanov 	ip6_frags.secret_interval = 10 * 60 * HZ;
7977eb95156SPavel Emelyanov 	inet_frags_init(&ip6_frags);
798853cbbaaSDaniel Lezcano out:
799853cbbaaSDaniel Lezcano 	return ret;
8000002c630SPavel Emelyanov 
8010002c630SPavel Emelyanov err_pernet:
8027d291ebbSPavel Emelyanov 	ip6_frags_sysctl_unregister();
8037d291ebbSPavel Emelyanov err_sysctl:
8040002c630SPavel Emelyanov 	inet6_del_protocol(&frag_protocol, IPPROTO_FRAGMENT);
8050002c630SPavel Emelyanov 	goto out;
806853cbbaaSDaniel Lezcano }
807853cbbaaSDaniel Lezcano 
808853cbbaaSDaniel Lezcano void ipv6_frag_exit(void)
809853cbbaaSDaniel Lezcano {
810853cbbaaSDaniel Lezcano 	inet_frags_fini(&ip6_frags);
8117d291ebbSPavel Emelyanov 	ip6_frags_sysctl_unregister();
81281566e83SPavel Emelyanov 	unregister_pernet_subsys(&ip6_frags_ops);
813853cbbaaSDaniel Lezcano 	inet6_del_protocol(&frag_protocol, IPPROTO_FRAGMENT);
8141da177e4SLinus Torvalds }
815