skbuff: Move definition of NETDEV_FRAG_PAGE_MAX_SIZE
[firefly-linux-kernel-4.4.55.git] / net / core / skbuff.c
1 /*
2  *      Routines having to do with the 'struct sk_buff' memory handlers.
3  *
4  *      Authors:        Alan Cox <alan@lxorguk.ukuu.org.uk>
5  *                      Florian La Roche <rzsfl@rz.uni-sb.de>
6  *
7  *      Fixes:
8  *              Alan Cox        :       Fixed the worst of the load
9  *                                      balancer bugs.
10  *              Dave Platt      :       Interrupt stacking fix.
11  *      Richard Kooijman        :       Timestamp fixes.
12  *              Alan Cox        :       Changed buffer format.
13  *              Alan Cox        :       destructor hook for AF_UNIX etc.
14  *              Linus Torvalds  :       Better skb_clone.
15  *              Alan Cox        :       Added skb_copy.
16  *              Alan Cox        :       Added all the changed routines Linus
17  *                                      only put in the headers
18  *              Ray VanTassle   :       Fixed --skb->lock in free
19  *              Alan Cox        :       skb_copy copy arp field
20  *              Andi Kleen      :       slabified it.
21  *              Robert Olsson   :       Removed skb_head_pool
22  *
23  *      NOTE:
24  *              The __skb_ routines should be called with interrupts
25  *      disabled, or you better be *real* sure that the operation is atomic
26  *      with respect to whatever list is being frobbed (e.g. via lock_sock()
27  *      or via disabling bottom half handlers, etc).
28  *
29  *      This program is free software; you can redistribute it and/or
30  *      modify it under the terms of the GNU General Public License
31  *      as published by the Free Software Foundation; either version
32  *      2 of the License, or (at your option) any later version.
33  */
34
35 /*
36  *      The functions in this file will not compile correctly with gcc 2.4.x
37  */
38
39 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
40
41 #include <linux/module.h>
42 #include <linux/types.h>
43 #include <linux/kernel.h>
44 #include <linux/kmemcheck.h>
45 #include <linux/mm.h>
46 #include <linux/interrupt.h>
47 #include <linux/in.h>
48 #include <linux/inet.h>
49 #include <linux/slab.h>
50 #include <linux/netdevice.h>
51 #ifdef CONFIG_NET_CLS_ACT
52 #include <net/pkt_sched.h>
53 #endif
54 #include <linux/string.h>
55 #include <linux/skbuff.h>
56 #include <linux/splice.h>
57 #include <linux/cache.h>
58 #include <linux/rtnetlink.h>
59 #include <linux/init.h>
60 #include <linux/scatterlist.h>
61 #include <linux/errqueue.h>
62 #include <linux/prefetch.h>
63
64 #include <net/protocol.h>
65 #include <net/dst.h>
66 #include <net/sock.h>
67 #include <net/checksum.h>
68 #include <net/xfrm.h>
69
70 #include <asm/uaccess.h>
71 #include <trace/events/skb.h>
72 #include <linux/highmem.h>
73
74 struct kmem_cache *skbuff_head_cache __read_mostly;
75 static struct kmem_cache *skbuff_fclone_cache __read_mostly;
76
77 static void sock_pipe_buf_release(struct pipe_inode_info *pipe,
78                                   struct pipe_buffer *buf)
79 {
80         put_page(buf->page);
81 }
82
83 static void sock_pipe_buf_get(struct pipe_inode_info *pipe,
84                                 struct pipe_buffer *buf)
85 {
86         get_page(buf->page);
87 }
88
89 static int sock_pipe_buf_steal(struct pipe_inode_info *pipe,
90                                struct pipe_buffer *buf)
91 {
92         return 1;
93 }
94
95
96 /* Pipe buffer operations for a socket. */
97 static const struct pipe_buf_operations sock_pipe_buf_ops = {
98         .can_merge = 0,
99         .map = generic_pipe_buf_map,
100         .unmap = generic_pipe_buf_unmap,
101         .confirm = generic_pipe_buf_confirm,
102         .release = sock_pipe_buf_release,
103         .steal = sock_pipe_buf_steal,
104         .get = sock_pipe_buf_get,
105 };
106
107 /*
108  *      Keep out-of-line to prevent kernel bloat.
109  *      __builtin_return_address is not used because it is not always
110  *      reliable.
111  */
112
113 /**
114  *      skb_over_panic  -       private function
115  *      @skb: buffer
116  *      @sz: size
117  *      @here: address
118  *
119  *      Out of line support code for skb_put(). Not user callable.
120  */
121 static void skb_over_panic(struct sk_buff *skb, int sz, void *here)
122 {
123         pr_emerg("%s: text:%p len:%d put:%d head:%p data:%p tail:%#lx end:%#lx dev:%s\n",
124                  __func__, here, skb->len, sz, skb->head, skb->data,
125                  (unsigned long)skb->tail, (unsigned long)skb->end,
126                  skb->dev ? skb->dev->name : "<NULL>");
127         BUG();
128 }
129
130 /**
131  *      skb_under_panic -       private function
132  *      @skb: buffer
133  *      @sz: size
134  *      @here: address
135  *
136  *      Out of line support code for skb_push(). Not user callable.
137  */
138
139 static void skb_under_panic(struct sk_buff *skb, int sz, void *here)
140 {
141         pr_emerg("%s: text:%p len:%d put:%d head:%p data:%p tail:%#lx end:%#lx dev:%s\n",
142                  __func__, here, skb->len, sz, skb->head, skb->data,
143                  (unsigned long)skb->tail, (unsigned long)skb->end,
144                  skb->dev ? skb->dev->name : "<NULL>");
145         BUG();
146 }
147
148
149 /*
150  * kmalloc_reserve is a wrapper around kmalloc_node_track_caller that tells
151  * the caller if emergency pfmemalloc reserves are being used. If it is and
152  * the socket is later found to be SOCK_MEMALLOC then PFMEMALLOC reserves
153  * may be used. Otherwise, the packet data may be discarded until enough
154  * memory is free
155  */
156 #define kmalloc_reserve(size, gfp, node, pfmemalloc) \
157          __kmalloc_reserve(size, gfp, node, _RET_IP_, pfmemalloc)
158
159 static void *__kmalloc_reserve(size_t size, gfp_t flags, int node,
160                                unsigned long ip, bool *pfmemalloc)
161 {
162         void *obj;
163         bool ret_pfmemalloc = false;
164
165         /*
166          * Try a regular allocation, when that fails and we're not entitled
167          * to the reserves, fail.
168          */
169         obj = kmalloc_node_track_caller(size,
170                                         flags | __GFP_NOMEMALLOC | __GFP_NOWARN,
171                                         node);
172         if (obj || !(gfp_pfmemalloc_allowed(flags)))
173                 goto out;
174
175         /* Try again but now we are using pfmemalloc reserves */
176         ret_pfmemalloc = true;
177         obj = kmalloc_node_track_caller(size, flags, node);
178
179 out:
180         if (pfmemalloc)
181                 *pfmemalloc = ret_pfmemalloc;
182
183         return obj;
184 }
185
186 /*      Allocate a new skbuff. We do this ourselves so we can fill in a few
187  *      'private' fields and also do memory statistics to find all the
188  *      [BEEP] leaks.
189  *
190  */
191
192 /**
193  *      __alloc_skb     -       allocate a network buffer
194  *      @size: size to allocate
195  *      @gfp_mask: allocation mask
196  *      @flags: If SKB_ALLOC_FCLONE is set, allocate from fclone cache
197  *              instead of head cache and allocate a cloned (child) skb.
198  *              If SKB_ALLOC_RX is set, __GFP_MEMALLOC will be used for
199  *              allocations in case the data is required for writeback
200  *      @node: numa node to allocate memory on
201  *
202  *      Allocate a new &sk_buff. The returned buffer has no headroom and a
203  *      tail room of at least size bytes. The object has a reference count
204  *      of one. The return is the buffer. On a failure the return is %NULL.
205  *
206  *      Buffers may only be allocated from interrupts using a @gfp_mask of
207  *      %GFP_ATOMIC.
208  */
209 struct sk_buff *__alloc_skb(unsigned int size, gfp_t gfp_mask,
210                             int flags, int node)
211 {
212         struct kmem_cache *cache;
213         struct skb_shared_info *shinfo;
214         struct sk_buff *skb;
215         u8 *data;
216         bool pfmemalloc;
217
218         cache = (flags & SKB_ALLOC_FCLONE)
219                 ? skbuff_fclone_cache : skbuff_head_cache;
220
221         if (sk_memalloc_socks() && (flags & SKB_ALLOC_RX))
222                 gfp_mask |= __GFP_MEMALLOC;
223
224         /* Get the HEAD */
225         skb = kmem_cache_alloc_node(cache, gfp_mask & ~__GFP_DMA, node);
226         if (!skb)
227                 goto out;
228         prefetchw(skb);
229
230         /* We do our best to align skb_shared_info on a separate cache
231          * line. It usually works because kmalloc(X > SMP_CACHE_BYTES) gives
232          * aligned memory blocks, unless SLUB/SLAB debug is enabled.
233          * Both skb->head and skb_shared_info are cache line aligned.
234          */
235         size = SKB_DATA_ALIGN(size);
236         size += SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
237         data = kmalloc_reserve(size, gfp_mask, node, &pfmemalloc);
238         if (!data)
239                 goto nodata;
240         /* kmalloc(size) might give us more room than requested.
241          * Put skb_shared_info exactly at the end of allocated zone,
242          * to allow max possible filling before reallocation.
243          */
244         size = SKB_WITH_OVERHEAD(ksize(data));
245         prefetchw(data + size);
246
247         /*
248          * Only clear those fields we need to clear, not those that we will
249          * actually initialise below. Hence, don't put any more fields after
250          * the tail pointer in struct sk_buff!
251          */
252         memset(skb, 0, offsetof(struct sk_buff, tail));
253         /* Account for allocated memory : skb + skb->head */
254         skb->truesize = SKB_TRUESIZE(size);
255         skb->pfmemalloc = pfmemalloc;
256         atomic_set(&skb->users, 1);
257         skb->head = data;
258         skb->data = data;
259         skb_reset_tail_pointer(skb);
260         skb->end = skb->tail + size;
261 #ifdef NET_SKBUFF_DATA_USES_OFFSET
262         skb->mac_header = ~0U;
263         skb->transport_header = ~0U;
264 #endif
265
266         /* make sure we initialize shinfo sequentially */
267         shinfo = skb_shinfo(skb);
268         memset(shinfo, 0, offsetof(struct skb_shared_info, dataref));
269         atomic_set(&shinfo->dataref, 1);
270         kmemcheck_annotate_variable(shinfo->destructor_arg);
271
272         if (flags & SKB_ALLOC_FCLONE) {
273                 struct sk_buff *child = skb + 1;
274                 atomic_t *fclone_ref = (atomic_t *) (child + 1);
275
276                 kmemcheck_annotate_bitfield(child, flags1);
277                 kmemcheck_annotate_bitfield(child, flags2);
278                 skb->fclone = SKB_FCLONE_ORIG;
279                 atomic_set(fclone_ref, 1);
280
281                 child->fclone = SKB_FCLONE_UNAVAILABLE;
282                 child->pfmemalloc = pfmemalloc;
283         }
284 out:
285         return skb;
286 nodata:
287         kmem_cache_free(cache, skb);
288         skb = NULL;
289         goto out;
290 }
291 EXPORT_SYMBOL(__alloc_skb);
292
293 /**
294  * build_skb - build a network buffer
295  * @data: data buffer provided by caller
296  * @frag_size: size of fragment, or 0 if head was kmalloced
297  *
298  * Allocate a new &sk_buff. Caller provides space holding head and
299  * skb_shared_info. @data must have been allocated by kmalloc()
300  * The return is the new skb buffer.
301  * On a failure the return is %NULL, and @data is not freed.
302  * Notes :
303  *  Before IO, driver allocates only data buffer where NIC put incoming frame
304  *  Driver should add room at head (NET_SKB_PAD) and
305  *  MUST add room at tail (SKB_DATA_ALIGN(skb_shared_info))
306  *  After IO, driver calls build_skb(), to allocate sk_buff and populate it
307  *  before giving packet to stack.
308  *  RX rings only contains data buffers, not full skbs.
309  */
310 struct sk_buff *build_skb(void *data, unsigned int frag_size)
311 {
312         struct skb_shared_info *shinfo;
313         struct sk_buff *skb;
314         unsigned int size = frag_size ? : ksize(data);
315
316         skb = kmem_cache_alloc(skbuff_head_cache, GFP_ATOMIC);
317         if (!skb)
318                 return NULL;
319
320         size -= SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
321
322         memset(skb, 0, offsetof(struct sk_buff, tail));
323         skb->truesize = SKB_TRUESIZE(size);
324         skb->head_frag = frag_size != 0;
325         atomic_set(&skb->users, 1);
326         skb->head = data;
327         skb->data = data;
328         skb_reset_tail_pointer(skb);
329         skb->end = skb->tail + size;
330 #ifdef NET_SKBUFF_DATA_USES_OFFSET
331         skb->mac_header = ~0U;
332         skb->transport_header = ~0U;
333 #endif
334
335         /* make sure we initialize shinfo sequentially */
336         shinfo = skb_shinfo(skb);
337         memset(shinfo, 0, offsetof(struct skb_shared_info, dataref));
338         atomic_set(&shinfo->dataref, 1);
339         kmemcheck_annotate_variable(shinfo->destructor_arg);
340
341         return skb;
342 }
343 EXPORT_SYMBOL(build_skb);
344
345 struct netdev_alloc_cache {
346         struct page_frag        frag;
347         /* we maintain a pagecount bias, so that we dont dirty cache line
348          * containing page->_count every time we allocate a fragment.
349          */
350         unsigned int            pagecnt_bias;
351 };
352 static DEFINE_PER_CPU(struct netdev_alloc_cache, netdev_alloc_cache);
353
354 static void *__netdev_alloc_frag(unsigned int fragsz, gfp_t gfp_mask)
355 {
356         struct netdev_alloc_cache *nc;
357         void *data = NULL;
358         int order;
359         unsigned long flags;
360
361         local_irq_save(flags);
362         nc = &__get_cpu_var(netdev_alloc_cache);
363         if (unlikely(!nc->frag.page)) {
364 refill:
365                 for (order = NETDEV_FRAG_PAGE_MAX_ORDER; ;) {
366                         gfp_t gfp = gfp_mask;
367
368                         if (order)
369                                 gfp |= __GFP_COMP | __GFP_NOWARN;
370                         nc->frag.page = alloc_pages(gfp, order);
371                         if (likely(nc->frag.page))
372                                 break;
373                         if (--order < 0)
374                                 goto end;
375                 }
376                 nc->frag.size = PAGE_SIZE << order;
377 recycle:
378                 atomic_set(&nc->frag.page->_count, NETDEV_PAGECNT_MAX_BIAS);
379                 nc->pagecnt_bias = NETDEV_PAGECNT_MAX_BIAS;
380                 nc->frag.offset = 0;
381         }
382
383         if (nc->frag.offset + fragsz > nc->frag.size) {
384                 /* avoid unnecessary locked operations if possible */
385                 if ((atomic_read(&nc->frag.page->_count) == nc->pagecnt_bias) ||
386                     atomic_sub_and_test(nc->pagecnt_bias, &nc->frag.page->_count))
387                         goto recycle;
388                 goto refill;
389         }
390
391         data = page_address(nc->frag.page) + nc->frag.offset;
392         nc->frag.offset += fragsz;
393         nc->pagecnt_bias--;
394 end:
395         local_irq_restore(flags);
396         return data;
397 }
398
399 /**
400  * netdev_alloc_frag - allocate a page fragment
401  * @fragsz: fragment size
402  *
403  * Allocates a frag from a page for receive buffer.
404  * Uses GFP_ATOMIC allocations.
405  */
406 void *netdev_alloc_frag(unsigned int fragsz)
407 {
408         return __netdev_alloc_frag(fragsz, GFP_ATOMIC | __GFP_COLD);
409 }
410 EXPORT_SYMBOL(netdev_alloc_frag);
411
412 /**
413  *      __netdev_alloc_skb - allocate an skbuff for rx on a specific device
414  *      @dev: network device to receive on
415  *      @length: length to allocate
416  *      @gfp_mask: get_free_pages mask, passed to alloc_skb
417  *
418  *      Allocate a new &sk_buff and assign it a usage count of one. The
419  *      buffer has unspecified headroom built in. Users should allocate
420  *      the headroom they think they need without accounting for the
421  *      built in space. The built in space is used for optimisations.
422  *
423  *      %NULL is returned if there is no free memory.
424  */
425 struct sk_buff *__netdev_alloc_skb(struct net_device *dev,
426                                    unsigned int length, gfp_t gfp_mask)
427 {
428         struct sk_buff *skb = NULL;
429         unsigned int fragsz = SKB_DATA_ALIGN(length + NET_SKB_PAD) +
430                               SKB_DATA_ALIGN(sizeof(struct skb_shared_info));
431
432         if (fragsz <= PAGE_SIZE && !(gfp_mask & (__GFP_WAIT | GFP_DMA))) {
433                 void *data;
434
435                 if (sk_memalloc_socks())
436                         gfp_mask |= __GFP_MEMALLOC;
437
438                 data = __netdev_alloc_frag(fragsz, gfp_mask);
439
440                 if (likely(data)) {
441                         skb = build_skb(data, fragsz);
442                         if (unlikely(!skb))
443                                 put_page(virt_to_head_page(data));
444                 }
445         } else {
446                 skb = __alloc_skb(length + NET_SKB_PAD, gfp_mask,
447                                   SKB_ALLOC_RX, NUMA_NO_NODE);
448         }
449         if (likely(skb)) {
450                 skb_reserve(skb, NET_SKB_PAD);
451                 skb->dev = dev;
452         }
453         return skb;
454 }
455 EXPORT_SYMBOL(__netdev_alloc_skb);
456
457 void skb_add_rx_frag(struct sk_buff *skb, int i, struct page *page, int off,
458                      int size, unsigned int truesize)
459 {
460         skb_fill_page_desc(skb, i, page, off, size);
461         skb->len += size;
462         skb->data_len += size;
463         skb->truesize += truesize;
464 }
465 EXPORT_SYMBOL(skb_add_rx_frag);
466
467 static void skb_drop_list(struct sk_buff **listp)
468 {
469         struct sk_buff *list = *listp;
470
471         *listp = NULL;
472
473         do {
474                 struct sk_buff *this = list;
475                 list = list->next;
476                 kfree_skb(this);
477         } while (list);
478 }
479
480 static inline void skb_drop_fraglist(struct sk_buff *skb)
481 {
482         skb_drop_list(&skb_shinfo(skb)->frag_list);
483 }
484
485 static void skb_clone_fraglist(struct sk_buff *skb)
486 {
487         struct sk_buff *list;
488
489         skb_walk_frags(skb, list)
490                 skb_get(list);
491 }
492
493 static void skb_free_head(struct sk_buff *skb)
494 {
495         if (skb->head_frag)
496                 put_page(virt_to_head_page(skb->head));
497         else
498                 kfree(skb->head);
499 }
500
501 static void skb_release_data(struct sk_buff *skb)
502 {
503         if (!skb->cloned ||
504             !atomic_sub_return(skb->nohdr ? (1 << SKB_DATAREF_SHIFT) + 1 : 1,
505                                &skb_shinfo(skb)->dataref)) {
506                 if (skb_shinfo(skb)->nr_frags) {
507                         int i;
508                         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++)
509                                 skb_frag_unref(skb, i);
510                 }
511
512                 /*
513                  * If skb buf is from userspace, we need to notify the caller
514                  * the lower device DMA has done;
515                  */
516                 if (skb_shinfo(skb)->tx_flags & SKBTX_DEV_ZEROCOPY) {
517                         struct ubuf_info *uarg;
518
519                         uarg = skb_shinfo(skb)->destructor_arg;
520                         if (uarg->callback)
521                                 uarg->callback(uarg, true);
522                 }
523
524                 if (skb_has_frag_list(skb))
525                         skb_drop_fraglist(skb);
526
527                 skb_free_head(skb);
528         }
529 }
530
531 /*
532  *      Free an skbuff by memory without cleaning the state.
533  */
534 static void kfree_skbmem(struct sk_buff *skb)
535 {
536         struct sk_buff *other;
537         atomic_t *fclone_ref;
538
539         switch (skb->fclone) {
540         case SKB_FCLONE_UNAVAILABLE:
541                 kmem_cache_free(skbuff_head_cache, skb);
542                 break;
543
544         case SKB_FCLONE_ORIG:
545                 fclone_ref = (atomic_t *) (skb + 2);
546                 if (atomic_dec_and_test(fclone_ref))
547                         kmem_cache_free(skbuff_fclone_cache, skb);
548                 break;
549
550         case SKB_FCLONE_CLONE:
551                 fclone_ref = (atomic_t *) (skb + 1);
552                 other = skb - 1;
553
554                 /* The clone portion is available for
555                  * fast-cloning again.
556                  */
557                 skb->fclone = SKB_FCLONE_UNAVAILABLE;
558
559                 if (atomic_dec_and_test(fclone_ref))
560                         kmem_cache_free(skbuff_fclone_cache, other);
561                 break;
562         }
563 }
564
565 static void skb_release_head_state(struct sk_buff *skb)
566 {
567         skb_dst_drop(skb);
568 #ifdef CONFIG_XFRM
569         secpath_put(skb->sp);
570 #endif
571         if (skb->destructor) {
572                 WARN_ON(in_irq());
573                 skb->destructor(skb);
574         }
575 #if IS_ENABLED(CONFIG_NF_CONNTRACK)
576         nf_conntrack_put(skb->nfct);
577 #endif
578 #ifdef NET_SKBUFF_NF_DEFRAG_NEEDED
579         nf_conntrack_put_reasm(skb->nfct_reasm);
580 #endif
581 #ifdef CONFIG_BRIDGE_NETFILTER
582         nf_bridge_put(skb->nf_bridge);
583 #endif
584 /* XXX: IS this still necessary? - JHS */
585 #ifdef CONFIG_NET_SCHED
586         skb->tc_index = 0;
587 #ifdef CONFIG_NET_CLS_ACT
588         skb->tc_verd = 0;
589 #endif
590 #endif
591 }
592
593 /* Free everything but the sk_buff shell. */
594 static void skb_release_all(struct sk_buff *skb)
595 {
596         skb_release_head_state(skb);
597         skb_release_data(skb);
598 }
599
600 /**
601  *      __kfree_skb - private function
602  *      @skb: buffer
603  *
604  *      Free an sk_buff. Release anything attached to the buffer.
605  *      Clean the state. This is an internal helper function. Users should
606  *      always call kfree_skb
607  */
608
609 void __kfree_skb(struct sk_buff *skb)
610 {
611         skb_release_all(skb);
612         kfree_skbmem(skb);
613 }
614 EXPORT_SYMBOL(__kfree_skb);
615
616 /**
617  *      kfree_skb - free an sk_buff
618  *      @skb: buffer to free
619  *
620  *      Drop a reference to the buffer and free it if the usage count has
621  *      hit zero.
622  */
623 void kfree_skb(struct sk_buff *skb)
624 {
625         if (unlikely(!skb))
626                 return;
627         if (likely(atomic_read(&skb->users) == 1))
628                 smp_rmb();
629         else if (likely(!atomic_dec_and_test(&skb->users)))
630                 return;
631         trace_kfree_skb(skb, __builtin_return_address(0));
632         __kfree_skb(skb);
633 }
634 EXPORT_SYMBOL(kfree_skb);
635
636 /**
637  *      skb_tx_error - report an sk_buff xmit error
638  *      @skb: buffer that triggered an error
639  *
640  *      Report xmit error if a device callback is tracking this skb.
641  *      skb must be freed afterwards.
642  */
643 void skb_tx_error(struct sk_buff *skb)
644 {
645         if (skb_shinfo(skb)->tx_flags & SKBTX_DEV_ZEROCOPY) {
646                 struct ubuf_info *uarg;
647
648                 uarg = skb_shinfo(skb)->destructor_arg;
649                 if (uarg->callback)
650                         uarg->callback(uarg, false);
651                 skb_shinfo(skb)->tx_flags &= ~SKBTX_DEV_ZEROCOPY;
652         }
653 }
654 EXPORT_SYMBOL(skb_tx_error);
655
656 /**
657  *      consume_skb - free an skbuff
658  *      @skb: buffer to free
659  *
660  *      Drop a ref to the buffer and free it if the usage count has hit zero
661  *      Functions identically to kfree_skb, but kfree_skb assumes that the frame
662  *      is being dropped after a failure and notes that
663  */
664 void consume_skb(struct sk_buff *skb)
665 {
666         if (unlikely(!skb))
667                 return;
668         if (likely(atomic_read(&skb->users) == 1))
669                 smp_rmb();
670         else if (likely(!atomic_dec_and_test(&skb->users)))
671                 return;
672         trace_consume_skb(skb);
673         __kfree_skb(skb);
674 }
675 EXPORT_SYMBOL(consume_skb);
676
677 static void __copy_skb_header(struct sk_buff *new, const struct sk_buff *old)
678 {
679         new->tstamp             = old->tstamp;
680         new->dev                = old->dev;
681         new->transport_header   = old->transport_header;
682         new->network_header     = old->network_header;
683         new->mac_header         = old->mac_header;
684         new->inner_transport_header = old->inner_transport_header;
685         new->inner_network_header = old->inner_network_header;
686         skb_dst_copy(new, old);
687         new->rxhash             = old->rxhash;
688         new->ooo_okay           = old->ooo_okay;
689         new->l4_rxhash          = old->l4_rxhash;
690         new->no_fcs             = old->no_fcs;
691         new->encapsulation      = old->encapsulation;
692 #ifdef CONFIG_XFRM
693         new->sp                 = secpath_get(old->sp);
694 #endif
695         memcpy(new->cb, old->cb, sizeof(old->cb));
696         new->csum               = old->csum;
697         new->local_df           = old->local_df;
698         new->pkt_type           = old->pkt_type;
699         new->ip_summed          = old->ip_summed;
700         skb_copy_queue_mapping(new, old);
701         new->priority           = old->priority;
702 #if IS_ENABLED(CONFIG_IP_VS)
703         new->ipvs_property      = old->ipvs_property;
704 #endif
705         new->pfmemalloc         = old->pfmemalloc;
706         new->protocol           = old->protocol;
707         new->mark               = old->mark;
708         new->skb_iif            = old->skb_iif;
709         __nf_copy(new, old);
710 #if IS_ENABLED(CONFIG_NETFILTER_XT_TARGET_TRACE)
711         new->nf_trace           = old->nf_trace;
712 #endif
713 #ifdef CONFIG_NET_SCHED
714         new->tc_index           = old->tc_index;
715 #ifdef CONFIG_NET_CLS_ACT
716         new->tc_verd            = old->tc_verd;
717 #endif
718 #endif
719         new->vlan_tci           = old->vlan_tci;
720
721         skb_copy_secmark(new, old);
722 }
723
724 /*
725  * You should not add any new code to this function.  Add it to
726  * __copy_skb_header above instead.
727  */
728 static struct sk_buff *__skb_clone(struct sk_buff *n, struct sk_buff *skb)
729 {
730 #define C(x) n->x = skb->x
731
732         n->next = n->prev = NULL;
733         n->sk = NULL;
734         __copy_skb_header(n, skb);
735
736         C(len);
737         C(data_len);
738         C(mac_len);
739         n->hdr_len = skb->nohdr ? skb_headroom(skb) : skb->hdr_len;
740         n->cloned = 1;
741         n->nohdr = 0;
742         n->destructor = NULL;
743         C(tail);
744         C(end);
745         C(head);
746         C(head_frag);
747         C(data);
748         C(truesize);
749         atomic_set(&n->users, 1);
750
751         atomic_inc(&(skb_shinfo(skb)->dataref));
752         skb->cloned = 1;
753
754         return n;
755 #undef C
756 }
757
758 /**
759  *      skb_morph       -       morph one skb into another
760  *      @dst: the skb to receive the contents
761  *      @src: the skb to supply the contents
762  *
763  *      This is identical to skb_clone except that the target skb is
764  *      supplied by the user.
765  *
766  *      The target skb is returned upon exit.
767  */
768 struct sk_buff *skb_morph(struct sk_buff *dst, struct sk_buff *src)
769 {
770         skb_release_all(dst);
771         return __skb_clone(dst, src);
772 }
773 EXPORT_SYMBOL_GPL(skb_morph);
774
775 /**
776  *      skb_copy_ubufs  -       copy userspace skb frags buffers to kernel
777  *      @skb: the skb to modify
778  *      @gfp_mask: allocation priority
779  *
780  *      This must be called on SKBTX_DEV_ZEROCOPY skb.
781  *      It will copy all frags into kernel and drop the reference
782  *      to userspace pages.
783  *
784  *      If this function is called from an interrupt gfp_mask() must be
785  *      %GFP_ATOMIC.
786  *
787  *      Returns 0 on success or a negative error code on failure
788  *      to allocate kernel memory to copy to.
789  */
790 int skb_copy_ubufs(struct sk_buff *skb, gfp_t gfp_mask)
791 {
792         int i;
793         int num_frags = skb_shinfo(skb)->nr_frags;
794         struct page *page, *head = NULL;
795         struct ubuf_info *uarg = skb_shinfo(skb)->destructor_arg;
796
797         for (i = 0; i < num_frags; i++) {
798                 u8 *vaddr;
799                 skb_frag_t *f = &skb_shinfo(skb)->frags[i];
800
801                 page = alloc_page(gfp_mask);
802                 if (!page) {
803                         while (head) {
804                                 struct page *next = (struct page *)head->private;
805                                 put_page(head);
806                                 head = next;
807                         }
808                         return -ENOMEM;
809                 }
810                 vaddr = kmap_atomic(skb_frag_page(f));
811                 memcpy(page_address(page),
812                        vaddr + f->page_offset, skb_frag_size(f));
813                 kunmap_atomic(vaddr);
814                 page->private = (unsigned long)head;
815                 head = page;
816         }
817
818         /* skb frags release userspace buffers */
819         for (i = 0; i < num_frags; i++)
820                 skb_frag_unref(skb, i);
821
822         uarg->callback(uarg, false);
823
824         /* skb frags point to kernel buffers */
825         for (i = num_frags - 1; i >= 0; i--) {
826                 __skb_fill_page_desc(skb, i, head, 0,
827                                      skb_shinfo(skb)->frags[i].size);
828                 head = (struct page *)head->private;
829         }
830
831         skb_shinfo(skb)->tx_flags &= ~SKBTX_DEV_ZEROCOPY;
832         return 0;
833 }
834 EXPORT_SYMBOL_GPL(skb_copy_ubufs);
835
836 /**
837  *      skb_clone       -       duplicate an sk_buff
838  *      @skb: buffer to clone
839  *      @gfp_mask: allocation priority
840  *
841  *      Duplicate an &sk_buff. The new one is not owned by a socket. Both
842  *      copies share the same packet data but not structure. The new
843  *      buffer has a reference count of 1. If the allocation fails the
844  *      function returns %NULL otherwise the new buffer is returned.
845  *
846  *      If this function is called from an interrupt gfp_mask() must be
847  *      %GFP_ATOMIC.
848  */
849
850 struct sk_buff *skb_clone(struct sk_buff *skb, gfp_t gfp_mask)
851 {
852         struct sk_buff *n;
853
854         if (skb_orphan_frags(skb, gfp_mask))
855                 return NULL;
856
857         n = skb + 1;
858         if (skb->fclone == SKB_FCLONE_ORIG &&
859             n->fclone == SKB_FCLONE_UNAVAILABLE) {
860                 atomic_t *fclone_ref = (atomic_t *) (n + 1);
861                 n->fclone = SKB_FCLONE_CLONE;
862                 atomic_inc(fclone_ref);
863         } else {
864                 if (skb_pfmemalloc(skb))
865                         gfp_mask |= __GFP_MEMALLOC;
866
867                 n = kmem_cache_alloc(skbuff_head_cache, gfp_mask);
868                 if (!n)
869                         return NULL;
870
871                 kmemcheck_annotate_bitfield(n, flags1);
872                 kmemcheck_annotate_bitfield(n, flags2);
873                 n->fclone = SKB_FCLONE_UNAVAILABLE;
874         }
875
876         return __skb_clone(n, skb);
877 }
878 EXPORT_SYMBOL(skb_clone);
879
880 static void copy_skb_header(struct sk_buff *new, const struct sk_buff *old)
881 {
882 #ifndef NET_SKBUFF_DATA_USES_OFFSET
883         /*
884          *      Shift between the two data areas in bytes
885          */
886         unsigned long offset = new->data - old->data;
887 #endif
888
889         __copy_skb_header(new, old);
890
891 #ifndef NET_SKBUFF_DATA_USES_OFFSET
892         /* {transport,network,mac}_header are relative to skb->head */
893         new->transport_header += offset;
894         new->network_header   += offset;
895         if (skb_mac_header_was_set(new))
896                 new->mac_header       += offset;
897         new->inner_transport_header += offset;
898         new->inner_network_header   += offset;
899 #endif
900         skb_shinfo(new)->gso_size = skb_shinfo(old)->gso_size;
901         skb_shinfo(new)->gso_segs = skb_shinfo(old)->gso_segs;
902         skb_shinfo(new)->gso_type = skb_shinfo(old)->gso_type;
903 }
904
905 static inline int skb_alloc_rx_flag(const struct sk_buff *skb)
906 {
907         if (skb_pfmemalloc(skb))
908                 return SKB_ALLOC_RX;
909         return 0;
910 }
911
912 /**
913  *      skb_copy        -       create private copy of an sk_buff
914  *      @skb: buffer to copy
915  *      @gfp_mask: allocation priority
916  *
917  *      Make a copy of both an &sk_buff and its data. This is used when the
918  *      caller wishes to modify the data and needs a private copy of the
919  *      data to alter. Returns %NULL on failure or the pointer to the buffer
920  *      on success. The returned buffer has a reference count of 1.
921  *
922  *      As by-product this function converts non-linear &sk_buff to linear
923  *      one, so that &sk_buff becomes completely private and caller is allowed
924  *      to modify all the data of returned buffer. This means that this
925  *      function is not recommended for use in circumstances when only
926  *      header is going to be modified. Use pskb_copy() instead.
927  */
928
929 struct sk_buff *skb_copy(const struct sk_buff *skb, gfp_t gfp_mask)
930 {
931         int headerlen = skb_headroom(skb);
932         unsigned int size = skb_end_offset(skb) + skb->data_len;
933         struct sk_buff *n = __alloc_skb(size, gfp_mask,
934                                         skb_alloc_rx_flag(skb), NUMA_NO_NODE);
935
936         if (!n)
937                 return NULL;
938
939         /* Set the data pointer */
940         skb_reserve(n, headerlen);
941         /* Set the tail pointer and length */
942         skb_put(n, skb->len);
943
944         if (skb_copy_bits(skb, -headerlen, n->head, headerlen + skb->len))
945                 BUG();
946
947         copy_skb_header(n, skb);
948         return n;
949 }
950 EXPORT_SYMBOL(skb_copy);
951
952 /**
953  *      __pskb_copy     -       create copy of an sk_buff with private head.
954  *      @skb: buffer to copy
955  *      @headroom: headroom of new skb
956  *      @gfp_mask: allocation priority
957  *
958  *      Make a copy of both an &sk_buff and part of its data, located
959  *      in header. Fragmented data remain shared. This is used when
960  *      the caller wishes to modify only header of &sk_buff and needs
961  *      private copy of the header to alter. Returns %NULL on failure
962  *      or the pointer to the buffer on success.
963  *      The returned buffer has a reference count of 1.
964  */
965
966 struct sk_buff *__pskb_copy(struct sk_buff *skb, int headroom, gfp_t gfp_mask)
967 {
968         unsigned int size = skb_headlen(skb) + headroom;
969         struct sk_buff *n = __alloc_skb(size, gfp_mask,
970                                         skb_alloc_rx_flag(skb), NUMA_NO_NODE);
971
972         if (!n)
973                 goto out;
974
975         /* Set the data pointer */
976         skb_reserve(n, headroom);
977         /* Set the tail pointer and length */
978         skb_put(n, skb_headlen(skb));
979         /* Copy the bytes */
980         skb_copy_from_linear_data(skb, n->data, n->len);
981
982         n->truesize += skb->data_len;
983         n->data_len  = skb->data_len;
984         n->len       = skb->len;
985
986         if (skb_shinfo(skb)->nr_frags) {
987                 int i;
988
989                 if (skb_orphan_frags(skb, gfp_mask)) {
990                         kfree_skb(n);
991                         n = NULL;
992                         goto out;
993                 }
994                 for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
995                         skb_shinfo(n)->frags[i] = skb_shinfo(skb)->frags[i];
996                         skb_frag_ref(skb, i);
997                 }
998                 skb_shinfo(n)->nr_frags = i;
999         }
1000
1001         if (skb_has_frag_list(skb)) {
1002                 skb_shinfo(n)->frag_list = skb_shinfo(skb)->frag_list;
1003                 skb_clone_fraglist(n);
1004         }
1005
1006         copy_skb_header(n, skb);
1007 out:
1008         return n;
1009 }
1010 EXPORT_SYMBOL(__pskb_copy);
1011
1012 /**
1013  *      pskb_expand_head - reallocate header of &sk_buff
1014  *      @skb: buffer to reallocate
1015  *      @nhead: room to add at head
1016  *      @ntail: room to add at tail
1017  *      @gfp_mask: allocation priority
1018  *
1019  *      Expands (or creates identical copy, if &nhead and &ntail are zero)
1020  *      header of skb. &sk_buff itself is not changed. &sk_buff MUST have
1021  *      reference count of 1. Returns zero in the case of success or error,
1022  *      if expansion failed. In the last case, &sk_buff is not changed.
1023  *
1024  *      All the pointers pointing into skb header may change and must be
1025  *      reloaded after call to this function.
1026  */
1027
1028 int pskb_expand_head(struct sk_buff *skb, int nhead, int ntail,
1029                      gfp_t gfp_mask)
1030 {
1031         int i;
1032         u8 *data;
1033         int size = nhead + skb_end_offset(skb) + ntail;
1034         long off;
1035
1036         BUG_ON(nhead < 0);
1037
1038         if (skb_shared(skb))
1039                 BUG();
1040
1041         size = SKB_DATA_ALIGN(size);
1042
1043         if (skb_pfmemalloc(skb))
1044                 gfp_mask |= __GFP_MEMALLOC;
1045         data = kmalloc_reserve(size + SKB_DATA_ALIGN(sizeof(struct skb_shared_info)),
1046                                gfp_mask, NUMA_NO_NODE, NULL);
1047         if (!data)
1048                 goto nodata;
1049         size = SKB_WITH_OVERHEAD(ksize(data));
1050
1051         /* Copy only real data... and, alas, header. This should be
1052          * optimized for the cases when header is void.
1053          */
1054         memcpy(data + nhead, skb->head, skb_tail_pointer(skb) - skb->head);
1055
1056         memcpy((struct skb_shared_info *)(data + size),
1057                skb_shinfo(skb),
1058                offsetof(struct skb_shared_info, frags[skb_shinfo(skb)->nr_frags]));
1059
1060         /*
1061          * if shinfo is shared we must drop the old head gracefully, but if it
1062          * is not we can just drop the old head and let the existing refcount
1063          * be since all we did is relocate the values
1064          */
1065         if (skb_cloned(skb)) {
1066                 /* copy this zero copy skb frags */
1067                 if (skb_orphan_frags(skb, gfp_mask))
1068                         goto nofrags;
1069                 for (i = 0; i < skb_shinfo(skb)->nr_frags; i++)
1070                         skb_frag_ref(skb, i);
1071
1072                 if (skb_has_frag_list(skb))
1073                         skb_clone_fraglist(skb);
1074
1075                 skb_release_data(skb);
1076         } else {
1077                 skb_free_head(skb);
1078         }
1079         off = (data + nhead) - skb->head;
1080
1081         skb->head     = data;
1082         skb->head_frag = 0;
1083         skb->data    += off;
1084 #ifdef NET_SKBUFF_DATA_USES_OFFSET
1085         skb->end      = size;
1086         off           = nhead;
1087 #else
1088         skb->end      = skb->head + size;
1089 #endif
1090         /* {transport,network,mac}_header and tail are relative to skb->head */
1091         skb->tail             += off;
1092         skb->transport_header += off;
1093         skb->network_header   += off;
1094         if (skb_mac_header_was_set(skb))
1095                 skb->mac_header += off;
1096         skb->inner_transport_header += off;
1097         skb->inner_network_header += off;
1098         /* Only adjust this if it actually is csum_start rather than csum */
1099         if (skb->ip_summed == CHECKSUM_PARTIAL)
1100                 skb->csum_start += nhead;
1101         skb->cloned   = 0;
1102         skb->hdr_len  = 0;
1103         skb->nohdr    = 0;
1104         atomic_set(&skb_shinfo(skb)->dataref, 1);
1105         return 0;
1106
1107 nofrags:
1108         kfree(data);
1109 nodata:
1110         return -ENOMEM;
1111 }
1112 EXPORT_SYMBOL(pskb_expand_head);
1113
1114 /* Make private copy of skb with writable head and some headroom */
1115
1116 struct sk_buff *skb_realloc_headroom(struct sk_buff *skb, unsigned int headroom)
1117 {
1118         struct sk_buff *skb2;
1119         int delta = headroom - skb_headroom(skb);
1120
1121         if (delta <= 0)
1122                 skb2 = pskb_copy(skb, GFP_ATOMIC);
1123         else {
1124                 skb2 = skb_clone(skb, GFP_ATOMIC);
1125                 if (skb2 && pskb_expand_head(skb2, SKB_DATA_ALIGN(delta), 0,
1126                                              GFP_ATOMIC)) {
1127                         kfree_skb(skb2);
1128                         skb2 = NULL;
1129                 }
1130         }
1131         return skb2;
1132 }
1133 EXPORT_SYMBOL(skb_realloc_headroom);
1134
1135 /**
1136  *      skb_copy_expand -       copy and expand sk_buff
1137  *      @skb: buffer to copy
1138  *      @newheadroom: new free bytes at head
1139  *      @newtailroom: new free bytes at tail
1140  *      @gfp_mask: allocation priority
1141  *
1142  *      Make a copy of both an &sk_buff and its data and while doing so
1143  *      allocate additional space.
1144  *
1145  *      This is used when the caller wishes to modify the data and needs a
1146  *      private copy of the data to alter as well as more space for new fields.
1147  *      Returns %NULL on failure or the pointer to the buffer
1148  *      on success. The returned buffer has a reference count of 1.
1149  *
1150  *      You must pass %GFP_ATOMIC as the allocation priority if this function
1151  *      is called from an interrupt.
1152  */
1153 struct sk_buff *skb_copy_expand(const struct sk_buff *skb,
1154                                 int newheadroom, int newtailroom,
1155                                 gfp_t gfp_mask)
1156 {
1157         /*
1158          *      Allocate the copy buffer
1159          */
1160         struct sk_buff *n = __alloc_skb(newheadroom + skb->len + newtailroom,
1161                                         gfp_mask, skb_alloc_rx_flag(skb),
1162                                         NUMA_NO_NODE);
1163         int oldheadroom = skb_headroom(skb);
1164         int head_copy_len, head_copy_off;
1165         int off;
1166
1167         if (!n)
1168                 return NULL;
1169
1170         skb_reserve(n, newheadroom);
1171
1172         /* Set the tail pointer and length */
1173         skb_put(n, skb->len);
1174
1175         head_copy_len = oldheadroom;
1176         head_copy_off = 0;
1177         if (newheadroom <= head_copy_len)
1178                 head_copy_len = newheadroom;
1179         else
1180                 head_copy_off = newheadroom - head_copy_len;
1181
1182         /* Copy the linear header and data. */
1183         if (skb_copy_bits(skb, -head_copy_len, n->head + head_copy_off,
1184                           skb->len + head_copy_len))
1185                 BUG();
1186
1187         copy_skb_header(n, skb);
1188
1189         off                  = newheadroom - oldheadroom;
1190         if (n->ip_summed == CHECKSUM_PARTIAL)
1191                 n->csum_start += off;
1192 #ifdef NET_SKBUFF_DATA_USES_OFFSET
1193         n->transport_header += off;
1194         n->network_header   += off;
1195         if (skb_mac_header_was_set(skb))
1196                 n->mac_header += off;
1197         n->inner_transport_header += off;
1198         n->inner_network_header    += off;
1199 #endif
1200
1201         return n;
1202 }
1203 EXPORT_SYMBOL(skb_copy_expand);
1204
1205 /**
1206  *      skb_pad                 -       zero pad the tail of an skb
1207  *      @skb: buffer to pad
1208  *      @pad: space to pad
1209  *
1210  *      Ensure that a buffer is followed by a padding area that is zero
1211  *      filled. Used by network drivers which may DMA or transfer data
1212  *      beyond the buffer end onto the wire.
1213  *
1214  *      May return error in out of memory cases. The skb is freed on error.
1215  */
1216
1217 int skb_pad(struct sk_buff *skb, int pad)
1218 {
1219         int err;
1220         int ntail;
1221
1222         /* If the skbuff is non linear tailroom is always zero.. */
1223         if (!skb_cloned(skb) && skb_tailroom(skb) >= pad) {
1224                 memset(skb->data+skb->len, 0, pad);
1225                 return 0;
1226         }
1227
1228         ntail = skb->data_len + pad - (skb->end - skb->tail);
1229         if (likely(skb_cloned(skb) || ntail > 0)) {
1230                 err = pskb_expand_head(skb, 0, ntail, GFP_ATOMIC);
1231                 if (unlikely(err))
1232                         goto free_skb;
1233         }
1234
1235         /* FIXME: The use of this function with non-linear skb's really needs
1236          * to be audited.
1237          */
1238         err = skb_linearize(skb);
1239         if (unlikely(err))
1240                 goto free_skb;
1241
1242         memset(skb->data + skb->len, 0, pad);
1243         return 0;
1244
1245 free_skb:
1246         kfree_skb(skb);
1247         return err;
1248 }
1249 EXPORT_SYMBOL(skb_pad);
1250
1251 /**
1252  *      skb_put - add data to a buffer
1253  *      @skb: buffer to use
1254  *      @len: amount of data to add
1255  *
1256  *      This function extends the used data area of the buffer. If this would
1257  *      exceed the total buffer size the kernel will panic. A pointer to the
1258  *      first byte of the extra data is returned.
1259  */
1260 unsigned char *skb_put(struct sk_buff *skb, unsigned int len)
1261 {
1262         unsigned char *tmp = skb_tail_pointer(skb);
1263         SKB_LINEAR_ASSERT(skb);
1264         skb->tail += len;
1265         skb->len  += len;
1266         if (unlikely(skb->tail > skb->end))
1267                 skb_over_panic(skb, len, __builtin_return_address(0));
1268         return tmp;
1269 }
1270 EXPORT_SYMBOL(skb_put);
1271
1272 /**
1273  *      skb_push - add data to the start of a buffer
1274  *      @skb: buffer to use
1275  *      @len: amount of data to add
1276  *
1277  *      This function extends the used data area of the buffer at the buffer
1278  *      start. If this would exceed the total buffer headroom the kernel will
1279  *      panic. A pointer to the first byte of the extra data is returned.
1280  */
1281 unsigned char *skb_push(struct sk_buff *skb, unsigned int len)
1282 {
1283         skb->data -= len;
1284         skb->len  += len;
1285         if (unlikely(skb->data<skb->head))
1286                 skb_under_panic(skb, len, __builtin_return_address(0));
1287         return skb->data;
1288 }
1289 EXPORT_SYMBOL(skb_push);
1290
1291 /**
1292  *      skb_pull - remove data from the start of a buffer
1293  *      @skb: buffer to use
1294  *      @len: amount of data to remove
1295  *
1296  *      This function removes data from the start of a buffer, returning
1297  *      the memory to the headroom. A pointer to the next data in the buffer
1298  *      is returned. Once the data has been pulled future pushes will overwrite
1299  *      the old data.
1300  */
1301 unsigned char *skb_pull(struct sk_buff *skb, unsigned int len)
1302 {
1303         return skb_pull_inline(skb, len);
1304 }
1305 EXPORT_SYMBOL(skb_pull);
1306
1307 /**
1308  *      skb_trim - remove end from a buffer
1309  *      @skb: buffer to alter
1310  *      @len: new length
1311  *
1312  *      Cut the length of a buffer down by removing data from the tail. If
1313  *      the buffer is already under the length specified it is not modified.
1314  *      The skb must be linear.
1315  */
1316 void skb_trim(struct sk_buff *skb, unsigned int len)
1317 {
1318         if (skb->len > len)
1319                 __skb_trim(skb, len);
1320 }
1321 EXPORT_SYMBOL(skb_trim);
1322
1323 /* Trims skb to length len. It can change skb pointers.
1324  */
1325
1326 int ___pskb_trim(struct sk_buff *skb, unsigned int len)
1327 {
1328         struct sk_buff **fragp;
1329         struct sk_buff *frag;
1330         int offset = skb_headlen(skb);
1331         int nfrags = skb_shinfo(skb)->nr_frags;
1332         int i;
1333         int err;
1334
1335         if (skb_cloned(skb) &&
1336             unlikely((err = pskb_expand_head(skb, 0, 0, GFP_ATOMIC))))
1337                 return err;
1338
1339         i = 0;
1340         if (offset >= len)
1341                 goto drop_pages;
1342
1343         for (; i < nfrags; i++) {
1344                 int end = offset + skb_frag_size(&skb_shinfo(skb)->frags[i]);
1345
1346                 if (end < len) {
1347                         offset = end;
1348                         continue;
1349                 }
1350
1351                 skb_frag_size_set(&skb_shinfo(skb)->frags[i++], len - offset);
1352
1353 drop_pages:
1354                 skb_shinfo(skb)->nr_frags = i;
1355
1356                 for (; i < nfrags; i++)
1357                         skb_frag_unref(skb, i);
1358
1359                 if (skb_has_frag_list(skb))
1360                         skb_drop_fraglist(skb);
1361                 goto done;
1362         }
1363
1364         for (fragp = &skb_shinfo(skb)->frag_list; (frag = *fragp);
1365              fragp = &frag->next) {
1366                 int end = offset + frag->len;
1367
1368                 if (skb_shared(frag)) {
1369                         struct sk_buff *nfrag;
1370
1371                         nfrag = skb_clone(frag, GFP_ATOMIC);
1372                         if (unlikely(!nfrag))
1373                                 return -ENOMEM;
1374
1375                         nfrag->next = frag->next;
1376                         consume_skb(frag);
1377                         frag = nfrag;
1378                         *fragp = frag;
1379                 }
1380
1381                 if (end < len) {
1382                         offset = end;
1383                         continue;
1384                 }
1385
1386                 if (end > len &&
1387                     unlikely((err = pskb_trim(frag, len - offset))))
1388                         return err;
1389
1390                 if (frag->next)
1391                         skb_drop_list(&frag->next);
1392                 break;
1393         }
1394
1395 done:
1396         if (len > skb_headlen(skb)) {
1397                 skb->data_len -= skb->len - len;
1398                 skb->len       = len;
1399         } else {
1400                 skb->len       = len;
1401                 skb->data_len  = 0;
1402                 skb_set_tail_pointer(skb, len);
1403         }
1404
1405         return 0;
1406 }
1407 EXPORT_SYMBOL(___pskb_trim);
1408
1409 /**
1410  *      __pskb_pull_tail - advance tail of skb header
1411  *      @skb: buffer to reallocate
1412  *      @delta: number of bytes to advance tail
1413  *
1414  *      The function makes a sense only on a fragmented &sk_buff,
1415  *      it expands header moving its tail forward and copying necessary
1416  *      data from fragmented part.
1417  *
1418  *      &sk_buff MUST have reference count of 1.
1419  *
1420  *      Returns %NULL (and &sk_buff does not change) if pull failed
1421  *      or value of new tail of skb in the case of success.
1422  *
1423  *      All the pointers pointing into skb header may change and must be
1424  *      reloaded after call to this function.
1425  */
1426
1427 /* Moves tail of skb head forward, copying data from fragmented part,
1428  * when it is necessary.
1429  * 1. It may fail due to malloc failure.
1430  * 2. It may change skb pointers.
1431  *
1432  * It is pretty complicated. Luckily, it is called only in exceptional cases.
1433  */
1434 unsigned char *__pskb_pull_tail(struct sk_buff *skb, int delta)
1435 {
1436         /* If skb has not enough free space at tail, get new one
1437          * plus 128 bytes for future expansions. If we have enough
1438          * room at tail, reallocate without expansion only if skb is cloned.
1439          */
1440         int i, k, eat = (skb->tail + delta) - skb->end;
1441
1442         if (eat > 0 || skb_cloned(skb)) {
1443                 if (pskb_expand_head(skb, 0, eat > 0 ? eat + 128 : 0,
1444                                      GFP_ATOMIC))
1445                         return NULL;
1446         }
1447
1448         if (skb_copy_bits(skb, skb_headlen(skb), skb_tail_pointer(skb), delta))
1449                 BUG();
1450
1451         /* Optimization: no fragments, no reasons to preestimate
1452          * size of pulled pages. Superb.
1453          */
1454         if (!skb_has_frag_list(skb))
1455                 goto pull_pages;
1456
1457         /* Estimate size of pulled pages. */
1458         eat = delta;
1459         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
1460                 int size = skb_frag_size(&skb_shinfo(skb)->frags[i]);
1461
1462                 if (size >= eat)
1463                         goto pull_pages;
1464                 eat -= size;
1465         }
1466
1467         /* If we need update frag list, we are in troubles.
1468          * Certainly, it possible to add an offset to skb data,
1469          * but taking into account that pulling is expected to
1470          * be very rare operation, it is worth to fight against
1471          * further bloating skb head and crucify ourselves here instead.
1472          * Pure masohism, indeed. 8)8)
1473          */
1474         if (eat) {
1475                 struct sk_buff *list = skb_shinfo(skb)->frag_list;
1476                 struct sk_buff *clone = NULL;
1477                 struct sk_buff *insp = NULL;
1478
1479                 do {
1480                         BUG_ON(!list);
1481
1482                         if (list->len <= eat) {
1483                                 /* Eaten as whole. */
1484                                 eat -= list->len;
1485                                 list = list->next;
1486                                 insp = list;
1487                         } else {
1488                                 /* Eaten partially. */
1489
1490                                 if (skb_shared(list)) {
1491                                         /* Sucks! We need to fork list. :-( */
1492                                         clone = skb_clone(list, GFP_ATOMIC);
1493                                         if (!clone)
1494                                                 return NULL;
1495                                         insp = list->next;
1496                                         list = clone;
1497                                 } else {
1498                                         /* This may be pulled without
1499                                          * problems. */
1500                                         insp = list;
1501                                 }
1502                                 if (!pskb_pull(list, eat)) {
1503                                         kfree_skb(clone);
1504                                         return NULL;
1505                                 }
1506                                 break;
1507                         }
1508                 } while (eat);
1509
1510                 /* Free pulled out fragments. */
1511                 while ((list = skb_shinfo(skb)->frag_list) != insp) {
1512                         skb_shinfo(skb)->frag_list = list->next;
1513                         kfree_skb(list);
1514                 }
1515                 /* And insert new clone at head. */
1516                 if (clone) {
1517                         clone->next = list;
1518                         skb_shinfo(skb)->frag_list = clone;
1519                 }
1520         }
1521         /* Success! Now we may commit changes to skb data. */
1522
1523 pull_pages:
1524         eat = delta;
1525         k = 0;
1526         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
1527                 int size = skb_frag_size(&skb_shinfo(skb)->frags[i]);
1528
1529                 if (size <= eat) {
1530                         skb_frag_unref(skb, i);
1531                         eat -= size;
1532                 } else {
1533                         skb_shinfo(skb)->frags[k] = skb_shinfo(skb)->frags[i];
1534                         if (eat) {
1535                                 skb_shinfo(skb)->frags[k].page_offset += eat;
1536                                 skb_frag_size_sub(&skb_shinfo(skb)->frags[k], eat);
1537                                 eat = 0;
1538                         }
1539                         k++;
1540                 }
1541         }
1542         skb_shinfo(skb)->nr_frags = k;
1543
1544         skb->tail     += delta;
1545         skb->data_len -= delta;
1546
1547         return skb_tail_pointer(skb);
1548 }
1549 EXPORT_SYMBOL(__pskb_pull_tail);
1550
1551 /**
1552  *      skb_copy_bits - copy bits from skb to kernel buffer
1553  *      @skb: source skb
1554  *      @offset: offset in source
1555  *      @to: destination buffer
1556  *      @len: number of bytes to copy
1557  *
1558  *      Copy the specified number of bytes from the source skb to the
1559  *      destination buffer.
1560  *
1561  *      CAUTION ! :
1562  *              If its prototype is ever changed,
1563  *              check arch/{*}/net/{*}.S files,
1564  *              since it is called from BPF assembly code.
1565  */
1566 int skb_copy_bits(const struct sk_buff *skb, int offset, void *to, int len)
1567 {
1568         int start = skb_headlen(skb);
1569         struct sk_buff *frag_iter;
1570         int i, copy;
1571
1572         if (offset > (int)skb->len - len)
1573                 goto fault;
1574
1575         /* Copy header. */
1576         if ((copy = start - offset) > 0) {
1577                 if (copy > len)
1578                         copy = len;
1579                 skb_copy_from_linear_data_offset(skb, offset, to, copy);
1580                 if ((len -= copy) == 0)
1581                         return 0;
1582                 offset += copy;
1583                 to     += copy;
1584         }
1585
1586         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
1587                 int end;
1588                 skb_frag_t *f = &skb_shinfo(skb)->frags[i];
1589
1590                 WARN_ON(start > offset + len);
1591
1592                 end = start + skb_frag_size(f);
1593                 if ((copy = end - offset) > 0) {
1594                         u8 *vaddr;
1595
1596                         if (copy > len)
1597                                 copy = len;
1598
1599                         vaddr = kmap_atomic(skb_frag_page(f));
1600                         memcpy(to,
1601                                vaddr + f->page_offset + offset - start,
1602                                copy);
1603                         kunmap_atomic(vaddr);
1604
1605                         if ((len -= copy) == 0)
1606                                 return 0;
1607                         offset += copy;
1608                         to     += copy;
1609                 }
1610                 start = end;
1611         }
1612
1613         skb_walk_frags(skb, frag_iter) {
1614                 int end;
1615
1616                 WARN_ON(start > offset + len);
1617
1618                 end = start + frag_iter->len;
1619                 if ((copy = end - offset) > 0) {
1620                         if (copy > len)
1621                                 copy = len;
1622                         if (skb_copy_bits(frag_iter, offset - start, to, copy))
1623                                 goto fault;
1624                         if ((len -= copy) == 0)
1625                                 return 0;
1626                         offset += copy;
1627                         to     += copy;
1628                 }
1629                 start = end;
1630         }
1631
1632         if (!len)
1633                 return 0;
1634
1635 fault:
1636         return -EFAULT;
1637 }
1638 EXPORT_SYMBOL(skb_copy_bits);
1639
1640 /*
1641  * Callback from splice_to_pipe(), if we need to release some pages
1642  * at the end of the spd in case we error'ed out in filling the pipe.
1643  */
1644 static void sock_spd_release(struct splice_pipe_desc *spd, unsigned int i)
1645 {
1646         put_page(spd->pages[i]);
1647 }
1648
1649 static struct page *linear_to_page(struct page *page, unsigned int *len,
1650                                    unsigned int *offset,
1651                                    struct sock *sk)
1652 {
1653         struct page_frag *pfrag = sk_page_frag(sk);
1654
1655         if (!sk_page_frag_refill(sk, pfrag))
1656                 return NULL;
1657
1658         *len = min_t(unsigned int, *len, pfrag->size - pfrag->offset);
1659
1660         memcpy(page_address(pfrag->page) + pfrag->offset,
1661                page_address(page) + *offset, *len);
1662         *offset = pfrag->offset;
1663         pfrag->offset += *len;
1664
1665         return pfrag->page;
1666 }
1667
1668 static bool spd_can_coalesce(const struct splice_pipe_desc *spd,
1669                              struct page *page,
1670                              unsigned int offset)
1671 {
1672         return  spd->nr_pages &&
1673                 spd->pages[spd->nr_pages - 1] == page &&
1674                 (spd->partial[spd->nr_pages - 1].offset +
1675                  spd->partial[spd->nr_pages - 1].len == offset);
1676 }
1677
1678 /*
1679  * Fill page/offset/length into spd, if it can hold more pages.
1680  */
1681 static bool spd_fill_page(struct splice_pipe_desc *spd,
1682                           struct pipe_inode_info *pipe, struct page *page,
1683                           unsigned int *len, unsigned int offset,
1684                           bool linear,
1685                           struct sock *sk)
1686 {
1687         if (unlikely(spd->nr_pages == MAX_SKB_FRAGS))
1688                 return true;
1689
1690         if (linear) {
1691                 page = linear_to_page(page, len, &offset, sk);
1692                 if (!page)
1693                         return true;
1694         }
1695         if (spd_can_coalesce(spd, page, offset)) {
1696                 spd->partial[spd->nr_pages - 1].len += *len;
1697                 return false;
1698         }
1699         get_page(page);
1700         spd->pages[spd->nr_pages] = page;
1701         spd->partial[spd->nr_pages].len = *len;
1702         spd->partial[spd->nr_pages].offset = offset;
1703         spd->nr_pages++;
1704
1705         return false;
1706 }
1707
1708 static bool __splice_segment(struct page *page, unsigned int poff,
1709                              unsigned int plen, unsigned int *off,
1710                              unsigned int *len,
1711                              struct splice_pipe_desc *spd, bool linear,
1712                              struct sock *sk,
1713                              struct pipe_inode_info *pipe)
1714 {
1715         if (!*len)
1716                 return true;
1717
1718         /* skip this segment if already processed */
1719         if (*off >= plen) {
1720                 *off -= plen;
1721                 return false;
1722         }
1723
1724         /* ignore any bits we already processed */
1725         poff += *off;
1726         plen -= *off;
1727         *off = 0;
1728
1729         do {
1730                 unsigned int flen = min(*len, plen);
1731
1732                 if (spd_fill_page(spd, pipe, page, &flen, poff,
1733                                   linear, sk))
1734                         return true;
1735                 poff += flen;
1736                 plen -= flen;
1737                 *len -= flen;
1738         } while (*len && plen);
1739
1740         return false;
1741 }
1742
1743 /*
1744  * Map linear and fragment data from the skb to spd. It reports true if the
1745  * pipe is full or if we already spliced the requested length.
1746  */
1747 static bool __skb_splice_bits(struct sk_buff *skb, struct pipe_inode_info *pipe,
1748                               unsigned int *offset, unsigned int *len,
1749                               struct splice_pipe_desc *spd, struct sock *sk)
1750 {
1751         int seg;
1752
1753         /* map the linear part :
1754          * If skb->head_frag is set, this 'linear' part is backed by a
1755          * fragment, and if the head is not shared with any clones then
1756          * we can avoid a copy since we own the head portion of this page.
1757          */
1758         if (__splice_segment(virt_to_page(skb->data),
1759                              (unsigned long) skb->data & (PAGE_SIZE - 1),
1760                              skb_headlen(skb),
1761                              offset, len, spd,
1762                              skb_head_is_locked(skb),
1763                              sk, pipe))
1764                 return true;
1765
1766         /*
1767          * then map the fragments
1768          */
1769         for (seg = 0; seg < skb_shinfo(skb)->nr_frags; seg++) {
1770                 const skb_frag_t *f = &skb_shinfo(skb)->frags[seg];
1771
1772                 if (__splice_segment(skb_frag_page(f),
1773                                      f->page_offset, skb_frag_size(f),
1774                                      offset, len, spd, false, sk, pipe))
1775                         return true;
1776         }
1777
1778         return false;
1779 }
1780
1781 /*
1782  * Map data from the skb to a pipe. Should handle both the linear part,
1783  * the fragments, and the frag list. It does NOT handle frag lists within
1784  * the frag list, if such a thing exists. We'd probably need to recurse to
1785  * handle that cleanly.
1786  */
1787 int skb_splice_bits(struct sk_buff *skb, unsigned int offset,
1788                     struct pipe_inode_info *pipe, unsigned int tlen,
1789                     unsigned int flags)
1790 {
1791         struct partial_page partial[MAX_SKB_FRAGS];
1792         struct page *pages[MAX_SKB_FRAGS];
1793         struct splice_pipe_desc spd = {
1794                 .pages = pages,
1795                 .partial = partial,
1796                 .nr_pages_max = MAX_SKB_FRAGS,
1797                 .flags = flags,
1798                 .ops = &sock_pipe_buf_ops,
1799                 .spd_release = sock_spd_release,
1800         };
1801         struct sk_buff *frag_iter;
1802         struct sock *sk = skb->sk;
1803         int ret = 0;
1804
1805         /*
1806          * __skb_splice_bits() only fails if the output has no room left,
1807          * so no point in going over the frag_list for the error case.
1808          */
1809         if (__skb_splice_bits(skb, pipe, &offset, &tlen, &spd, sk))
1810                 goto done;
1811         else if (!tlen)
1812                 goto done;
1813
1814         /*
1815          * now see if we have a frag_list to map
1816          */
1817         skb_walk_frags(skb, frag_iter) {
1818                 if (!tlen)
1819                         break;
1820                 if (__skb_splice_bits(frag_iter, pipe, &offset, &tlen, &spd, sk))
1821                         break;
1822         }
1823
1824 done:
1825         if (spd.nr_pages) {
1826                 /*
1827                  * Drop the socket lock, otherwise we have reverse
1828                  * locking dependencies between sk_lock and i_mutex
1829                  * here as compared to sendfile(). We enter here
1830                  * with the socket lock held, and splice_to_pipe() will
1831                  * grab the pipe inode lock. For sendfile() emulation,
1832                  * we call into ->sendpage() with the i_mutex lock held
1833                  * and networking will grab the socket lock.
1834                  */
1835                 release_sock(sk);
1836                 ret = splice_to_pipe(pipe, &spd);
1837                 lock_sock(sk);
1838         }
1839
1840         return ret;
1841 }
1842
1843 /**
1844  *      skb_store_bits - store bits from kernel buffer to skb
1845  *      @skb: destination buffer
1846  *      @offset: offset in destination
1847  *      @from: source buffer
1848  *      @len: number of bytes to copy
1849  *
1850  *      Copy the specified number of bytes from the source buffer to the
1851  *      destination skb.  This function handles all the messy bits of
1852  *      traversing fragment lists and such.
1853  */
1854
1855 int skb_store_bits(struct sk_buff *skb, int offset, const void *from, int len)
1856 {
1857         int start = skb_headlen(skb);
1858         struct sk_buff *frag_iter;
1859         int i, copy;
1860
1861         if (offset > (int)skb->len - len)
1862                 goto fault;
1863
1864         if ((copy = start - offset) > 0) {
1865                 if (copy > len)
1866                         copy = len;
1867                 skb_copy_to_linear_data_offset(skb, offset, from, copy);
1868                 if ((len -= copy) == 0)
1869                         return 0;
1870                 offset += copy;
1871                 from += copy;
1872         }
1873
1874         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
1875                 skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
1876                 int end;
1877
1878                 WARN_ON(start > offset + len);
1879
1880                 end = start + skb_frag_size(frag);
1881                 if ((copy = end - offset) > 0) {
1882                         u8 *vaddr;
1883
1884                         if (copy > len)
1885                                 copy = len;
1886
1887                         vaddr = kmap_atomic(skb_frag_page(frag));
1888                         memcpy(vaddr + frag->page_offset + offset - start,
1889                                from, copy);
1890                         kunmap_atomic(vaddr);
1891
1892                         if ((len -= copy) == 0)
1893                                 return 0;
1894                         offset += copy;
1895                         from += copy;
1896                 }
1897                 start = end;
1898         }
1899
1900         skb_walk_frags(skb, frag_iter) {
1901                 int end;
1902
1903                 WARN_ON(start > offset + len);
1904
1905                 end = start + frag_iter->len;
1906                 if ((copy = end - offset) > 0) {
1907                         if (copy > len)
1908                                 copy = len;
1909                         if (skb_store_bits(frag_iter, offset - start,
1910                                            from, copy))
1911                                 goto fault;
1912                         if ((len -= copy) == 0)
1913                                 return 0;
1914                         offset += copy;
1915                         from += copy;
1916                 }
1917                 start = end;
1918         }
1919         if (!len)
1920                 return 0;
1921
1922 fault:
1923         return -EFAULT;
1924 }
1925 EXPORT_SYMBOL(skb_store_bits);
1926
1927 /* Checksum skb data. */
1928
1929 __wsum skb_checksum(const struct sk_buff *skb, int offset,
1930                           int len, __wsum csum)
1931 {
1932         int start = skb_headlen(skb);
1933         int i, copy = start - offset;
1934         struct sk_buff *frag_iter;
1935         int pos = 0;
1936
1937         /* Checksum header. */
1938         if (copy > 0) {
1939                 if (copy > len)
1940                         copy = len;
1941                 csum = csum_partial(skb->data + offset, copy, csum);
1942                 if ((len -= copy) == 0)
1943                         return csum;
1944                 offset += copy;
1945                 pos     = copy;
1946         }
1947
1948         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
1949                 int end;
1950                 skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
1951
1952                 WARN_ON(start > offset + len);
1953
1954                 end = start + skb_frag_size(frag);
1955                 if ((copy = end - offset) > 0) {
1956                         __wsum csum2;
1957                         u8 *vaddr;
1958
1959                         if (copy > len)
1960                                 copy = len;
1961                         vaddr = kmap_atomic(skb_frag_page(frag));
1962                         csum2 = csum_partial(vaddr + frag->page_offset +
1963                                              offset - start, copy, 0);
1964                         kunmap_atomic(vaddr);
1965                         csum = csum_block_add(csum, csum2, pos);
1966                         if (!(len -= copy))
1967                                 return csum;
1968                         offset += copy;
1969                         pos    += copy;
1970                 }
1971                 start = end;
1972         }
1973
1974         skb_walk_frags(skb, frag_iter) {
1975                 int end;
1976
1977                 WARN_ON(start > offset + len);
1978
1979                 end = start + frag_iter->len;
1980                 if ((copy = end - offset) > 0) {
1981                         __wsum csum2;
1982                         if (copy > len)
1983                                 copy = len;
1984                         csum2 = skb_checksum(frag_iter, offset - start,
1985                                              copy, 0);
1986                         csum = csum_block_add(csum, csum2, pos);
1987                         if ((len -= copy) == 0)
1988                                 return csum;
1989                         offset += copy;
1990                         pos    += copy;
1991                 }
1992                 start = end;
1993         }
1994         BUG_ON(len);
1995
1996         return csum;
1997 }
1998 EXPORT_SYMBOL(skb_checksum);
1999
2000 /* Both of above in one bottle. */
2001
2002 __wsum skb_copy_and_csum_bits(const struct sk_buff *skb, int offset,
2003                                     u8 *to, int len, __wsum csum)
2004 {
2005         int start = skb_headlen(skb);
2006         int i, copy = start - offset;
2007         struct sk_buff *frag_iter;
2008         int pos = 0;
2009
2010         /* Copy header. */
2011         if (copy > 0) {
2012                 if (copy > len)
2013                         copy = len;
2014                 csum = csum_partial_copy_nocheck(skb->data + offset, to,
2015                                                  copy, csum);
2016                 if ((len -= copy) == 0)
2017                         return csum;
2018                 offset += copy;
2019                 to     += copy;
2020                 pos     = copy;
2021         }
2022
2023         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
2024                 int end;
2025
2026                 WARN_ON(start > offset + len);
2027
2028                 end = start + skb_frag_size(&skb_shinfo(skb)->frags[i]);
2029                 if ((copy = end - offset) > 0) {
2030                         __wsum csum2;
2031                         u8 *vaddr;
2032                         skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
2033
2034                         if (copy > len)
2035                                 copy = len;
2036                         vaddr = kmap_atomic(skb_frag_page(frag));
2037                         csum2 = csum_partial_copy_nocheck(vaddr +
2038                                                           frag->page_offset +
2039                                                           offset - start, to,
2040                                                           copy, 0);
2041                         kunmap_atomic(vaddr);
2042                         csum = csum_block_add(csum, csum2, pos);
2043                         if (!(len -= copy))
2044                                 return csum;
2045                         offset += copy;
2046                         to     += copy;
2047                         pos    += copy;
2048                 }
2049                 start = end;
2050         }
2051
2052         skb_walk_frags(skb, frag_iter) {
2053                 __wsum csum2;
2054                 int end;
2055
2056                 WARN_ON(start > offset + len);
2057
2058                 end = start + frag_iter->len;
2059                 if ((copy = end - offset) > 0) {
2060                         if (copy > len)
2061                                 copy = len;
2062                         csum2 = skb_copy_and_csum_bits(frag_iter,
2063                                                        offset - start,
2064                                                        to, copy, 0);
2065                         csum = csum_block_add(csum, csum2, pos);
2066                         if ((len -= copy) == 0)
2067                                 return csum;
2068                         offset += copy;
2069                         to     += copy;
2070                         pos    += copy;
2071                 }
2072                 start = end;
2073         }
2074         BUG_ON(len);
2075         return csum;
2076 }
2077 EXPORT_SYMBOL(skb_copy_and_csum_bits);
2078
2079 void skb_copy_and_csum_dev(const struct sk_buff *skb, u8 *to)
2080 {
2081         __wsum csum;
2082         long csstart;
2083
2084         if (skb->ip_summed == CHECKSUM_PARTIAL)
2085                 csstart = skb_checksum_start_offset(skb);
2086         else
2087                 csstart = skb_headlen(skb);
2088
2089         BUG_ON(csstart > skb_headlen(skb));
2090
2091         skb_copy_from_linear_data(skb, to, csstart);
2092
2093         csum = 0;
2094         if (csstart != skb->len)
2095                 csum = skb_copy_and_csum_bits(skb, csstart, to + csstart,
2096                                               skb->len - csstart, 0);
2097
2098         if (skb->ip_summed == CHECKSUM_PARTIAL) {
2099                 long csstuff = csstart + skb->csum_offset;
2100
2101                 *((__sum16 *)(to + csstuff)) = csum_fold(csum);
2102         }
2103 }
2104 EXPORT_SYMBOL(skb_copy_and_csum_dev);
2105
2106 /**
2107  *      skb_dequeue - remove from the head of the queue
2108  *      @list: list to dequeue from
2109  *
2110  *      Remove the head of the list. The list lock is taken so the function
2111  *      may be used safely with other locking list functions. The head item is
2112  *      returned or %NULL if the list is empty.
2113  */
2114
2115 struct sk_buff *skb_dequeue(struct sk_buff_head *list)
2116 {
2117         unsigned long flags;
2118         struct sk_buff *result;
2119
2120         spin_lock_irqsave(&list->lock, flags);
2121         result = __skb_dequeue(list);
2122         spin_unlock_irqrestore(&list->lock, flags);
2123         return result;
2124 }
2125 EXPORT_SYMBOL(skb_dequeue);
2126
2127 /**
2128  *      skb_dequeue_tail - remove from the tail of the queue
2129  *      @list: list to dequeue from
2130  *
2131  *      Remove the tail of the list. The list lock is taken so the function
2132  *      may be used safely with other locking list functions. The tail item is
2133  *      returned or %NULL if the list is empty.
2134  */
2135 struct sk_buff *skb_dequeue_tail(struct sk_buff_head *list)
2136 {
2137         unsigned long flags;
2138         struct sk_buff *result;
2139
2140         spin_lock_irqsave(&list->lock, flags);
2141         result = __skb_dequeue_tail(list);
2142         spin_unlock_irqrestore(&list->lock, flags);
2143         return result;
2144 }
2145 EXPORT_SYMBOL(skb_dequeue_tail);
2146
2147 /**
2148  *      skb_queue_purge - empty a list
2149  *      @list: list to empty
2150  *
2151  *      Delete all buffers on an &sk_buff list. Each buffer is removed from
2152  *      the list and one reference dropped. This function takes the list
2153  *      lock and is atomic with respect to other list locking functions.
2154  */
2155 void skb_queue_purge(struct sk_buff_head *list)
2156 {
2157         struct sk_buff *skb;
2158         while ((skb = skb_dequeue(list)) != NULL)
2159                 kfree_skb(skb);
2160 }
2161 EXPORT_SYMBOL(skb_queue_purge);
2162
2163 /**
2164  *      skb_queue_head - queue a buffer at the list head
2165  *      @list: list to use
2166  *      @newsk: buffer to queue
2167  *
2168  *      Queue a buffer at the start of the list. This function takes the
2169  *      list lock and can be used safely with other locking &sk_buff functions
2170  *      safely.
2171  *
2172  *      A buffer cannot be placed on two lists at the same time.
2173  */
2174 void skb_queue_head(struct sk_buff_head *list, struct sk_buff *newsk)
2175 {
2176         unsigned long flags;
2177
2178         spin_lock_irqsave(&list->lock, flags);
2179         __skb_queue_head(list, newsk);
2180         spin_unlock_irqrestore(&list->lock, flags);
2181 }
2182 EXPORT_SYMBOL(skb_queue_head);
2183
2184 /**
2185  *      skb_queue_tail - queue a buffer at the list tail
2186  *      @list: list to use
2187  *      @newsk: buffer to queue
2188  *
2189  *      Queue a buffer at the tail of the list. This function takes the
2190  *      list lock and can be used safely with other locking &sk_buff functions
2191  *      safely.
2192  *
2193  *      A buffer cannot be placed on two lists at the same time.
2194  */
2195 void skb_queue_tail(struct sk_buff_head *list, struct sk_buff *newsk)
2196 {
2197         unsigned long flags;
2198
2199         spin_lock_irqsave(&list->lock, flags);
2200         __skb_queue_tail(list, newsk);
2201         spin_unlock_irqrestore(&list->lock, flags);
2202 }
2203 EXPORT_SYMBOL(skb_queue_tail);
2204
2205 /**
2206  *      skb_unlink      -       remove a buffer from a list
2207  *      @skb: buffer to remove
2208  *      @list: list to use
2209  *
2210  *      Remove a packet from a list. The list locks are taken and this
2211  *      function is atomic with respect to other list locked calls
2212  *
2213  *      You must know what list the SKB is on.
2214  */
2215 void skb_unlink(struct sk_buff *skb, struct sk_buff_head *list)
2216 {
2217         unsigned long flags;
2218
2219         spin_lock_irqsave(&list->lock, flags);
2220         __skb_unlink(skb, list);
2221         spin_unlock_irqrestore(&list->lock, flags);
2222 }
2223 EXPORT_SYMBOL(skb_unlink);
2224
2225 /**
2226  *      skb_append      -       append a buffer
2227  *      @old: buffer to insert after
2228  *      @newsk: buffer to insert
2229  *      @list: list to use
2230  *
2231  *      Place a packet after a given packet in a list. The list locks are taken
2232  *      and this function is atomic with respect to other list locked calls.
2233  *      A buffer cannot be placed on two lists at the same time.
2234  */
2235 void skb_append(struct sk_buff *old, struct sk_buff *newsk, struct sk_buff_head *list)
2236 {
2237         unsigned long flags;
2238
2239         spin_lock_irqsave(&list->lock, flags);
2240         __skb_queue_after(list, old, newsk);
2241         spin_unlock_irqrestore(&list->lock, flags);
2242 }
2243 EXPORT_SYMBOL(skb_append);
2244
2245 /**
2246  *      skb_insert      -       insert a buffer
2247  *      @old: buffer to insert before
2248  *      @newsk: buffer to insert
2249  *      @list: list to use
2250  *
2251  *      Place a packet before a given packet in a list. The list locks are
2252  *      taken and this function is atomic with respect to other list locked
2253  *      calls.
2254  *
2255  *      A buffer cannot be placed on two lists at the same time.
2256  */
2257 void skb_insert(struct sk_buff *old, struct sk_buff *newsk, struct sk_buff_head *list)
2258 {
2259         unsigned long flags;
2260
2261         spin_lock_irqsave(&list->lock, flags);
2262         __skb_insert(newsk, old->prev, old, list);
2263         spin_unlock_irqrestore(&list->lock, flags);
2264 }
2265 EXPORT_SYMBOL(skb_insert);
2266
2267 static inline void skb_split_inside_header(struct sk_buff *skb,
2268                                            struct sk_buff* skb1,
2269                                            const u32 len, const int pos)
2270 {
2271         int i;
2272
2273         skb_copy_from_linear_data_offset(skb, len, skb_put(skb1, pos - len),
2274                                          pos - len);
2275         /* And move data appendix as is. */
2276         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++)
2277                 skb_shinfo(skb1)->frags[i] = skb_shinfo(skb)->frags[i];
2278
2279         skb_shinfo(skb1)->nr_frags = skb_shinfo(skb)->nr_frags;
2280         skb_shinfo(skb)->nr_frags  = 0;
2281         skb1->data_len             = skb->data_len;
2282         skb1->len                  += skb1->data_len;
2283         skb->data_len              = 0;
2284         skb->len                   = len;
2285         skb_set_tail_pointer(skb, len);
2286 }
2287
2288 static inline void skb_split_no_header(struct sk_buff *skb,
2289                                        struct sk_buff* skb1,
2290                                        const u32 len, int pos)
2291 {
2292         int i, k = 0;
2293         const int nfrags = skb_shinfo(skb)->nr_frags;
2294
2295         skb_shinfo(skb)->nr_frags = 0;
2296         skb1->len                 = skb1->data_len = skb->len - len;
2297         skb->len                  = len;
2298         skb->data_len             = len - pos;
2299
2300         for (i = 0; i < nfrags; i++) {
2301                 int size = skb_frag_size(&skb_shinfo(skb)->frags[i]);
2302
2303                 if (pos + size > len) {
2304                         skb_shinfo(skb1)->frags[k] = skb_shinfo(skb)->frags[i];
2305
2306                         if (pos < len) {
2307                                 /* Split frag.
2308                                  * We have two variants in this case:
2309                                  * 1. Move all the frag to the second
2310                                  *    part, if it is possible. F.e.
2311                                  *    this approach is mandatory for TUX,
2312                                  *    where splitting is expensive.
2313                                  * 2. Split is accurately. We make this.
2314                                  */
2315                                 skb_frag_ref(skb, i);
2316                                 skb_shinfo(skb1)->frags[0].page_offset += len - pos;
2317                                 skb_frag_size_sub(&skb_shinfo(skb1)->frags[0], len - pos);
2318                                 skb_frag_size_set(&skb_shinfo(skb)->frags[i], len - pos);
2319                                 skb_shinfo(skb)->nr_frags++;
2320                         }
2321                         k++;
2322                 } else
2323                         skb_shinfo(skb)->nr_frags++;
2324                 pos += size;
2325         }
2326         skb_shinfo(skb1)->nr_frags = k;
2327 }
2328
2329 /**
2330  * skb_split - Split fragmented skb to two parts at length len.
2331  * @skb: the buffer to split
2332  * @skb1: the buffer to receive the second part
2333  * @len: new length for skb
2334  */
2335 void skb_split(struct sk_buff *skb, struct sk_buff *skb1, const u32 len)
2336 {
2337         int pos = skb_headlen(skb);
2338
2339         skb_shinfo(skb1)->gso_type = skb_shinfo(skb)->gso_type;
2340
2341         if (len < pos)  /* Split line is inside header. */
2342                 skb_split_inside_header(skb, skb1, len, pos);
2343         else            /* Second chunk has no header, nothing to copy. */
2344                 skb_split_no_header(skb, skb1, len, pos);
2345 }
2346 EXPORT_SYMBOL(skb_split);
2347
2348 /* Shifting from/to a cloned skb is a no-go.
2349  *
2350  * Caller cannot keep skb_shinfo related pointers past calling here!
2351  */
2352 static int skb_prepare_for_shift(struct sk_buff *skb)
2353 {
2354         return skb_cloned(skb) && pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
2355 }
2356
2357 /**
2358  * skb_shift - Shifts paged data partially from skb to another
2359  * @tgt: buffer into which tail data gets added
2360  * @skb: buffer from which the paged data comes from
2361  * @shiftlen: shift up to this many bytes
2362  *
2363  * Attempts to shift up to shiftlen worth of bytes, which may be less than
2364  * the length of the skb, from skb to tgt. Returns number bytes shifted.
2365  * It's up to caller to free skb if everything was shifted.
2366  *
2367  * If @tgt runs out of frags, the whole operation is aborted.
2368  *
2369  * Skb cannot include anything else but paged data while tgt is allowed
2370  * to have non-paged data as well.
2371  *
2372  * TODO: full sized shift could be optimized but that would need
2373  * specialized skb free'er to handle frags without up-to-date nr_frags.
2374  */
2375 int skb_shift(struct sk_buff *tgt, struct sk_buff *skb, int shiftlen)
2376 {
2377         int from, to, merge, todo;
2378         struct skb_frag_struct *fragfrom, *fragto;
2379
2380         BUG_ON(shiftlen > skb->len);
2381         BUG_ON(skb_headlen(skb));       /* Would corrupt stream */
2382
2383         todo = shiftlen;
2384         from = 0;
2385         to = skb_shinfo(tgt)->nr_frags;
2386         fragfrom = &skb_shinfo(skb)->frags[from];
2387
2388         /* Actual merge is delayed until the point when we know we can
2389          * commit all, so that we don't have to undo partial changes
2390          */
2391         if (!to ||
2392             !skb_can_coalesce(tgt, to, skb_frag_page(fragfrom),
2393                               fragfrom->page_offset)) {
2394                 merge = -1;
2395         } else {
2396                 merge = to - 1;
2397
2398                 todo -= skb_frag_size(fragfrom);
2399                 if (todo < 0) {
2400                         if (skb_prepare_for_shift(skb) ||
2401                             skb_prepare_for_shift(tgt))
2402                                 return 0;
2403
2404                         /* All previous frag pointers might be stale! */
2405                         fragfrom = &skb_shinfo(skb)->frags[from];
2406                         fragto = &skb_shinfo(tgt)->frags[merge];
2407
2408                         skb_frag_size_add(fragto, shiftlen);
2409                         skb_frag_size_sub(fragfrom, shiftlen);
2410                         fragfrom->page_offset += shiftlen;
2411
2412                         goto onlymerged;
2413                 }
2414
2415                 from++;
2416         }
2417
2418         /* Skip full, not-fitting skb to avoid expensive operations */
2419         if ((shiftlen == skb->len) &&
2420             (skb_shinfo(skb)->nr_frags - from) > (MAX_SKB_FRAGS - to))
2421                 return 0;
2422
2423         if (skb_prepare_for_shift(skb) || skb_prepare_for_shift(tgt))
2424                 return 0;
2425
2426         while ((todo > 0) && (from < skb_shinfo(skb)->nr_frags)) {
2427                 if (to == MAX_SKB_FRAGS)
2428                         return 0;
2429
2430                 fragfrom = &skb_shinfo(skb)->frags[from];
2431                 fragto = &skb_shinfo(tgt)->frags[to];
2432
2433                 if (todo >= skb_frag_size(fragfrom)) {
2434                         *fragto = *fragfrom;
2435                         todo -= skb_frag_size(fragfrom);
2436                         from++;
2437                         to++;
2438
2439                 } else {
2440                         __skb_frag_ref(fragfrom);
2441                         fragto->page = fragfrom->page;
2442                         fragto->page_offset = fragfrom->page_offset;
2443                         skb_frag_size_set(fragto, todo);
2444
2445                         fragfrom->page_offset += todo;
2446                         skb_frag_size_sub(fragfrom, todo);
2447                         todo = 0;
2448
2449                         to++;
2450                         break;
2451                 }
2452         }
2453
2454         /* Ready to "commit" this state change to tgt */
2455         skb_shinfo(tgt)->nr_frags = to;
2456
2457         if (merge >= 0) {
2458                 fragfrom = &skb_shinfo(skb)->frags[0];
2459                 fragto = &skb_shinfo(tgt)->frags[merge];
2460
2461                 skb_frag_size_add(fragto, skb_frag_size(fragfrom));
2462                 __skb_frag_unref(fragfrom);
2463         }
2464
2465         /* Reposition in the original skb */
2466         to = 0;
2467         while (from < skb_shinfo(skb)->nr_frags)
2468                 skb_shinfo(skb)->frags[to++] = skb_shinfo(skb)->frags[from++];
2469         skb_shinfo(skb)->nr_frags = to;
2470
2471         BUG_ON(todo > 0 && !skb_shinfo(skb)->nr_frags);
2472
2473 onlymerged:
2474         /* Most likely the tgt won't ever need its checksum anymore, skb on
2475          * the other hand might need it if it needs to be resent
2476          */
2477         tgt->ip_summed = CHECKSUM_PARTIAL;
2478         skb->ip_summed = CHECKSUM_PARTIAL;
2479
2480         /* Yak, is it really working this way? Some helper please? */
2481         skb->len -= shiftlen;
2482         skb->data_len -= shiftlen;
2483         skb->truesize -= shiftlen;
2484         tgt->len += shiftlen;
2485         tgt->data_len += shiftlen;
2486         tgt->truesize += shiftlen;
2487
2488         return shiftlen;
2489 }
2490
2491 /**
2492  * skb_prepare_seq_read - Prepare a sequential read of skb data
2493  * @skb: the buffer to read
2494  * @from: lower offset of data to be read
2495  * @to: upper offset of data to be read
2496  * @st: state variable
2497  *
2498  * Initializes the specified state variable. Must be called before
2499  * invoking skb_seq_read() for the first time.
2500  */
2501 void skb_prepare_seq_read(struct sk_buff *skb, unsigned int from,
2502                           unsigned int to, struct skb_seq_state *st)
2503 {
2504         st->lower_offset = from;
2505         st->upper_offset = to;
2506         st->root_skb = st->cur_skb = skb;
2507         st->frag_idx = st->stepped_offset = 0;
2508         st->frag_data = NULL;
2509 }
2510 EXPORT_SYMBOL(skb_prepare_seq_read);
2511
2512 /**
2513  * skb_seq_read - Sequentially read skb data
2514  * @consumed: number of bytes consumed by the caller so far
2515  * @data: destination pointer for data to be returned
2516  * @st: state variable
2517  *
2518  * Reads a block of skb data at &consumed relative to the
2519  * lower offset specified to skb_prepare_seq_read(). Assigns
2520  * the head of the data block to &data and returns the length
2521  * of the block or 0 if the end of the skb data or the upper
2522  * offset has been reached.
2523  *
2524  * The caller is not required to consume all of the data
2525  * returned, i.e. &consumed is typically set to the number
2526  * of bytes already consumed and the next call to
2527  * skb_seq_read() will return the remaining part of the block.
2528  *
2529  * Note 1: The size of each block of data returned can be arbitrary,
2530  *       this limitation is the cost for zerocopy seqeuental
2531  *       reads of potentially non linear data.
2532  *
2533  * Note 2: Fragment lists within fragments are not implemented
2534  *       at the moment, state->root_skb could be replaced with
2535  *       a stack for this purpose.
2536  */
2537 unsigned int skb_seq_read(unsigned int consumed, const u8 **data,
2538                           struct skb_seq_state *st)
2539 {
2540         unsigned int block_limit, abs_offset = consumed + st->lower_offset;
2541         skb_frag_t *frag;
2542
2543         if (unlikely(abs_offset >= st->upper_offset))
2544                 return 0;
2545
2546 next_skb:
2547         block_limit = skb_headlen(st->cur_skb) + st->stepped_offset;
2548
2549         if (abs_offset < block_limit && !st->frag_data) {
2550                 *data = st->cur_skb->data + (abs_offset - st->stepped_offset);
2551                 return block_limit - abs_offset;
2552         }
2553
2554         if (st->frag_idx == 0 && !st->frag_data)
2555                 st->stepped_offset += skb_headlen(st->cur_skb);
2556
2557         while (st->frag_idx < skb_shinfo(st->cur_skb)->nr_frags) {
2558                 frag = &skb_shinfo(st->cur_skb)->frags[st->frag_idx];
2559                 block_limit = skb_frag_size(frag) + st->stepped_offset;
2560
2561                 if (abs_offset < block_limit) {
2562                         if (!st->frag_data)
2563                                 st->frag_data = kmap_atomic(skb_frag_page(frag));
2564
2565                         *data = (u8 *) st->frag_data + frag->page_offset +
2566                                 (abs_offset - st->stepped_offset);
2567
2568                         return block_limit - abs_offset;
2569                 }
2570
2571                 if (st->frag_data) {
2572                         kunmap_atomic(st->frag_data);
2573                         st->frag_data = NULL;
2574                 }
2575
2576                 st->frag_idx++;
2577                 st->stepped_offset += skb_frag_size(frag);
2578         }
2579
2580         if (st->frag_data) {
2581                 kunmap_atomic(st->frag_data);
2582                 st->frag_data = NULL;
2583         }
2584
2585         if (st->root_skb == st->cur_skb && skb_has_frag_list(st->root_skb)) {
2586                 st->cur_skb = skb_shinfo(st->root_skb)->frag_list;
2587                 st->frag_idx = 0;
2588                 goto next_skb;
2589         } else if (st->cur_skb->next) {
2590                 st->cur_skb = st->cur_skb->next;
2591                 st->frag_idx = 0;
2592                 goto next_skb;
2593         }
2594
2595         return 0;
2596 }
2597 EXPORT_SYMBOL(skb_seq_read);
2598
2599 /**
2600  * skb_abort_seq_read - Abort a sequential read of skb data
2601  * @st: state variable
2602  *
2603  * Must be called if skb_seq_read() was not called until it
2604  * returned 0.
2605  */
2606 void skb_abort_seq_read(struct skb_seq_state *st)
2607 {
2608         if (st->frag_data)
2609                 kunmap_atomic(st->frag_data);
2610 }
2611 EXPORT_SYMBOL(skb_abort_seq_read);
2612
2613 #define TS_SKB_CB(state)        ((struct skb_seq_state *) &((state)->cb))
2614
2615 static unsigned int skb_ts_get_next_block(unsigned int offset, const u8 **text,
2616                                           struct ts_config *conf,
2617                                           struct ts_state *state)
2618 {
2619         return skb_seq_read(offset, text, TS_SKB_CB(state));
2620 }
2621
2622 static void skb_ts_finish(struct ts_config *conf, struct ts_state *state)
2623 {
2624         skb_abort_seq_read(TS_SKB_CB(state));
2625 }
2626
2627 /**
2628  * skb_find_text - Find a text pattern in skb data
2629  * @skb: the buffer to look in
2630  * @from: search offset
2631  * @to: search limit
2632  * @config: textsearch configuration
2633  * @state: uninitialized textsearch state variable
2634  *
2635  * Finds a pattern in the skb data according to the specified
2636  * textsearch configuration. Use textsearch_next() to retrieve
2637  * subsequent occurrences of the pattern. Returns the offset
2638  * to the first occurrence or UINT_MAX if no match was found.
2639  */
2640 unsigned int skb_find_text(struct sk_buff *skb, unsigned int from,
2641                            unsigned int to, struct ts_config *config,
2642                            struct ts_state *state)
2643 {
2644         unsigned int ret;
2645
2646         config->get_next_block = skb_ts_get_next_block;
2647         config->finish = skb_ts_finish;
2648
2649         skb_prepare_seq_read(skb, from, to, TS_SKB_CB(state));
2650
2651         ret = textsearch_find(config, state);
2652         return (ret <= to - from ? ret : UINT_MAX);
2653 }
2654 EXPORT_SYMBOL(skb_find_text);
2655
2656 /**
2657  * skb_append_datato_frags - append the user data to a skb
2658  * @sk: sock  structure
2659  * @skb: skb structure to be appened with user data.
2660  * @getfrag: call back function to be used for getting the user data
2661  * @from: pointer to user message iov
2662  * @length: length of the iov message
2663  *
2664  * Description: This procedure append the user data in the fragment part
2665  * of the skb if any page alloc fails user this procedure returns  -ENOMEM
2666  */
2667 int skb_append_datato_frags(struct sock *sk, struct sk_buff *skb,
2668                         int (*getfrag)(void *from, char *to, int offset,
2669                                         int len, int odd, struct sk_buff *skb),
2670                         void *from, int length)
2671 {
2672         int frg_cnt = skb_shinfo(skb)->nr_frags;
2673         int copy;
2674         int offset = 0;
2675         int ret;
2676         struct page_frag *pfrag = &current->task_frag;
2677
2678         do {
2679                 /* Return error if we don't have space for new frag */
2680                 if (frg_cnt >= MAX_SKB_FRAGS)
2681                         return -EMSGSIZE;
2682
2683                 if (!sk_page_frag_refill(sk, pfrag))
2684                         return -ENOMEM;
2685
2686                 /* copy the user data to page */
2687                 copy = min_t(int, length, pfrag->size - pfrag->offset);
2688
2689                 ret = getfrag(from, page_address(pfrag->page) + pfrag->offset,
2690                               offset, copy, 0, skb);
2691                 if (ret < 0)
2692                         return -EFAULT;
2693
2694                 /* copy was successful so update the size parameters */
2695                 skb_fill_page_desc(skb, frg_cnt, pfrag->page, pfrag->offset,
2696                                    copy);
2697                 frg_cnt++;
2698                 pfrag->offset += copy;
2699                 get_page(pfrag->page);
2700
2701                 skb->truesize += copy;
2702                 atomic_add(copy, &sk->sk_wmem_alloc);
2703                 skb->len += copy;
2704                 skb->data_len += copy;
2705                 offset += copy;
2706                 length -= copy;
2707
2708         } while (length > 0);
2709
2710         return 0;
2711 }
2712 EXPORT_SYMBOL(skb_append_datato_frags);
2713
2714 /**
2715  *      skb_pull_rcsum - pull skb and update receive checksum
2716  *      @skb: buffer to update
2717  *      @len: length of data pulled
2718  *
2719  *      This function performs an skb_pull on the packet and updates
2720  *      the CHECKSUM_COMPLETE checksum.  It should be used on
2721  *      receive path processing instead of skb_pull unless you know
2722  *      that the checksum difference is zero (e.g., a valid IP header)
2723  *      or you are setting ip_summed to CHECKSUM_NONE.
2724  */
2725 unsigned char *skb_pull_rcsum(struct sk_buff *skb, unsigned int len)
2726 {
2727         BUG_ON(len > skb->len);
2728         skb->len -= len;
2729         BUG_ON(skb->len < skb->data_len);
2730         skb_postpull_rcsum(skb, skb->data, len);
2731         return skb->data += len;
2732 }
2733 EXPORT_SYMBOL_GPL(skb_pull_rcsum);
2734
2735 /**
2736  *      skb_segment - Perform protocol segmentation on skb.
2737  *      @skb: buffer to segment
2738  *      @features: features for the output path (see dev->features)
2739  *
2740  *      This function performs segmentation on the given skb.  It returns
2741  *      a pointer to the first in a list of new skbs for the segments.
2742  *      In case of error it returns ERR_PTR(err).
2743  */
2744 struct sk_buff *skb_segment(struct sk_buff *skb, netdev_features_t features)
2745 {
2746         struct sk_buff *segs = NULL;
2747         struct sk_buff *tail = NULL;
2748         struct sk_buff *fskb = skb_shinfo(skb)->frag_list;
2749         unsigned int mss = skb_shinfo(skb)->gso_size;
2750         unsigned int doffset = skb->data - skb_mac_header(skb);
2751         unsigned int offset = doffset;
2752         unsigned int headroom;
2753         unsigned int len;
2754         int sg = !!(features & NETIF_F_SG);
2755         int nfrags = skb_shinfo(skb)->nr_frags;
2756         int err = -ENOMEM;
2757         int i = 0;
2758         int pos;
2759
2760         __skb_push(skb, doffset);
2761         headroom = skb_headroom(skb);
2762         pos = skb_headlen(skb);
2763
2764         do {
2765                 struct sk_buff *nskb;
2766                 skb_frag_t *frag;
2767                 int hsize;
2768                 int size;
2769
2770                 len = skb->len - offset;
2771                 if (len > mss)
2772                         len = mss;
2773
2774                 hsize = skb_headlen(skb) - offset;
2775                 if (hsize < 0)
2776                         hsize = 0;
2777                 if (hsize > len || !sg)
2778                         hsize = len;
2779
2780                 if (!hsize && i >= nfrags) {
2781                         BUG_ON(fskb->len != len);
2782
2783                         pos += len;
2784                         nskb = skb_clone(fskb, GFP_ATOMIC);
2785                         fskb = fskb->next;
2786
2787                         if (unlikely(!nskb))
2788                                 goto err;
2789
2790                         hsize = skb_end_offset(nskb);
2791                         if (skb_cow_head(nskb, doffset + headroom)) {
2792                                 kfree_skb(nskb);
2793                                 goto err;
2794                         }
2795
2796                         nskb->truesize += skb_end_offset(nskb) - hsize;
2797                         skb_release_head_state(nskb);
2798                         __skb_push(nskb, doffset);
2799                 } else {
2800                         nskb = __alloc_skb(hsize + doffset + headroom,
2801                                            GFP_ATOMIC, skb_alloc_rx_flag(skb),
2802                                            NUMA_NO_NODE);
2803
2804                         if (unlikely(!nskb))
2805                                 goto err;
2806
2807                         skb_reserve(nskb, headroom);
2808                         __skb_put(nskb, doffset);
2809                 }
2810
2811                 if (segs)
2812                         tail->next = nskb;
2813                 else
2814                         segs = nskb;
2815                 tail = nskb;
2816
2817                 __copy_skb_header(nskb, skb);
2818                 nskb->mac_len = skb->mac_len;
2819
2820                 /* nskb and skb might have different headroom */
2821                 if (nskb->ip_summed == CHECKSUM_PARTIAL)
2822                         nskb->csum_start += skb_headroom(nskb) - headroom;
2823
2824                 skb_reset_mac_header(nskb);
2825                 skb_set_network_header(nskb, skb->mac_len);
2826                 nskb->transport_header = (nskb->network_header +
2827                                           skb_network_header_len(skb));
2828                 skb_copy_from_linear_data(skb, nskb->data, doffset);
2829
2830                 if (fskb != skb_shinfo(skb)->frag_list)
2831                         continue;
2832
2833                 if (!sg) {
2834                         nskb->ip_summed = CHECKSUM_NONE;
2835                         nskb->csum = skb_copy_and_csum_bits(skb, offset,
2836                                                             skb_put(nskb, len),
2837                                                             len, 0);
2838                         continue;
2839                 }
2840
2841                 frag = skb_shinfo(nskb)->frags;
2842
2843                 skb_copy_from_linear_data_offset(skb, offset,
2844                                                  skb_put(nskb, hsize), hsize);
2845
2846                 skb_shinfo(nskb)->gso_type = skb_shinfo(skb)->gso_type;
2847
2848                 while (pos < offset + len && i < nfrags) {
2849                         *frag = skb_shinfo(skb)->frags[i];
2850                         __skb_frag_ref(frag);
2851                         size = skb_frag_size(frag);
2852
2853                         if (pos < offset) {
2854                                 frag->page_offset += offset - pos;
2855                                 skb_frag_size_sub(frag, offset - pos);
2856                         }
2857
2858                         skb_shinfo(nskb)->nr_frags++;
2859
2860                         if (pos + size <= offset + len) {
2861                                 i++;
2862                                 pos += size;
2863                         } else {
2864                                 skb_frag_size_sub(frag, pos + size - (offset + len));
2865                                 goto skip_fraglist;
2866                         }
2867
2868                         frag++;
2869                 }
2870
2871                 if (pos < offset + len) {
2872                         struct sk_buff *fskb2 = fskb;
2873
2874                         BUG_ON(pos + fskb->len != offset + len);
2875
2876                         pos += fskb->len;
2877                         fskb = fskb->next;
2878
2879                         if (fskb2->next) {
2880                                 fskb2 = skb_clone(fskb2, GFP_ATOMIC);
2881                                 if (!fskb2)
2882                                         goto err;
2883                         } else
2884                                 skb_get(fskb2);
2885
2886                         SKB_FRAG_ASSERT(nskb);
2887                         skb_shinfo(nskb)->frag_list = fskb2;
2888                 }
2889
2890 skip_fraglist:
2891                 nskb->data_len = len - hsize;
2892                 nskb->len += nskb->data_len;
2893                 nskb->truesize += nskb->data_len;
2894         } while ((offset += len) < skb->len);
2895
2896         return segs;
2897
2898 err:
2899         while ((skb = segs)) {
2900                 segs = skb->next;
2901                 kfree_skb(skb);
2902         }
2903         return ERR_PTR(err);
2904 }
2905 EXPORT_SYMBOL_GPL(skb_segment);
2906
2907 int skb_gro_receive(struct sk_buff **head, struct sk_buff *skb)
2908 {
2909         struct sk_buff *p = *head;
2910         struct sk_buff *nskb;
2911         struct skb_shared_info *skbinfo = skb_shinfo(skb);
2912         struct skb_shared_info *pinfo = skb_shinfo(p);
2913         unsigned int headroom;
2914         unsigned int len = skb_gro_len(skb);
2915         unsigned int offset = skb_gro_offset(skb);
2916         unsigned int headlen = skb_headlen(skb);
2917         unsigned int delta_truesize;
2918
2919         if (p->len + len >= 65536)
2920                 return -E2BIG;
2921
2922         if (pinfo->frag_list)
2923                 goto merge;
2924         else if (headlen <= offset) {
2925                 skb_frag_t *frag;
2926                 skb_frag_t *frag2;
2927                 int i = skbinfo->nr_frags;
2928                 int nr_frags = pinfo->nr_frags + i;
2929
2930                 offset -= headlen;
2931
2932                 if (nr_frags > MAX_SKB_FRAGS)
2933                         return -E2BIG;
2934
2935                 pinfo->nr_frags = nr_frags;
2936                 skbinfo->nr_frags = 0;
2937
2938                 frag = pinfo->frags + nr_frags;
2939                 frag2 = skbinfo->frags + i;
2940                 do {
2941                         *--frag = *--frag2;
2942                 } while (--i);
2943
2944                 frag->page_offset += offset;
2945                 skb_frag_size_sub(frag, offset);
2946
2947                 /* all fragments truesize : remove (head size + sk_buff) */
2948                 delta_truesize = skb->truesize -
2949                                  SKB_TRUESIZE(skb_end_offset(skb));
2950
2951                 skb->truesize -= skb->data_len;
2952                 skb->len -= skb->data_len;
2953                 skb->data_len = 0;
2954
2955                 NAPI_GRO_CB(skb)->free = NAPI_GRO_FREE;
2956                 goto done;
2957         } else if (skb->head_frag) {
2958                 int nr_frags = pinfo->nr_frags;
2959                 skb_frag_t *frag = pinfo->frags + nr_frags;
2960                 struct page *page = virt_to_head_page(skb->head);
2961                 unsigned int first_size = headlen - offset;
2962                 unsigned int first_offset;
2963
2964                 if (nr_frags + 1 + skbinfo->nr_frags > MAX_SKB_FRAGS)
2965                         return -E2BIG;
2966
2967                 first_offset = skb->data -
2968                                (unsigned char *)page_address(page) +
2969                                offset;
2970
2971                 pinfo->nr_frags = nr_frags + 1 + skbinfo->nr_frags;
2972
2973                 frag->page.p      = page;
2974                 frag->page_offset = first_offset;
2975                 skb_frag_size_set(frag, first_size);
2976
2977                 memcpy(frag + 1, skbinfo->frags, sizeof(*frag) * skbinfo->nr_frags);
2978                 /* We dont need to clear skbinfo->nr_frags here */
2979
2980                 delta_truesize = skb->truesize - SKB_DATA_ALIGN(sizeof(struct sk_buff));
2981                 NAPI_GRO_CB(skb)->free = NAPI_GRO_FREE_STOLEN_HEAD;
2982                 goto done;
2983         } else if (skb_gro_len(p) != pinfo->gso_size)
2984                 return -E2BIG;
2985
2986         headroom = skb_headroom(p);
2987         nskb = alloc_skb(headroom + skb_gro_offset(p), GFP_ATOMIC);
2988         if (unlikely(!nskb))
2989                 return -ENOMEM;
2990
2991         __copy_skb_header(nskb, p);
2992         nskb->mac_len = p->mac_len;
2993
2994         skb_reserve(nskb, headroom);
2995         __skb_put(nskb, skb_gro_offset(p));
2996
2997         skb_set_mac_header(nskb, skb_mac_header(p) - p->data);
2998         skb_set_network_header(nskb, skb_network_offset(p));
2999         skb_set_transport_header(nskb, skb_transport_offset(p));
3000
3001         __skb_pull(p, skb_gro_offset(p));
3002         memcpy(skb_mac_header(nskb), skb_mac_header(p),
3003                p->data - skb_mac_header(p));
3004
3005         skb_shinfo(nskb)->frag_list = p;
3006         skb_shinfo(nskb)->gso_size = pinfo->gso_size;
3007         pinfo->gso_size = 0;
3008         skb_header_release(p);
3009         NAPI_GRO_CB(nskb)->last = p;
3010
3011         nskb->data_len += p->len;
3012         nskb->truesize += p->truesize;
3013         nskb->len += p->len;
3014
3015         *head = nskb;
3016         nskb->next = p->next;
3017         p->next = NULL;
3018
3019         p = nskb;
3020
3021 merge:
3022         delta_truesize = skb->truesize;
3023         if (offset > headlen) {
3024                 unsigned int eat = offset - headlen;
3025
3026                 skbinfo->frags[0].page_offset += eat;
3027                 skb_frag_size_sub(&skbinfo->frags[0], eat);
3028                 skb->data_len -= eat;
3029                 skb->len -= eat;
3030                 offset = headlen;
3031         }
3032
3033         __skb_pull(skb, offset);
3034
3035         NAPI_GRO_CB(p)->last->next = skb;
3036         NAPI_GRO_CB(p)->last = skb;
3037         skb_header_release(skb);
3038
3039 done:
3040         NAPI_GRO_CB(p)->count++;
3041         p->data_len += len;
3042         p->truesize += delta_truesize;
3043         p->len += len;
3044
3045         NAPI_GRO_CB(skb)->same_flow = 1;
3046         return 0;
3047 }
3048 EXPORT_SYMBOL_GPL(skb_gro_receive);
3049
3050 void __init skb_init(void)
3051 {
3052         skbuff_head_cache = kmem_cache_create("skbuff_head_cache",
3053                                               sizeof(struct sk_buff),
3054                                               0,
3055                                               SLAB_HWCACHE_ALIGN|SLAB_PANIC,
3056                                               NULL);
3057         skbuff_fclone_cache = kmem_cache_create("skbuff_fclone_cache",
3058                                                 (2*sizeof(struct sk_buff)) +
3059                                                 sizeof(atomic_t),
3060                                                 0,
3061                                                 SLAB_HWCACHE_ALIGN|SLAB_PANIC,
3062                                                 NULL);
3063 }
3064
3065 /**
3066  *      skb_to_sgvec - Fill a scatter-gather list from a socket buffer
3067  *      @skb: Socket buffer containing the buffers to be mapped
3068  *      @sg: The scatter-gather list to map into
3069  *      @offset: The offset into the buffer's contents to start mapping
3070  *      @len: Length of buffer space to be mapped
3071  *
3072  *      Fill the specified scatter-gather list with mappings/pointers into a
3073  *      region of the buffer space attached to a socket buffer.
3074  */
3075 static int
3076 __skb_to_sgvec(struct sk_buff *skb, struct scatterlist *sg, int offset, int len)
3077 {
3078         int start = skb_headlen(skb);
3079         int i, copy = start - offset;
3080         struct sk_buff *frag_iter;
3081         int elt = 0;
3082
3083         if (copy > 0) {
3084                 if (copy > len)
3085                         copy = len;
3086                 sg_set_buf(sg, skb->data + offset, copy);
3087                 elt++;
3088                 if ((len -= copy) == 0)
3089                         return elt;
3090                 offset += copy;
3091         }
3092
3093         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
3094                 int end;
3095
3096                 WARN_ON(start > offset + len);
3097
3098                 end = start + skb_frag_size(&skb_shinfo(skb)->frags[i]);
3099                 if ((copy = end - offset) > 0) {
3100                         skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
3101
3102                         if (copy > len)
3103                                 copy = len;
3104                         sg_set_page(&sg[elt], skb_frag_page(frag), copy,
3105                                         frag->page_offset+offset-start);
3106                         elt++;
3107                         if (!(len -= copy))
3108                                 return elt;
3109                         offset += copy;
3110                 }
3111                 start = end;
3112         }
3113
3114         skb_walk_frags(skb, frag_iter) {
3115                 int end;
3116
3117                 WARN_ON(start > offset + len);
3118
3119                 end = start + frag_iter->len;
3120                 if ((copy = end - offset) > 0) {
3121                         if (copy > len)
3122                                 copy = len;
3123                         elt += __skb_to_sgvec(frag_iter, sg+elt, offset - start,
3124                                               copy);
3125                         if ((len -= copy) == 0)
3126                                 return elt;
3127                         offset += copy;
3128                 }
3129                 start = end;
3130         }
3131         BUG_ON(len);
3132         return elt;
3133 }
3134
3135 int skb_to_sgvec(struct sk_buff *skb, struct scatterlist *sg, int offset, int len)
3136 {
3137         int nsg = __skb_to_sgvec(skb, sg, offset, len);
3138
3139         sg_mark_end(&sg[nsg - 1]);
3140
3141         return nsg;
3142 }
3143 EXPORT_SYMBOL_GPL(skb_to_sgvec);
3144
3145 /**
3146  *      skb_cow_data - Check that a socket buffer's data buffers are writable
3147  *      @skb: The socket buffer to check.
3148  *      @tailbits: Amount of trailing space to be added
3149  *      @trailer: Returned pointer to the skb where the @tailbits space begins
3150  *
3151  *      Make sure that the data buffers attached to a socket buffer are
3152  *      writable. If they are not, private copies are made of the data buffers
3153  *      and the socket buffer is set to use these instead.
3154  *
3155  *      If @tailbits is given, make sure that there is space to write @tailbits
3156  *      bytes of data beyond current end of socket buffer.  @trailer will be
3157  *      set to point to the skb in which this space begins.
3158  *
3159  *      The number of scatterlist elements required to completely map the
3160  *      COW'd and extended socket buffer will be returned.
3161  */
3162 int skb_cow_data(struct sk_buff *skb, int tailbits, struct sk_buff **trailer)
3163 {
3164         int copyflag;
3165         int elt;
3166         struct sk_buff *skb1, **skb_p;
3167
3168         /* If skb is cloned or its head is paged, reallocate
3169          * head pulling out all the pages (pages are considered not writable
3170          * at the moment even if they are anonymous).
3171          */
3172         if ((skb_cloned(skb) || skb_shinfo(skb)->nr_frags) &&
3173             __pskb_pull_tail(skb, skb_pagelen(skb)-skb_headlen(skb)) == NULL)
3174                 return -ENOMEM;
3175
3176         /* Easy case. Most of packets will go this way. */
3177         if (!skb_has_frag_list(skb)) {
3178                 /* A little of trouble, not enough of space for trailer.
3179                  * This should not happen, when stack is tuned to generate
3180                  * good frames. OK, on miss we reallocate and reserve even more
3181                  * space, 128 bytes is fair. */
3182
3183                 if (skb_tailroom(skb) < tailbits &&
3184                     pskb_expand_head(skb, 0, tailbits-skb_tailroom(skb)+128, GFP_ATOMIC))
3185                         return -ENOMEM;
3186
3187                 /* Voila! */
3188                 *trailer = skb;
3189                 return 1;
3190         }
3191
3192         /* Misery. We are in troubles, going to mincer fragments... */
3193
3194         elt = 1;
3195         skb_p = &skb_shinfo(skb)->frag_list;
3196         copyflag = 0;
3197
3198         while ((skb1 = *skb_p) != NULL) {
3199                 int ntail = 0;
3200
3201                 /* The fragment is partially pulled by someone,
3202                  * this can happen on input. Copy it and everything
3203                  * after it. */
3204
3205                 if (skb_shared(skb1))
3206                         copyflag = 1;
3207
3208                 /* If the skb is the last, worry about trailer. */
3209
3210                 if (skb1->next == NULL && tailbits) {
3211                         if (skb_shinfo(skb1)->nr_frags ||
3212                             skb_has_frag_list(skb1) ||
3213                             skb_tailroom(skb1) < tailbits)
3214                                 ntail = tailbits + 128;
3215                 }
3216
3217                 if (copyflag ||
3218                     skb_cloned(skb1) ||
3219                     ntail ||
3220                     skb_shinfo(skb1)->nr_frags ||
3221                     skb_has_frag_list(skb1)) {
3222                         struct sk_buff *skb2;
3223
3224                         /* Fuck, we are miserable poor guys... */
3225                         if (ntail == 0)
3226                                 skb2 = skb_copy(skb1, GFP_ATOMIC);
3227                         else
3228                                 skb2 = skb_copy_expand(skb1,
3229                                                        skb_headroom(skb1),
3230                                                        ntail,
3231                                                        GFP_ATOMIC);
3232                         if (unlikely(skb2 == NULL))
3233                                 return -ENOMEM;
3234
3235                         if (skb1->sk)
3236                                 skb_set_owner_w(skb2, skb1->sk);
3237
3238                         /* Looking around. Are we still alive?
3239                          * OK, link new skb, drop old one */
3240
3241                         skb2->next = skb1->next;
3242                         *skb_p = skb2;
3243                         kfree_skb(skb1);
3244                         skb1 = skb2;
3245                 }
3246                 elt++;
3247                 *trailer = skb1;
3248                 skb_p = &skb1->next;
3249         }
3250
3251         return elt;
3252 }
3253 EXPORT_SYMBOL_GPL(skb_cow_data);
3254
3255 static void sock_rmem_free(struct sk_buff *skb)
3256 {
3257         struct sock *sk = skb->sk;
3258
3259         atomic_sub(skb->truesize, &sk->sk_rmem_alloc);
3260 }
3261
3262 /*
3263  * Note: We dont mem charge error packets (no sk_forward_alloc changes)
3264  */
3265 int sock_queue_err_skb(struct sock *sk, struct sk_buff *skb)
3266 {
3267         int len = skb->len;
3268
3269         if (atomic_read(&sk->sk_rmem_alloc) + skb->truesize >=
3270             (unsigned int)sk->sk_rcvbuf)
3271                 return -ENOMEM;
3272
3273         skb_orphan(skb);
3274         skb->sk = sk;
3275         skb->destructor = sock_rmem_free;
3276         atomic_add(skb->truesize, &sk->sk_rmem_alloc);
3277
3278         /* before exiting rcu section, make sure dst is refcounted */
3279         skb_dst_force(skb);
3280
3281         skb_queue_tail(&sk->sk_error_queue, skb);
3282         if (!sock_flag(sk, SOCK_DEAD))
3283                 sk->sk_data_ready(sk, len);
3284         return 0;
3285 }
3286 EXPORT_SYMBOL(sock_queue_err_skb);
3287
3288 void skb_tstamp_tx(struct sk_buff *orig_skb,
3289                 struct skb_shared_hwtstamps *hwtstamps)
3290 {
3291         struct sock *sk = orig_skb->sk;
3292         struct sock_exterr_skb *serr;
3293         struct sk_buff *skb;
3294         int err;
3295
3296         if (!sk)
3297                 return;
3298
3299         skb = skb_clone(orig_skb, GFP_ATOMIC);
3300         if (!skb)
3301                 return;
3302
3303         if (hwtstamps) {
3304                 *skb_hwtstamps(skb) =
3305                         *hwtstamps;
3306         } else {
3307                 /*
3308                  * no hardware time stamps available,
3309                  * so keep the shared tx_flags and only
3310                  * store software time stamp
3311                  */
3312                 skb->tstamp = ktime_get_real();
3313         }
3314
3315         serr = SKB_EXT_ERR(skb);
3316         memset(serr, 0, sizeof(*serr));
3317         serr->ee.ee_errno = ENOMSG;
3318         serr->ee.ee_origin = SO_EE_ORIGIN_TIMESTAMPING;
3319
3320         err = sock_queue_err_skb(sk, skb);
3321
3322         if (err)
3323                 kfree_skb(skb);
3324 }
3325 EXPORT_SYMBOL_GPL(skb_tstamp_tx);
3326
3327 void skb_complete_wifi_ack(struct sk_buff *skb, bool acked)
3328 {
3329         struct sock *sk = skb->sk;
3330         struct sock_exterr_skb *serr;
3331         int err;
3332
3333         skb->wifi_acked_valid = 1;
3334         skb->wifi_acked = acked;
3335
3336         serr = SKB_EXT_ERR(skb);
3337         memset(serr, 0, sizeof(*serr));
3338         serr->ee.ee_errno = ENOMSG;
3339         serr->ee.ee_origin = SO_EE_ORIGIN_TXSTATUS;
3340
3341         err = sock_queue_err_skb(sk, skb);
3342         if (err)
3343                 kfree_skb(skb);
3344 }
3345 EXPORT_SYMBOL_GPL(skb_complete_wifi_ack);
3346
3347
3348 /**
3349  * skb_partial_csum_set - set up and verify partial csum values for packet
3350  * @skb: the skb to set
3351  * @start: the number of bytes after skb->data to start checksumming.
3352  * @off: the offset from start to place the checksum.
3353  *
3354  * For untrusted partially-checksummed packets, we need to make sure the values
3355  * for skb->csum_start and skb->csum_offset are valid so we don't oops.
3356  *
3357  * This function checks and sets those values and skb->ip_summed: if this
3358  * returns false you should drop the packet.
3359  */
3360 bool skb_partial_csum_set(struct sk_buff *skb, u16 start, u16 off)
3361 {
3362         if (unlikely(start > skb_headlen(skb)) ||
3363             unlikely((int)start + off > skb_headlen(skb) - 2)) {
3364                 net_warn_ratelimited("bad partial csum: csum=%u/%u len=%u\n",
3365                                      start, off, skb_headlen(skb));
3366                 return false;
3367         }
3368         skb->ip_summed = CHECKSUM_PARTIAL;
3369         skb->csum_start = skb_headroom(skb) + start;
3370         skb->csum_offset = off;
3371         return true;
3372 }
3373 EXPORT_SYMBOL_GPL(skb_partial_csum_set);
3374
3375 void __skb_warn_lro_forwarding(const struct sk_buff *skb)
3376 {
3377         net_warn_ratelimited("%s: received packets cannot be forwarded while LRO is enabled\n",
3378                              skb->dev->name);
3379 }
3380 EXPORT_SYMBOL(__skb_warn_lro_forwarding);
3381
3382 void kfree_skb_partial(struct sk_buff *skb, bool head_stolen)
3383 {
3384         if (head_stolen) {
3385                 skb_release_head_state(skb);
3386                 kmem_cache_free(skbuff_head_cache, skb);
3387         } else {
3388                 __kfree_skb(skb);
3389         }
3390 }
3391 EXPORT_SYMBOL(kfree_skb_partial);
3392
3393 /**
3394  * skb_try_coalesce - try to merge skb to prior one
3395  * @to: prior buffer
3396  * @from: buffer to add
3397  * @fragstolen: pointer to boolean
3398  * @delta_truesize: how much more was allocated than was requested
3399  */
3400 bool skb_try_coalesce(struct sk_buff *to, struct sk_buff *from,
3401                       bool *fragstolen, int *delta_truesize)
3402 {
3403         int i, delta, len = from->len;
3404
3405         *fragstolen = false;
3406
3407         if (skb_cloned(to))
3408                 return false;
3409
3410         if (len <= skb_tailroom(to)) {
3411                 BUG_ON(skb_copy_bits(from, 0, skb_put(to, len), len));
3412                 *delta_truesize = 0;
3413                 return true;
3414         }
3415
3416         if (skb_has_frag_list(to) || skb_has_frag_list(from))
3417                 return false;
3418
3419         if (skb_headlen(from) != 0) {
3420                 struct page *page;
3421                 unsigned int offset;
3422
3423                 if (skb_shinfo(to)->nr_frags +
3424                     skb_shinfo(from)->nr_frags >= MAX_SKB_FRAGS)
3425                         return false;
3426
3427                 if (skb_head_is_locked(from))
3428                         return false;
3429
3430                 delta = from->truesize - SKB_DATA_ALIGN(sizeof(struct sk_buff));
3431
3432                 page = virt_to_head_page(from->head);
3433                 offset = from->data - (unsigned char *)page_address(page);
3434
3435                 skb_fill_page_desc(to, skb_shinfo(to)->nr_frags,
3436                                    page, offset, skb_headlen(from));
3437                 *fragstolen = true;
3438         } else {
3439                 if (skb_shinfo(to)->nr_frags +
3440                     skb_shinfo(from)->nr_frags > MAX_SKB_FRAGS)
3441                         return false;
3442
3443                 delta = from->truesize - SKB_TRUESIZE(skb_end_offset(from));
3444         }
3445
3446         WARN_ON_ONCE(delta < len);
3447
3448         memcpy(skb_shinfo(to)->frags + skb_shinfo(to)->nr_frags,
3449                skb_shinfo(from)->frags,
3450                skb_shinfo(from)->nr_frags * sizeof(skb_frag_t));
3451         skb_shinfo(to)->nr_frags += skb_shinfo(from)->nr_frags;
3452
3453         if (!skb_cloned(from))
3454                 skb_shinfo(from)->nr_frags = 0;
3455
3456         /* if the skb is not cloned this does nothing
3457          * since we set nr_frags to 0.
3458          */
3459         for (i = 0; i < skb_shinfo(from)->nr_frags; i++)
3460                 skb_frag_ref(from, i);
3461
3462         to->truesize += delta;
3463         to->len += len;
3464         to->data_len += len;
3465
3466         *delta_truesize = delta;
3467         return true;
3468 }
3469 EXPORT_SYMBOL(skb_try_coalesce);