net/core/skbuff.c

   1 /*
   2  *      Routines having to do with the 'struct sk_buff' memory handlers.
   3  *
   4  *      Authors:        Alan Cox <iiitac@pyr.swan.ac.uk>
   5  *                      Florian La Roche <rzsfl@rz.uni-sb.de>
   6  *
   7  *      Version:        $Id: skbuff.c,v 1.90 2001/11/07 05:56:19 davem Exp $
   8  *
   9  *      Fixes:
  10  *              Alan Cox        :       Fixed the worst of the load
  11  *                                      balancer bugs.
  12  *              Dave Platt      :       Interrupt stacking fix.
  13  *      Richard Kooijman        :       Timestamp fixes.
  14  *              Alan Cox        :       Changed buffer format.
  15  *              Alan Cox        :       destructor hook for AF_UNIX etc.
  16  *              Linus Torvalds  :       Better skb_clone.
  17  *              Alan Cox        :       Added skb_copy.
  18  *              Alan Cox        :       Added all the changed routines Linus
  19  *                                      only put in the headers
  20  *              Ray VanTassle   :       Fixed --skb->lock in free
  21  *              Alan Cox        :       skb_copy copy arp field
  22  *              Andi Kleen      :       slabified it.
  23  *              Robert Olsson   :       Removed skb_head_pool
  24  *
  25  *      NOTE:
  26  *              The __skb_ routines should be called with interrupts
  27  *      disabled, or you better be *real* sure that the operation is atomic
  28  *      with respect to whatever list is being frobbed (e.g. via lock_sock()
  29  *      or via disabling bottom half handlers, etc).
  30  *
  31  *      This program is free software; you can redistribute it and/or
  32  *      modify it under the terms of the GNU General Public License
  33  *      as published by the Free Software Foundation; either version
  34  *      2 of the License, or (at your option) any later version.
  35  */
  36
  37 /*
  38  *      The functions in this file will not compile correctly with gcc 2.4.x
  39  */
  40
  41 #include <linux/config.h>
  42 #include <linux/module.h>
  43 #include <linux/types.h>
  44 #include <linux/kernel.h>
  45 #include <linux/sched.h>
  46 #include <linux/mm.h>
  47 #include <linux/interrupt.h>
  48 #include <linux/in.h>
  49 #include <linux/inet.h>
  50 #include <linux/slab.h>
  51 #include <linux/netdevice.h>
  52 #ifdef CONFIG_NET_CLS_ACT
  53 #include <net/pkt_sched.h>
  54 #endif
  55 #include <linux/string.h>
  56 #include <linux/skbuff.h>
  57 #include <linux/cache.h>
  58 #include <linux/rtnetlink.h>
  59 #include <linux/init.h>
  60 #include <linux/highmem.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
  71 static kmem_cache_t *skbuff_head_cache;
  72
  73 /*
  74  *      Keep out-of-line to prevent kernel bloat.
  75  *      __builtin_return_address is not used because it is not always
  76  *      reliable.
  77  */
  78
  79 /**
  80  *      skb_over_panic  -       private function
  81  *      @skb: buffer
  82  *      @sz: size
  83  *      @here: address
  84  *
  85  *      Out of line support code for skb_put(). Not user callable.
  86  */
  87 void skb_over_panic(struct sk_buff *skb, int sz, void *here)
  88 {
  89         printk(KERN_INFO "skput:over: %p:%d put:%d dev:%s",
  90                 here, skb->len, sz, skb->dev ? skb->dev->name : "<NULL>");
  91         BUG();
  92 }
  93
  94 /**
  95  *      skb_under_panic -       private function
  96  *      @skb: buffer
  97  *      @sz: size
  98  *      @here: address
  99  *
 100  *      Out of line support code for skb_push(). Not user callable.
 101  */
 102
 103 void skb_under_panic(struct sk_buff *skb, int sz, void *here)
 104 {
 105         printk(KERN_INFO "skput:under: %p:%d put:%d dev:%s",
 106                here, skb->len, sz, skb->dev ? skb->dev->name : "<NULL>");
 107         BUG();
 108 }
 109
 110 /*      Allocate a new skbuff. We do this ourselves so we can fill in a few
 111  *      'private' fields and also do memory statistics to find all the
 112  *      [BEEP] leaks.
 113  *
 114  */
 115
 116 /**
 117  *      alloc_skb       -       allocate a network buffer
 118  *      @size: size to allocate
 119  *      @gfp_mask: allocation mask
 120  *
 121  *      Allocate a new &sk_buff. The returned buffer has no headroom and a
 122  *      tail room of size bytes. The object has a reference count of one.
 123  *      The return is the buffer. On a failure the return is %NULL.
 124  *
 125  *      Buffers may only be allocated from interrupts using a @gfp_mask of
 126  *      %GFP_ATOMIC.
 127  */
 128 struct sk_buff *alloc_skb(unsigned int size, int gfp_mask)
 129 {
 130         struct sk_buff *skb;
 131         u8 *data;
 132
 133         /* Get the HEAD */
 134         skb = kmem_cache_alloc(skbuff_head_cache,
 135                                gfp_mask & ~__GFP_DMA);
 136         if (!skb)
 137                 goto out;
 138
 139         /* Get the DATA. Size must match skb_add_mtu(). */
 140         size = SKB_DATA_ALIGN(size);
 141         data = kmalloc(size + sizeof(struct skb_shared_info), gfp_mask);
 142         if (!data)
 143                 goto nodata;
 144
 145         memset(skb, 0, offsetof(struct sk_buff, truesize));
 146         skb->truesize = size + sizeof(struct sk_buff);
 147         atomic_set(&skb->users, 1);
 148         skb->head = data;
 149         skb->data = data;
 150         skb->tail = data;
 151         skb->end  = data + size;
 152
 153         atomic_set(&(skb_shinfo(skb)->dataref), 1);
 154         skb_shinfo(skb)->nr_frags  = 0;
 155         skb_shinfo(skb)->tso_size = 0;
 156         skb_shinfo(skb)->tso_segs = 0;
 157         skb_shinfo(skb)->frag_list = NULL;
 158 out:
 159         return skb;
 160 nodata:
 161         kmem_cache_free(skbuff_head_cache, skb);
 162         skb = NULL;
 163         goto out;
 164 }
 165
 166
 167 static void skb_drop_fraglist(struct sk_buff *skb)
 168 {
 169         struct sk_buff *list = skb_shinfo(skb)->frag_list;
 170
 171         skb_shinfo(skb)->frag_list = NULL;
 172
 173         do {
 174                 struct sk_buff *this = list;
 175                 list = list->next;
 176                 kfree_skb(this);
 177         } while (list);
 178 }
 179
 180 static void skb_clone_fraglist(struct sk_buff *skb)
 181 {
 182         struct sk_buff *list;
 183
 184         for (list = skb_shinfo(skb)->frag_list; list; list = list->next)
 185                 skb_get(list);
 186 }
 187
 188 void skb_release_data(struct sk_buff *skb)
 189 {
 190         if (!skb->cloned ||
 191             atomic_dec_and_test(&(skb_shinfo(skb)->dataref))) {
 192                 if (skb_shinfo(skb)->nr_frags) {
 193                         int i;
 194                         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++)
 195                                 put_page(skb_shinfo(skb)->frags[i].page);
 196                 }
 197
 198                 if (skb_shinfo(skb)->frag_list)
 199                         skb_drop_fraglist(skb);
 200
 201                 kfree(skb->head);
 202         }
 203 }
 204
 205 /*
 206  *      Free an skbuff by memory without cleaning the state.
 207  */
 208 void kfree_skbmem(struct sk_buff *skb)
 209 {
 210         skb_release_data(skb);
 211         kmem_cache_free(skbuff_head_cache, skb);
 212 }
 213
 214 /**
 215  *      __kfree_skb - private function
 216  *      @skb: buffer
 217  *
 218  *      Free an sk_buff. Release anything attached to the buffer.
 219  *      Clean the state. This is an internal helper function. Users should
 220  *      always call kfree_skb
 221  */
 222
 223 void __kfree_skb(struct sk_buff *skb)
 224 {
 225         if (skb->list) {
 226                 printk(KERN_WARNING "Warning: kfree_skb passed an skb still "
 227                        "on a list (from %p).\n", NET_CALLER(skb));
 228                 BUG();
 229         }
 230
 231         dst_release(skb->dst);
 232 #ifdef CONFIG_XFRM
 233         secpath_put(skb->sp);
 234 #endif
 235         if(skb->destructor) {
 236                 if (in_irq())
 237                         printk(KERN_WARNING "Warning: kfree_skb on "
 238                                             "hard IRQ %p\n", NET_CALLER(skb));
 239                 skb->destructor(skb);
 240         }
 241 #ifdef CONFIG_NETFILTER
 242         nf_conntrack_put(skb->nfct);
 243 #ifdef CONFIG_BRIDGE_NETFILTER
 244         nf_bridge_put(skb->nf_bridge);
 245 #endif
 246 #endif
 247 /* XXX: IS this still necessary? - JHS */
 248 #ifdef CONFIG_NET_SCHED
 249         skb->tc_index = 0;
 250 #ifdef CONFIG_NET_CLS_ACT
 251         skb->tc_verd = 0;
 252         skb->tc_classid = 0;
 253 #endif
 254 #endif
 255
 256         kfree_skbmem(skb);
 257 }
 258
 259 /**
 260  *      skb_clone       -       duplicate an sk_buff
 261  *      @skb: buffer to clone
 262  *      @gfp_mask: allocation priority
 263  *
 264  *      Duplicate an &sk_buff. The new one is not owned by a socket. Both
 265  *      copies share the same packet data but not structure. The new
 266  *      buffer has a reference count of 1. If the allocation fails the
 267  *      function returns %NULL otherwise the new buffer is returned.
 268  *
 269  *      If this function is called from an interrupt gfp_mask() must be
 270  *      %GFP_ATOMIC.
 271  */
 272
 273 struct sk_buff *skb_clone(struct sk_buff *skb, int gfp_mask)
 274 {
 275         struct sk_buff *n = kmem_cache_alloc(skbuff_head_cache, gfp_mask);
 276
 277         if (!n)
 278                 return NULL;
 279
 280 #define C(x) n->x = skb->x
 281
 282         n->next = n->prev = NULL;
 283         n->list = NULL;
 284         n->sk = NULL;
 285         C(stamp);
 286         C(dev);
 287         C(real_dev);
 288         C(h);
 289         C(nh);
 290         C(mac);
 291         C(dst);
 292         dst_clone(skb->dst);
 293         C(sp);
 294 #ifdef CONFIG_INET
 295         secpath_get(skb->sp);
 296 #endif
 297         memcpy(n->cb, skb->cb, sizeof(skb->cb));
 298         C(len);
 299         C(data_len);
 300         C(csum);
 301         C(local_df);
 302         n->cloned = 1;
 303         C(pkt_type);
 304         C(ip_summed);
 305         C(priority);
 306         C(protocol);
 307         C(security);
 308         n->destructor = NULL;
 309 #ifdef CONFIG_NETFILTER
 310         C(nfmark);
 311         C(nfcache);
 312         C(nfct);
 313         nf_conntrack_get(skb->nfct);
 314         C(nfctinfo);
 315 #ifdef CONFIG_NETFILTER_DEBUG
 316         C(nf_debug);
 317 #endif
 318 #ifdef CONFIG_BRIDGE_NETFILTER
 319         C(nf_bridge);
 320         nf_bridge_get(skb->nf_bridge);
 321 #endif
 322 #endif /*CONFIG_NETFILTER*/
 323 #if defined(CONFIG_HIPPI)
 324         C(private);
 325 #endif
 326 #ifdef CONFIG_NET_SCHED
 327         C(tc_index);
 328 #ifdef CONFIG_NET_CLS_ACT
 329         n->tc_verd = SET_TC_VERD(skb->tc_verd,0);
 330         n->tc_verd = CLR_TC_OK2MUNGE(skb->tc_verd);
 331         n->tc_verd = CLR_TC_MUNGED(skb->tc_verd);
 332         C(input_dev);
 333         C(tc_classid);
 334 #endif
 335
 336 #endif
 337         C(truesize);
 338         atomic_set(&n->users, 1);
 339         C(head);
 340         C(data);
 341         C(tail);
 342         C(end);
 343
 344         atomic_inc(&(skb_shinfo(skb)->dataref));
 345         skb->cloned = 1;
 346
 347         return n;
 348 }
 349
 350 static void copy_skb_header(struct sk_buff *new, const struct sk_buff *old)
 351 {
 352         /*
 353          *      Shift between the two data areas in bytes
 354          */
 355         unsigned long offset = new->data - old->data;
 356
 357         new->list       = NULL;
 358         new->sk         = NULL;
 359         new->dev        = old->dev;
 360         new->real_dev   = old->real_dev;
 361         new->priority   = old->priority;
 362         new->protocol   = old->protocol;
 363         new->dst        = dst_clone(old->dst);
 364 #ifdef CONFIG_INET
 365         new->sp         = secpath_get(old->sp);
 366 #endif
 367         new->h.raw      = old->h.raw + offset;
 368         new->nh.raw     = old->nh.raw + offset;
 369         new->mac.raw    = old->mac.raw + offset;
 370         memcpy(new->cb, old->cb, sizeof(old->cb));
 371         new->local_df   = old->local_df;
 372         new->pkt_type   = old->pkt_type;
 373         new->stamp      = old->stamp;
 374         new->destructor = NULL;
 375         new->security   = old->security;
 376 #ifdef CONFIG_NETFILTER
 377         new->nfmark     = old->nfmark;
 378         new->nfcache    = old->nfcache;
 379         new->nfct       = old->nfct;
 380         nf_conntrack_get(old->nfct);
 381         new->nfctinfo   = old->nfctinfo;
 382 #ifdef CONFIG_NETFILTER_DEBUG
 383         new->nf_debug   = old->nf_debug;
 384 #endif
 385 #ifdef CONFIG_BRIDGE_NETFILTER
 386         new->nf_bridge  = old->nf_bridge;
 387         nf_bridge_get(old->nf_bridge);
 388 #endif
 389 #endif
 390 #ifdef CONFIG_NET_SCHED
 391 #ifdef CONFIG_NET_CLS_ACT
 392         new->tc_verd = old->tc_verd;
 393 #endif
 394         new->tc_index   = old->tc_index;
 395 #endif
 396         atomic_set(&new->users, 1);
 397 }
 398
 399 /**
 400  *      skb_copy        -       create private copy of an sk_buff
 401  *      @skb: buffer to copy
 402  *      @gfp_mask: allocation priority
 403  *
 404  *      Make a copy of both an &sk_buff and its data. This is used when the
 405  *      caller wishes to modify the data and needs a private copy of the
 406  *      data to alter. Returns %NULL on failure or the pointer to the buffer
 407  *      on success. The returned buffer has a reference count of 1.
 408  *
 409  *      As by-product this function converts non-linear &sk_buff to linear
 410  *      one, so that &sk_buff becomes completely private and caller is allowed
 411  *      to modify all the data of returned buffer. This means that this
 412  *      function is not recommended for use in circumstances when only
 413  *      header is going to be modified. Use pskb_copy() instead.
 414  */
 415
 416 struct sk_buff *skb_copy(const struct sk_buff *skb, int gfp_mask)
 417 {
 418         int headerlen = skb->data - skb->head;
 419         /*
 420          *      Allocate the copy buffer
 421          */
 422         struct sk_buff *n = alloc_skb(skb->end - skb->head + skb->data_len,
 423                                       gfp_mask);
 424         if (!n)
 425                 return NULL;
 426
 427         /* Set the data pointer */
 428         skb_reserve(n, headerlen);
 429         /* Set the tail pointer and length */
 430         skb_put(n, skb->len);
 431         n->csum      = skb->csum;
 432         n->ip_summed = skb->ip_summed;
 433
 434         if (skb_copy_bits(skb, -headerlen, n->head, headerlen + skb->len))
 435                 BUG();
 436
 437         copy_skb_header(n, skb);
 438         return n;
 439 }
 440
 441
 442 /**
 443  *      pskb_copy       -       create copy of an sk_buff with private head.
 444  *      @skb: buffer to copy
 445  *      @gfp_mask: allocation priority
 446  *
 447  *      Make a copy of both an &sk_buff and part of its data, located
 448  *      in header. Fragmented data remain shared. This is used when
 449  *      the caller wishes to modify only header of &sk_buff and needs
 450  *      private copy of the header to alter. Returns %NULL on failure
 451  *      or the pointer to the buffer on success.
 452  *      The returned buffer has a reference count of 1.
 453  */
 454
 455 struct sk_buff *pskb_copy(struct sk_buff *skb, int gfp_mask)
 456 {
 457         /*
 458          *      Allocate the copy buffer
 459          */
 460         struct sk_buff *n = alloc_skb(skb->end - skb->head, gfp_mask);
 461
 462         if (!n)
 463                 goto out;
 464
 465         /* Set the data pointer */
 466         skb_reserve(n, skb->data - skb->head);
 467         /* Set the tail pointer and length */
 468         skb_put(n, skb_headlen(skb));
 469         /* Copy the bytes */
 470         memcpy(n->data, skb->data, n->len);
 471         n->csum      = skb->csum;
 472         n->ip_summed = skb->ip_summed;
 473
 474         n->data_len  = skb->data_len;
 475         n->len       = skb->len;
 476
 477         if (skb_shinfo(skb)->nr_frags) {
 478                 int i;
 479
 480                 for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
 481                         skb_shinfo(n)->frags[i] = skb_shinfo(skb)->frags[i];
 482                         get_page(skb_shinfo(n)->frags[i].page);
 483                 }
 484                 skb_shinfo(n)->nr_frags = i;
 485         }
 486         skb_shinfo(n)->tso_size = skb_shinfo(skb)->tso_size;
 487         skb_shinfo(n)->tso_segs = skb_shinfo(skb)->tso_segs;
 488
 489         if (skb_shinfo(skb)->frag_list) {
 490                 skb_shinfo(n)->frag_list = skb_shinfo(skb)->frag_list;
 491                 skb_clone_fraglist(n);
 492         }
 493
 494         copy_skb_header(n, skb);
 495 out:
 496         return n;
 497 }
 498
 499 /**
 500  *      pskb_expand_head - reallocate header of &sk_buff
 501  *      @skb: buffer to reallocate
 502  *      @nhead: room to add at head
 503  *      @ntail: room to add at tail
 504  *      @gfp_mask: allocation priority
 505  *
 506  *      Expands (or creates identical copy, if &nhead and &ntail are zero)
 507  *      header of skb. &sk_buff itself is not changed. &sk_buff MUST have
 508  *      reference count of 1. Returns zero in the case of success or error,
 509  *      if expansion failed. In the last case, &sk_buff is not changed.
 510  *
 511  *      All the pointers pointing into skb header may change and must be
 512  *      reloaded after call to this function.
 513  */
 514
 515 int pskb_expand_head(struct sk_buff *skb, int nhead, int ntail, int gfp_mask)
 516 {
 517         int i;
 518         u8 *data;
 519         int size = nhead + (skb->end - skb->head) + ntail;
 520         long off;
 521
 522         if (skb_shared(skb))
 523                 BUG();
 524
 525         size = SKB_DATA_ALIGN(size);
 526
 527         data = kmalloc(size + sizeof(struct skb_shared_info), gfp_mask);
 528         if (!data)
 529                 goto nodata;
 530
 531         /* Copy only real data... and, alas, header. This should be
 532          * optimized for the cases when header is void. */
 533         memcpy(data + nhead, skb->head, skb->tail - skb->head);
 534         memcpy(data + size, skb->end, sizeof(struct skb_shared_info));
 535
 536         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++)
 537                 get_page(skb_shinfo(skb)->frags[i].page);
 538
 539         if (skb_shinfo(skb)->frag_list)
 540                 skb_clone_fraglist(skb);
 541
 542         skb_release_data(skb);
 543
 544         off = (data + nhead) - skb->head;
 545
 546         skb->head     = data;
 547         skb->end      = data + size;
 548         skb->data    += off;
 549         skb->tail    += off;
 550         skb->mac.raw += off;
 551         skb->h.raw   += off;
 552         skb->nh.raw  += off;
 553         skb->cloned   = 0;
 554         atomic_set(&skb_shinfo(skb)->dataref, 1);
 555         return 0;
 556
 557 nodata:
 558         return -ENOMEM;
 559 }
 560
 561 /* Make private copy of skb with writable head and some headroom */
 562
 563 struct sk_buff *skb_realloc_headroom(struct sk_buff *skb, unsigned int headroom)
 564 {
 565         struct sk_buff *skb2;
 566         int delta = headroom - skb_headroom(skb);
 567
 568         if (delta <= 0)
 569                 skb2 = pskb_copy(skb, GFP_ATOMIC);
 570         else {
 571                 skb2 = skb_clone(skb, GFP_ATOMIC);
 572                 if (skb2 && pskb_expand_head(skb2, SKB_DATA_ALIGN(delta), 0,
 573                                              GFP_ATOMIC)) {
 574                         kfree_skb(skb2);
 575                         skb2 = NULL;
 576                 }
 577         }
 578         return skb2;
 579 }
 580
 581
 582 /**
 583  *      skb_copy_expand -       copy and expand sk_buff
 584  *      @skb: buffer to copy
 585  *      @newheadroom: new free bytes at head
 586  *      @newtailroom: new free bytes at tail
 587  *      @gfp_mask: allocation priority
 588  *
 589  *      Make a copy of both an &sk_buff and its data and while doing so
 590  *      allocate additional space.
 591  *
 592  *      This is used when the caller wishes to modify the data and needs a
 593  *      private copy of the data to alter as well as more space for new fields.
 594  *      Returns %NULL on failure or the pointer to the buffer
 595  *      on success. The returned buffer has a reference count of 1.
 596  *
 597  *      You must pass %GFP_ATOMIC as the allocation priority if this function
 598  *      is called from an interrupt.
 599  *
 600  *      BUG ALERT: ip_summed is not copied. Why does this work? Is it used
 601  *      only by netfilter in the cases when checksum is recalculated? --ANK
 602  */
 603 struct sk_buff *skb_copy_expand(const struct sk_buff *skb,
 604                                 int newheadroom, int newtailroom, int gfp_mask)
 605 {
 606         /*
 607          *      Allocate the copy buffer
 608          */
 609         struct sk_buff *n = alloc_skb(newheadroom + skb->len + newtailroom,
 610                                       gfp_mask);
 611         int head_copy_len, head_copy_off;
 612
 613         if (!n)
 614                 return NULL;
 615
 616         skb_reserve(n, newheadroom);
 617
 618         /* Set the tail pointer and length */
 619         skb_put(n, skb->len);
 620
 621         head_copy_len = skb_headroom(skb);
 622         head_copy_off = 0;
 623         if (newheadroom <= head_copy_len)
 624                 head_copy_len = newheadroom;
 625         else
 626                 head_copy_off = newheadroom - head_copy_len;
 627
 628         /* Copy the linear header and data. */
 629         if (skb_copy_bits(skb, -head_copy_len, n->head + head_copy_off,
 630                           skb->len + head_copy_len))
 631                 BUG();
 632
 633         copy_skb_header(n, skb);
 634         skb_shinfo(n)->tso_size = skb_shinfo(skb)->tso_size;
 635         skb_shinfo(n)->tso_segs = skb_shinfo(skb)->tso_segs;
 636
 637         return n;
 638 }
 639
 640 /**
 641  *      skb_pad                 -       zero pad the tail of an skb
 642  *      @skb: buffer to pad
 643  *      @pad: space to pad
 644  *
 645  *      Ensure that a buffer is followed by a padding area that is zero
 646  *      filled. Used by network drivers which may DMA or transfer data
 647  *      beyond the buffer end onto the wire.
 648  *
 649  *      May return NULL in out of memory cases.
 650  */
 651
 652 struct sk_buff *skb_pad(struct sk_buff *skb, int pad)
 653 {
 654         struct sk_buff *nskb;
 655
 656         /* If the skbuff is non linear tailroom is always zero.. */
 657         if (skb_tailroom(skb) >= pad) {
 658                 memset(skb->data+skb->len, 0, pad);
 659                 return skb;
 660         }
 661
 662         nskb = skb_copy_expand(skb, skb_headroom(skb), skb_tailroom(skb) + pad, GFP_ATOMIC);
 663         kfree_skb(skb);
 664         if (nskb)
 665                 memset(nskb->data+nskb->len, 0, pad);
 666         return nskb;
 667 }
 668
 669 /* Trims skb to length len. It can change skb pointers, if "realloc" is 1.
 670  * If realloc==0 and trimming is impossible without change of data,
 671  * it is BUG().
 672  */
 673
 674 int ___pskb_trim(struct sk_buff *skb, unsigned int len, int realloc)
 675 {
 676         int offset = skb_headlen(skb);
 677         int nfrags = skb_shinfo(skb)->nr_frags;
 678         int i;
 679
 680         for (i = 0; i < nfrags; i++) {
 681                 int end = offset + skb_shinfo(skb)->frags[i].size;
 682                 if (end > len) {
 683                         if (skb_cloned(skb)) {
 684                                 if (!realloc)
 685                                         BUG();
 686                                 if (pskb_expand_head(skb, 0, 0, GFP_ATOMIC))
 687                                         return -ENOMEM;
 688                         }
 689                         if (len <= offset) {
 690                                 put_page(skb_shinfo(skb)->frags[i].page);
 691                                 skb_shinfo(skb)->nr_frags--;
 692                         } else {
 693                                 skb_shinfo(skb)->frags[i].size = len - offset;
 694                         }
 695                 }
 696                 offset = end;
 697         }
 698
 699         if (offset < len) {
 700                 skb->data_len -= skb->len - len;
 701                 skb->len       = len;
 702         } else {
 703                 if (len <= skb_headlen(skb)) {
 704                         skb->len      = len;
 705                         skb->data_len = 0;
 706                         skb->tail     = skb->data + len;
 707                         if (skb_shinfo(skb)->frag_list && !skb_cloned(skb))
 708                                 skb_drop_fraglist(skb);
 709                 } else {
 710                         skb->data_len -= skb->len - len;
 711                         skb->len       = len;
 712                 }
 713         }
 714
 715         return 0;
 716 }
 717
 718 /**
 719  *      __pskb_pull_tail - advance tail of skb header
 720  *      @skb: buffer to reallocate
 721  *      @delta: number of bytes to advance tail
 722  *
 723  *      The function makes a sense only on a fragmented &sk_buff,
 724  *      it expands header moving its tail forward and copying necessary
 725  *      data from fragmented part.
 726  *
 727  *      &sk_buff MUST have reference count of 1.
 728  *
 729  *      Returns %NULL (and &sk_buff does not change) if pull failed
 730  *      or value of new tail of skb in the case of success.
 731  *
 732  *      All the pointers pointing into skb header may change and must be
 733  *      reloaded after call to this function.
 734  */
 735
 736 /* Moves tail of skb head forward, copying data from fragmented part,
 737  * when it is necessary.
 738  * 1. It may fail due to malloc failure.
 739  * 2. It may change skb pointers.
 740  *
 741  * It is pretty complicated. Luckily, it is called only in exceptional cases.
 742  */
 743 unsigned char *__pskb_pull_tail(struct sk_buff *skb, int delta)
 744 {
 745         /* If skb has not enough free space at tail, get new one
 746          * plus 128 bytes for future expansions. If we have enough
 747          * room at tail, reallocate without expansion only if skb is cloned.
 748          */
 749         int i, k, eat = (skb->tail + delta) - skb->end;
 750
 751         if (eat > 0 || skb_cloned(skb)) {
 752                 if (pskb_expand_head(skb, 0, eat > 0 ? eat + 128 : 0,
 753                                      GFP_ATOMIC))
 754                         return NULL;
 755         }
 756
 757         if (skb_copy_bits(skb, skb_headlen(skb), skb->tail, delta))
 758                 BUG();
 759
 760         /* Optimization: no fragments, no reasons to preestimate
 761          * size of pulled pages. Superb.
 762          */
 763         if (!skb_shinfo(skb)->frag_list)
 764                 goto pull_pages;
 765
 766         /* Estimate size of pulled pages. */
 767         eat = delta;
 768         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
 769                 if (skb_shinfo(skb)->frags[i].size >= eat)
 770                         goto pull_pages;
 771                 eat -= skb_shinfo(skb)->frags[i].size;
 772         }
 773
 774         /* If we need update frag list, we are in troubles.
 775          * Certainly, it possible to add an offset to skb data,
 776          * but taking into account that pulling is expected to
 777          * be very rare operation, it is worth to fight against
 778          * further bloating skb head and crucify ourselves here instead.
 779          * Pure masohism, indeed. 8)8)
 780          */
 781         if (eat) {
 782                 struct sk_buff *list = skb_shinfo(skb)->frag_list;
 783                 struct sk_buff *clone = NULL;
 784                 struct sk_buff *insp = NULL;
 785
 786                 do {
 787                         if (!list)
 788                                 BUG();
 789
 790                         if (list->len <= eat) {
 791                                 /* Eaten as whole. */
 792                                 eat -= list->len;
 793                                 list = list->next;
 794                                 insp = list;
 795                         } else {
 796                                 /* Eaten partially. */
 797
 798                                 if (skb_shared(list)) {
 799                                         /* Sucks! We need to fork list. :-( */
 800                                         clone = skb_clone(list, GFP_ATOMIC);
 801                                         if (!clone)
 802                                                 return NULL;
 803                                         insp = list->next;
 804                                         list = clone;
 805                                 } else {
 806                                         /* This may be pulled without
 807                                          * problems. */
 808                                         insp = list;
 809                                 }
 810                                 if (!pskb_pull(list, eat)) {
 811                                         if (clone)
 812                                                 kfree_skb(clone);
 813                                         return NULL;
 814                                 }
 815                                 break;
 816                         }
 817                 } while (eat);
 818
 819                 /* Free pulled out fragments. */
 820                 while ((list = skb_shinfo(skb)->frag_list) != insp) {
 821                         skb_shinfo(skb)->frag_list = list->next;
 822                         kfree_skb(list);
 823                 }
 824                 /* And insert new clone at head. */
 825                 if (clone) {
 826                         clone->next = list;
 827                         skb_shinfo(skb)->frag_list = clone;
 828                 }
 829         }
 830         /* Success! Now we may commit changes to skb data. */
 831
 832 pull_pages:
 833         eat = delta;
 834         k = 0;
 835         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
 836                 if (skb_shinfo(skb)->frags[i].size <= eat) {
 837                         put_page(skb_shinfo(skb)->frags[i].page);
 838                         eat -= skb_shinfo(skb)->frags[i].size;
 839                 } else {
 840                         skb_shinfo(skb)->frags[k] = skb_shinfo(skb)->frags[i];
 841                         if (eat) {
 842                                 skb_shinfo(skb)->frags[k].page_offset += eat;
 843                                 skb_shinfo(skb)->frags[k].size -= eat;
 844                                 eat = 0;
 845                         }
 846                         k++;
 847                 }
 848         }
 849         skb_shinfo(skb)->nr_frags = k;
 850
 851         skb->tail     += delta;
 852         skb->data_len -= delta;
 853
 854         return skb->tail;
 855 }
 856
 857 /* Copy some data bits from skb to kernel buffer. */
 858
 859 int skb_copy_bits(const struct sk_buff *skb, int offset, void *to, int len)
 860 {
 861         int i, copy;
 862         int start = skb_headlen(skb);
 863
 864         if (offset > (int)skb->len - len)
 865                 goto fault;
 866
 867         /* Copy header. */
 868         if ((copy = start - offset) > 0) {
 869                 if (copy > len)
 870                         copy = len;
 871                 memcpy(to, skb->data + offset, copy);
 872                 if ((len -= copy) == 0)
 873                         return 0;
 874                 offset += copy;
 875                 to     += copy;
 876         }
 877
 878         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
 879                 int end;
 880
 881                 BUG_TRAP(start <= offset + len);
 882
 883                 end = start + skb_shinfo(skb)->frags[i].size;
 884                 if ((copy = end - offset) > 0) {
 885                         u8 *vaddr;
 886
 887                         if (copy > len)
 888                                 copy = len;
 889
 890                         vaddr = kmap_skb_frag(&skb_shinfo(skb)->frags[i]);
 891                         memcpy(to,
 892                                vaddr + skb_shinfo(skb)->frags[i].page_offset+
 893                                offset - start, copy);
 894                         kunmap_skb_frag(vaddr);
 895
 896                         if ((len -= copy) == 0)
 897                                 return 0;
 898                         offset += copy;
 899                         to     += copy;
 900                 }
 901                 start = end;
 902         }
 903
 904         if (skb_shinfo(skb)->frag_list) {
 905                 struct sk_buff *list = skb_shinfo(skb)->frag_list;
 906
 907                 for (; list; list = list->next) {
 908                         int end;
 909
 910                         BUG_TRAP(start <= offset + len);
 911
 912                         end = start + list->len;
 913                         if ((copy = end - offset) > 0) {
 914                                 if (copy > len)
 915                                         copy = len;
 916                                 if (skb_copy_bits(list, offset - start,
 917                                                   to, copy))
 918                                         goto fault;
 919                                 if ((len -= copy) == 0)
 920                                         return 0;
 921                                 offset += copy;
 922                                 to     += copy;
 923                         }
 924                         start = end;
 925                 }
 926         }
 927         if (!len)
 928                 return 0;
 929
 930 fault:
 931         return -EFAULT;
 932 }
 933
 934 /* Keep iterating until skb_iter_next returns false. */
 935 void skb_iter_first(const struct sk_buff *skb, struct skb_iter *i)
 936 {
 937         i->len = skb_headlen(skb);
 938         i->data = (unsigned char *)skb->data;
 939         i->nextfrag = 0;
 940         i->fraglist = NULL;
 941 }
 942
 943 int skb_iter_next(const struct sk_buff *skb, struct skb_iter *i)
 944 {
 945         /* Unmap previous, if not head fragment. */
 946         if (i->nextfrag)
 947                 kunmap_skb_frag(i->data);
 948
 949         if (i->fraglist) {
 950         fraglist:
 951                 /* We're iterating through fraglist. */
 952                 if (i->nextfrag < skb_shinfo(i->fraglist)->nr_frags) {
 953                         i->data = kmap_skb_frag(&skb_shinfo(i->fraglist)
 954                                                 ->frags[i->nextfrag]);
 955                         i->len = skb_shinfo(i->fraglist)->frags[i->nextfrag]
 956                                 .size;
 957                         i->nextfrag++;
 958                         return 1;
 959                 }
 960                 /* Fragments with fragments?  Too hard! */
 961                 BUG_ON(skb_shinfo(i->fraglist)->frag_list);
 962                 i->fraglist = i->fraglist->next;
 963                 if (!i->fraglist)
 964                         goto end;
 965
 966                 i->len = skb_headlen(i->fraglist);
 967                 i->data = i->fraglist->data;
 968                 i->nextfrag = 0;
 969                 return 1;
 970         }
 971
 972         if (i->nextfrag < skb_shinfo(skb)->nr_frags) {
 973                 i->data = kmap_skb_frag(&skb_shinfo(skb)->frags[i->nextfrag]);
 974                 i->len = skb_shinfo(skb)->frags[i->nextfrag].size;
 975                 i->nextfrag++;
 976                 return 1;
 977         }
 978
 979         i->fraglist = skb_shinfo(skb)->frag_list;
 980         if (i->fraglist)
 981                 goto fraglist;
 982
 983 end:
 984         /* Bug trap for callers */
 985         i->data = NULL;
 986         return 0;
 987 }
 988
 989 void skb_iter_abort(const struct sk_buff *skb, struct skb_iter *i)
 990 {
 991         /* Unmap previous, if not head fragment. */
 992         if (i->data && i->nextfrag)
 993                 kunmap_skb_frag(i->data);
 994         /* Bug trap for callers */
 995         i->data = NULL;
 996 }
 997
 998 /* Checksum skb data. */
 999
