blob: 3437d7d4eed6dcff351adcd7645dffd919c3477e [file] [log] [blame]
Diego Beltrami0a694522006-10-03 23:47:05 -07001/*
2 * xfrm6_mode_beet.c - BEET mode encapsulation for IPv6.
3 *
4 * Copyright (c) 2006 Diego Beltrami <diego.beltrami@gmail.com>
5 * Miika Komu <miika@iki.fi>
6 * Herbert Xu <herbert@gondor.apana.org.au>
7 * Abhinav Pathak <abhinav.pathak@hiit.fi>
8 * Jeff Ahrenholz <ahrenholz@gmail.com>
9 */
10
11#include <linux/init.h>
12#include <linux/kernel.h>
13#include <linux/module.h>
14#include <linux/skbuff.h>
15#include <linux/stringify.h>
16#include <net/dsfield.h>
17#include <net/dst.h>
18#include <net/inet_ecn.h>
19#include <net/ipv6.h>
20#include <net/xfrm.h>
21
Herbert Xu227620e2007-11-13 21:41:28 -080022static void xfrm6_beet_make_header(struct sk_buff *skb)
23{
24 struct ipv6hdr *iph = ipv6_hdr(skb);
25
26 iph->version = 6;
27
28 memcpy(iph->flow_lbl, XFRM_MODE_SKB_CB(skb)->flow_lbl,
29 sizeof(iph->flow_lbl));
30 iph->nexthdr = XFRM_MODE_SKB_CB(skb)->protocol;
31
32 ipv6_change_dsfield(iph, 0, XFRM_MODE_SKB_CB(skb)->tos);
33 iph->hop_limit = XFRM_MODE_SKB_CB(skb)->ttl;
34}
35
Diego Beltrami0a694522006-10-03 23:47:05 -070036/* Add encapsulation header.
37 *
38 * The top IP header will be constructed per draft-nikander-esp-beet-mode-06.txt.
Diego Beltrami0a694522006-10-03 23:47:05 -070039 */
40static int xfrm6_beet_output(struct xfrm_state *x, struct sk_buff *skb)
41{
Herbert Xu36cf9ac2007-11-13 21:40:52 -080042 struct ipv6hdr *top_iph;
Joakim Koskelaabf5cdb2008-08-06 02:40:25 -070043 struct ip_beet_phdr *ph;
Joakim Koskelaabf5cdb2008-08-06 02:40:25 -070044 int optlen, hdr_len;
Diego Beltrami0a694522006-10-03 23:47:05 -070045
Joakim Koskelaabf5cdb2008-08-06 02:40:25 -070046 hdr_len = 0;
47 optlen = XFRM_MODE_SKB_CB(skb)->optlen;
48 if (unlikely(optlen))
49 hdr_len += IPV4_BEET_PHMAXLEN - (optlen & 4);
50
51 skb_set_network_header(skb, -x->props.header_len - hdr_len);
52 if (x->sel.family != AF_INET6)
53 skb->network_header += IPV4_BEET_PHMAXLEN;
Herbert Xu36cf9ac2007-11-13 21:40:52 -080054 skb->mac_header = skb->network_header +
55 offsetof(struct ipv6hdr, nexthdr);
56 skb->transport_header = skb->network_header + sizeof(*top_iph);
Joakim Koskelaabf5cdb2008-08-06 02:40:25 -070057 ph = (struct ip_beet_phdr *)__skb_pull(skb, XFRM_MODE_SKB_CB(skb)->ihl-hdr_len);
Herbert Xu227620e2007-11-13 21:41:28 -080058
59 xfrm6_beet_make_header(skb);
60
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -070061 top_iph = ipv6_hdr(skb);
Joakim Koskelaabf5cdb2008-08-06 02:40:25 -070062 if (unlikely(optlen)) {
63
64 BUG_ON(optlen < 0);
65
66 ph->padlen = 4 - (optlen & 4);
67 ph->hdrlen = optlen / 8;
68 ph->nexthdr = top_iph->nexthdr;
69 if (ph->padlen)
70 memset(ph + 1, IPOPT_NOP, ph->padlen);
71
72 top_iph->nexthdr = IPPROTO_BEETPH;
73 }
Diego Beltrami0a694522006-10-03 23:47:05 -070074
75 ipv6_addr_copy(&top_iph->saddr, (struct in6_addr *)&x->props.saddr);
76 ipv6_addr_copy(&top_iph->daddr, (struct in6_addr *)&x->id.daddr);
Diego Beltrami0a694522006-10-03 23:47:05 -070077 return 0;
78}
79
80static int xfrm6_beet_input(struct xfrm_state *x, struct sk_buff *skb)
81{
82 struct ipv6hdr *ip6h;
Arnaldo Carvalho de Melo39f69c62007-03-10 12:40:27 -030083 const unsigned char *old_mac;
Diego Beltrami0a694522006-10-03 23:47:05 -070084 int size = sizeof(struct ipv6hdr);
Herbert Xu227620e2007-11-13 21:41:28 -080085 int err;
Diego Beltrami0a694522006-10-03 23:47:05 -070086
Herbert Xu227620e2007-11-13 21:41:28 -080087 err = skb_cow_head(skb, size + skb->mac_len);
88 if (err)
Diego Beltrami0a694522006-10-03 23:47:05 -070089 goto out;
90
Herbert Xu227620e2007-11-13 21:41:28 -080091 __skb_push(skb, size);
Arnaldo Carvalho de Meloc1d2bbe2007-04-10 20:45:18 -070092 skb_reset_network_header(skb);
Diego Beltrami0a694522006-10-03 23:47:05 -070093
Arnaldo Carvalho de Melo98e399f2007-03-19 15:33:04 -070094 old_mac = skb_mac_header(skb);
Arnaldo Carvalho de Melo39f69c62007-03-10 12:40:27 -030095 skb_set_mac_header(skb, -skb->mac_len);
Arnaldo Carvalho de Melo98e399f2007-03-19 15:33:04 -070096 memmove(skb_mac_header(skb), old_mac, skb->mac_len);
Diego Beltrami0a694522006-10-03 23:47:05 -070097
Herbert Xu227620e2007-11-13 21:41:28 -080098 xfrm6_beet_make_header(skb);
99
Arnaldo Carvalho de Melo0660e032007-04-25 17:54:47 -0700100 ip6h = ipv6_hdr(skb);
Diego Beltrami0a694522006-10-03 23:47:05 -0700101 ip6h->payload_len = htons(skb->len - size);
102 ipv6_addr_copy(&ip6h->daddr, (struct in6_addr *) &x->sel.daddr.a6);
103 ipv6_addr_copy(&ip6h->saddr, (struct in6_addr *) &x->sel.saddr.a6);
104 err = 0;
105out:
106 return err;
107}
108
109static struct xfrm_mode xfrm6_beet_mode = {
Herbert Xu227620e2007-11-13 21:41:28 -0800110 .input2 = xfrm6_beet_input,
111 .input = xfrm_prepare_input,
Herbert Xu36cf9ac2007-11-13 21:40:52 -0800112 .output2 = xfrm6_beet_output,
113 .output = xfrm6_prepare_output,
Diego Beltrami0a694522006-10-03 23:47:05 -0700114 .owner = THIS_MODULE,
115 .encap = XFRM_MODE_BEET,
Herbert Xu1bfcb102007-10-17 21:31:50 -0700116 .flags = XFRM_MODE_FLAG_TUNNEL,
Diego Beltrami0a694522006-10-03 23:47:05 -0700117};
118
119static int __init xfrm6_beet_init(void)
120{
121 return xfrm_register_mode(&xfrm6_beet_mode, AF_INET6);
122}
123
124static void __exit xfrm6_beet_exit(void)
125{
126 int err;
127
128 err = xfrm_unregister_mode(&xfrm6_beet_mode, AF_INET6);
129 BUG_ON(err);
130}
131
132module_init(xfrm6_beet_init);
133module_exit(xfrm6_beet_exit);
134MODULE_LICENSE("GPL");
135MODULE_ALIAS_XFRM_MODE(AF_INET6, XFRM_MODE_BEET);