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