1000 unsigned int skb_checksum(const struct sk_buff *skb, int offset,
1001                           int len, unsigned int csum)
1002 {
1003         int start = skb_headlen(skb);
1004         int i, copy = start - offset;
1005         int pos = 0;
1006
1007         /* Checksum header. */
1008         if (copy > 0) {
1009                 if (copy > len)
1010                         copy = len;
1011                 csum = csum_partial(skb->data + offset, copy, csum);
1012                 if ((len -= copy) == 0)
1013                         return csum;
1014                 offset += copy;
1015                 pos     = copy;
1016         }
1017
1018         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
1019                 int end;
1020
1021                 BUG_TRAP(start <= offset + len);
1022
1023                 end = start + skb_shinfo(skb)->frags[i].size;
1024                 if ((copy = end - offset) > 0) {
1025                         unsigned int csum2;
1026                         u8 *vaddr;
1027                         skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
1028
1029                         if (copy > len)
1030                                 copy = len;
1031                         vaddr = kmap_skb_frag(frag);
1032                         csum2 = csum_partial(vaddr + frag->page_offset +
1033                                              offset - start, copy, 0);
1034                         kunmap_skb_frag(vaddr);
1035                         csum = csum_block_add(csum, csum2, pos);
1036                         if (!(len -= copy))
1037                                 return csum;
1038                         offset += copy;
1039                         pos    += copy;
1040                 }
1041                 start = end;
1042         }
1043
1044         if (skb_shinfo(skb)->frag_list) {
1045                 struct sk_buff *list = skb_shinfo(skb)->frag_list;
1046
1047                 for (; list; list = list->next) {
1048                         int end;
1049
1050                         BUG_TRAP(start <= offset + len);
1051
1052                         end = start + list->len;
1053                         if ((copy = end - offset) > 0) {
1054                                 unsigned int csum2;
1055                                 if (copy > len)
1056                                         copy = len;
1057                                 csum2 = skb_checksum(list, offset - start,
1058                                                      copy, 0);
1059                                 csum = csum_block_add(csum, csum2, pos);
1060                                 if ((len -= copy) == 0)
1061                                         return csum;
1062                                 offset += copy;
1063                                 pos    += copy;
1064                         }
1065                         start = end;
1066                 }
1067         }
1068         if (len)
1069                 BUG();
1070
1071         return csum;
1072 }
1073
1074 /* Both of above in one bottle. */
1075
1076 unsigned int skb_copy_and_csum_bits(const struct sk_buff *skb, int offset,
1077                                     u8 *to, int len, unsigned int csum)
1078 {
1079         int start = skb_headlen(skb);
1080         int i, copy = start - offset;
1081         int pos = 0;
1082
1083         /* Copy header. */
1084         if (copy > 0) {
1085                 if (copy > len)
1086                         copy = len;
1087                 csum = csum_partial_copy_nocheck(skb->data + offset, to,
1088                                                  copy, csum);
1089                 if ((len -= copy) == 0)
1090                         return csum;
1091                 offset += copy;
1092                 to     += copy;
1093                 pos     = copy;
1094         }
1095
1096         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
1097                 int end;
1098
1099                 BUG_TRAP(start <= offset + len);
1100
1101                 end = start + skb_shinfo(skb)->frags[i].size;
1102                 if ((copy = end - offset) > 0) {
1103                         unsigned int csum2;
1104                         u8 *vaddr;
1105                         skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
1106
1107                         if (copy > len)
1108                                 copy = len;
1109                         vaddr = kmap_skb_frag(frag);
1110                         csum2 = csum_partial_copy_nocheck(vaddr +
1111                                                           frag->page_offset +
1112                                                           offset - start, to,
1113                                                           copy, 0);
1114                         kunmap_skb_frag(vaddr);
1115                         csum = csum_block_add(csum, csum2, pos);
1116                         if (!(len -= copy))
1117                                 return csum;
1118                         offset += copy;
1119                         to     += copy;
1120                         pos    += copy;
1121                 }
1122                 start = end;
1123         }
1124
1125         if (skb_shinfo(skb)->frag_list) {
1126                 struct sk_buff *list = skb_shinfo(skb)->frag_list;
1127
1128                 for (; list; list = list->next) {
1129                         unsigned int csum2;
1130                         int end;
1131
1132                         BUG_TRAP(start <= offset + len);
1133
1134                         end = start + list->len;
1135                         if ((copy = end - offset) > 0) {
1136                                 if (copy > len)
1137                                         copy = len;
1138                                 csum2 = skb_copy_and_csum_bits(list,
1139                                                                offset - start,
1140                                                                to, copy, 0);
1141                                 csum = csum_block_add(csum, csum2, pos);
1142                                 if ((len -= copy) == 0)
1143                                         return csum;
1144                                 offset += copy;
1145                                 to     += copy;
1146                                 pos    += copy;
1147                         }
1148                         start = end;
1149                 }
1150         }
1151         if (len)
1152                 BUG();
1153         return csum;
1154 }
1155
1156 void skb_copy_and_csum_dev(const struct sk_buff *skb, u8 *to)
1157 {
1158         unsigned int csum;
1159         long csstart;
1160
1161         if (skb->ip_summed == CHECKSUM_HW)
1162                 csstart = skb->h.raw - skb->data;
1163         else
1164                 csstart = skb_headlen(skb);
1165
1166         if (csstart > skb_headlen(skb))
1167                 BUG();
1168
1169         memcpy(to, skb->data, csstart);
1170
1171         csum = 0;
1172         if (csstart != skb->len)
1173                 csum = skb_copy_and_csum_bits(skb, csstart, to + csstart,
1174                                               skb->len - csstart, 0);
1175
1176         if (skb->ip_summed == CHECKSUM_HW) {
1177                 long csstuff = csstart + skb->csum;
1178
1179                 *((unsigned short *)(to + csstuff)) = csum_fold(csum);
1180         }
1181 }
1182
1183 /**
1184  *      skb_dequeue - remove from the head of the queue
1185  *      @list: list to dequeue from
1186  *
1187  *      Remove the head of the list. The list lock is taken so the function
1188  *      may be used safely with other locking list functions. The head item is
1189  *      returned or %NULL if the list is empty.
1190  */
1191
1192 struct sk_buff *skb_dequeue(struct sk_buff_head *list)
1193 {
1194         unsigned long flags;
1195         struct sk_buff *result;
1196
1197         spin_lock_irqsave(&list->lock, flags);
1198         result = __skb_dequeue(list);
1199         spin_unlock_irqrestore(&list->lock, flags);
1200         return result;
1201 }
1202
1203 /**
1204  *      skb_dequeue_tail - remove from the tail of the queue
1205  *      @list: list to dequeue from
1206  *
1207  *      Remove the tail of the list. The list lock is taken so the function
1208  *      may be used safely with other locking list functions. The tail item is
1209  *      returned or %NULL if the list is empty.
1210  */
1211 struct sk_buff *skb_dequeue_tail(struct sk_buff_head *list)
1212 {
1213         unsigned long flags;
1214         struct sk_buff *result;
1215
1216         spin_lock_irqsave(&list->lock, flags);
1217         result = __skb_dequeue_tail(list);
1218         spin_unlock_irqrestore(&list->lock, flags);
1219         return result;
1220 }
1221
1222 /**
1223  *      skb_queue_purge - empty a list
1224  *      @list: list to empty
1225  *
1226  *      Delete all buffers on an &sk_buff list. Each buffer is removed from
1227  *      the list and one reference dropped. This function takes the list
1228  *      lock and is atomic with respect to other list locking functions.
1229  */
1230 void skb_queue_purge(struct sk_buff_head *list)
1231 {
1232         struct sk_buff *skb;
1233         while ((skb = skb_dequeue(list)) != NULL)
1234                 kfree_skb(skb);
1235 }
1236
1237 /**
1238  *      skb_queue_head - queue a buffer at the list head
1239  *      @list: list to use
1240  *      @newsk: buffer to queue
1241  *
1242  *      Queue a buffer at the start of the list. This function takes the
1243  *      list lock and can be used safely with other locking &sk_buff functions
1244  *      safely.
1245  *
1246  *      A buffer cannot be placed on two lists at the same time.
1247  */
1248 void skb_queue_head(struct sk_buff_head *list, struct sk_buff *newsk)
1249 {
1250         unsigned long flags;
1251
1252         spin_lock_irqsave(&list->lock, flags);
1253         __skb_queue_head(list, newsk);
1254         spin_unlock_irqrestore(&list->lock, flags);
1255 }
1256
1257 /**
1258  *      skb_queue_tail - queue a buffer at the list tail
1259  *      @list: list to use
1260  *      @newsk: buffer to queue
1261  *
1262  *      Queue a buffer at the tail of the list. This function takes the
1263  *      list lock and can be used safely with other locking &sk_buff functions
1264  *      safely.
1265  *
1266  *      A buffer cannot be placed on two lists at the same time.
1267  */
1268 void skb_queue_tail(struct sk_buff_head *list, struct sk_buff *newsk)
1269 {
1270         unsigned long flags;
1271
1272         spin_lock_irqsave(&list->lock, flags);
1273         __skb_queue_tail(list, newsk);
1274         spin_unlock_irqrestore(&list->lock, flags);
1275 }
1276 /**
1277  *      skb_unlink      -       remove a buffer from a list
1278  *      @skb: buffer to remove
1279  *
1280  *      Place a packet after a given packet in a list. The list locks are taken
1281  *      and this function is atomic with respect to other list locked calls
1282  *
1283  *      Works even without knowing the list it is sitting on, which can be
1284  *      handy at times. It also means that THE LIST MUST EXIST when you
1285  *      unlink. Thus a list must have its contents unlinked before it is
1286  *      destroyed.
1287  */
1288 void skb_unlink(struct sk_buff *skb)
1289 {
1290         struct sk_buff_head *list = skb->list;
1291
1292         if (list) {
1293                 unsigned long flags;
1294
1295                 spin_lock_irqsave(&list->lock, flags);
1296                 if (skb->list == list)
1297                         __skb_unlink(skb, skb->list);
1298                 spin_unlock_irqrestore(&list->lock, flags);
1299         }
1300 }
1301
1302
1303 /**
1304  *      skb_append      -       append a buffer
1305  *      @old: buffer to insert after
1306  *      @newsk: buffer to insert
1307  *
1308  *      Place a packet after a given packet in a list. The list locks are taken
1309  *      and this function is atomic with respect to other list locked calls.
1310  *      A buffer cannot be placed on two lists at the same time.
1311  */
1312
1313 void skb_append(struct sk_buff *old, struct sk_buff *newsk)
1314 {
1315         unsigned long flags;
1316
1317         spin_lock_irqsave(&old->list->lock, flags);
1318         __skb_append(old, newsk);
1319         spin_unlock_irqrestore(&old->list->lock, flags);
1320 }
1321
1322
1323 /**
1324  *      skb_insert      -       insert a buffer
1325  *      @old: buffer to insert before
1326  *      @newsk: buffer to insert
1327  *
1328  *      Place a packet before a given packet in a list. The list locks are taken
1329  *      and this function is atomic with respect to other list locked calls
1330  *      A buffer cannot be placed on two lists at the same time.
1331  */
1332
1333 void skb_insert(struct sk_buff *old, struct sk_buff *newsk)
1334 {
1335         unsigned long flags;
1336
1337         spin_lock_irqsave(&old->list->lock, flags);
1338         __skb_insert(newsk, old->prev, old, old->list);
1339         spin_unlock_irqrestore(&old->list->lock, flags);
1340 }
1341
1342 #if 0
1343 /*
1344  *      Tune the memory allocator for a new MTU size.
1345  */
1346 void skb_add_mtu(int mtu)
1347 {
1348         /* Must match allocation in alloc_skb */
1349         mtu = SKB_DATA_ALIGN(mtu) + sizeof(struct skb_shared_info);
1350
1351         kmem_add_cache_size(mtu);
1352 }
1353 #endif
1354
1355 static void inline skb_split_inside_header(struct sk_buff *skb,
1356                                            struct sk_buff* skb1,
1357                                            const u32 len, const int pos)
1358 {
1359         int i;
1360
1361         memcpy(skb_put(skb1, pos - len), skb->data + len, pos - len);
1362
1363         /* And move data appendix as is. */
1364         for (i = 0; i < skb_shinfo(skb)->nr_frags; i++)
1365                 skb_shinfo(skb1)->frags[i] = skb_shinfo(skb)->frags[i];
1366
1367         skb_shinfo(skb1)->nr_frags = skb_shinfo(skb)->nr_frags;
1368         skb_shinfo(skb)->nr_frags  = 0;
1369         skb1->data_len             = skb->data_len;
1370         skb1->len                  += skb1->data_len;
1371         skb->data_len              = 0;
1372         skb->len                   = len;
1373         skb->tail                  = skb->data + len;
1374 }
1375
1376 static void inline skb_split_no_header(struct sk_buff *skb,
1377                                        struct sk_buff* skb1,
1378                                        const u32 len, int pos)
1379 {
1380         int i, k = 0;
1381         const int nfrags = skb_shinfo(skb)->nr_frags;
1382
1383         skb_shinfo(skb)->nr_frags = 0;
1384         skb1->len                 = skb1->data_len = skb->len - len;
1385         skb->len                  = len;
1386         skb->data_len             = len - pos;
1387
1388         for (i = 0; i < nfrags; i++) {
1389                 int size = skb_shinfo(skb)->frags[i].size;
1390
1391                 if (pos + size > len) {
1392                         skb_shinfo(skb1)->frags[k] = skb_shinfo(skb)->frags[i];
1393
1394                         if (pos < len) {
1395                                 /* Split frag.
1396                                  * We have to variants in this case:
1397                                  * 1. Move all the frag to the second
1398                                  *    part, if it is possible. F.e.
1399                                  *    this approach is mandatory for TUX,
1400                                  *    where splitting is expensive.
1401                                  * 2. Split is accurately. We make this.
1402                                  */
1403                                 get_page(skb_shinfo(skb)->frags[i].page);
1404                                 skb_shinfo(skb1)->frags[0].page_offset += len - pos;
1405                                 skb_shinfo(skb1)->frags[0].size -= len - pos;
1406                                 skb_shinfo(skb)->frags[i].size  = len - pos;
1407                                 skb_shinfo(skb)->nr_frags++;
1408                         }
1409                         k++;
1410                 } else
1411                         skb_shinfo(skb)->nr_frags++;
1412                 pos += size;
1413         }
1414         skb_shinfo(skb1)->nr_frags = k;
1415 }
1416
1417 /**
1418  * skb_split - Split fragmented skb to two parts at length len.
1419  */
1420 void skb_split(struct sk_buff *skb, struct sk_buff *skb1, const u32 len)
1421 {
1422         int pos = skb_headlen(skb);
1423
1424         if (len < pos)  /* Split line is inside header. */
1425                 skb_split_inside_header(skb, skb1, len, pos);
1426         else            /* Second chunk has no header, nothing to copy. */
1427                 skb_split_no_header(skb, skb1, len, pos);
1428 }
1429
1430 void __init skb_init(void)
1431 {
1432         skbuff_head_cache = kmem_cache_create("skbuff_head_cache",
1433                                               sizeof(struct sk_buff),
1434                                               0,
1435                                               SLAB_HWCACHE_ALIGN,
1436                                               NULL, NULL);
1437         if (!skbuff_head_cache)
1438                 panic("cannot create skbuff cache");
1439 }
1440
1441 EXPORT_SYMBOL(___pskb_trim);
1442 EXPORT_SYMBOL(__kfree_skb);
1443 EXPORT_SYMBOL(__pskb_pull_tail);
1444 EXPORT_SYMBOL(alloc_skb);
1445 EXPORT_SYMBOL(pskb_copy);
1446 EXPORT_SYMBOL(pskb_expand_head);
1447 EXPORT_SYMBOL(skb_checksum);
1448 EXPORT_SYMBOL(skb_clone);
1449 EXPORT_SYMBOL(skb_clone_fraglist);
1450 EXPORT_SYMBOL(skb_copy);
1451 EXPORT_SYMBOL(skb_copy_and_csum_bits);
1452 EXPORT_SYMBOL(skb_copy_and_csum_dev);
1453 EXPORT_SYMBOL(skb_copy_bits);
1454 EXPORT_SYMBOL(skb_copy_expand);
1455 EXPORT_SYMBOL(skb_over_panic);
1456 EXPORT_SYMBOL(skb_pad);
1457 EXPORT_SYMBOL(skb_realloc_headroom);
1458 EXPORT_SYMBOL(skb_under_panic);
1459 EXPORT_SYMBOL(skb_dequeue);
1460 EXPORT_SYMBOL(skb_dequeue_tail);
1461 EXPORT_SYMBOL(skb_insert);
1462 EXPORT_SYMBOL(skb_queue_purge);
1463 EXPORT_SYMBOL(skb_queue_head);
1464 EXPORT_SYMBOL(skb_queue_tail);
1465 EXPORT_SYMBOL(skb_unlink);
1466 EXPORT_SYMBOL(skb_append);
1467 EXPORT_SYMBOL(skb_split);
1468 EXPORT_SYMBOL(skb_iter_first);
1469 EXPORT_SYMBOL(skb_iter_next);
1470 EXPORT_SYMBOL(skb_iter_abort);