esp6: add gso_segment for esp6 beet mode

[linux-2.6-microblaze.git] / net / ipv6 / esp6_offload.c

diff --git a/net/ipv6/esp6_offload.c b/net/ipv6/esp6_offload.c
index fd53505..8eab2c8 100644 (file)
--- a/net/ipv6/esp6_offload.c
+++ b/net/ipv6/esp6_offload.c
@@ -159,6 +159,40 @@ static struct sk_buff *xfrm6_transport_gso_segment(struct xfrm_state *x,
        return segs;
 }
 
+static struct sk_buff *xfrm6_beet_gso_segment(struct xfrm_state *x,
+                                             struct sk_buff *skb,
+                                             netdev_features_t features)
+{
+       struct xfrm_offload *xo = xfrm_offload(skb);
+       struct sk_buff *segs = ERR_PTR(-EINVAL);
+       const struct net_offload *ops;
+       int proto = xo->proto;
+
+       skb->transport_header += x->props.header_len;
+
+       if (proto == IPPROTO_BEETPH) {
+               struct ip_beet_phdr *ph = (struct ip_beet_phdr *)skb->data;
+
+               skb->transport_header += ph->hdrlen * 8;
+               proto = ph->nexthdr;
+       }
+
+       if (x->sel.family != AF_INET6) {
+               skb->transport_header -=
+                       (sizeof(struct ipv6hdr) - sizeof(struct iphdr));
+
+               if (proto == IPPROTO_TCP)
+                       skb_shinfo(skb)->gso_type |= SKB_GSO_TCPV6;
+       }
+
+       __skb_pull(skb, skb_transport_offset(skb));
+       ops = rcu_dereference(inet6_offloads[proto]);
+       if (likely(ops && ops->callbacks.gso_segment))
+               segs = ops->callbacks.gso_segment(skb, features);
+
+       return segs;
+}
+
 static struct sk_buff *xfrm6_outer_mode_gso_segment(struct xfrm_state *x,
                                                    struct sk_buff *skb,
                                                    netdev_features_t features)
@@ -168,6 +202,8 @@ static struct sk_buff *xfrm6_outer_mode_gso_segment(struct xfrm_state *x,
                return xfrm6_tunnel_gso_segment(x, skb, features);
        case XFRM_MODE_TRANSPORT:
                return xfrm6_transport_gso_segment(x, skb, features);
+       case XFRM_MODE_BEET:
+               return xfrm6_beet_gso_segment(x, skb, features);
        }
 
        return ERR_PTR(-EOPNOTSUPP);