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