3 files changed, 142 insertions, 0 deletions

diff --git a/net/core/dev.c b/net/core/dev.c
index a44eeef24edf..8d1541595277 100644
--- a/net/core/dev.c
+++ b/net/core/dev.c
@@ -2717,6 +2717,20 @@ int register_netdevice(struct net_device *dev)
                        dev->name);
                 dev->features &= ~NETIF_F_TSO;
         }
+        if (dev->features & NETIF_F_UFO) {
+                if (!(dev->features & NETIF_F_HW_CSUM)) {
+                        printk(KERN_ERR "%s: Dropping NETIF_F_UFO since no "
+                                        "NETIF_F_HW_CSUM feature.\n",
+                                                        dev->name);
+                        dev->features &= ~NETIF_F_UFO;
+                }
+                if (!(dev->features & NETIF_F_SG)) {
+                        printk(KERN_ERR "%s: Dropping NETIF_F_UFO since no "
+                                        "NETIF_F_SG feature.\n",
+                                        dev->name);
+                        dev->features &= ~NETIF_F_UFO;
+                }
+        }
 
         /*
          *      nil rebuild_header routine,
diff --git a/net/core/ethtool.c b/net/core/ethtool.c
index 404b761e82ce..0350586e9195 100644
--- a/net/core/ethtool.c
+++ b/net/core/ethtool.c
@@ -93,6 +93,20 @@ int ethtool_op_get_perm_addr(struct net_device *dev, struct ethtool_perm_addr *a
 }
  
 
+u32 ethtool_op_get_ufo(struct net_device *dev)
+{
+        return (dev->features & NETIF_F_UFO) != 0;
+}
+
+int ethtool_op_set_ufo(struct net_device *dev, u32 data)
+{
+        if (data)
+                dev->features |= NETIF_F_UFO;
+        else
+                dev->features &= ~NETIF_F_UFO;
+        return 0;
+}
+
 /* Handlers for each ethtool command */
 
 static int ethtool_get_settings(struct net_device *dev, void __user *useraddr)
@@ -483,6 +497,11 @@ static int __ethtool_set_sg(struct net_device *dev, u32 data)
                         return err;
         }
 
+        if (!data && dev->ethtool_ops->set_ufo) {
+                err = dev->ethtool_ops->set_ufo(dev, 0);
+                if (err)
+                        return err;
+        }
         return dev->ethtool_ops->set_sg(dev, data);
 }
 
@@ -569,6 +588,32 @@ static int ethtool_set_tso(struct net_device *dev, char __user *useraddr)
         return dev->ethtool_ops->set_tso(dev, edata.data);
 }
 
+static int ethtool_get_ufo(struct net_device *dev, char __user *useraddr)
+{
+        struct ethtool_value edata = { ETHTOOL_GTSO };
+
+        if (!dev->ethtool_ops->get_ufo)
+                return -EOPNOTSUPP;
+        edata.data = dev->ethtool_ops->get_ufo(dev);
+        if (copy_to_user(useraddr, &edata, sizeof(edata)))
+                 return -EFAULT;
+        return 0;
+}
+static int ethtool_set_ufo(struct net_device *dev, char __user *useraddr)
+{
+        struct ethtool_value edata;
+
+        if (!dev->ethtool_ops->set_ufo)
+                return -EOPNOTSUPP;
+        if (copy_from_user(&edata, useraddr, sizeof(edata)))
+                return -EFAULT;
+        if (edata.data && !(dev->features & NETIF_F_SG))
+                return -EINVAL;
+        if (edata.data && !(dev->features & NETIF_F_HW_CSUM))
+                return -EINVAL;
+        return dev->ethtool_ops->set_ufo(dev, edata.data);
+}
+
 static int ethtool_self_test(struct net_device *dev, char __user *useraddr)
 {
         struct ethtool_test test;
@@ -854,6 +899,12 @@ int dev_ethtool(struct ifreq *ifr)
         case ETHTOOL_GPERMADDR:
                 rc = ethtool_get_perm_addr(dev, useraddr);
                 break;
+        case ETHTOOL_GUFO:
+                rc = ethtool_get_ufo(dev, useraddr);
+                break;
+        case ETHTOOL_SUFO:
+                rc = ethtool_set_ufo(dev, useraddr);
+                break;
         default:
                 rc =  -EOPNOTSUPP;
         }
