lists.openwall.net   lists  /  announce  owl-users  owl-dev  john-users  john-dev  passwdqc-users  yescrypt  popa3d-users  /  oss-security  kernel-hardening  musl  sabotage  tlsify  passwords  /  crypt-dev  xvendor  /  Bugtraq  Full-Disclosure  linux-kernel  linux-netdev  linux-ext4  linux-hardening  linux-cve-announce  PHC 
Open Source and information security mailing list archives
 
Hash Suite: Windows password security audit tool. GUI, reports in PDF.
[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Date:	Mon, 16 Jul 2007 09:56:59 -0300
From:	"Arnaldo Carvalho de Melo" <acme@...stprotocols.net>
To:	"Joakim Koskela" <joakim.koskela@...t.fi>
Cc:	netdev@...r.kernel.org, "David Miller" <davem@...emloft.net>
Subject: Re: [PATCH net-2.6.22-rc7] xfrm beet interfamily support

On 7/16/07, Joakim Koskela <joakim.koskela@...t.fi> wrote:
> Hi all,
>
> Here's again a cleaned-up and corrected version of the patch adding
> support for ipv4/ipv6 interfamily addressing for the ipsec BEET (Bound
> End-to-End Tunnel) mode, as specified by the ietf draft found at:
>
> http://www.ietf.org/internet-drafts/draft-nikander-esp-beet-mode-07.txt
>
> The previous implementation required that both address pairs in the SA
> were of the same family. This patch enables mixing ipv4 and ipv6
> addresses. All combinations (4-4, 4-6, 6-4, 6-6) have been tested
> using manual key setups.
>
> Signed-off-by: Joakim Koskela <jookos@...il.com>
> Signed-off-by: Herbert Xu     <herbert@...dor.apana.org.au>
> Signed-off-by: Diego Beltrami <diego.beltrami@...il.com>
> Signed-off-by: Miika Komu     <miika@....fi>
> ---
>
> diff --git a/net/ipv4/xfrm4_input.c b/net/ipv4/xfrm4_input.c
> index fa1902d..7a39f4c 100644
> --- a/net/ipv4/xfrm4_input.c
> +++ b/net/ipv4/xfrm4_input.c
> @@ -108,7 +108,8 @@ int xfrm4_rcv_encap(struct sk_buff *skb, __u16 encap_type)
>                 if (x->mode->input(x, skb))
>                         goto drop;
>
> -               if (x->props.mode == XFRM_MODE_TUNNEL) {
> +               if (x->props.mode == XFRM_MODE_TUNNEL ||
> +                   x->props.mode == XFRM_MODE_BEET) {
>                         decaps = 1;
>                         break;
>                 }
> diff --git a/net/ipv4/xfrm4_mode_beet.c b/net/ipv4/xfrm4_mode_beet.c
> index a73e710..2994dc5 100644
> --- a/net/ipv4/xfrm4_mode_beet.c
> +++ b/net/ipv4/xfrm4_mode_beet.c
> @@ -6,6 +6,7 @@
>   *                    Herbert Xu     <herbert@...dor.apana.org.au>
>   *                    Abhinav Pathak <abhinav.pathak@...t.fi>
>   *                    Jeff Ahrenholz <ahrenholz@...il.com>
> + *                    Joakim Koskela <jookos@...il.com>
>   */
>
>  #include <linux/init.h>
> @@ -29,86 +30,176 @@
>   */
>  static int xfrm4_beet_output(struct xfrm_state *x, struct sk_buff *skb)
>  {
> -       struct iphdr *iph, *top_iph;
> -       int hdrlen, optlen;
> -
> -       iph = ip_hdr(skb);
> -       skb->transport_header = skb->network_header;
> -
> -       hdrlen = 0;
> -       optlen = iph->ihl * 4 - sizeof(*iph);
> -       if (unlikely(optlen))
> -               hdrlen += IPV4_BEET_PHMAXLEN - (optlen & 4);
> -
> -       skb_push(skb, x->props.header_len - IPV4_BEET_PHMAXLEN + hdrlen);
> -       skb_reset_network_header(skb);
> -       top_iph = ip_hdr(skb);
> -       skb->transport_header += sizeof(*iph) - hdrlen;
> -
> -       memmove(top_iph, iph, sizeof(*iph));
> -       if (unlikely(optlen)) {
> -               struct ip_beet_phdr *ph;
> -
> -               BUG_ON(optlen < 0);
> -
> -               ph = (struct ip_beet_phdr *)skb_transport_header(skb);
> -               ph->padlen = 4 - (optlen & 4);
> -               ph->hdrlen = optlen / 8;
> -               ph->nexthdr = top_iph->protocol;
> -               if (ph->padlen)
> -                       memset(ph + 1, IPOPT_NOP, ph->padlen);
> -
> -               top_iph->protocol = IPPROTO_BEETPH;
> -               top_iph->ihl = sizeof(struct iphdr) / 4;
> +#if defined(CONFIG_IPV6) || defined (CONFIG_IPV6_MODULE)
> +       struct ipv6hdr *iphv6, *top_iphv6;
> +#endif
> +       struct dst_entry *dst = skb->dst;
> +       struct iphdr *iphv4, *top_iphv4;
> +       int hdrlen;
> +
> +       if (ip_hdr(skb)->version == 4) {
> +               int optlen;
> +
> +               /* 4-4 */
> +               iphv4 = ip_hdr(skb);
> +               skb_set_transport_header(skb, skb_network_offset(skb));

Sorry for not commented that the code you were using (and David said
it was invalid) is in fact valid:

            skb->transport_header = skb->network_header;

This works for both offsets and pointers, i.e. both transport_header
and network_header are in the same "address space".


             skb_set_transport_header(skb, skb_network_offset(skb));

Also works, but its too convoluted IMHO, for pointers it would reduce to:

              skb->transport_header = skb->data + skb->network_header
- skb->data;

for offsets:

              skb->transport_header = skb->data - skb->head;
              skb->transport_header += skb->head + skb->network_header
- skb->data;

I.e. both reduce to:

               skb->transport_header = skb->network_header;

Some more comments below, but I think this time, sans the above
possible cleanup, your patch is OK wrt offsets/pointers.

- Arnaldo

> +
> +               hdrlen = x->props.header_len;
> +               optlen = iphv4->ihl * 4 - sizeof(*iphv4);
> +               if (!optlen) {
> +                       hdrlen -= IPV4_BEET_PHMAXLEN;
> +               } else {
> +                       skb->transport_header -=
> +                               (IPV4_BEET_PHMAXLEN - (optlen & 4));
> +                       hdrlen -= optlen & 4;
> +               }
> +
> +               skb_push(skb, hdrlen);
> +               skb_reset_network_header(skb);
> +
> +               top_iphv4 = ip_hdr(skb);
> +               hdrlen = iphv4->ihl * 4 - optlen;
> +               skb->transport_header += hdrlen;
> +               memmove(top_iphv4, iphv4, hdrlen);
> +
> +               if (unlikely(optlen)) {
> +                       struct ip_beet_phdr *ph;
> +
> +                       BUG_ON(optlen < 0);
> +
> +                       ph = (struct ip_beet_phdr *)skb_transport_header(skb);
> +                       ph->padlen = 4 - (optlen & 4);
> +                       ph->hdrlen = (optlen + ph->padlen + sizeof(*ph)) / 8;
> +                       ph->nexthdr = iphv4->protocol;
> +                       top_iphv4->protocol = IPPROTO_BEETPH;
> +                       top_iphv4->ihl = sizeof(struct iphdr) / 4;
> +               }
> +
> +               top_iphv4->saddr = x->props.saddr.a4;
> +               top_iphv4->daddr = x->id.daddr.a4;
> +
> +               skb->protocol = htons(ETH_P_IP);
> +       } else if (ip_hdr(skb)->version == 6) {
> +#if defined(CONFIG_IPV6) || defined (CONFIG_IPV6_MODULE)
> +               int delta = sizeof(struct ipv6hdr) - sizeof(struct iphdr);
> +               u8 protocol;
> +
> +               /* Inner = 6, Outer = 4 : changing the external IP hdr
> +                * to the outer addresses
> +                */
> +               hdrlen = x->props.header_len - IPV4_BEET_PHMAXLEN;
> +               skb_push(skb, hdrlen);
> +               iphv6 = ipv6_hdr(skb);
> +
> +               skb_reset_network_header(skb);
> +               top_iphv6 = ipv6_hdr(skb);
> +
> +               protocol = iphv6->nexthdr;
> +               skb_pull(skb, delta);
> +               skb_reset_network_header(skb);
> +               top_iphv4 = ip_hdr(skb);
> +               skb_set_transport_header(skb, hdrlen);
> +               top_iphv4->ihl = (sizeof(struct iphdr) >> 2);
> +               top_iphv4->version = 4;
> +               top_iphv4->id = 0;
> +               top_iphv4->frag_off = htons(IP_DF);
> +               top_iphv4->ttl = dst_metric(dst->child, RTAX_HOPLIMIT);
> +               top_iphv4->saddr = x->props.saddr.a4;
> +               top_iphv4->daddr = x->id.daddr.a4;
> +               skb->transport_header += top_iphv4->ihl*4;
> +               top_iphv4->protocol = protocol;
> +
> +               skb->protocol = htons(ETH_P_IP);
> +#endif
>         }
>
> -       top_iph->saddr = x->props.saddr.a4;
> -       top_iph->daddr = x->id.daddr.a4;
> -
>         return 0;
>  }
>
>  static int xfrm4_beet_input(struct xfrm_state *x, struct sk_buff *skb)
>  {
>         struct iphdr *iph = ip_hdr(skb);
> +       int hops = iph->ttl;
>         int phlen = 0;
>         int optlen = 0;
> -       u8 ph_nexthdr = 0;
> +#if defined(CONFIG_IPV6) || defined (CONFIG_IPV6_MODULE)
> +       int size = ((x->sel.family == AF_INET) ?
> +                   sizeof(struct iphdr) :
> +                   sizeof(struct ipv6hdr));
> +       int delta = sizeof(struct ipv6hdr) - sizeof(struct iphdr);
> +#else
> +       int size = sizeof(struct iphdr);
> +#endif
> +       __u8 ph_nexthdr = 0, protocol = 0;
>         int err = -EINVAL;
>
> -       if (unlikely(iph->protocol == IPPROTO_BEETPH)) {
> -               struct ip_beet_phdr *ph;
> -
> -               if (!pskb_may_pull(skb, sizeof(*ph)))
> -                       goto out;
> -               ph = (struct ip_beet_phdr *)(ipip_hdr(skb) + 1);
> -
> -               phlen = sizeof(*ph) + ph->padlen;
> -               optlen = ph->hdrlen * 8 + (IPV4_BEET_PHMAXLEN - phlen);
> -               if (optlen < 0 || optlen & 3 || optlen > 250)
> -                       goto out;
> +       protocol = iph->protocol;
> +       if (x->sel.family == AF_INET) {
> +               if (unlikely(iph->protocol == IPPROTO_BEETPH)) {
> +                       struct ip_beet_phdr *ph =
> +                               (struct ip_beet_phdr*)(iph + 1);
> +
> +                       if (!pskb_may_pull(skb, sizeof(*ph)))
> +                               goto out;
> +
> +                       phlen = ph->hdrlen * 8;
> +                       optlen = phlen - ph->padlen - sizeof(*ph);
> +                       if (optlen < 0 || optlen & 3 || optlen > 250)
> +                               goto out;
> +
> +                       if (!pskb_may_pull(skb, phlen))
> +                               goto out;
> +
> +                       ph_nexthdr = ph->nexthdr;
> +               }
> +       } else if (x->sel.family == AF_INET6) {
> +#if defined(CONFIG_IPV6) || defined (CONFIG_IPV6_MODULE)
> +               /* Here, the inner family is 6, therefore I have to
> +                * substitute the IPhdr by enlarging it.
> +                */
> +               if (skb_tailroom(skb) < delta) {
> +                       if (pskb_expand_head(skb, 0, delta, GFP_ATOMIC))
> +                               goto out;
> +               }
> +
> +               skb->network_header -= delta;
> +#endif
> +       }
>
> -               if (!pskb_may_pull(skb, phlen + optlen))
> -                       goto out;
> -               skb->len -= phlen + optlen;
> +       size += (optlen - phlen);
> +       skb_push(skb, size);
> +       memmove(skb->data, skb_network_header(skb), sizeof(*iph));

Great, now its OK, skb->data still is a pointer, but
skb->network_header can be an offset.

> +       skb_reset_network_header(skb);
>
> -               ph_nexthdr = ph->nexthdr;
> +       if (x->sel.family == AF_INET) {
> +               iph = ip_hdr(skb);
> +               iph->ihl = (sizeof(*iph) + optlen) / 4;
> +               iph->tot_len = htons(skb->len);
> +               iph->daddr = x->sel.daddr.a4;
> +               iph->saddr = x->sel.saddr.a4;
> +               if (ph_nexthdr)
> +                       iph->protocol = ph_nexthdr;
> +               else
> +                       iph->protocol = protocol;
> +               iph->check = 0;
> +               iph->check = ip_fast_csum(skb_network_header(skb), iph->ihl);
> +       } else if (x->sel.family == AF_INET6) {
> +#if defined(CONFIG_IPV6) || defined (CONFIG_IPV6_MODULE)
> +               struct ipv6hdr *ip6h = ipv6_hdr(skb);
> +
> +               memset(ip6h->flow_lbl, 0, sizeof(ip6h->flow_lbl));
> +               ip6h->version = 6;
> +               ip6h->priority = 0;
> +               ip6h->nexthdr = protocol;
> +               ip6h->hop_limit = hops;
> +               ip6h->payload_len = htons(skb->len - size);
> +               ipv6_addr_copy(&ip6h->daddr,
> +                              (struct in6_addr *)&x->sel.daddr.a6);
> +               ipv6_addr_copy(&ip6h->saddr,
> +                              (struct in6_addr *)&x->sel.saddr.a6);
> +               skb->protocol = htons(ETH_P_IPV6);
> +#endif
>         }
> -
> -       skb_set_network_header(skb, phlen - sizeof(*iph));
> -       memmove(skb_network_header(skb), iph, sizeof(*iph));
> -       skb_set_transport_header(skb, phlen + optlen);
> -       skb->data = skb_transport_header(skb);
> -
> -       iph = ip_hdr(skb);
> -       iph->ihl = (sizeof(*iph) + optlen) / 4;
> -       iph->tot_len = htons(skb->len + iph->ihl * 4);
> -       iph->daddr = x->sel.daddr.a4;
> -       iph->saddr = x->sel.saddr.a4;
> -       if (ph_nexthdr)
> -               iph->protocol = ph_nexthdr;
> -       iph->check = 0;
> -       iph->check = ip_fast_csum(skb_network_header(skb), iph->ihl);
>         err = 0;
>  out:
>         return err;
> diff --git a/net/ipv4/xfrm4_output.c b/net/ipv4/xfrm4_output.c
> index 44ef208..8db7910 100644
> --- a/net/ipv4/xfrm4_output.c
> +++ b/net/ipv4/xfrm4_output.c
> @@ -53,7 +53,8 @@ static int xfrm4_output_one(struct sk_buff *skb)
>                         goto error_nolock;
>         }
>
> -       if (x->props.mode == XFRM_MODE_TUNNEL) {
> +       if (x->props.mode == XFRM_MODE_TUNNEL ||
> +           x->props.mode == XFRM_MODE_BEET) {
>                 err = xfrm4_tunnel_check_size(skb);
>                 if (err)
>                         goto error_nolock;
> diff --git a/net/ipv4/xfrm4_policy.c b/net/ipv4/xfrm4_policy.c
> index 4ff8ed3..d761e30 100644
> --- a/net/ipv4/xfrm4_policy.c
> +++ b/net/ipv4/xfrm4_policy.c
> @@ -15,6 +15,7 @@
>
>  static struct dst_ops xfrm4_dst_ops;
>  static struct xfrm_policy_afinfo xfrm4_policy_afinfo;
> +static void xfrm4_update_pmtu(struct dst_entry *dst, u32 mtu);
>
>  static int xfrm4_dst_lookup(struct xfrm_dst **dst, struct flowi *fl)
>  {
> @@ -81,10 +82,15 @@ __xfrm4_bundle_create(struct xfrm_policy *policy, struct xfrm_state **xfrm, int
>                         }
>                 }
>         };
> +       union {
> +               struct in6_addr *in6;
> +               struct in_addr *in;
> +       } remote, local;
>         int i;
>         int err;
>         int header_len = 0;
>         int trailer_len = 0;
> +       unsigned short encap_family = 0;
>
>         dst = dst_prev = NULL;
>         dst_hold(&rt->u.dst);
> @@ -113,12 +119,24 @@ __xfrm4_bundle_create(struct xfrm_policy *policy, struct xfrm_state **xfrm, int
>
>                 dst1->next = dst_prev;
>                 dst_prev = dst1;
> -
> +               if (xfrm[i]->props.mode != XFRM_MODE_TRANSPORT) {
> +                       encap_family = xfrm[i]->props.family;
> +                       if (encap_family == AF_INET) {
> +                               remote.in = (struct in_addr *)
> +                                       &xfrm[i]->id.daddr.a4;
> +                               local.in  = (struct in_addr *)
> +                                       &xfrm[i]->props.saddr.a4;
> +                       } else if (encap_family == AF_INET6) {
> +                               remote.in6 = (struct in6_addr *)
> +                                       xfrm[i]->id.daddr.a6;
> +                               local.in6 = (struct in6_addr *)
> +                                       xfrm[i]->props.saddr.a6;
> +                       }
> +               }
>                 header_len += xfrm[i]->props.header_len;
>                 trailer_len += xfrm[i]->props.trailer_len;
>
> -               if (xfrm[i]->props.mode == XFRM_MODE_TUNNEL) {
> -                       unsigned short encap_family = xfrm[i]->props.family;
> +               if (encap_family) {
>                         switch (encap_family) {
>                         case AF_INET:
>                                 fl_tunnel.fl4_dst = xfrm[i]->id.daddr.a4;
> @@ -198,6 +216,12 @@ __xfrm4_bundle_create(struct xfrm_policy *policy, struct xfrm_state **xfrm, int
>         }
>
>         xfrm_init_pmtu(dst);
> +       if (encap_family == AF_INET6) {
> +               /* The worst case */
> +               int delta = sizeof(struct ipv6hdr) - sizeof(struct iphdr);
> +               u32 mtu = dst_mtu(dst);
> +               xfrm4_update_pmtu(dst, mtu - delta);
> +       }
>         return 0;
>
>  error:
> diff --git a/net/ipv4/xfrm4_tunnel.c b/net/ipv4/xfrm4_tunnel.c
> index 5685103..57c2dba 100644
> --- a/net/ipv4/xfrm4_tunnel.c
> +++ b/net/ipv4/xfrm4_tunnel.c
> @@ -27,7 +27,8 @@ static int ipip_xfrm_rcv(struct xfrm_state *x, struct sk_buff *skb)
>
>  static int ipip_init_state(struct xfrm_state *x)
>  {
> -       if (x->props.mode != XFRM_MODE_TUNNEL)
> +       if (x->props.mode != XFRM_MODE_TUNNEL ||
> +           x->props.mode != XFRM_MODE_BEET)
>                 return -EINVAL;
>
>         if (x->encap)
> diff --git a/net/ipv6/esp6.c b/net/ipv6/esp6.c
> index 7107bb7..34ea5a6 100644
> --- a/net/ipv6/esp6.c
> +++ b/net/ipv6/esp6.c
> @@ -246,7 +246,8 @@ static u32 esp6_get_mtu(struct xfrm_state *x, int mtu)
>         rem = mtu & (align - 1);
>         mtu &= ~(align - 1);
>
> -       if (x->props.mode != XFRM_MODE_TUNNEL) {
> +       if (x->props.mode != XFRM_MODE_TUNNEL ||
> +           x->props.mode != XFRM_MODE_BEET) {
>                 u32 padsize = ((blksize - 1) & 7) + 1;
>                 mtu -= blksize - padsize;
>                 mtu += min_t(u32, blksize - padsize, rem);
> @@ -365,6 +366,8 @@ static int esp6_init_state(struct xfrm_state *x)
>         x->props.header_len = sizeof(struct ipv6_esp_hdr) + esp->conf.ivlen;
>         if (x->props.mode == XFRM_MODE_TUNNEL)
>                 x->props.header_len += sizeof(struct ipv6hdr);
> +       else if (x->props.mode == XFRM_MODE_BEET)
> +               x->props.header_len += IPV4_BEET_PHMAXLEN;
>         x->data = esp;
>         return 0;
>
> diff --git a/net/ipv6/xfrm6_input.c b/net/ipv6/xfrm6_input.c
> index c858537..bfb3d7b 100644
> --- a/net/ipv6/xfrm6_input.c
> +++ b/net/ipv6/xfrm6_input.c
> @@ -73,7 +73,8 @@ int xfrm6_rcv_spi(struct sk_buff *skb, __be32 spi)
>                 if (x->mode->input(x, skb))
>                         goto drop;
>
> -               if (x->props.mode == XFRM_MODE_TUNNEL) { /* XXX */
> +               if (x->props.mode == XFRM_MODE_TUNNEL ||
> +                   x->props.mode == XFRM_MODE_BEET) { /* XXX */
>                         decaps = 1;
>                         break;
>                 }
> diff --git a/net/ipv6/xfrm6_mode_beet.c b/net/ipv6/xfrm6_mode_beet.c
> index 2e61d6d..7b7afb4 100644
> --- a/net/ipv6/xfrm6_mode_beet.c
> +++ b/net/ipv6/xfrm6_mode_beet.c
> @@ -6,6 +6,7 @@
>   *                    Herbert Xu     <herbert@...dor.apana.org.au>
>   *                    Abhinav Pathak <abhinav.pathak@...t.fi>
>   *                    Jeff Ahrenholz <ahrenholz@...il.com>
> + *                    Joakim Koskela <jookos@...il.com>
>   */
>
>  #include <linux/init.h>
> @@ -17,6 +18,7 @@
>  #include <net/dst.h>
>  #include <net/inet_ecn.h>
>  #include <net/ipv6.h>
> +#include <net/ip.h>
>  #include <net/xfrm.h>
>
>  /* Add encapsulation header.
> @@ -33,38 +35,157 @@
>   */
>  static int xfrm6_beet_output(struct xfrm_state *x, struct sk_buff *skb)
>  {
> -       struct ipv6hdr *iph, *top_iph;
> -       u8 *prevhdr;
> -       int hdr_len;
> +       struct dst_entry *dst = skb->dst;
> +       struct iphdr *iphv4, *top_iphv4;
> +       struct ipv6hdr *iphv6, *top_iphv6;
> +       int hdrlen;
>
> -       skb_push(skb, x->props.header_len);
> -       iph = ipv6_hdr(skb);
> +       if (ip_hdr(skb)->version == 6) {
> +               u8 *prevhdr;
> +               int hdr_len;
>
> -       hdr_len = ip6_find_1stfragopt(skb, &prevhdr);
> -       skb_set_network_header(skb,
> -                              (prevhdr - x->props.header_len) - skb->data);
> -       skb_set_transport_header(skb, hdr_len);
> -       memmove(skb->data, iph, hdr_len);
> +               /* 6-6 */
> +               hdrlen = x->props.header_len - IPV4_BEET_PHMAXLEN;
> +               skb_push(skb, hdrlen);
> +               iphv6 = ipv6_hdr(skb);
>
> -       skb_reset_network_header(skb);
> -       top_iph = ipv6_hdr(skb);
> -       skb->transport_header = skb->network_header + sizeof(struct ipv6hdr);
> -       skb->network_header += offsetof(struct ipv6hdr, nexthdr);
> +               hdr_len = ip6_find_1stfragopt(skb, &prevhdr);
> +               skb->network_header = prevhdr - hdrlen;
> +               skb_set_transport_header(skb, hdr_len);
> +               memmove(skb->data, iphv6, hdr_len);
> +
> +               skb_reset_network_header(skb);
> +               top_iphv6 = ipv6_hdr(skb);
> +               skb_set_transport_header(skb, sizeof(struct ipv6hdr));
> +               skb->network_header += offsetof(struct ipv6hdr, nexthdr);
> +
> +               ipv6_addr_copy(&top_iphv6->saddr,
> +                              (struct in6_addr *) &x->props.saddr);
> +               ipv6_addr_copy(&top_iphv6->daddr,
> +                              (struct in6_addr *) &x->id.daddr);
> +
> +               skb->protocol = htons(ETH_P_IPV6);
> +       } else if (ip_hdr(skb)->version == 4) {
> +               int delta = sizeof(struct ipv6hdr) - sizeof(struct iphdr);
> +               int flags, optlen, dsfield;
> +               u8 protocol;
> +
> +               /* Inner = 4, Outer = 6*/
> +               iphv4 = ip_hdr(skb);
> +               skb_set_transport_header(skb, skb_network_offset(skb));
> +
> +               hdrlen = x->props.header_len;
> +               optlen = iphv4->ihl * 4 - sizeof(*iphv4);
> +
> +               if (!optlen) {
> +                       hdrlen -= IPV4_BEET_PHMAXLEN;
> +               } else {
> +                       skb->transport_header -=
> +                               (IPV4_BEET_PHMAXLEN - (optlen & 4));
> +                       hdrlen -= optlen & 4;
> +               }
> +
> +               skb_push(skb, hdrlen);
> +               skb_reset_network_header(skb);
> +
> +               top_iphv4 = ip_hdr(skb);
> +               hdrlen = iphv4->ihl * 4 - optlen;
> +               skb->transport_header += hdrlen;
> +               if (unlikely(optlen)) {
> +                       struct ip_beet_phdr *ph;
> +
> +                       BUG_ON(optlen < 0);
> +                       ph = (struct ip_beet_phdr *) skb_transport_header(skb);
> +                       ph->padlen = 4 - (optlen & 4);
> +                       ph->hdrlen = (optlen + ph->padlen + sizeof(*ph)) / 8;
> +                       ph->nexthdr = iphv4->protocol;
> +                       top_iphv4->protocol = IPPROTO_BEETPH;
> +                       top_iphv4->ihl = sizeof(struct iphdr) / 4;
> +               }
> +
> +               if (unlikely(optlen))
> +                       protocol = top_iphv4->protocol;
> +               else
> +                       protocol = iphv4->protocol;
>
> -       ipv6_addr_copy(&top_iph->saddr, (struct in6_addr *)&x->props.saddr);
> -       ipv6_addr_copy(&top_iph->daddr, (struct in6_addr *)&x->id.daddr);
> +               if (skb_headroom(skb) <=  2*delta){
> +                       if (pskb_expand_head(skb, delta,0, GFP_ATOMIC))
> +                               return -ENOMEM;
> +               }
> +
> +               skb_push(skb, delta);
> +               skb_reset_network_header(skb);
> +
> +               top_iphv6 = ipv6_hdr(skb);
> +               skb_set_transport_header(skb, sizeof(struct ipv6hdr));
> +
> +               /* DS disclosed */
> +               top_iphv6->version = 6;
> +               top_iphv6->priority = 0;
> +               top_iphv6->flow_lbl[0] = 0;
> +               top_iphv6->flow_lbl[1] = 0;
> +               top_iphv6->flow_lbl[2] = 0;
> +               dsfield = ipv6_get_dsfield(top_iphv6);
> +               dsfield = INET_ECN_encapsulate(dsfield, dsfield);
> +               flags = x->props.flags;
> +               if (flags & XFRM_STATE_NOECN)
> +                       dsfield &= ~INET_ECN_MASK;
> +               ipv6_change_dsfield(top_iphv6, 0, dsfield);
> +
> +               top_iphv6->nexthdr = protocol;
> +               top_iphv6->hop_limit = dst_metric(dst->child, RTAX_HOPLIMIT);
> +               top_iphv6->payload_len = htons(skb->len -
> +                                              sizeof(struct ipv6hdr));
> +               ipv6_addr_copy(&top_iphv6->saddr,
> +                              (struct in6_addr *) &x->props.saddr);
> +               ipv6_addr_copy(&top_iphv6->daddr,
> +                              (struct in6_addr *) &x->id.daddr);
> +
> +               skb->network_header += offsetof(struct ipv6hdr, nexthdr);
> +
> +               skb->protocol = htons(ETH_P_IPV6);
> +       }
>
>         return 0;
>  }
>
>  static int xfrm6_beet_input(struct xfrm_state *x, struct sk_buff *skb)
>  {
> -       struct ipv6hdr *ip6h;
> +       struct ip_beet_phdr *ph = (struct ip_beet_phdr *)
> +               skb_transport_header(skb);
> +       int size = ((x->sel.family == AF_INET) ?
> +                   sizeof(struct iphdr) :
> +                   sizeof(struct ipv6hdr));
> +       int delta = sizeof(struct ipv6hdr) - sizeof(struct iphdr);
> +       __u8 proto = ipv6_hdr(skb)->nexthdr;
> +       __u8 hops = ipv6_hdr(skb)->hop_limit;
>         const unsigned char *old_mac;
> -       int size = sizeof(struct ipv6hdr);
> +       __u8 ph_nexthdr = 0;
> +       int phlen = 0;
> +       int optlen = 0;
>         int err = -EINVAL;
>
> -       if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
> +       if (x->sel.family == AF_INET) {
> +               /* Inner = IPv4, therefore the IPhdr must be shrunk */
> +               /* Inner = 4, Outer = 6 */
> +               if (unlikely(proto == IPPROTO_BEETPH)) {
> +                       if (!pskb_may_pull(skb, sizeof(*ph)))
> +                               goto out;
> +                       phlen = ph->hdrlen * 8;
> +                       optlen = phlen - ph->padlen - sizeof(*ph);
> +
> +                       if (optlen < 0 || optlen & 3 || optlen > 250)
> +                               goto out;
> +                       if (!pskb_may_pull(skb, phlen))
> +                               goto out;
> +
> +                       proto = ph_nexthdr = ph->nexthdr;
> +               }
> +               skb->network_header += delta;
> +       }
> +
> +       if (skb_cloned(skb) &&
> +           pskb_expand_head(skb, 0, 0, GFP_ATOMIC))
>                 goto out;
>
>         skb_push(skb, size);
> @@ -75,10 +196,38 @@ static int xfrm6_beet_input(struct xfrm_state *x, struct sk_buff *skb)
>         skb_set_mac_header(skb, -skb->mac_len);
>         memmove(skb_mac_header(skb), old_mac, skb->mac_len);
>
> -       ip6h = ipv6_hdr(skb);
> -       ip6h->payload_len = htons(skb->len - size);
> -       ipv6_addr_copy(&ip6h->daddr, (struct in6_addr *) &x->sel.daddr.a6);
> -       ipv6_addr_copy(&ip6h->saddr, (struct in6_addr *) &x->sel.saddr.a6);
> +       if (unlikely(phlen)) {
> +               skb_pull(skb, phlen - optlen);
> +               skb_reset_network_header(skb);
> +       }
> +       if (x->sel.family == AF_INET6) {
> +               struct ipv6hdr *ip6h = ipv6_hdr(skb);
> +               ip6h->payload_len = htons(skb->len - size);
> +               ipv6_addr_copy(&ip6h->daddr,
> +                              (struct in6_addr *) &x->sel.daddr.a6);
> +               ipv6_addr_copy(&ip6h->saddr,
> +                              (struct in6_addr *) &x->sel.saddr.a6);
> +       } else if (x->sel.family == AF_INET) {
> +               struct iphdr *iph = ip_hdr(skb);
> +               iph->ihl = (sizeof(*iph) + optlen) / 4;
> +               iph->version = 4;
> +               iph->tos = 0;
> +               iph->id = 0;
> +               iph->frag_off = 0;
> +               iph->ttl = hops;
> +               iph->protocol = proto;
> +               iph->daddr = x->sel.daddr.a4;
> +               iph->saddr = x->sel.saddr.a4;
> +               iph->tot_len = htons(skb->len);
> +               ip_send_check(iph);
> +               skb->protocol = htons(ETH_P_IP);
> +               if (unlikely(!optlen))
> +                       skb_set_transport_header(skb, skb_network_offset(skb));
> +
> +               dst_release(skb->dst);
> +               skb->dst = NULL;
> +       }
> +
>         err = 0;
>  out:
>         return err;
> diff --git a/net/ipv6/xfrm6_mode_tunnel.c b/net/ipv6/xfrm6_mode_tunnel.c
> diff --git a/net/ipv6/xfrm6_policy.c b/net/ipv6/xfrm6_policy.c
> index 1faa2ea..4ccdd3f 100644
> --- a/net/ipv6/xfrm6_policy.c
> +++ b/net/ipv6/xfrm6_policy.c
> @@ -24,6 +24,7 @@
>
>  static struct dst_ops xfrm6_dst_ops;
>  static struct xfrm_policy_afinfo xfrm6_policy_afinfo;
> +static void xfrm6_update_pmtu(struct dst_entry *dst, u32 mtu);
>
>  static int xfrm6_dst_lookup(struct xfrm_dst **xdst, struct flowi *fl)
>  {
> @@ -131,6 +132,7 @@ __xfrm6_bundle_create(struct xfrm_policy *policy, struct xfrm_state **xfrm, int
>         struct dst_entry *dst, *dst_prev;
>         struct rt6_info *rt0 = (struct rt6_info*)(*dst_p);
>         struct rt6_info *rt  = rt0;
> +       unsigned short encap_family = 0, beet = 0;
>         struct flowi fl_tunnel = {
>                 .nl_u = {
>                         .ip6_u = {
> @@ -139,6 +141,10 @@ __xfrm6_bundle_create(struct xfrm_policy *policy, struct xfrm_state **xfrm, int
>                         }
>                 }
>         };
> +       union {
> +               struct in6_addr *in6;
> +               struct in_addr *in;
> +       } remote, local;
>         int i;
>         int err = 0;
>         int header_len = 0;
> @@ -175,20 +181,39 @@ __xfrm6_bundle_create(struct xfrm_policy *policy, struct xfrm_state **xfrm, int
>                 dst1->next = dst_prev;
>                 dst_prev = dst1;
>
> +               if (xfrm[i]->props.mode != XFRM_MODE_TRANSPORT) {
> +                       encap_family = xfrm[i]->props.family;
> +                       beet = (xfrm[i]->props.mode == XFRM_MODE_BEET);
> +                       if (encap_family == AF_INET6) {
> +                               remote.in6 =
> +                                       __xfrm6_bundle_addr_remote(xfrm[i],
> +                                                                  remote.in6);
> +                               local.in6  =
> +                                       __xfrm6_bundle_addr_local(xfrm[i],
> +                                                                 local.in6);
> +                       } else if (encap_family == AF_INET) {
> +                               remote.in = (struct in_addr *)
> +                                       &xfrm[i]->id.daddr.a4;
> +                               local.in = (struct in_addr *)
> +                                       &xfrm[i]->props.saddr.a4;
> +                       }
> +               }
> +
>                 __xfrm6_bundle_len_inc(&header_len, &nfheader_len, xfrm[i]);
>                 trailer_len += xfrm[i]->props.trailer_len;
>
>                 if (xfrm[i]->props.mode == XFRM_MODE_TUNNEL ||
> +                   xfrm[i]->props.mode == XFRM_MODE_BEET ||
>                     xfrm[i]->props.mode == XFRM_MODE_ROUTEOPTIMIZATION) {
> -                       unsigned short encap_family = xfrm[i]->props.family;
>                         switch(encap_family) {
>                         case AF_INET:
>                                 fl_tunnel.fl4_dst = xfrm[i]->id.daddr.a4;
>                                 fl_tunnel.fl4_src = xfrm[i]->props.saddr.a4;
> +                               fl_tunnel.fl4_tos = 0;
> +                               fl_tunnel.fl4_scope = 0;
>                                 break;
>                         case AF_INET6:
>                                 ipv6_addr_copy(&fl_tunnel.fl6_dst, __xfrm6_bundle_addr_remote(xfrm[i], &fl->fl6_dst));
> -
>                                 ipv6_addr_copy(&fl_tunnel.fl6_src, __xfrm6_bundle_addr_local(xfrm[i], &fl->fl6_src));
>                                 break;
>                         default:
> @@ -260,6 +285,13 @@ __xfrm6_bundle_create(struct xfrm_policy *policy, struct xfrm_state **xfrm, int
>         }
>
>         xfrm_init_pmtu(dst);
> +
> +       if (beet && encap_family == AF_INET) {
> +               int delta = sizeof(struct ipv6hdr) - sizeof(struct iphdr);
> +               u32 mtu = dst_mtu(dst);
> +               xfrm6_update_pmtu(dst, mtu + delta);
> +       }
> +
>         return 0;
>
>  error:
> diff --git a/net/ipv6/xfrm6_state.c b/net/ipv6/xfrm6_state.c
> index baa461b..5c14227 100644
> --- a/net/ipv6/xfrm6_state.c
> +++ b/net/ipv6/xfrm6_state.c
> @@ -98,6 +98,17 @@ __xfrm6_state_sort(struct xfrm_state **dst, struct xfrm_state **src, int n)
>                         src[i] = NULL;
>                 }
>         }
> +       if (j == n)
> +               goto end;
> +
> +       /* Rule 5: select IPsec BEET */
> +       for (i = 0; i < n; i++) {
> +               if (src[i] &&
> +                   src[i]->props.mode == XFRM_MODE_BEET) {
> +                       dst[j++] = src[i];
> +                       src[i] = NULL;
> +               }
> +       }
>         if (likely(j == n))
>                 goto end;
>
> diff --git a/net/ipv6/xfrm6_tunnel.c b/net/ipv6/xfrm6_tunnel.c
> index 5502cc9..bdabdef 100644
> --- a/net/ipv6/xfrm6_tunnel.c
> +++ b/net/ipv6/xfrm6_tunnel.c
> @@ -307,7 +307,8 @@ static int xfrm6_tunnel_err(struct sk_buff *skb, struct inet6_skb_parm *opt,
>
>  static int xfrm6_tunnel_init_state(struct xfrm_state *x)
>  {
> -       if (x->props.mode != XFRM_MODE_TUNNEL)
> +       if (x->props.mode != XFRM_MODE_TUNNEL ||
> +           x->props.mode != XFRM_MODE_BEET)
>                 return -EINVAL;
>
>         if (x->encap)
> diff --git a/net/xfrm/xfrm_policy.c b/net/xfrm/xfrm_policy.c
> index 157bfbd..75fdb7d 100644
> --- a/net/xfrm/xfrm_policy.c
> +++ b/net/xfrm/xfrm_policy.c
> @@ -1299,7 +1299,8 @@ xfrm_tmpl_resolve_one(struct xfrm_policy *policy, struct flowi *fl,
>                 xfrm_address_t *local  = saddr;
>                 struct xfrm_tmpl *tmpl = &policy->xfrm_vec[i];
>
> -               if (tmpl->mode == XFRM_MODE_TUNNEL) {
> +               if (tmpl->mode == XFRM_MODE_TUNNEL ||
> +                   tmpl->mode == XFRM_MODE_BEET) {
>                         remote = &tmpl->id.daddr;
>                         local = &tmpl->saddr;
>                         family = tmpl->encap_family;
> diff --git a/net/xfrm/xfrm_state.c b/net/xfrm/xfrm_state.c
> index dfacb9c..0a2ff8e 100644
> --- a/net/xfrm/xfrm_state.c
> +++ b/net/xfrm/xfrm_state.c
> @@ -611,7 +611,7 @@ xfrm_state_find(xfrm_address_t *daddr, xfrm_address_t *saddr,
>                               selector.
>                          */
>                         if (x->km.state == XFRM_STATE_VALID) {
> -                               if (!xfrm_selector_match(&x->sel, fl, family) ||
> +                               if (!xfrm_selector_match(&x->sel, fl, x->sel.family) ||
>                                     !security_xfrm_state_pol_flow_match(x, pol, fl))
>                                         continue;
>                                 if (!best ||
> @@ -623,7 +623,7 @@ xfrm_state_find(xfrm_address_t *daddr, xfrm_address_t *saddr,
>                                 acquire_in_progress = 1;
>                         } else if (x->km.state == XFRM_STATE_ERROR ||
>                                    x->km.state == XFRM_STATE_EXPIRED) {
> -                               if (xfrm_selector_match(&x->sel, fl, family) &&
> +                               if (xfrm_selector_match(&x->sel, fl, x->sel.family) &&
>                                     security_xfrm_state_pol_flow_match(x, pol, fl))
>                                         error = -ESRCH;
>                         }
> -
> To unsubscribe from this list: send the line "unsubscribe netdev" in
> the body of a message to majordomo@...r.kernel.org
> More majordomo info at  http://vger.kernel.org/majordomo-info.html
>
-
To unsubscribe from this list: send the line "unsubscribe netdev" in
the body of a message to majordomo@...r.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Powered by blists - more mailing lists