Loading...
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * IPv6 fragment reassembly
4 * Linux INET6 implementation
5 *
6 * Authors:
7 * Pedro Roque <roque@di.fc.ul.pt>
8 *
9 * Based on: net/ipv4/ip_fragment.c
10 */
11
12/*
13 * Fixes:
14 * Andi Kleen Make it work with multiple hosts.
15 * More RFC compliance.
16 *
17 * Horst von Brand Add missing #include <linux/string.h>
18 * Alexey Kuznetsov SMP races, threading, cleanup.
19 * Patrick McHardy LRU queue of frag heads for evictor.
20 * Mitsuru KANDA @USAGI Register inet6_protocol{}.
21 * David Stevens and
22 * YOSHIFUJI,H. @USAGI Always remove fragment header to
23 * calculate ICV correctly.
24 */
25
26#define pr_fmt(fmt) "IPv6: " fmt
27
28#include <linux/errno.h>
29#include <linux/types.h>
30#include <linux/string.h>
31#include <linux/socket.h>
32#include <linux/sockios.h>
33#include <linux/jiffies.h>
34#include <linux/net.h>
35#include <linux/list.h>
36#include <linux/netdevice.h>
37#include <linux/in6.h>
38#include <linux/ipv6.h>
39#include <linux/icmpv6.h>
40#include <linux/random.h>
41#include <linux/jhash.h>
42#include <linux/skbuff.h>
43#include <linux/slab.h>
44#include <linux/export.h>
45
46#include <net/sock.h>
47#include <net/snmp.h>
48
49#include <net/ipv6.h>
50#include <net/ip6_route.h>
51#include <net/protocol.h>
52#include <net/transp_v6.h>
53#include <net/rawv6.h>
54#include <net/ndisc.h>
55#include <net/addrconf.h>
56#include <net/ipv6_frag.h>
57#include <net/inet_ecn.h>
58
59static const char ip6_frag_cache_name[] = "ip6-frags";
60
61static u8 ip6_frag_ecn(const struct ipv6hdr *ipv6h)
62{
63 return 1 << (ipv6_get_dsfield(ipv6h) & INET_ECN_MASK);
64}
65
66static struct inet_frags ip6_frags;
67
68static int ip6_frag_reasm(struct frag_queue *fq, struct sk_buff *skb,
69 struct sk_buff *prev_tail, struct net_device *dev);
70
71static void ip6_frag_expire(struct timer_list *t)
72{
73 struct inet_frag_queue *frag = from_timer(frag, t, timer);
74 struct frag_queue *fq;
75
76 fq = container_of(frag, struct frag_queue, q);
77
78 ip6frag_expire_frag_queue(fq->q.fqdir->net, fq);
79}
80
81static struct frag_queue *
82fq_find(struct net *net, __be32 id, const struct ipv6hdr *hdr, int iif)
83{
84 struct frag_v6_compare_key key = {
85 .id = id,
86 .saddr = hdr->saddr,
87 .daddr = hdr->daddr,
88 .user = IP6_DEFRAG_LOCAL_DELIVER,
89 .iif = iif,
90 };
91 struct inet_frag_queue *q;
92
93 if (!(ipv6_addr_type(&hdr->daddr) & (IPV6_ADDR_MULTICAST |
94 IPV6_ADDR_LINKLOCAL)))
95 key.iif = 0;
96
97 q = inet_frag_find(net->ipv6.fqdir, &key);
98 if (!q)
99 return NULL;
100
101 return container_of(q, struct frag_queue, q);
102}
103
104static int ip6_frag_queue(struct frag_queue *fq, struct sk_buff *skb,
105 struct frag_hdr *fhdr, int nhoff,
106 u32 *prob_offset)
107{
108 struct net *net = dev_net(skb_dst(skb)->dev);
109 int offset, end, fragsize;
110 struct sk_buff *prev_tail;
111 struct net_device *dev;
112 int err = -ENOENT;
113 u8 ecn;
114
115 if (fq->q.flags & INET_FRAG_COMPLETE)
116 goto err;
117
118 err = -EINVAL;
119 offset = ntohs(fhdr->frag_off) & ~0x7;
120 end = offset + (ntohs(ipv6_hdr(skb)->payload_len) -
121 ((u8 *)(fhdr + 1) - (u8 *)(ipv6_hdr(skb) + 1)));
122
123 if ((unsigned int)end > IPV6_MAXPLEN) {
124 *prob_offset = (u8 *)&fhdr->frag_off - skb_network_header(skb);
125 /* note that if prob_offset is set, the skb is freed elsewhere,
126 * we do not free it here.
127 */
128 return -1;
129 }
130
131 ecn = ip6_frag_ecn(ipv6_hdr(skb));
132
133 if (skb->ip_summed == CHECKSUM_COMPLETE) {
134 const unsigned char *nh = skb_network_header(skb);
135 skb->csum = csum_sub(skb->csum,
136 csum_partial(nh, (u8 *)(fhdr + 1) - nh,
137 0));
138 }
139
140 /* Is this the final fragment? */
141 if (!(fhdr->frag_off & htons(IP6_MF))) {
142 /* If we already have some bits beyond end
143 * or have different end, the segment is corrupted.
144 */
145 if (end < fq->q.len ||
146 ((fq->q.flags & INET_FRAG_LAST_IN) && end != fq->q.len))
147 goto discard_fq;
148 fq->q.flags |= INET_FRAG_LAST_IN;
149 fq->q.len = end;
150 } else {
151 /* Check if the fragment is rounded to 8 bytes.
152 * Required by the RFC.
153 */
154 if (end & 0x7) {
155 /* RFC2460 says always send parameter problem in
156 * this case. -DaveM
157 */
158 *prob_offset = offsetof(struct ipv6hdr, payload_len);
159 return -1;
160 }
161 if (end > fq->q.len) {
162 /* Some bits beyond end -> corruption. */
163 if (fq->q.flags & INET_FRAG_LAST_IN)
164 goto discard_fq;
165 fq->q.len = end;
166 }
167 }
168
169 if (end == offset)
170 goto discard_fq;
171
172 err = -ENOMEM;
173 /* Point into the IP datagram 'data' part. */
174 if (!pskb_pull(skb, (u8 *) (fhdr + 1) - skb->data))
175 goto discard_fq;
176
177 err = pskb_trim_rcsum(skb, end - offset);
178 if (err)
179 goto discard_fq;
180
181 /* Note : skb->rbnode and skb->dev share the same location. */
182 dev = skb->dev;
183 /* Makes sure compiler wont do silly aliasing games */
184 barrier();
185
186 prev_tail = fq->q.fragments_tail;
187 err = inet_frag_queue_insert(&fq->q, skb, offset, end);
188 if (err)
189 goto insert_error;
190
191 if (dev)
192 fq->iif = dev->ifindex;
193
194 fq->q.stamp = skb->tstamp;
195 fq->q.meat += skb->len;
196 fq->ecn |= ecn;
197 add_frag_mem_limit(fq->q.fqdir, skb->truesize);
198
199 fragsize = -skb_network_offset(skb) + skb->len;
200 if (fragsize > fq->q.max_size)
201 fq->q.max_size = fragsize;
202
203 /* The first fragment.
204 * nhoffset is obtained from the first fragment, of course.
205 */
206 if (offset == 0) {
207 fq->nhoffset = nhoff;
208 fq->q.flags |= INET_FRAG_FIRST_IN;
209 }
210
211 if (fq->q.flags == (INET_FRAG_FIRST_IN | INET_FRAG_LAST_IN) &&
212 fq->q.meat == fq->q.len) {
213 unsigned long orefdst = skb->_skb_refdst;
214
215 skb->_skb_refdst = 0UL;
216 err = ip6_frag_reasm(fq, skb, prev_tail, dev);
217 skb->_skb_refdst = orefdst;
218 return err;
219 }
220
221 skb_dst_drop(skb);
222 return -EINPROGRESS;
223
224insert_error:
225 if (err == IPFRAG_DUP) {
226 kfree_skb(skb);
227 return -EINVAL;
228 }
229 err = -EINVAL;
230 __IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
231 IPSTATS_MIB_REASM_OVERLAPS);
232discard_fq:
233 inet_frag_kill(&fq->q);
234 __IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
235 IPSTATS_MIB_REASMFAILS);
236err:
237 kfree_skb(skb);
238 return err;
239}
240
241/*
242 * Check if this packet is complete.
243 *
244 * It is called with locked fq, and caller must check that
245 * queue is eligible for reassembly i.e. it is not COMPLETE,
246 * the last and the first frames arrived and all the bits are here.
247 */
248static int ip6_frag_reasm(struct frag_queue *fq, struct sk_buff *skb,
249 struct sk_buff *prev_tail, struct net_device *dev)
250{
251 struct net *net = fq->q.fqdir->net;
252 unsigned int nhoff;
253 void *reasm_data;
254 int payload_len;
255 u8 ecn;
256
257 inet_frag_kill(&fq->q);
258
259 ecn = ip_frag_ecn_table[fq->ecn];
260 if (unlikely(ecn == 0xff))
261 goto out_fail;
262
263 reasm_data = inet_frag_reasm_prepare(&fq->q, skb, prev_tail);
264 if (!reasm_data)
265 goto out_oom;
266
267 payload_len = ((skb->data - skb_network_header(skb)) -
268 sizeof(struct ipv6hdr) + fq->q.len -
269 sizeof(struct frag_hdr));
270 if (payload_len > IPV6_MAXPLEN)
271 goto out_oversize;
272
273 /* We have to remove fragment header from datagram and to relocate
274 * header in order to calculate ICV correctly. */
275 nhoff = fq->nhoffset;
276 skb_network_header(skb)[nhoff] = skb_transport_header(skb)[0];
277 memmove(skb->head + sizeof(struct frag_hdr), skb->head,
278 (skb->data - skb->head) - sizeof(struct frag_hdr));
279 if (skb_mac_header_was_set(skb))
280 skb->mac_header += sizeof(struct frag_hdr);
281 skb->network_header += sizeof(struct frag_hdr);
282
283 skb_reset_transport_header(skb);
284
285 inet_frag_reasm_finish(&fq->q, skb, reasm_data, true);
286
287 skb->dev = dev;
288 ipv6_hdr(skb)->payload_len = htons(payload_len);
289 ipv6_change_dsfield(ipv6_hdr(skb), 0xff, ecn);
290 IP6CB(skb)->nhoff = nhoff;
291 IP6CB(skb)->flags |= IP6SKB_FRAGMENTED;
292 IP6CB(skb)->frag_max_size = fq->q.max_size;
293
294 /* Yes, and fold redundant checksum back. 8) */
295 skb_postpush_rcsum(skb, skb_network_header(skb),
296 skb_network_header_len(skb));
297
298 rcu_read_lock();
299 __IP6_INC_STATS(net, __in6_dev_stats_get(dev, skb), IPSTATS_MIB_REASMOKS);
300 rcu_read_unlock();
301 fq->q.rb_fragments = RB_ROOT;
302 fq->q.fragments_tail = NULL;
303 fq->q.last_run_head = NULL;
304 return 1;
305
306out_oversize:
307 net_dbg_ratelimited("ip6_frag_reasm: payload len = %d\n", payload_len);
308 goto out_fail;
309out_oom:
310 net_dbg_ratelimited("ip6_frag_reasm: no memory for reassembly\n");
311out_fail:
312 rcu_read_lock();
313 __IP6_INC_STATS(net, __in6_dev_stats_get(dev, skb), IPSTATS_MIB_REASMFAILS);
314 rcu_read_unlock();
315 inet_frag_kill(&fq->q);
316 return -1;
317}
318
319static int ipv6_frag_rcv(struct sk_buff *skb)
320{
321 struct frag_hdr *fhdr;
322 struct frag_queue *fq;
323 const struct ipv6hdr *hdr = ipv6_hdr(skb);
324 struct net *net = dev_net(skb_dst(skb)->dev);
325 int iif;
326
327 if (IP6CB(skb)->flags & IP6SKB_FRAGMENTED)
328 goto fail_hdr;
329
330 __IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_REASMREQDS);
331
332 /* Jumbo payload inhibits frag. header */
333 if (hdr->payload_len == 0)
334 goto fail_hdr;
335
336 if (!pskb_may_pull(skb, (skb_transport_offset(skb) +
337 sizeof(struct frag_hdr))))
338 goto fail_hdr;
339
340 hdr = ipv6_hdr(skb);
341 fhdr = (struct frag_hdr *)skb_transport_header(skb);
342
343 if (!(fhdr->frag_off & htons(0xFFF9))) {
344 /* It is not a fragmented frame */
345 skb->transport_header += sizeof(struct frag_hdr);
346 __IP6_INC_STATS(net,
347 ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_REASMOKS);
348
349 IP6CB(skb)->nhoff = (u8 *)fhdr - skb_network_header(skb);
350 IP6CB(skb)->flags |= IP6SKB_FRAGMENTED;
351 return 1;
352 }
353
354 iif = skb->dev ? skb->dev->ifindex : 0;
355 fq = fq_find(net, fhdr->identification, hdr, iif);
356 if (fq) {
357 u32 prob_offset = 0;
358 int ret;
359
360 spin_lock(&fq->q.lock);
361
362 fq->iif = iif;
363 ret = ip6_frag_queue(fq, skb, fhdr, IP6CB(skb)->nhoff,
364 &prob_offset);
365
366 spin_unlock(&fq->q.lock);
367 inet_frag_put(&fq->q);
368 if (prob_offset) {
369 __IP6_INC_STATS(net, __in6_dev_get_safely(skb->dev),
370 IPSTATS_MIB_INHDRERRORS);
371 /* icmpv6_param_prob() calls kfree_skb(skb) */
372 icmpv6_param_prob(skb, ICMPV6_HDR_FIELD, prob_offset);
373 }
374 return ret;
375 }
376
377 __IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_REASMFAILS);
378 kfree_skb(skb);
379 return -1;
380
381fail_hdr:
382 __IP6_INC_STATS(net, __in6_dev_get_safely(skb->dev),
383 IPSTATS_MIB_INHDRERRORS);
384 icmpv6_param_prob(skb, ICMPV6_HDR_FIELD, skb_network_header_len(skb));
385 return -1;
386}
387
388static const struct inet6_protocol frag_protocol = {
389 .handler = ipv6_frag_rcv,
390 .flags = INET6_PROTO_NOPOLICY,
391};
392
393#ifdef CONFIG_SYSCTL
394
395static struct ctl_table ip6_frags_ns_ctl_table[] = {
396 {
397 .procname = "ip6frag_high_thresh",
398 .maxlen = sizeof(unsigned long),
399 .mode = 0644,
400 .proc_handler = proc_doulongvec_minmax,
401 },
402 {
403 .procname = "ip6frag_low_thresh",
404 .maxlen = sizeof(unsigned long),
405 .mode = 0644,
406 .proc_handler = proc_doulongvec_minmax,
407 },
408 {
409 .procname = "ip6frag_time",
410 .maxlen = sizeof(int),
411 .mode = 0644,
412 .proc_handler = proc_dointvec_jiffies,
413 },
414 { }
415};
416
417/* secret interval has been deprecated */
418static int ip6_frags_secret_interval_unused;
419static struct ctl_table ip6_frags_ctl_table[] = {
420 {
421 .procname = "ip6frag_secret_interval",
422 .data = &ip6_frags_secret_interval_unused,
423 .maxlen = sizeof(int),
424 .mode = 0644,
425 .proc_handler = proc_dointvec_jiffies,
426 },
427 { }
428};
429
430static int __net_init ip6_frags_ns_sysctl_register(struct net *net)
431{
432 struct ctl_table *table;
433 struct ctl_table_header *hdr;
434
435 table = ip6_frags_ns_ctl_table;
436 if (!net_eq(net, &init_net)) {
437 table = kmemdup(table, sizeof(ip6_frags_ns_ctl_table), GFP_KERNEL);
438 if (!table)
439 goto err_alloc;
440
441 }
442 table[0].data = &net->ipv6.fqdir->high_thresh;
443 table[0].extra1 = &net->ipv6.fqdir->low_thresh;
444 table[1].data = &net->ipv6.fqdir->low_thresh;
445 table[1].extra2 = &net->ipv6.fqdir->high_thresh;
446 table[2].data = &net->ipv6.fqdir->timeout;
447
448 hdr = register_net_sysctl(net, "net/ipv6", table);
449 if (!hdr)
450 goto err_reg;
451
452 net->ipv6.sysctl.frags_hdr = hdr;
453 return 0;
454
455err_reg:
456 if (!net_eq(net, &init_net))
457 kfree(table);
458err_alloc:
459 return -ENOMEM;
460}
461
462static void __net_exit ip6_frags_ns_sysctl_unregister(struct net *net)
463{
464 struct ctl_table *table;
465
466 table = net->ipv6.sysctl.frags_hdr->ctl_table_arg;
467 unregister_net_sysctl_table(net->ipv6.sysctl.frags_hdr);
468 if (!net_eq(net, &init_net))
469 kfree(table);
470}
471
472static struct ctl_table_header *ip6_ctl_header;
473
474static int ip6_frags_sysctl_register(void)
475{
476 ip6_ctl_header = register_net_sysctl(&init_net, "net/ipv6",
477 ip6_frags_ctl_table);
478 return ip6_ctl_header == NULL ? -ENOMEM : 0;
479}
480
481static void ip6_frags_sysctl_unregister(void)
482{
483 unregister_net_sysctl_table(ip6_ctl_header);
484}
485#else
486static int ip6_frags_ns_sysctl_register(struct net *net)
487{
488 return 0;
489}
490
491static void ip6_frags_ns_sysctl_unregister(struct net *net)
492{
493}
494
495static int ip6_frags_sysctl_register(void)
496{
497 return 0;
498}
499
500static void ip6_frags_sysctl_unregister(void)
501{
502}
503#endif
504
505static int __net_init ipv6_frags_init_net(struct net *net)
506{
507 int res;
508
509 res = fqdir_init(&net->ipv6.fqdir, &ip6_frags, net);
510 if (res < 0)
511 return res;
512
513 net->ipv6.fqdir->high_thresh = IPV6_FRAG_HIGH_THRESH;
514 net->ipv6.fqdir->low_thresh = IPV6_FRAG_LOW_THRESH;
515 net->ipv6.fqdir->timeout = IPV6_FRAG_TIMEOUT;
516
517 res = ip6_frags_ns_sysctl_register(net);
518 if (res < 0)
519 fqdir_exit(net->ipv6.fqdir);
520 return res;
521}
522
523static void __net_exit ipv6_frags_pre_exit_net(struct net *net)
524{
525 fqdir_pre_exit(net->ipv6.fqdir);
526}
527
528static void __net_exit ipv6_frags_exit_net(struct net *net)
529{
530 ip6_frags_ns_sysctl_unregister(net);
531 fqdir_exit(net->ipv6.fqdir);
532}
533
534static struct pernet_operations ip6_frags_ops = {
535 .init = ipv6_frags_init_net,
536 .pre_exit = ipv6_frags_pre_exit_net,
537 .exit = ipv6_frags_exit_net,
538};
539
540static const struct rhashtable_params ip6_rhash_params = {
541 .head_offset = offsetof(struct inet_frag_queue, node),
542 .hashfn = ip6frag_key_hashfn,
543 .obj_hashfn = ip6frag_obj_hashfn,
544 .obj_cmpfn = ip6frag_obj_cmpfn,
545 .automatic_shrinking = true,
546};
547
548int __init ipv6_frag_init(void)
549{
550 int ret;
551
552 ip6_frags.constructor = ip6frag_init;
553 ip6_frags.destructor = NULL;
554 ip6_frags.qsize = sizeof(struct frag_queue);
555 ip6_frags.frag_expire = ip6_frag_expire;
556 ip6_frags.frags_cache_name = ip6_frag_cache_name;
557 ip6_frags.rhash_params = ip6_rhash_params;
558 ret = inet_frags_init(&ip6_frags);
559 if (ret)
560 goto out;
561
562 ret = inet6_add_protocol(&frag_protocol, IPPROTO_FRAGMENT);
563 if (ret)
564 goto err_protocol;
565
566 ret = ip6_frags_sysctl_register();
567 if (ret)
568 goto err_sysctl;
569
570 ret = register_pernet_subsys(&ip6_frags_ops);
571 if (ret)
572 goto err_pernet;
573
574out:
575 return ret;
576
577err_pernet:
578 ip6_frags_sysctl_unregister();
579err_sysctl:
580 inet6_del_protocol(&frag_protocol, IPPROTO_FRAGMENT);
581err_protocol:
582 inet_frags_fini(&ip6_frags);
583 goto out;
584}
585
586void ipv6_frag_exit(void)
587{
588 ip6_frags_sysctl_unregister();
589 unregister_pernet_subsys(&ip6_frags_ops);
590 inet6_del_protocol(&frag_protocol, IPPROTO_FRAGMENT);
591 inet_frags_fini(&ip6_frags);
592}
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * IPv6 fragment reassembly
4 * Linux INET6 implementation
5 *
6 * Authors:
7 * Pedro Roque <roque@di.fc.ul.pt>
8 *
9 * Based on: net/ipv4/ip_fragment.c
10 */
11
12/*
13 * Fixes:
14 * Andi Kleen Make it work with multiple hosts.
15 * More RFC compliance.
16 *
17 * Horst von Brand Add missing #include <linux/string.h>
18 * Alexey Kuznetsov SMP races, threading, cleanup.
19 * Patrick McHardy LRU queue of frag heads for evictor.
20 * Mitsuru KANDA @USAGI Register inet6_protocol{}.
21 * David Stevens and
22 * YOSHIFUJI,H. @USAGI Always remove fragment header to
23 * calculate ICV correctly.
24 */
25
26#define pr_fmt(fmt) "IPv6: " fmt
27
28#include <linux/errno.h>
29#include <linux/types.h>
30#include <linux/string.h>
31#include <linux/socket.h>
32#include <linux/sockios.h>
33#include <linux/jiffies.h>
34#include <linux/net.h>
35#include <linux/list.h>
36#include <linux/netdevice.h>
37#include <linux/in6.h>
38#include <linux/ipv6.h>
39#include <linux/icmpv6.h>
40#include <linux/random.h>
41#include <linux/jhash.h>
42#include <linux/skbuff.h>
43#include <linux/slab.h>
44#include <linux/export.h>
45#include <linux/tcp.h>
46#include <linux/udp.h>
47
48#include <net/sock.h>
49#include <net/snmp.h>
50
51#include <net/ipv6.h>
52#include <net/ip6_route.h>
53#include <net/protocol.h>
54#include <net/transp_v6.h>
55#include <net/rawv6.h>
56#include <net/ndisc.h>
57#include <net/addrconf.h>
58#include <net/ipv6_frag.h>
59#include <net/inet_ecn.h>
60
61static const char ip6_frag_cache_name[] = "ip6-frags";
62
63static u8 ip6_frag_ecn(const struct ipv6hdr *ipv6h)
64{
65 return 1 << (ipv6_get_dsfield(ipv6h) & INET_ECN_MASK);
66}
67
68static struct inet_frags ip6_frags;
69
70static int ip6_frag_reasm(struct frag_queue *fq, struct sk_buff *skb,
71 struct sk_buff *prev_tail, struct net_device *dev);
72
73static void ip6_frag_expire(struct timer_list *t)
74{
75 struct inet_frag_queue *frag = from_timer(frag, t, timer);
76 struct frag_queue *fq;
77
78 fq = container_of(frag, struct frag_queue, q);
79
80 ip6frag_expire_frag_queue(fq->q.fqdir->net, fq);
81}
82
83static struct frag_queue *
84fq_find(struct net *net, __be32 id, const struct ipv6hdr *hdr, int iif)
85{
86 struct frag_v6_compare_key key = {
87 .id = id,
88 .saddr = hdr->saddr,
89 .daddr = hdr->daddr,
90 .user = IP6_DEFRAG_LOCAL_DELIVER,
91 .iif = iif,
92 };
93 struct inet_frag_queue *q;
94
95 if (!(ipv6_addr_type(&hdr->daddr) & (IPV6_ADDR_MULTICAST |
96 IPV6_ADDR_LINKLOCAL)))
97 key.iif = 0;
98
99 q = inet_frag_find(net->ipv6.fqdir, &key);
100 if (!q)
101 return NULL;
102
103 return container_of(q, struct frag_queue, q);
104}
105
106static int ip6_frag_queue(struct frag_queue *fq, struct sk_buff *skb,
107 struct frag_hdr *fhdr, int nhoff,
108 u32 *prob_offset)
109{
110 struct net *net = dev_net(skb_dst(skb)->dev);
111 int offset, end, fragsize;
112 struct sk_buff *prev_tail;
113 struct net_device *dev;
114 int err = -ENOENT;
115 u8 ecn;
116
117 if (fq->q.flags & INET_FRAG_COMPLETE)
118 goto err;
119
120 err = -EINVAL;
121 offset = ntohs(fhdr->frag_off) & ~0x7;
122 end = offset + (ntohs(ipv6_hdr(skb)->payload_len) -
123 ((u8 *)(fhdr + 1) - (u8 *)(ipv6_hdr(skb) + 1)));
124
125 if ((unsigned int)end > IPV6_MAXPLEN) {
126 *prob_offset = (u8 *)&fhdr->frag_off - skb_network_header(skb);
127 /* note that if prob_offset is set, the skb is freed elsewhere,
128 * we do not free it here.
129 */
130 return -1;
131 }
132
133 ecn = ip6_frag_ecn(ipv6_hdr(skb));
134
135 if (skb->ip_summed == CHECKSUM_COMPLETE) {
136 const unsigned char *nh = skb_network_header(skb);
137 skb->csum = csum_sub(skb->csum,
138 csum_partial(nh, (u8 *)(fhdr + 1) - nh,
139 0));
140 }
141
142 /* Is this the final fragment? */
143 if (!(fhdr->frag_off & htons(IP6_MF))) {
144 /* If we already have some bits beyond end
145 * or have different end, the segment is corrupted.
146 */
147 if (end < fq->q.len ||
148 ((fq->q.flags & INET_FRAG_LAST_IN) && end != fq->q.len))
149 goto discard_fq;
150 fq->q.flags |= INET_FRAG_LAST_IN;
151 fq->q.len = end;
152 } else {
153 /* Check if the fragment is rounded to 8 bytes.
154 * Required by the RFC.
155 */
156 if (end & 0x7) {
157 /* RFC2460 says always send parameter problem in
158 * this case. -DaveM
159 */
160 *prob_offset = offsetof(struct ipv6hdr, payload_len);
161 return -1;
162 }
163 if (end > fq->q.len) {
164 /* Some bits beyond end -> corruption. */
165 if (fq->q.flags & INET_FRAG_LAST_IN)
166 goto discard_fq;
167 fq->q.len = end;
168 }
169 }
170
171 if (end == offset)
172 goto discard_fq;
173
174 err = -ENOMEM;
175 /* Point into the IP datagram 'data' part. */
176 if (!pskb_pull(skb, (u8 *) (fhdr + 1) - skb->data))
177 goto discard_fq;
178
179 err = pskb_trim_rcsum(skb, end - offset);
180 if (err)
181 goto discard_fq;
182
183 /* Note : skb->rbnode and skb->dev share the same location. */
184 dev = skb->dev;
185 /* Makes sure compiler wont do silly aliasing games */
186 barrier();
187
188 prev_tail = fq->q.fragments_tail;
189 err = inet_frag_queue_insert(&fq->q, skb, offset, end);
190 if (err)
191 goto insert_error;
192
193 if (dev)
194 fq->iif = dev->ifindex;
195
196 fq->q.stamp = skb->tstamp;
197 fq->q.meat += skb->len;
198 fq->ecn |= ecn;
199 add_frag_mem_limit(fq->q.fqdir, skb->truesize);
200
201 fragsize = -skb_network_offset(skb) + skb->len;
202 if (fragsize > fq->q.max_size)
203 fq->q.max_size = fragsize;
204
205 /* The first fragment.
206 * nhoffset is obtained from the first fragment, of course.
207 */
208 if (offset == 0) {
209 fq->nhoffset = nhoff;
210 fq->q.flags |= INET_FRAG_FIRST_IN;
211 }
212
213 if (fq->q.flags == (INET_FRAG_FIRST_IN | INET_FRAG_LAST_IN) &&
214 fq->q.meat == fq->q.len) {
215 unsigned long orefdst = skb->_skb_refdst;
216
217 skb->_skb_refdst = 0UL;
218 err = ip6_frag_reasm(fq, skb, prev_tail, dev);
219 skb->_skb_refdst = orefdst;
220 return err;
221 }
222
223 skb_dst_drop(skb);
224 return -EINPROGRESS;
225
226insert_error:
227 if (err == IPFRAG_DUP) {
228 kfree_skb(skb);
229 return -EINVAL;
230 }
231 err = -EINVAL;
232 __IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
233 IPSTATS_MIB_REASM_OVERLAPS);
234discard_fq:
235 inet_frag_kill(&fq->q);
236 __IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)),
237 IPSTATS_MIB_REASMFAILS);
238err:
239 kfree_skb(skb);
240 return err;
241}
242
243/*
244 * Check if this packet is complete.
245 *
246 * It is called with locked fq, and caller must check that
247 * queue is eligible for reassembly i.e. it is not COMPLETE,
248 * the last and the first frames arrived and all the bits are here.
249 */
250static int ip6_frag_reasm(struct frag_queue *fq, struct sk_buff *skb,
251 struct sk_buff *prev_tail, struct net_device *dev)
252{
253 struct net *net = fq->q.fqdir->net;
254 unsigned int nhoff;
255 void *reasm_data;
256 int payload_len;
257 u8 ecn;
258
259 inet_frag_kill(&fq->q);
260
261 ecn = ip_frag_ecn_table[fq->ecn];
262 if (unlikely(ecn == 0xff))
263 goto out_fail;
264
265 reasm_data = inet_frag_reasm_prepare(&fq->q, skb, prev_tail);
266 if (!reasm_data)
267 goto out_oom;
268
269 payload_len = ((skb->data - skb_network_header(skb)) -
270 sizeof(struct ipv6hdr) + fq->q.len -
271 sizeof(struct frag_hdr));
272 if (payload_len > IPV6_MAXPLEN)
273 goto out_oversize;
274
275 /* We have to remove fragment header from datagram and to relocate
276 * header in order to calculate ICV correctly. */
277 nhoff = fq->nhoffset;
278 skb_network_header(skb)[nhoff] = skb_transport_header(skb)[0];
279 memmove(skb->head + sizeof(struct frag_hdr), skb->head,
280 (skb->data - skb->head) - sizeof(struct frag_hdr));
281 if (skb_mac_header_was_set(skb))
282 skb->mac_header += sizeof(struct frag_hdr);
283 skb->network_header += sizeof(struct frag_hdr);
284
285 skb_reset_transport_header(skb);
286
287 inet_frag_reasm_finish(&fq->q, skb, reasm_data, true);
288
289 skb->dev = dev;
290 ipv6_hdr(skb)->payload_len = htons(payload_len);
291 ipv6_change_dsfield(ipv6_hdr(skb), 0xff, ecn);
292 IP6CB(skb)->nhoff = nhoff;
293 IP6CB(skb)->flags |= IP6SKB_FRAGMENTED;
294 IP6CB(skb)->frag_max_size = fq->q.max_size;
295
296 /* Yes, and fold redundant checksum back. 8) */
297 skb_postpush_rcsum(skb, skb_network_header(skb),
298 skb_network_header_len(skb));
299
300 rcu_read_lock();
301 __IP6_INC_STATS(net, __in6_dev_stats_get(dev, skb), IPSTATS_MIB_REASMOKS);
302 rcu_read_unlock();
303 fq->q.rb_fragments = RB_ROOT;
304 fq->q.fragments_tail = NULL;
305 fq->q.last_run_head = NULL;
306 return 1;
307
308out_oversize:
309 net_dbg_ratelimited("ip6_frag_reasm: payload len = %d\n", payload_len);
310 goto out_fail;
311out_oom:
312 net_dbg_ratelimited("ip6_frag_reasm: no memory for reassembly\n");
313out_fail:
314 rcu_read_lock();
315 __IP6_INC_STATS(net, __in6_dev_stats_get(dev, skb), IPSTATS_MIB_REASMFAILS);
316 rcu_read_unlock();
317 inet_frag_kill(&fq->q);
318 return -1;
319}
320
321static int ipv6_frag_rcv(struct sk_buff *skb)
322{
323 struct frag_hdr *fhdr;
324 struct frag_queue *fq;
325 const struct ipv6hdr *hdr = ipv6_hdr(skb);
326 struct net *net = dev_net(skb_dst(skb)->dev);
327 u8 nexthdr;
328 int iif;
329
330 if (IP6CB(skb)->flags & IP6SKB_FRAGMENTED)
331 goto fail_hdr;
332
333 __IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_REASMREQDS);
334
335 /* Jumbo payload inhibits frag. header */
336 if (hdr->payload_len == 0)
337 goto fail_hdr;
338
339 if (!pskb_may_pull(skb, (skb_transport_offset(skb) +
340 sizeof(struct frag_hdr))))
341 goto fail_hdr;
342
343 hdr = ipv6_hdr(skb);
344 fhdr = (struct frag_hdr *)skb_transport_header(skb);
345
346 if (!(fhdr->frag_off & htons(IP6_OFFSET | IP6_MF))) {
347 /* It is not a fragmented frame */
348 skb->transport_header += sizeof(struct frag_hdr);
349 __IP6_INC_STATS(net,
350 ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_REASMOKS);
351
352 IP6CB(skb)->nhoff = (u8 *)fhdr - skb_network_header(skb);
353 IP6CB(skb)->flags |= IP6SKB_FRAGMENTED;
354 IP6CB(skb)->frag_max_size = ntohs(hdr->payload_len) +
355 sizeof(struct ipv6hdr);
356 return 1;
357 }
358
359 /* RFC 8200, Section 4.5 Fragment Header:
360 * If the first fragment does not include all headers through an
361 * Upper-Layer header, then that fragment should be discarded and
362 * an ICMP Parameter Problem, Code 3, message should be sent to
363 * the source of the fragment, with the Pointer field set to zero.
364 */
365 nexthdr = hdr->nexthdr;
366 if (ipv6frag_thdr_truncated(skb, skb_transport_offset(skb), &nexthdr)) {
367 __IP6_INC_STATS(net, __in6_dev_get_safely(skb->dev),
368 IPSTATS_MIB_INHDRERRORS);
369 icmpv6_param_prob(skb, ICMPV6_HDR_INCOMP, 0);
370 return -1;
371 }
372
373 iif = skb->dev ? skb->dev->ifindex : 0;
374 fq = fq_find(net, fhdr->identification, hdr, iif);
375 if (fq) {
376 u32 prob_offset = 0;
377 int ret;
378
379 spin_lock(&fq->q.lock);
380
381 fq->iif = iif;
382 ret = ip6_frag_queue(fq, skb, fhdr, IP6CB(skb)->nhoff,
383 &prob_offset);
384
385 spin_unlock(&fq->q.lock);
386 inet_frag_put(&fq->q);
387 if (prob_offset) {
388 __IP6_INC_STATS(net, __in6_dev_get_safely(skb->dev),
389 IPSTATS_MIB_INHDRERRORS);
390 /* icmpv6_param_prob() calls kfree_skb(skb) */
391 icmpv6_param_prob(skb, ICMPV6_HDR_FIELD, prob_offset);
392 }
393 return ret;
394 }
395
396 __IP6_INC_STATS(net, ip6_dst_idev(skb_dst(skb)), IPSTATS_MIB_REASMFAILS);
397 kfree_skb(skb);
398 return -1;
399
400fail_hdr:
401 __IP6_INC_STATS(net, __in6_dev_get_safely(skb->dev),
402 IPSTATS_MIB_INHDRERRORS);
403 icmpv6_param_prob(skb, ICMPV6_HDR_FIELD, skb_network_header_len(skb));
404 return -1;
405}
406
407static const struct inet6_protocol frag_protocol = {
408 .handler = ipv6_frag_rcv,
409 .flags = INET6_PROTO_NOPOLICY,
410};
411
412#ifdef CONFIG_SYSCTL
413
414static struct ctl_table ip6_frags_ns_ctl_table[] = {
415 {
416 .procname = "ip6frag_high_thresh",
417 .maxlen = sizeof(unsigned long),
418 .mode = 0644,
419 .proc_handler = proc_doulongvec_minmax,
420 },
421 {
422 .procname = "ip6frag_low_thresh",
423 .maxlen = sizeof(unsigned long),
424 .mode = 0644,
425 .proc_handler = proc_doulongvec_minmax,
426 },
427 {
428 .procname = "ip6frag_time",
429 .maxlen = sizeof(int),
430 .mode = 0644,
431 .proc_handler = proc_dointvec_jiffies,
432 },
433 { }
434};
435
436/* secret interval has been deprecated */
437static int ip6_frags_secret_interval_unused;
438static struct ctl_table ip6_frags_ctl_table[] = {
439 {
440 .procname = "ip6frag_secret_interval",
441 .data = &ip6_frags_secret_interval_unused,
442 .maxlen = sizeof(int),
443 .mode = 0644,
444 .proc_handler = proc_dointvec_jiffies,
445 },
446 { }
447};
448
449static int __net_init ip6_frags_ns_sysctl_register(struct net *net)
450{
451 struct ctl_table *table;
452 struct ctl_table_header *hdr;
453
454 table = ip6_frags_ns_ctl_table;
455 if (!net_eq(net, &init_net)) {
456 table = kmemdup(table, sizeof(ip6_frags_ns_ctl_table), GFP_KERNEL);
457 if (!table)
458 goto err_alloc;
459
460 }
461 table[0].data = &net->ipv6.fqdir->high_thresh;
462 table[0].extra1 = &net->ipv6.fqdir->low_thresh;
463 table[1].data = &net->ipv6.fqdir->low_thresh;
464 table[1].extra2 = &net->ipv6.fqdir->high_thresh;
465 table[2].data = &net->ipv6.fqdir->timeout;
466
467 hdr = register_net_sysctl(net, "net/ipv6", table);
468 if (!hdr)
469 goto err_reg;
470
471 net->ipv6.sysctl.frags_hdr = hdr;
472 return 0;
473
474err_reg:
475 if (!net_eq(net, &init_net))
476 kfree(table);
477err_alloc:
478 return -ENOMEM;
479}
480
481static void __net_exit ip6_frags_ns_sysctl_unregister(struct net *net)
482{
483 struct ctl_table *table;
484
485 table = net->ipv6.sysctl.frags_hdr->ctl_table_arg;
486 unregister_net_sysctl_table(net->ipv6.sysctl.frags_hdr);
487 if (!net_eq(net, &init_net))
488 kfree(table);
489}
490
491static struct ctl_table_header *ip6_ctl_header;
492
493static int ip6_frags_sysctl_register(void)
494{
495 ip6_ctl_header = register_net_sysctl(&init_net, "net/ipv6",
496 ip6_frags_ctl_table);
497 return ip6_ctl_header == NULL ? -ENOMEM : 0;
498}
499
500static void ip6_frags_sysctl_unregister(void)
501{
502 unregister_net_sysctl_table(ip6_ctl_header);
503}
504#else
505static int ip6_frags_ns_sysctl_register(struct net *net)
506{
507 return 0;
508}
509
510static void ip6_frags_ns_sysctl_unregister(struct net *net)
511{
512}
513
514static int ip6_frags_sysctl_register(void)
515{
516 return 0;
517}
518
519static void ip6_frags_sysctl_unregister(void)
520{
521}
522#endif
523
524static int __net_init ipv6_frags_init_net(struct net *net)
525{
526 int res;
527
528 res = fqdir_init(&net->ipv6.fqdir, &ip6_frags, net);
529 if (res < 0)
530 return res;
531
532 net->ipv6.fqdir->high_thresh = IPV6_FRAG_HIGH_THRESH;
533 net->ipv6.fqdir->low_thresh = IPV6_FRAG_LOW_THRESH;
534 net->ipv6.fqdir->timeout = IPV6_FRAG_TIMEOUT;
535
536 res = ip6_frags_ns_sysctl_register(net);
537 if (res < 0)
538 fqdir_exit(net->ipv6.fqdir);
539 return res;
540}
541
542static void __net_exit ipv6_frags_pre_exit_net(struct net *net)
543{
544 fqdir_pre_exit(net->ipv6.fqdir);
545}
546
547static void __net_exit ipv6_frags_exit_net(struct net *net)
548{
549 ip6_frags_ns_sysctl_unregister(net);
550 fqdir_exit(net->ipv6.fqdir);
551}
552
553static struct pernet_operations ip6_frags_ops = {
554 .init = ipv6_frags_init_net,
555 .pre_exit = ipv6_frags_pre_exit_net,
556 .exit = ipv6_frags_exit_net,
557};
558
559static const struct rhashtable_params ip6_rhash_params = {
560 .head_offset = offsetof(struct inet_frag_queue, node),
561 .hashfn = ip6frag_key_hashfn,
562 .obj_hashfn = ip6frag_obj_hashfn,
563 .obj_cmpfn = ip6frag_obj_cmpfn,
564 .automatic_shrinking = true,
565};
566
567int __init ipv6_frag_init(void)
568{
569 int ret;
570
571 ip6_frags.constructor = ip6frag_init;
572 ip6_frags.destructor = NULL;
573 ip6_frags.qsize = sizeof(struct frag_queue);
574 ip6_frags.frag_expire = ip6_frag_expire;
575 ip6_frags.frags_cache_name = ip6_frag_cache_name;
576 ip6_frags.rhash_params = ip6_rhash_params;
577 ret = inet_frags_init(&ip6_frags);
578 if (ret)
579 goto out;
580
581 ret = inet6_add_protocol(&frag_protocol, IPPROTO_FRAGMENT);
582 if (ret)
583 goto err_protocol;
584
585 ret = ip6_frags_sysctl_register();
586 if (ret)
587 goto err_sysctl;
588
589 ret = register_pernet_subsys(&ip6_frags_ops);
590 if (ret)
591 goto err_pernet;
592
593out:
594 return ret;
595
596err_pernet:
597 ip6_frags_sysctl_unregister();
598err_sysctl:
599 inet6_del_protocol(&frag_protocol, IPPROTO_FRAGMENT);
600err_protocol:
601 inet_frags_fini(&ip6_frags);
602 goto out;
603}
604
605void ipv6_frag_exit(void)
606{
607 ip6_frags_sysctl_unregister();
608 unregister_pernet_subsys(&ip6_frags_ops);
609 inet6_del_protocol(&frag_protocol, IPPROTO_FRAGMENT);
610 inet_frags_fini(&ip6_frags);
611}