|
@@ -1010,7 +1010,8 @@ int ip6_tnl_xmit(struct sk_buff *skb, struct net_device *dev, __u8 dsfield,
|
|
|
struct dst_entry *dst = NULL, *ndst = NULL;
|
|
|
struct net_device *tdev;
|
|
|
int mtu;
|
|
|
- unsigned int max_headroom = sizeof(struct ipv6hdr);
|
|
|
+ unsigned int psh_hlen = sizeof(struct ipv6hdr) + t->encap_hlen;
|
|
|
+ unsigned int max_headroom = psh_hlen;
|
|
|
int err = -1;
|
|
|
|
|
|
/* NBMA tunnel */
|
|
@@ -1063,7 +1064,7 @@ int ip6_tnl_xmit(struct sk_buff *skb, struct net_device *dev, __u8 dsfield,
|
|
|
t->parms.name);
|
|
|
goto tx_err_dst_release;
|
|
|
}
|
|
|
- mtu = dst_mtu(dst) - sizeof(*ipv6h);
|
|
|
+ mtu = dst_mtu(dst) - psh_hlen;
|
|
|
if (encap_limit >= 0) {
|
|
|
max_headroom += 8;
|
|
|
mtu -= 8;
|
|
@@ -1119,16 +1120,18 @@ int ip6_tnl_xmit(struct sk_buff *skb, struct net_device *dev, __u8 dsfield,
|
|
|
ipv6_push_nfrag_opts(skb, &opt.ops, &proto, NULL);
|
|
|
}
|
|
|
|
|
|
- if (likely(!skb->encapsulation)) {
|
|
|
- skb_reset_inner_headers(skb);
|
|
|
- skb->encapsulation = 1;
|
|
|
- }
|
|
|
-
|
|
|
+ /* Calculate max headroom for all the headers and adjust
|
|
|
+ * needed_headroom if necessary.
|
|
|
+ */
|
|
|
max_headroom = LL_RESERVED_SPACE(dst->dev) + sizeof(struct ipv6hdr)
|
|
|
- + dst->header_len;
|
|
|
+ + dst->header_len + t->hlen;
|
|
|
if (max_headroom > dev->needed_headroom)
|
|
|
dev->needed_headroom = max_headroom;
|
|
|
|
|
|
+ err = ip6_tnl_encap(skb, t, &proto, fl6);
|
|
|
+ if (err)
|
|
|
+ return err;
|
|
|
+
|
|
|
skb_push(skb, sizeof(struct ipv6hdr));
|
|
|
skb_reset_network_header(skb);
|
|
|
ipv6h = ipv6_hdr(skb);
|
|
@@ -1180,6 +1183,11 @@ ip4ip6_tnl_xmit(struct sk_buff *skb, struct net_device *dev)
|
|
|
if (t->parms.flags & IP6_TNL_F_USE_ORIG_FWMARK)
|
|
|
fl6.flowi6_mark = skb->mark;
|
|
|
|
|
|
+ if (iptunnel_handle_offloads(skb, SKB_GSO_IPXIP6))
|
|
|
+ return -1;
|
|
|
+
|
|
|
+ skb_set_inner_ipproto(skb, IPPROTO_IPIP);
|
|
|
+
|
|
|
err = ip6_tnl_xmit(skb, dev, dsfield, &fl6, encap_limit, &mtu,
|
|
|
IPPROTO_IPIP);
|
|
|
if (err != 0) {
|
|
@@ -1234,6 +1242,11 @@ ip6ip6_tnl_xmit(struct sk_buff *skb, struct net_device *dev)
|
|
|
if (t->parms.flags & IP6_TNL_F_USE_ORIG_FWMARK)
|
|
|
fl6.flowi6_mark = skb->mark;
|
|
|
|
|
|
+ if (iptunnel_handle_offloads(skb, SKB_GSO_IPXIP6))
|
|
|
+ return -1;
|
|
|
+
|
|
|
+ skb_set_inner_ipproto(skb, IPPROTO_IPV6);
|
|
|
+
|
|
|
err = ip6_tnl_xmit(skb, dev, dsfield, &fl6, encap_limit, &mtu,
|
|
|
IPPROTO_IPV6);
|
|
|
if (err != 0) {
|
|
@@ -1280,6 +1293,7 @@ static void ip6_tnl_link_config(struct ip6_tnl *t)
|
|
|
struct net_device *dev = t->dev;
|
|
|
struct __ip6_tnl_parm *p = &t->parms;
|
|
|
struct flowi6 *fl6 = &t->fl.u.ip6;
|
|
|
+ int t_hlen;
|
|
|
|
|
|
memcpy(dev->dev_addr, &p->laddr, sizeof(struct in6_addr));
|
|
|
memcpy(dev->broadcast, &p->raddr, sizeof(struct in6_addr));
|
|
@@ -1303,6 +1317,10 @@ static void ip6_tnl_link_config(struct ip6_tnl *t)
|
|
|
else
|
|
|
dev->flags &= ~IFF_POINTOPOINT;
|
|
|
|
|
|
+ t->tun_hlen = 0;
|
|
|
+ t->hlen = t->encap_hlen + t->tun_hlen;
|
|
|
+ t_hlen = t->hlen + sizeof(struct ipv6hdr);
|
|
|
+
|
|
|
if (p->flags & IP6_TNL_F_CAP_XMIT) {
|
|
|
int strict = (ipv6_addr_type(&p->raddr) &
|
|
|
(IPV6_ADDR_MULTICAST|IPV6_ADDR_LINKLOCAL));
|
|
@@ -1316,9 +1334,9 @@ static void ip6_tnl_link_config(struct ip6_tnl *t)
|
|
|
|
|
|
if (rt->dst.dev) {
|
|
|
dev->hard_header_len = rt->dst.dev->hard_header_len +
|
|
|
- sizeof(struct ipv6hdr);
|
|
|
+ t_hlen;
|
|
|
|
|
|
- dev->mtu = rt->dst.dev->mtu - sizeof(struct ipv6hdr);
|
|
|
+ dev->mtu = rt->dst.dev->mtu - t_hlen;
|
|
|
if (!(t->parms.flags & IP6_TNL_F_IGN_ENCAP_LIMIT))
|
|
|
dev->mtu -= 8;
|
|
|
|
|
@@ -1564,6 +1582,59 @@ int ip6_tnl_get_iflink(const struct net_device *dev)
|
|
|
}
|
|
|
EXPORT_SYMBOL(ip6_tnl_get_iflink);
|
|
|
|
|
|
+int ip6_tnl_encap_add_ops(const struct ip6_tnl_encap_ops *ops,
|
|
|
+ unsigned int num)
|
|
|
+{
|
|
|
+ if (num >= MAX_IPTUN_ENCAP_OPS)
|
|
|
+ return -ERANGE;
|
|
|
+
|
|
|
+ return !cmpxchg((const struct ip6_tnl_encap_ops **)
|
|
|
+ &ip6tun_encaps[num],
|
|
|
+ NULL, ops) ? 0 : -1;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(ip6_tnl_encap_add_ops);
|
|
|
+
|
|
|
+int ip6_tnl_encap_del_ops(const struct ip6_tnl_encap_ops *ops,
|
|
|
+ unsigned int num)
|
|
|
+{
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ if (num >= MAX_IPTUN_ENCAP_OPS)
|
|
|
+ return -ERANGE;
|
|
|
+
|
|
|
+ ret = (cmpxchg((const struct ip6_tnl_encap_ops **)
|
|
|
+ &ip6tun_encaps[num],
|
|
|
+ ops, NULL) == ops) ? 0 : -1;
|
|
|
+
|
|
|
+ synchronize_net();
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(ip6_tnl_encap_del_ops);
|
|
|
+
|
|
|
+int ip6_tnl_encap_setup(struct ip6_tnl *t,
|
|
|
+ struct ip_tunnel_encap *ipencap)
|
|
|
+{
|
|
|
+ int hlen;
|
|
|
+
|
|
|
+ memset(&t->encap, 0, sizeof(t->encap));
|
|
|
+
|
|
|
+ hlen = ip6_encap_hlen(ipencap);
|
|
|
+ if (hlen < 0)
|
|
|
+ return hlen;
|
|
|
+
|
|
|
+ t->encap.type = ipencap->type;
|
|
|
+ t->encap.sport = ipencap->sport;
|
|
|
+ t->encap.dport = ipencap->dport;
|
|
|
+ t->encap.flags = ipencap->flags;
|
|
|
+
|
|
|
+ t->encap_hlen = hlen;
|
|
|
+ t->hlen = t->encap_hlen + t->tun_hlen;
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL_GPL(ip6_tnl_encap_setup);
|
|
|
+
|
|
|
static const struct net_device_ops ip6_tnl_netdev_ops = {
|
|
|
.ndo_init = ip6_tnl_dev_init,
|
|
|
.ndo_uninit = ip6_tnl_dev_uninit,
|
|
@@ -1574,6 +1645,11 @@ static const struct net_device_ops ip6_tnl_netdev_ops = {
|
|
|
.ndo_get_iflink = ip6_tnl_get_iflink,
|
|
|
};
|
|
|
|
|
|
+#define IPXIPX_FEATURES (NETIF_F_SG | \
|
|
|
+ NETIF_F_FRAGLIST | \
|
|
|
+ NETIF_F_HIGHDMA | \
|
|
|
+ NETIF_F_GSO_SOFTWARE | \
|
|
|
+ NETIF_F_HW_CSUM)
|
|
|
|
|
|
/**
|
|
|
* ip6_tnl_dev_setup - setup virtual tunnel device
|
|
@@ -1585,20 +1661,18 @@ static const struct net_device_ops ip6_tnl_netdev_ops = {
|
|
|
|
|
|
static void ip6_tnl_dev_setup(struct net_device *dev)
|
|
|
{
|
|
|
- struct ip6_tnl *t;
|
|
|
-
|
|
|
dev->netdev_ops = &ip6_tnl_netdev_ops;
|
|
|
dev->destructor = ip6_dev_free;
|
|
|
|
|
|
dev->type = ARPHRD_TUNNEL6;
|
|
|
- dev->hard_header_len = LL_MAX_HEADER + sizeof(struct ipv6hdr);
|
|
|
- dev->mtu = ETH_DATA_LEN - sizeof(struct ipv6hdr);
|
|
|
- t = netdev_priv(dev);
|
|
|
- if (!(t->parms.flags & IP6_TNL_F_IGN_ENCAP_LIMIT))
|
|
|
- dev->mtu -= 8;
|
|
|
dev->flags |= IFF_NOARP;
|
|
|
dev->addr_len = sizeof(struct in6_addr);
|
|
|
+ dev->features |= NETIF_F_LLTX;
|
|
|
netif_keep_dst(dev);
|
|
|
+
|
|
|
+ dev->features |= IPXIPX_FEATURES;
|
|
|
+ dev->hw_features |= IPXIPX_FEATURES;
|
|
|
+
|
|
|
/* This perm addr will be used as interface identifier by IPv6 */
|
|
|
dev->addr_assign_type = NET_ADDR_RANDOM;
|
|
|
eth_random_addr(dev->perm_addr);
|
|
@@ -1615,6 +1689,7 @@ ip6_tnl_dev_init_gen(struct net_device *dev)
|
|
|
{
|
|
|
struct ip6_tnl *t = netdev_priv(dev);
|
|
|
int ret;
|
|
|
+ int t_hlen;
|
|
|
|
|
|
t->dev = dev;
|
|
|
t->net = dev_net(dev);
|
|
@@ -1630,8 +1705,15 @@ ip6_tnl_dev_init_gen(struct net_device *dev)
|
|
|
if (ret)
|
|
|
goto destroy_dst;
|
|
|
|
|
|
- t->hlen = 0;
|
|
|
t->tun_hlen = 0;
|
|
|
+ t->hlen = t->encap_hlen + t->tun_hlen;
|
|
|
+ t_hlen = t->hlen + sizeof(struct ipv6hdr);
|
|
|
+
|
|
|
+ dev->type = ARPHRD_TUNNEL6;
|
|
|
+ dev->hard_header_len = LL_MAX_HEADER + t_hlen;
|
|
|
+ dev->mtu = ETH_DATA_LEN - t_hlen;
|
|
|
+ if (!(t->parms.flags & IP6_TNL_F_IGN_ENCAP_LIMIT))
|
|
|
+ dev->mtu -= 8;
|
|
|
|
|
|
return 0;
|
|
|
|
|
@@ -1729,13 +1811,55 @@ static void ip6_tnl_netlink_parms(struct nlattr *data[],
|
|
|
parms->proto = nla_get_u8(data[IFLA_IPTUN_PROTO]);
|
|
|
}
|
|
|
|
|
|
+static bool ip6_tnl_netlink_encap_parms(struct nlattr *data[],
|
|
|
+ struct ip_tunnel_encap *ipencap)
|
|
|
+{
|
|
|
+ bool ret = false;
|
|
|
+
|
|
|
+ memset(ipencap, 0, sizeof(*ipencap));
|
|
|
+
|
|
|
+ if (!data)
|
|
|
+ return ret;
|
|
|
+
|
|
|
+ if (data[IFLA_IPTUN_ENCAP_TYPE]) {
|
|
|
+ ret = true;
|
|
|
+ ipencap->type = nla_get_u16(data[IFLA_IPTUN_ENCAP_TYPE]);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (data[IFLA_IPTUN_ENCAP_FLAGS]) {
|
|
|
+ ret = true;
|
|
|
+ ipencap->flags = nla_get_u16(data[IFLA_IPTUN_ENCAP_FLAGS]);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (data[IFLA_IPTUN_ENCAP_SPORT]) {
|
|
|
+ ret = true;
|
|
|
+ ipencap->sport = nla_get_be16(data[IFLA_IPTUN_ENCAP_SPORT]);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (data[IFLA_IPTUN_ENCAP_DPORT]) {
|
|
|
+ ret = true;
|
|
|
+ ipencap->dport = nla_get_be16(data[IFLA_IPTUN_ENCAP_DPORT]);
|
|
|
+ }
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
static int ip6_tnl_newlink(struct net *src_net, struct net_device *dev,
|
|
|
struct nlattr *tb[], struct nlattr *data[])
|
|
|
{
|
|
|
struct net *net = dev_net(dev);
|
|
|
struct ip6_tnl *nt, *t;
|
|
|
+ struct ip_tunnel_encap ipencap;
|
|
|
|
|
|
nt = netdev_priv(dev);
|
|
|
+
|
|
|
+ if (ip6_tnl_netlink_encap_parms(data, &ipencap)) {
|
|
|
+ int err = ip6_tnl_encap_setup(nt, &ipencap);
|
|
|
+
|
|
|
+ if (err < 0)
|
|
|
+ return err;
|
|
|
+ }
|
|
|
+
|
|
|
ip6_tnl_netlink_parms(data, &nt->parms);
|
|
|
|
|
|
t = ip6_tnl_locate(net, &nt->parms, 0);
|
|
@@ -1752,10 +1876,17 @@ static int ip6_tnl_changelink(struct net_device *dev, struct nlattr *tb[],
|
|
|
struct __ip6_tnl_parm p;
|
|
|
struct net *net = t->net;
|
|
|
struct ip6_tnl_net *ip6n = net_generic(net, ip6_tnl_net_id);
|
|
|
+ struct ip_tunnel_encap ipencap;
|
|
|
|
|
|
if (dev == ip6n->fb_tnl_dev)
|
|
|
return -EINVAL;
|
|
|
|
|
|
+ if (ip6_tnl_netlink_encap_parms(data, &ipencap)) {
|
|
|
+ int err = ip6_tnl_encap_setup(t, &ipencap);
|
|
|
+
|
|
|
+ if (err < 0)
|
|
|
+ return err;
|
|
|
+ }
|
|
|
ip6_tnl_netlink_parms(data, &p);
|
|
|
|
|
|
t = ip6_tnl_locate(net, &p, 0);
|
|
@@ -1796,6 +1927,14 @@ static size_t ip6_tnl_get_size(const struct net_device *dev)
|
|
|
nla_total_size(4) +
|
|
|
/* IFLA_IPTUN_PROTO */
|
|
|
nla_total_size(1) +
|
|
|
+ /* IFLA_IPTUN_ENCAP_TYPE */
|
|
|
+ nla_total_size(2) +
|
|
|
+ /* IFLA_IPTUN_ENCAP_FLAGS */
|
|
|
+ nla_total_size(2) +
|
|
|
+ /* IFLA_IPTUN_ENCAP_SPORT */
|
|
|
+ nla_total_size(2) +
|
|
|
+ /* IFLA_IPTUN_ENCAP_DPORT */
|
|
|
+ nla_total_size(2) +
|
|
|
0;
|
|
|
}
|
|
|
|
|
@@ -1813,6 +1952,17 @@ static int ip6_tnl_fill_info(struct sk_buff *skb, const struct net_device *dev)
|
|
|
nla_put_u32(skb, IFLA_IPTUN_FLAGS, parm->flags) ||
|
|
|
nla_put_u8(skb, IFLA_IPTUN_PROTO, parm->proto))
|
|
|
goto nla_put_failure;
|
|
|
+
|
|
|
+ if (nla_put_u16(skb, IFLA_IPTUN_ENCAP_TYPE,
|
|
|
+ tunnel->encap.type) ||
|
|
|
+ nla_put_be16(skb, IFLA_IPTUN_ENCAP_SPORT,
|
|
|
+ tunnel->encap.sport) ||
|
|
|
+ nla_put_be16(skb, IFLA_IPTUN_ENCAP_DPORT,
|
|
|
+ tunnel->encap.dport) ||
|
|
|
+ nla_put_u16(skb, IFLA_IPTUN_ENCAP_FLAGS,
|
|
|
+ tunnel->encap.flags))
|
|
|
+ goto nla_put_failure;
|
|
|
+
|
|
|
return 0;
|
|
|
|
|
|
nla_put_failure:
|
|
@@ -1836,6 +1986,10 @@ static const struct nla_policy ip6_tnl_policy[IFLA_IPTUN_MAX + 1] = {
|
|
|
[IFLA_IPTUN_FLOWINFO] = { .type = NLA_U32 },
|
|
|
[IFLA_IPTUN_FLAGS] = { .type = NLA_U32 },
|
|
|
[IFLA_IPTUN_PROTO] = { .type = NLA_U8 },
|
|
|
+ [IFLA_IPTUN_ENCAP_TYPE] = { .type = NLA_U16 },
|
|
|
+ [IFLA_IPTUN_ENCAP_FLAGS] = { .type = NLA_U16 },
|
|
|
+ [IFLA_IPTUN_ENCAP_SPORT] = { .type = NLA_U16 },
|
|
|
+ [IFLA_IPTUN_ENCAP_DPORT] = { .type = NLA_U16 },
|
|
|
};
|
|
|
|
|
|
static struct rtnl_link_ops ip6_link_ops __read_mostly = {
|