Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
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 | |
1ab1457c | 11 | * |
1da177e4 LT |
12 | */ |
13 | ||
14 | #include <net/xfrm.h> | |
15 | #include <linux/pfkeyv2.h> | |
16 | #include <linux/ipsec.h> | |
862b82c6 | 17 | #include <linux/netfilter_ipv6.h> |
36cf9acf | 18 | #include <net/dsfield.h> |
1da177e4 | 19 | #include <net/ipv6.h> |
ee51b1b6 | 20 | #include <net/addrconf.h> |
1da177e4 | 21 | |
1da177e4 | 22 | static void |
8444cf71 | 23 | __xfrm6_init_tempsel(struct xfrm_selector *sel, struct flowi *fl) |
1da177e4 LT |
24 | { |
25 | /* Initialize temporary selector matching only | |
26 | * to current session. */ | |
8444cf71 TE |
27 | ipv6_addr_copy((struct in6_addr *)&sel->daddr, &fl->fl6_dst); |
28 | ipv6_addr_copy((struct in6_addr *)&sel->saddr, &fl->fl6_src); | |
29 | sel->dport = xfrm_flowi_dport(fl); | |
30 | sel->dport_mask = htons(0xffff); | |
31 | sel->sport = xfrm_flowi_sport(fl); | |
32 | sel->sport_mask = htons(0xffff); | |
33 | sel->family = AF_INET6; | |
34 | sel->prefixlen_d = 128; | |
35 | sel->prefixlen_s = 128; | |
36 | sel->proto = fl->proto; | |
37 | sel->ifindex = fl->oif; | |
38 | } | |
39 | ||
40 | static void | |
41 | xfrm6_init_temprop(struct xfrm_state *x, struct xfrm_tmpl *tmpl, | |
42 | xfrm_address_t *daddr, xfrm_address_t *saddr) | |
43 | { | |
1da177e4 LT |
44 | x->id = tmpl->id; |
45 | if (ipv6_addr_any((struct in6_addr*)&x->id.daddr)) | |
46 | memcpy(&x->id.daddr, daddr, sizeof(x->sel.daddr)); | |
47 | memcpy(&x->props.saddr, &tmpl->saddr, sizeof(x->props.saddr)); | |
48 | if (ipv6_addr_any((struct in6_addr*)&x->props.saddr)) | |
49 | memcpy(&x->props.saddr, saddr, sizeof(x->props.saddr)); | |
50 | x->props.mode = tmpl->mode; | |
51 | x->props.reqid = tmpl->reqid; | |
52 | x->props.family = AF_INET6; | |
53 | } | |
54 | ||
3b6cdf94 | 55 | /* distribution counting sort function for xfrm_state and xfrm_tmpl */ |
58c949d1 | 56 | static int |
3b6cdf94 | 57 | __xfrm6_sort(void **dst, void **src, int n, int (*cmp)(void *p), int maxclass) |
58c949d1 MN |
58 | { |
59 | int i; | |
3b6cdf94 YH |
60 | int class[XFRM_MAX_DEPTH]; |
61 | int count[maxclass]; | |
58c949d1 | 62 | |
3b6cdf94 | 63 | memset(count, 0, sizeof(count)); |
58c949d1 | 64 | |
64d9fdda | 65 | for (i = 0; i < n; i++) { |
3b6cdf94 YH |
66 | int c; |
67 | class[i] = c = cmp(src[i]); | |
68 | count[c]++; | |
64d9fdda | 69 | } |
58c949d1 | 70 | |
3b6cdf94 YH |
71 | for (i = 2; i < maxclass; i++) |
72 | count[i] += count[i - 1]; | |
58c949d1 | 73 | |
58c949d1 | 74 | for (i = 0; i < n; i++) { |
3b6cdf94 | 75 | dst[count[class[i] - 1]++] = src[i]; |
66da8c52 | 76 | src[i] = NULL; |
58c949d1 | 77 | } |
58c949d1 | 78 | |
58c949d1 MN |
79 | return 0; |
80 | } | |
81 | ||
3b6cdf94 YH |
82 | /* |
83 | * Rule for xfrm_state: | |
84 | * | |
85 | * rule 1: select IPsec transport except AH | |
86 | * rule 2: select MIPv6 RO or inbound trigger | |
87 | * rule 3: select IPsec transport AH | |
88 | * rule 4: select IPsec tunnel | |
89 | * rule 5: others | |
90 | */ | |
91 | static int __xfrm6_state_sort_cmp(void *p) | |
58c949d1 | 92 | { |
3b6cdf94 YH |
93 | struct xfrm_state *v = p; |
94 | ||
95 | switch (v->props.mode) { | |
96 | case XFRM_MODE_TRANSPORT: | |
97 | if (v->id.proto != IPPROTO_AH) | |
98 | return 1; | |
99 | else | |
100 | return 3; | |
59fbb3a6 | 101 | #if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE) |
3b6cdf94 YH |
102 | case XFRM_MODE_ROUTEOPTIMIZATION: |
103 | case XFRM_MODE_IN_TRIGGER: | |
104 | return 2; | |
64d9fdda | 105 | #endif |
3b6cdf94 YH |
106 | case XFRM_MODE_TUNNEL: |
107 | case XFRM_MODE_BEET: | |
108 | return 4; | |
58c949d1 | 109 | } |
3b6cdf94 YH |
110 | return 5; |
111 | } | |
58c949d1 | 112 | |
3b6cdf94 YH |
113 | static int |
114 | __xfrm6_state_sort(struct xfrm_state **dst, struct xfrm_state **src, int n) | |
115 | { | |
116 | return __xfrm6_sort((void **)dst, (void **)src, n, | |
117 | __xfrm6_state_sort_cmp, 6); | |
118 | } | |
119 | ||
120 | /* | |
121 | * Rule for xfrm_tmpl: | |
122 | * | |
123 | * rule 1: select IPsec transport | |
124 | * rule 2: select MIPv6 RO or inbound trigger | |
125 | * rule 3: select IPsec tunnel | |
126 | * rule 4: others | |
127 | */ | |
128 | static int __xfrm6_tmpl_sort_cmp(void *p) | |
129 | { | |
130 | struct xfrm_tmpl *v = p; | |
131 | switch (v->mode) { | |
132 | case XFRM_MODE_TRANSPORT: | |
133 | return 1; | |
134 | #if defined(CONFIG_IPV6_MIP6) || defined(CONFIG_IPV6_MIP6_MODULE) | |
135 | case XFRM_MODE_ROUTEOPTIMIZATION: | |
136 | case XFRM_MODE_IN_TRIGGER: | |
137 | return 2; | |
138 | #endif | |
139 | case XFRM_MODE_TUNNEL: | |
140 | case XFRM_MODE_BEET: | |
141 | return 3; | |
58c949d1 | 142 | } |
3b6cdf94 YH |
143 | return 4; |
144 | } | |
58c949d1 | 145 | |
3b6cdf94 YH |
146 | static int |
147 | __xfrm6_tmpl_sort(struct xfrm_tmpl **dst, struct xfrm_tmpl **src, int n) | |
148 | { | |
149 | return __xfrm6_sort((void **)dst, (void **)src, n, | |
150 | __xfrm6_tmpl_sort_cmp, 5); | |
58c949d1 MN |
151 | } |
152 | ||
36cf9acf HX |
153 | int xfrm6_extract_header(struct sk_buff *skb) |
154 | { | |
155 | struct ipv6hdr *iph = ipv6_hdr(skb); | |
156 | ||
732c8bd5 | 157 | XFRM_MODE_SKB_CB(skb)->ihl = sizeof(*iph); |
36cf9acf HX |
158 | XFRM_MODE_SKB_CB(skb)->id = 0; |
159 | XFRM_MODE_SKB_CB(skb)->frag_off = htons(IP_DF); | |
160 | XFRM_MODE_SKB_CB(skb)->tos = ipv6_get_dsfield(iph); | |
161 | XFRM_MODE_SKB_CB(skb)->ttl = iph->hop_limit; | |
732c8bd5 | 162 | XFRM_MODE_SKB_CB(skb)->optlen = 0; |
36cf9acf HX |
163 | memcpy(XFRM_MODE_SKB_CB(skb)->flow_lbl, iph->flow_lbl, |
164 | sizeof(XFRM_MODE_SKB_CB(skb)->flow_lbl)); | |
165 | ||
166 | return 0; | |
167 | } | |
168 | ||
1da177e4 LT |
169 | static struct xfrm_state_afinfo xfrm6_state_afinfo = { |
170 | .family = AF_INET6, | |
36cf9acf | 171 | .proto = IPPROTO_IPV6, |
227620e2 | 172 | .eth_proto = htons(ETH_P_IPV6), |
17c2a42a | 173 | .owner = THIS_MODULE, |
1da177e4 | 174 | .init_tempsel = __xfrm6_init_tempsel, |
8444cf71 | 175 | .init_temprop = xfrm6_init_temprop, |
58c949d1 MN |
176 | .tmpl_sort = __xfrm6_tmpl_sort, |
177 | .state_sort = __xfrm6_state_sort, | |
cdca7265 | 178 | .output = xfrm6_output, |
227620e2 | 179 | .extract_input = xfrm6_extract_input, |
36cf9acf | 180 | .extract_output = xfrm6_extract_output, |
716062fd | 181 | .transport_finish = xfrm6_transport_finish, |
1da177e4 LT |
182 | }; |
183 | ||
0013caba | 184 | int __init xfrm6_state_init(void) |
1da177e4 | 185 | { |
0013caba | 186 | return xfrm_state_register_afinfo(&xfrm6_state_afinfo); |
1da177e4 LT |
187 | } |
188 | ||
189 | void xfrm6_state_fini(void) | |
190 | { | |
191 | xfrm_state_unregister_afinfo(&xfrm6_state_afinfo); | |
192 | } | |
193 |