blob: 60c78cfc273797247312c6846727fc7b10b9db21 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * xfrm6_state.c: based on xfrm4_state.c
3 *
4 * Authors:
5 * Mitsuru KANDA @USAGI
6 * Kazunori MIYAZAWA @USAGI
7 * Kunihiro Ishiguro <kunihiro@ipinfusion.com>
8 * IPv6 support
9 * YOSHIFUJI Hideaki @USAGI
10 * Split up af-specific portion
YOSHIFUJI Hideaki1ab14572007-02-09 23:24:49 +090011 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070012 */
13
14#include <net/xfrm.h>
15#include <linux/pfkeyv2.h>
16#include <linux/ipsec.h>
Herbert Xu862b82c2007-11-13 21:43:11 -080017#include <linux/netfilter_ipv6.h>
Herbert Xu36cf9ac2007-11-13 21:40:52 -080018#include <net/dsfield.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070019#include <net/ipv6.h>
Patrick McHardyee51b1b2006-01-13 14:34:36 -080020#include <net/addrconf.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070021
22static struct xfrm_state_afinfo xfrm6_state_afinfo;
23
24static void
25__xfrm6_init_tempsel(struct xfrm_state *x, struct flowi *fl,
26 struct xfrm_tmpl *tmpl,
27 xfrm_address_t *daddr, xfrm_address_t *saddr)
28{
29 /* Initialize temporary selector matching only
30 * to current session. */
31 ipv6_addr_copy((struct in6_addr *)&x->sel.daddr, &fl->fl6_dst);
32 ipv6_addr_copy((struct in6_addr *)&x->sel.saddr, &fl->fl6_src);
33 x->sel.dport = xfrm_flowi_dport(fl);
Al Viro8f83f232006-09-27 18:46:11 -070034 x->sel.dport_mask = htons(0xffff);
Linus Torvalds1da177e2005-04-16 15:20:36 -070035 x->sel.sport = xfrm_flowi_sport(fl);
Al Viro8f83f232006-09-27 18:46:11 -070036 x->sel.sport_mask = htons(0xffff);
Andreas Steffen79654a72008-11-04 14:49:19 -080037 x->sel.family = AF_INET6;
Linus Torvalds1da177e2005-04-16 15:20:36 -070038 x->sel.prefixlen_d = 128;
39 x->sel.prefixlen_s = 128;
40 x->sel.proto = fl->proto;
41 x->sel.ifindex = fl->oif;
42 x->id = tmpl->id;
43 if (ipv6_addr_any((struct in6_addr*)&x->id.daddr))
44 memcpy(&x->id.daddr, daddr, sizeof(x->sel.daddr));
45 memcpy(&x->props.saddr, &tmpl->saddr, sizeof(x->props.saddr));
46 if (ipv6_addr_any((struct in6_addr*)&x->props.saddr))
47 memcpy(&x->props.saddr, saddr, sizeof(x->props.saddr));
Linus Torvalds1da177e2005-04-16 15:20:36 -070048 x->props.mode = tmpl->mode;
49 x->props.reqid = tmpl->reqid;
50 x->props.family = AF_INET6;
51}
52
YOSHIFUJI Hideaki3b6cdf92008-02-19 10:15:27 +090053/* distribution counting sort function for xfrm_state and xfrm_tmpl */
54static int
55__xfrm6_sort(void **dst, void **src, int n, int (*cmp)(void *p), int maxclass)
56{
57 int i;
58 int class[XFRM_MAX_DEPTH];
59 int count[maxclass];
60
61 memset(count, 0, sizeof(count));
62
63 for (i = 0; i < n; i++) {
64 int c;
65 class[i] = c = cmp(src[i]);
66 count[c]++;
67 }
68
69 for (i = 2; i < maxclass; i++)
70 count[i] += count[i - 1];
71
72 for (i = 0; i < n; i++) {
73 dst[count[class[i] - 1]++] = src[i];
74 src[i] = 0;
75 }
76
77 return 0;
78}
79
80/*
81 * Rule for xfrm_state:
82 *
83 * rule 1: select IPsec transport except AH
84 * rule 2: select MIPv6 RO or inbound trigger
85 * rule 3: select IPsec transport AH
86 * rule 4: select IPsec tunnel
87 * rule 5: others
88 */
89static int __xfrm6_state_sort_cmp(void *p)
90{
91 struct xfrm_state *v = p;
92
93 switch (v->props.mode) {
94 case XFRM_MODE_TRANSPORT:
95 if (v->id.proto != IPPROTO_AH)
96 return 1;
97 else
98 return 3;
99#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
100 case XFRM_MODE_ROUTEOPTIMIZATION:
101 case XFRM_MODE_IN_TRIGGER:
102 return 2;
103#endif
104 case XFRM_MODE_TUNNEL:
105 case XFRM_MODE_BEET:
106 return 4;
107 }
108 return 5;
109}
110
Masahide NAKAMURA58c949d2006-08-23 22:51:02 -0700111static int
112__xfrm6_state_sort(struct xfrm_state **dst, struct xfrm_state **src, int n)
113{
YOSHIFUJI Hideaki3b6cdf92008-02-19 10:15:27 +0900114 return __xfrm6_sort((void **)dst, (void **)src, n,
115 __xfrm6_state_sort_cmp, 6);
116}
Masahide NAKAMURA58c949d2006-08-23 22:51:02 -0700117
YOSHIFUJI Hideaki3b6cdf92008-02-19 10:15:27 +0900118/*
119 * Rule for xfrm_tmpl:
120 *
121 * rule 1: select IPsec transport
122 * rule 2: select MIPv6 RO or inbound trigger
123 * rule 3: select IPsec tunnel
124 * rule 4: others
125 */
126static int __xfrm6_tmpl_sort_cmp(void *p)
127{
128 struct xfrm_tmpl *v = p;
129 switch (v->mode) {
130 case XFRM_MODE_TRANSPORT:
131 return 1;
Masahide NAKAMURA59fbb3a62007-06-26 23:56:32 -0700132#if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE)
YOSHIFUJI Hideaki3b6cdf92008-02-19 10:15:27 +0900133 case XFRM_MODE_ROUTEOPTIMIZATION:
134 case XFRM_MODE_IN_TRIGGER:
135 return 2;
Masahide NAKAMURA64d9fdd2006-08-23 22:54:07 -0700136#endif
YOSHIFUJI Hideaki3b6cdf92008-02-19 10:15:27 +0900137 case XFRM_MODE_TUNNEL:
138 case XFRM_MODE_BEET:
139 return 3;
Masahide NAKAMURA58c949d2006-08-23 22:51:02 -0700140 }
YOSHIFUJI Hideaki3b6cdf92008-02-19 10:15:27 +0900141 return 4;
Masahide NAKAMURA58c949d2006-08-23 22:51:02 -0700142}
143
144static int
145__xfrm6_tmpl_sort(struct xfrm_tmpl **dst, struct xfrm_tmpl **src, int n)
146{
YOSHIFUJI Hideaki3b6cdf92008-02-19 10:15:27 +0900147 return __xfrm6_sort((void **)dst, (void **)src, n,
148 __xfrm6_tmpl_sort_cmp, 5);
Masahide NAKAMURA58c949d2006-08-23 22:51:02 -0700149}
150
Herbert Xu36cf9ac2007-11-13 21:40:52 -0800151int xfrm6_extract_header(struct sk_buff *skb)
152{
153 struct ipv6hdr *iph = ipv6_hdr(skb);
154
Herbert Xu732c8bd2008-03-26 16:51:09 -0700155 XFRM_MODE_SKB_CB(skb)->ihl = sizeof(*iph);
Herbert Xu36cf9ac2007-11-13 21:40:52 -0800156 XFRM_MODE_SKB_CB(skb)->id = 0;
157 XFRM_MODE_SKB_CB(skb)->frag_off = htons(IP_DF);
158 XFRM_MODE_SKB_CB(skb)->tos = ipv6_get_dsfield(iph);
159 XFRM_MODE_SKB_CB(skb)->ttl = iph->hop_limit;
Herbert Xu732c8bd2008-03-26 16:51:09 -0700160 XFRM_MODE_SKB_CB(skb)->optlen = 0;
Herbert Xu36cf9ac2007-11-13 21:40:52 -0800161 memcpy(XFRM_MODE_SKB_CB(skb)->flow_lbl, iph->flow_lbl,
162 sizeof(XFRM_MODE_SKB_CB(skb)->flow_lbl));
163
164 return 0;
165}
166
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167static struct xfrm_state_afinfo xfrm6_state_afinfo = {
168 .family = AF_INET6,
Herbert Xu36cf9ac2007-11-13 21:40:52 -0800169 .proto = IPPROTO_IPV6,
Herbert Xu227620e2007-11-13 21:41:28 -0800170 .eth_proto = htons(ETH_P_IPV6),
Herbert Xu17c2a422007-10-17 21:33:12 -0700171 .owner = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172 .init_tempsel = __xfrm6_init_tempsel,
Masahide NAKAMURA58c949d2006-08-23 22:51:02 -0700173 .tmpl_sort = __xfrm6_tmpl_sort,
174 .state_sort = __xfrm6_state_sort,
Miika Komucdca7262007-02-06 14:24:56 -0800175 .output = xfrm6_output,
Herbert Xu227620e2007-11-13 21:41:28 -0800176 .extract_input = xfrm6_extract_input,
Herbert Xu36cf9ac2007-11-13 21:40:52 -0800177 .extract_output = xfrm6_extract_output,
Herbert Xu716062f2007-11-13 21:44:23 -0800178 .transport_finish = xfrm6_transport_finish,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179};
180
Daniel Lezcano0013cab2007-12-07 00:42:11 -0800181int __init xfrm6_state_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182{
Daniel Lezcano0013cab2007-12-07 00:42:11 -0800183 return xfrm_state_register_afinfo(&xfrm6_state_afinfo);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184}
185
186void xfrm6_state_fini(void)
187{
188 xfrm_state_unregister_afinfo(&xfrm6_state_afinfo);
189}
190