@@ -882,3 +933,5 @@ EXPORT_SYMBOL(ethtool_op_set_sg);
 EXPORT_SYMBOL(ethtool_op_set_tso);
 EXPORT_SYMBOL(ethtool_op_set_tx_csum);
 EXPORT_SYMBOL(ethtool_op_set_tx_hw_csum);
+EXPORT_SYMBOL(ethtool_op_set_ufo);
+EXPORT_SYMBOL(ethtool_op_get_ufo);
diff --git a/net/core/skbuff.c b/net/core/skbuff.c
index ef9d46b91eb9..95501e40100e 100644
--- a/net/core/skbuff.c
+++ b/net/core/skbuff.c
@@ -176,6 +176,8 @@ struct sk_buff *__alloc_skb(unsigned int size, gfp_t gfp_mask,
         skb_shinfo(skb)->tso_size = 0;
         skb_shinfo(skb)->tso_segs = 0;
         skb_shinfo(skb)->frag_list = NULL;
+        skb_shinfo(skb)->ufo_size = 0;
+        skb_shinfo(skb)->ip6_frag_id = 0;
 out:
         return skb;
 nodata:
@@ -1696,6 +1698,78 @@ unsigned int skb_find_text(struct sk_buff *skb, unsigned int from,
         return textsearch_find(config, state);
 }
 
+/**
+ * skb_append_datato_frags: - append the user data to a skb
+ * @sk: sock  structure
+ * @skb: skb structure to be appened with user data.
+ * @getfrag: call back function to be used for getting the user data
+ * @from: pointer to user message iov
+ * @length: length of the iov message
+ *
+ * Description: This procedure append the user data in the fragment part
+ * of the skb if any page alloc fails user this procedure returns  -ENOMEM
+ */
+int skb_append_datato_frags(struct sock *sk, struct sk_buff *skb,
+                        int getfrag(void *from, char *to, int offset,
+                                        int len, int odd, struct sk_buff *skb),
+                        void *from, int length)
+{
+        int frg_cnt = 0;
+        skb_frag_t *frag = NULL;
+        struct page *page = NULL;
+        int copy, left;
+        int offset = 0;
+        int ret;
+
+        do {
+                /* Return error if we don't have space for new frag */
+                frg_cnt = skb_shinfo(skb)->nr_frags;
+                if (frg_cnt >= MAX_SKB_FRAGS)
+                        return -EFAULT;
+
+                /* allocate a new page for next frag */
+                page = alloc_pages(sk->sk_allocation, 0);
+
+                /* If alloc_page fails just return failure and caller will
+                 * free previous allocated pages by doing kfree_skb()
+                 */
+                if (page == NULL)
+                        return -ENOMEM;
+
+                /* initialize the next frag */
+                sk->sk_sndmsg_page = page;
+                sk->sk_sndmsg_off = 0;
+                skb_fill_page_desc(skb, frg_cnt, page, 0, 0);
+                skb->truesize += PAGE_SIZE;
+                atomic_add(PAGE_SIZE, &sk->sk_wmem_alloc);
+
+                /* get the new initialized frag */
+                frg_cnt = skb_shinfo(skb)->nr_frags;
+                frag = &skb_shinfo(skb)->frags[frg_cnt - 1];
+
+                /* copy the user data to page */
+                left = PAGE_SIZE - frag->page_offset;
+                copy = (length > left)? left : length;
+
+                ret = getfrag(from, (page_address(frag->page) +
+                            frag->page_offset + frag->size),
+                            offset, copy, 0, skb);
+                if (ret < 0)
+                        return -EFAULT;
+
+                /* copy was successful so update the size parameters */
+                sk->sk_sndmsg_off += copy;
+                frag->size += copy;
+                skb->len += copy;
+                skb->data_len += copy;
+                offset += copy;
+                length -= copy;
+
+        } while (length > 0);
+
+        return 0;
+}
+
 void __init skb_init(void)
 {
         skbuff_head_cache = kmem_cache_create("skbuff_head_cache",
@@ -1747,3 +1821,4 @@ EXPORT_SYMBOL(skb_prepare_seq_read);
 EXPORT_SYMBOL(skb_seq_read);
 EXPORT_SYMBOL(skb_abort_seq_read);
 EXPORT_SYMBOL(skb_find_text);
+EXPORT_SYMBOL(skb_append_datato_frags);