Branch data Line data Source code
1 : : // SPDX-License-Identifier: GPL-2.0
2 : : /*
3 : : * xfrm_input.c
4 : : *
5 : : * Changes:
6 : : * YOSHIFUJI Hideaki @USAGI
7 : : * Split up af-specific portion
8 : : *
9 : : */
10 : :
11 : : #include <linux/bottom_half.h>
12 : : #include <linux/cache.h>
13 : : #include <linux/interrupt.h>
14 : : #include <linux/slab.h>
15 : : #include <linux/module.h>
16 : : #include <linux/netdevice.h>
17 : : #include <linux/percpu.h>
18 : : #include <net/dst.h>
19 : : #include <net/ip.h>
20 : : #include <net/xfrm.h>
21 : : #include <net/ip_tunnels.h>
22 : : #include <net/ip6_tunnel.h>
23 : :
24 : : #include "xfrm_inout.h"
25 : :
26 : : struct xfrm_trans_tasklet {
27 : : struct tasklet_struct tasklet;
28 : : struct sk_buff_head queue;
29 : : };
30 : :
31 : : struct xfrm_trans_cb {
32 : : union {
33 : : struct inet_skb_parm h4;
34 : : #if IS_ENABLED(CONFIG_IPV6)
35 : : struct inet6_skb_parm h6;
36 : : #endif
37 : : } header;
38 : : int (*finish)(struct net *net, struct sock *sk, struct sk_buff *skb);
39 : : struct net *net;
40 : : };
41 : :
42 : : #define XFRM_TRANS_SKB_CB(__skb) ((struct xfrm_trans_cb *)&((__skb)->cb[0]))
43 : :
44 : : static DEFINE_SPINLOCK(xfrm_input_afinfo_lock);
45 : : static struct xfrm_input_afinfo const __rcu *xfrm_input_afinfo[AF_INET6 + 1];
46 : :
47 : : static struct gro_cells gro_cells;
48 : : static struct net_device xfrm_napi_dev;
49 : :
50 : : static DEFINE_PER_CPU(struct xfrm_trans_tasklet, xfrm_trans_tasklet);
51 : :
52 : 60 : int xfrm_input_register_afinfo(const struct xfrm_input_afinfo *afinfo)
53 : : {
54 : 60 : int err = 0;
55 : :
56 [ - + + - ]: 60 : if (WARN_ON(afinfo->family >= ARRAY_SIZE(xfrm_input_afinfo)))
57 : : return -EAFNOSUPPORT;
58 : :
59 : 60 : spin_lock_bh(&xfrm_input_afinfo_lock);
60 [ + - ]: 60 : if (unlikely(xfrm_input_afinfo[afinfo->family] != NULL))
61 : : err = -EEXIST;
62 : : else
63 : 60 : rcu_assign_pointer(xfrm_input_afinfo[afinfo->family], afinfo);
64 : 60 : spin_unlock_bh(&xfrm_input_afinfo_lock);
65 : 60 : return err;
66 : : }
67 : : EXPORT_SYMBOL(xfrm_input_register_afinfo);
68 : :
69 : 0 : int xfrm_input_unregister_afinfo(const struct xfrm_input_afinfo *afinfo)
70 : : {
71 : 0 : int err = 0;
72 : :
73 : 0 : spin_lock_bh(&xfrm_input_afinfo_lock);
74 [ # # ]: 0 : if (likely(xfrm_input_afinfo[afinfo->family] != NULL)) {
75 [ # # ]: 0 : if (unlikely(xfrm_input_afinfo[afinfo->family] != afinfo))
76 : : err = -EINVAL;
77 : : else
78 : 0 : RCU_INIT_POINTER(xfrm_input_afinfo[afinfo->family], NULL);
79 : : }
80 : 0 : spin_unlock_bh(&xfrm_input_afinfo_lock);
81 : 0 : synchronize_rcu();
82 : 0 : return err;
83 : : }
84 : : EXPORT_SYMBOL(xfrm_input_unregister_afinfo);
85 : :
86 : 0 : static const struct xfrm_input_afinfo *xfrm_input_get_afinfo(unsigned int family)
87 : : {
88 : 0 : const struct xfrm_input_afinfo *afinfo;
89 : :
90 [ # # ]: 0 : if (WARN_ON_ONCE(family >= ARRAY_SIZE(xfrm_input_afinfo)))
91 : : return NULL;
92 : :
93 : 0 : rcu_read_lock();
94 [ # # ]: 0 : afinfo = rcu_dereference(xfrm_input_afinfo[family]);
95 [ # # ]: 0 : if (unlikely(!afinfo))
96 : 0 : rcu_read_unlock();
97 : : return afinfo;
98 : : }
99 : :
100 : 0 : static int xfrm_rcv_cb(struct sk_buff *skb, unsigned int family, u8 protocol,
101 : : int err)
102 : : {
103 : 0 : int ret;
104 [ # # ]: 0 : const struct xfrm_input_afinfo *afinfo = xfrm_input_get_afinfo(family);
105 : :
106 [ # # ]: 0 : if (!afinfo)
107 : 0 : return -EAFNOSUPPORT;
108 : :
109 : 0 : ret = afinfo->callback(skb, protocol, err);
110 : 0 : rcu_read_unlock();
111 : :
112 : 0 : return ret;
113 : : }
114 : :
115 : 0 : struct sec_path *secpath_set(struct sk_buff *skb)
116 : : {
117 [ # # ]: 0 : struct sec_path *sp, *tmp = skb_ext_find(skb, SKB_EXT_SEC_PATH);
118 : :
119 : 0 : sp = skb_ext_add(skb, SKB_EXT_SEC_PATH);
120 [ # # ]: 0 : if (!sp)
121 : : return NULL;
122 : :
123 [ # # ]: 0 : if (tmp) /* reused existing one (was COW'd if needed) */
124 : : return sp;
125 : :
126 : : /* allocated new secpath */
127 : 0 : memset(sp->ovec, 0, sizeof(sp->ovec));
128 : 0 : sp->olen = 0;
129 : 0 : sp->len = 0;
130 : :
131 : 0 : return sp;
132 : : }
133 : : EXPORT_SYMBOL(secpath_set);
134 : :
135 : : /* Fetch spi and seq from ipsec header */
136 : :
137 : 0 : int xfrm_parse_spi(struct sk_buff *skb, u8 nexthdr, __be32 *spi, __be32 *seq)
138 : : {
139 : 0 : int offset, offset_seq;
140 : 0 : int hlen;
141 : :
142 [ # # # # ]: 0 : switch (nexthdr) {
143 : : case IPPROTO_AH:
144 : : hlen = sizeof(struct ip_auth_hdr);
145 : : offset = offsetof(struct ip_auth_hdr, spi);
146 : : offset_seq = offsetof(struct ip_auth_hdr, seq_no);
147 : : break;
148 : 0 : case IPPROTO_ESP:
149 : 0 : hlen = sizeof(struct ip_esp_hdr);
150 : 0 : offset = offsetof(struct ip_esp_hdr, spi);
151 : 0 : offset_seq = offsetof(struct ip_esp_hdr, seq_no);
152 : 0 : break;
153 : 0 : case IPPROTO_COMP:
154 [ # # ]: 0 : if (!pskb_may_pull(skb, sizeof(struct ip_comp_hdr)))
155 : : return -EINVAL;
156 : 0 : *spi = htonl(ntohs(*(__be16 *)(skb_transport_header(skb) + 2)));
157 : 0 : *seq = 0;
158 : 0 : return 0;
159 : : default:
160 : : return 1;
161 : : }
162 : :
163 [ # # ]: 0 : if (!pskb_may_pull(skb, hlen))
164 : : return -EINVAL;
165 : :
166 : 0 : *spi = *(__be32 *)(skb_transport_header(skb) + offset);
167 : 0 : *seq = *(__be32 *)(skb_transport_header(skb) + offset_seq);
168 : 0 : return 0;
169 : : }
170 : : EXPORT_SYMBOL(xfrm_parse_spi);
171 : :
172 : : static int xfrm4_remove_beet_encap(struct xfrm_state *x, struct sk_buff *skb)
173 : : {
174 : : struct iphdr *iph;
175 : : int optlen = 0;
176 : : int err = -EINVAL;
177 : :
178 : : if (unlikely(XFRM_MODE_SKB_CB(skb)->protocol == IPPROTO_BEETPH)) {
179 : : struct ip_beet_phdr *ph;
180 : : int phlen;
181 : :
182 : : if (!pskb_may_pull(skb, sizeof(*ph)))
183 : : goto out;
184 : :
185 : : ph = (struct ip_beet_phdr *)skb->data;
186 : :
187 : : phlen = sizeof(*ph) + ph->padlen;
188 : : optlen = ph->hdrlen * 8 + (IPV4_BEET_PHMAXLEN - phlen);
189 : : if (optlen < 0 || optlen & 3 || optlen > 250)
190 : : goto out;
191 : :
192 : : XFRM_MODE_SKB_CB(skb)->protocol = ph->nexthdr;
193 : :
194 : : if (!pskb_may_pull(skb, phlen))
195 : : goto out;
196 : : __skb_pull(skb, phlen);
197 : : }
198 : :
199 : : skb_push(skb, sizeof(*iph));
200 : : skb_reset_network_header(skb);
201 : : skb_mac_header_rebuild(skb);
202 : :
203 : : xfrm4_beet_make_header(skb);
204 : :
205 : : iph = ip_hdr(skb);
206 : :
207 : : iph->ihl += optlen / 4;
208 : : iph->tot_len = htons(skb->len);
209 : : iph->daddr = x->sel.daddr.a4;
210 : : iph->saddr = x->sel.saddr.a4;
211 : : iph->check = 0;
212 : : iph->check = ip_fast_csum(skb_network_header(skb), iph->ihl);
213 : : err = 0;
214 : : out:
215 : : return err;
216 : : }
217 : :
218 : 0 : static void ipip_ecn_decapsulate(struct sk_buff *skb)
219 : : {
220 [ # # ]: 0 : struct iphdr *inner_iph = ipip_hdr(skb);
221 : :
222 [ # # ]: 0 : if (INET_ECN_is_ce(XFRM_MODE_SKB_CB(skb)->tos))
223 [ # # ]: 0 : IP_ECN_set_ce(inner_iph);
224 : 0 : }
225 : :
226 : : static int xfrm4_remove_tunnel_encap(struct xfrm_state *x, struct sk_buff *skb)
227 : : {
228 : : int err = -EINVAL;
229 : :
230 : : if (XFRM_MODE_SKB_CB(skb)->protocol != IPPROTO_IPIP)
231 : : goto out;
232 : :
233 : : if (!pskb_may_pull(skb, sizeof(struct iphdr)))
234 : : goto out;
235 : :
236 : : err = skb_unclone(skb, GFP_ATOMIC);
237 : : if (err)
238 : : goto out;
239 : :
240 : : if (x->props.flags & XFRM_STATE_DECAP_DSCP)
241 : : ipv4_copy_dscp(XFRM_MODE_SKB_CB(skb)->tos, ipip_hdr(skb));
242 : : if (!(x->props.flags & XFRM_STATE_NOECN))
243 : : ipip_ecn_decapsulate(skb);
244 : :
245 : : skb_reset_network_header(skb);
246 : : skb_mac_header_rebuild(skb);
247 : : if (skb->mac_len)
248 : : eth_hdr(skb)->h_proto = skb->protocol;
249 : :
250 : : err = 0;
251 : :
252 : : out:
253 : : return err;
254 : : }
255 : :
256 : 0 : static void ipip6_ecn_decapsulate(struct sk_buff *skb)
257 : : {
258 [ # # ]: 0 : struct ipv6hdr *inner_iph = ipipv6_hdr(skb);
259 : :
260 [ # # ]: 0 : if (INET_ECN_is_ce(XFRM_MODE_SKB_CB(skb)->tos))
261 [ # # ]: 0 : IP6_ECN_set_ce(skb, inner_iph);
262 : 0 : }
263 : :
264 : : static int xfrm6_remove_tunnel_encap(struct xfrm_state *x, struct sk_buff *skb)
265 : : {
266 : : int err = -EINVAL;
267 : :
268 : : if (XFRM_MODE_SKB_CB(skb)->protocol != IPPROTO_IPV6)
269 : : goto out;
270 : : if (!pskb_may_pull(skb, sizeof(struct ipv6hdr)))
271 : : goto out;
272 : :
273 : : err = skb_unclone(skb, GFP_ATOMIC);
274 : : if (err)
275 : : goto out;
276 : :
277 : : if (x->props.flags & XFRM_STATE_DECAP_DSCP)
278 : : ipv6_copy_dscp(ipv6_get_dsfield(ipv6_hdr(skb)),
279 : : ipipv6_hdr(skb));
280 : : if (!(x->props.flags & XFRM_STATE_NOECN))
281 : : ipip6_ecn_decapsulate(skb);
282 : :
283 : : skb_reset_network_header(skb);
284 : : skb_mac_header_rebuild(skb);
285 : : if (skb->mac_len)
286 : : eth_hdr(skb)->h_proto = skb->protocol;
287 : :
288 : : err = 0;
289 : :
290 : : out:
291 : : return err;
292 : : }
293 : :
294 : : static int xfrm6_remove_beet_encap(struct xfrm_state *x, struct sk_buff *skb)
295 : : {
296 : : struct ipv6hdr *ip6h;
297 : : int size = sizeof(struct ipv6hdr);
298 : : int err;
299 : :
300 : : err = skb_cow_head(skb, size + skb->mac_len);
301 : : if (err)
302 : : goto out;
303 : :
304 : : __skb_push(skb, size);
305 : : skb_reset_network_header(skb);
306 : : skb_mac_header_rebuild(skb);
307 : :
308 : : xfrm6_beet_make_header(skb);
309 : :
310 : : ip6h = ipv6_hdr(skb);
311 : : ip6h->payload_len = htons(skb->len - size);
312 : : ip6h->daddr = x->sel.daddr.in6;
313 : : ip6h->saddr = x->sel.saddr.in6;
314 : : err = 0;
315 : : out:
316 : : return err;
317 : : }
318 : :
319 : : /* Remove encapsulation header.
320 : : *
321 : : * The IP header will be moved over the top of the encapsulation
322 : : * header.
323 : : *
324 : : * On entry, the transport header shall point to where the IP header
325 : : * should be and the network header shall be set to where the IP
326 : : * header currently is. skb->data shall point to the start of the
327 : : * payload.
328 : : */
329 : : static int
330 : : xfrm_inner_mode_encap_remove(struct xfrm_state *x,
331 : : const struct xfrm_mode *inner_mode,
332 : : struct sk_buff *skb)
333 : : {
334 : : switch (inner_mode->encap) {
335 : : case XFRM_MODE_BEET:
336 : : if (inner_mode->family == AF_INET)
337 : : return xfrm4_remove_beet_encap(x, skb);
338 : : if (inner_mode->family == AF_INET6)
339 : : return xfrm6_remove_beet_encap(x, skb);
340 : : break;
341 : : case XFRM_MODE_TUNNEL:
342 : : if (inner_mode->family == AF_INET)
343 : : return xfrm4_remove_tunnel_encap(x, skb);
344 : : if (inner_mode->family == AF_INET6)
345 : : return xfrm6_remove_tunnel_encap(x, skb);
346 : : break;
347 : : }
348 : :
349 : : WARN_ON_ONCE(1);
350 : : return -EOPNOTSUPP;
351 : : }
352 : :
353 : 0 : static int xfrm_prepare_input(struct xfrm_state *x, struct sk_buff *skb)
354 : : {
355 : 0 : const struct xfrm_mode *inner_mode = &x->inner_mode;
356 : 0 : const struct xfrm_state_afinfo *afinfo;
357 : 0 : int err = -EAFNOSUPPORT;
358 : :
359 : 0 : rcu_read_lock();
360 : 0 : afinfo = xfrm_state_afinfo_get_rcu(x->outer_mode.family);
361 [ # # ]: 0 : if (likely(afinfo))
362 : 0 : err = afinfo->extract_input(x, skb);
363 : 0 : rcu_read_unlock();
364 : :
365 [ # # ]: 0 : if (err)
366 : 0 : return err;
367 : :
368 [ # # ]: 0 : if (x->sel.family == AF_UNSPEC) {
369 [ # # ]: 0 : inner_mode = xfrm_ip2inner_mode(x, XFRM_MODE_SKB_CB(skb)->protocol);
370 [ # # ]: 0 : if (!inner_mode)
371 : : return -EAFNOSUPPORT;
372 : : }
373 : :
374 [ # # # ]: 0 : switch (inner_mode->family) {
375 : 0 : case AF_INET:
376 : 0 : skb->protocol = htons(ETH_P_IP);
377 : 0 : break;
378 : 0 : case AF_INET6:
379 : 0 : skb->protocol = htons(ETH_P_IPV6);
380 : 0 : break;
381 : : default:
382 : 0 : WARN_ON_ONCE(1);
383 : 0 : break;
384 : : }
385 : :
386 : 0 : return xfrm_inner_mode_encap_remove(x, inner_mode, skb);
387 : : }
388 : :
389 : : /* Remove encapsulation header.
390 : : *
391 : : * The IP header will be moved over the top of the encapsulation header.
392 : : *
393 : : * On entry, skb_transport_header() shall point to where the IP header
394 : : * should be and skb_network_header() shall be set to where the IP header
395 : : * currently is. skb->data shall point to the start of the payload.
396 : : */
397 : : static int xfrm4_transport_input(struct xfrm_state *x, struct sk_buff *skb)
398 : : {
399 : : int ihl = skb->data - skb_transport_header(skb);
400 : :
401 : : if (skb->transport_header != skb->network_header) {
402 : : memmove(skb_transport_header(skb),
403 : : skb_network_header(skb), ihl);
404 : : skb->network_header = skb->transport_header;
405 : : }
406 : : ip_hdr(skb)->tot_len = htons(skb->len + ihl);
407 : : skb_reset_transport_header(skb);
408 : : return 0;
409 : : }
410 : :
411 : : static int xfrm6_transport_input(struct xfrm_state *x, struct sk_buff *skb)
412 : : {
413 : : #if IS_ENABLED(CONFIG_IPV6)
414 : : int ihl = skb->data - skb_transport_header(skb);
415 : :
416 : : if (skb->transport_header != skb->network_header) {
417 : : memmove(skb_transport_header(skb),
418 : : skb_network_header(skb), ihl);
419 : : skb->network_header = skb->transport_header;
420 : : }
421 : : ipv6_hdr(skb)->payload_len = htons(skb->len + ihl -
422 : : sizeof(struct ipv6hdr));
423 : : skb_reset_transport_header(skb);
424 : : return 0;
425 : : #else
426 : : WARN_ON_ONCE(1);
427 : : return -EAFNOSUPPORT;
428 : : #endif
429 : : }
430 : :
431 : : static int xfrm_inner_mode_input(struct xfrm_state *x,
432 : : const struct xfrm_mode *inner_mode,
433 : : struct sk_buff *skb)
434 : : {
435 : : switch (inner_mode->encap) {
436 : : case XFRM_MODE_BEET:
437 : : case XFRM_MODE_TUNNEL:
438 : : return xfrm_prepare_input(x, skb);
439 : : case XFRM_MODE_TRANSPORT:
440 : : if (inner_mode->family == AF_INET)
441 : : return xfrm4_transport_input(x, skb);
442 : : if (inner_mode->family == AF_INET6)
443 : : return xfrm6_transport_input(x, skb);
444 : : break;
445 : : case XFRM_MODE_ROUTEOPTIMIZATION:
446 : : WARN_ON_ONCE(1);
447 : : break;
448 : : default:
449 : : WARN_ON_ONCE(1);
450 : : break;
451 : : }
452 : :
453 : : return -EOPNOTSUPP;
454 : : }
455 : :
456 : 0 : int xfrm_input(struct sk_buff *skb, int nexthdr, __be32 spi, int encap_type)
457 : : {
458 : 0 : const struct xfrm_state_afinfo *afinfo;
459 [ # # ]: 0 : struct net *net = dev_net(skb->dev);
460 : 0 : const struct xfrm_mode *inner_mode;
461 : 0 : int err;
462 : 0 : __be32 seq;
463 : 0 : __be32 seq_hi;
464 : 0 : struct xfrm_state *x = NULL;
465 : 0 : xfrm_address_t *daddr;
466 : 0 : u32 mark = skb->mark;
467 : 0 : unsigned int family = AF_UNSPEC;
468 : 0 : int decaps = 0;
469 : 0 : int async = 0;
470 : 0 : bool xfrm_gro = false;
471 : 0 : bool crypto_done = false;
472 [ # # ]: 0 : struct xfrm_offload *xo = xfrm_offload(skb);
473 : 0 : struct sec_path *sp;
474 : :
475 [ # # ]: 0 : if (encap_type < 0) {
476 [ # # ]: 0 : x = xfrm_input_state(skb);
477 : :
478 [ # # ]: 0 : if (unlikely(x->km.state != XFRM_STATE_VALID)) {
479 : 0 : if (x->km.state == XFRM_STATE_ACQ)
480 : : XFRM_INC_STATS(net, LINUX_MIB_XFRMACQUIREERROR);
481 : : else
482 : 0 : XFRM_INC_STATS(net,
483 : : LINUX_MIB_XFRMINSTATEINVALID);
484 : :
485 [ # # ]: 0 : if (encap_type == -1)
486 : 0 : dev_put(skb->dev);
487 : 0 : goto drop;
488 : : }
489 : :
490 : 0 : family = x->outer_mode.family;
491 : :
492 : : /* An encap_type of -1 indicates async resumption. */
493 [ # # ]: 0 : if (encap_type == -1) {
494 : 0 : async = 1;
495 : 0 : seq = XFRM_SKB_CB(skb)->seq.input.low;
496 : 0 : goto resume;
497 : : }
498 : :
499 : : /* encap_type < -1 indicates a GRO call. */
500 : 0 : encap_type = 0;
501 : 0 : seq = XFRM_SPI_SKB_CB(skb)->seq;
502 : :
503 [ # # # # ]: 0 : if (xo && (xo->flags & CRYPTO_DONE)) {
504 : 0 : crypto_done = true;
505 : 0 : family = XFRM_SPI_SKB_CB(skb)->family;
506 : :
507 [ # # ]: 0 : if (!(xo->status & CRYPTO_SUCCESS)) {
508 [ # # ]: 0 : if (xo->status &
509 : : (CRYPTO_TRANSPORT_AH_AUTH_FAILED |
510 : : CRYPTO_TRANSPORT_ESP_AUTH_FAILED |
511 : : CRYPTO_TUNNEL_AH_AUTH_FAILED |
512 : : CRYPTO_TUNNEL_ESP_AUTH_FAILED)) {
513 : :
514 : 0 : xfrm_audit_state_icvfail(x, skb,
515 : 0 : x->type->proto);
516 : 0 : x->stats.integrity_failed++;
517 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATEPROTOERROR);
518 : 0 : goto drop;
519 : : }
520 : :
521 [ # # ]: 0 : if (xo->status & CRYPTO_INVALID_PROTOCOL) {
522 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATEPROTOERROR);
523 : 0 : goto drop;
524 : : }
525 : :
526 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINBUFFERERROR);
527 : 0 : goto drop;
528 : : }
529 : :
530 [ # # ]: 0 : if ((err = xfrm_parse_spi(skb, nexthdr, &spi, &seq)) != 0) {
531 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINHDRERROR);
532 : 0 : goto drop;
533 : : }
534 : : }
535 : :
536 : 0 : goto lock;
537 : : }
538 : :
539 : 0 : family = XFRM_SPI_SKB_CB(skb)->family;
540 : :
541 : : /* if tunnel is present override skb->mark value with tunnel i_key */
542 [ # # # ]: 0 : switch (family) {
543 : 0 : case AF_INET:
544 [ # # ]: 0 : if (XFRM_TUNNEL_SKB_CB(skb)->tunnel.ip4)
545 : 0 : mark = be32_to_cpu(XFRM_TUNNEL_SKB_CB(skb)->tunnel.ip4->parms.i_key);
546 : : break;
547 : 0 : case AF_INET6:
548 [ # # ]: 0 : if (XFRM_TUNNEL_SKB_CB(skb)->tunnel.ip6)
549 : 0 : mark = be32_to_cpu(XFRM_TUNNEL_SKB_CB(skb)->tunnel.ip6->parms.i_key);
550 : : break;
551 : : }
552 : :
553 : 0 : sp = secpath_set(skb);
554 [ # # ]: 0 : if (!sp) {
555 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINERROR);
556 : 0 : goto drop;
557 : : }
558 : :
559 : 0 : seq = 0;
560 [ # # # # ]: 0 : if (!spi && (err = xfrm_parse_spi(skb, nexthdr, &spi, &seq)) != 0) {
561 [ # # ]: 0 : secpath_reset(skb);
562 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINHDRERROR);
563 : 0 : goto drop;
564 : : }
565 : :
566 : 0 : daddr = (xfrm_address_t *)(skb_network_header(skb) +
567 : 0 : XFRM_SPI_SKB_CB(skb)->daddroff);
568 : 0 : do {
569 [ # # ]: 0 : sp = skb_sec_path(skb);
570 : :
571 [ # # ]: 0 : if (sp->len == XFRM_MAX_DEPTH) {
572 [ # # ]: 0 : secpath_reset(skb);
573 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINBUFFERERROR);
574 : 0 : goto drop;
575 : : }
576 : :
577 : 0 : x = xfrm_state_lookup(net, mark, daddr, spi, nexthdr, family);
578 [ # # ]: 0 : if (x == NULL) {
579 [ # # ]: 0 : secpath_reset(skb);
580 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINNOSTATES);
581 : 0 : xfrm_audit_state_notfound(skb, family, spi, seq);
582 : 0 : goto drop;
583 : : }
584 : :
585 : 0 : skb->mark = xfrm_smark_get(skb->mark, x);
586 : :
587 : 0 : sp->xvec[sp->len++] = x;
588 : :
589 : 0 : skb_dst_force(skb);
590 [ # # ]: 0 : if (!skb_dst(skb)) {
591 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINERROR);
592 : 0 : goto drop;
593 : : }
594 : :
595 : 0 : lock:
596 : 0 : spin_lock(&x->lock);
597 : :
598 [ # # ]: 0 : if (unlikely(x->km.state != XFRM_STATE_VALID)) {
599 : 0 : if (x->km.state == XFRM_STATE_ACQ)
600 : : XFRM_INC_STATS(net, LINUX_MIB_XFRMACQUIREERROR);
601 : : else
602 : 0 : XFRM_INC_STATS(net,
603 : : LINUX_MIB_XFRMINSTATEINVALID);
604 : 0 : goto drop_unlock;
605 : : }
606 : :
607 [ # # # # ]: 0 : if ((x->encap ? x->encap->encap_type : 0) != encap_type) {
608 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATEMISMATCH);
609 : 0 : goto drop_unlock;
610 : : }
611 : :
612 [ # # ]: 0 : if (x->repl->check(x, skb, seq)) {
613 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATESEQERROR);
614 : 0 : goto drop_unlock;
615 : : }
616 : :
617 [ # # ]: 0 : if (xfrm_state_check_expire(x)) {
618 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATEEXPIRED);
619 : 0 : goto drop_unlock;
620 : : }
621 : :
622 : 0 : spin_unlock(&x->lock);
623 : :
624 [ # # # ]: 0 : if (xfrm_tunnel_check(skb, x, family)) {
625 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATEMODEERROR);
626 : 0 : goto drop;
627 : : }
628 : :
629 : 0 : seq_hi = htonl(xfrm_replay_seqhi(x, seq));
630 : :
631 : 0 : XFRM_SKB_CB(skb)->seq.input.low = seq;
632 : 0 : XFRM_SKB_CB(skb)->seq.input.hi = seq_hi;
633 : :
634 : 0 : dev_hold(skb->dev);
635 : :
636 [ # # ]: 0 : if (crypto_done)
637 : 0 : nexthdr = x->type_offload->input_tail(x, skb);
638 : : else
639 : 0 : nexthdr = x->type->input(x, skb);
640 : :
641 [ # # ]: 0 : if (nexthdr == -EINPROGRESS)
642 : : return 0;
643 : 0 : resume:
644 : 0 : dev_put(skb->dev);
645 : :
646 : 0 : spin_lock(&x->lock);
647 [ # # ]: 0 : if (nexthdr <= 0) {
648 [ # # ]: 0 : if (nexthdr == -EBADMSG) {
649 : 0 : xfrm_audit_state_icvfail(x, skb,
650 : 0 : x->type->proto);
651 : 0 : x->stats.integrity_failed++;
652 : : }
653 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATEPROTOERROR);
654 : 0 : goto drop_unlock;
655 : : }
656 : :
657 : : /* only the first xfrm gets the encap type */
658 : 0 : encap_type = 0;
659 : :
660 [ # # # # ]: 0 : if (async && x->repl->recheck(x, skb, seq)) {
661 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATESEQERROR);
662 : 0 : goto drop_unlock;
663 : : }
664 : :
665 : 0 : x->repl->advance(x, seq);
666 : :
667 : 0 : x->curlft.bytes += skb->len;
668 : 0 : x->curlft.packets++;
669 : :
670 : 0 : spin_unlock(&x->lock);
671 : :
672 : 0 : XFRM_MODE_SKB_CB(skb)->protocol = nexthdr;
673 : :
674 : 0 : inner_mode = &x->inner_mode;
675 : :
676 [ # # ]: 0 : if (x->sel.family == AF_UNSPEC) {
677 [ # # ]: 0 : inner_mode = xfrm_ip2inner_mode(x, XFRM_MODE_SKB_CB(skb)->protocol);
678 [ # # ]: 0 : if (inner_mode == NULL) {
679 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATEMODEERROR);
680 : 0 : goto drop;
681 : : }
682 : : }
683 : :
684 [ # # ]: 0 : if (xfrm_inner_mode_input(x, inner_mode, skb)) {
685 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATEMODEERROR);
686 : 0 : goto drop;
687 : : }
688 : :
689 [ # # ]: 0 : if (x->outer_mode.flags & XFRM_MODE_FLAG_TUNNEL) {
690 : : decaps = 1;
691 : : break;
692 : : }
693 : :
694 : : /*
695 : : * We need the inner address. However, we only get here for
696 : : * transport mode so the outer address is identical.
697 : : */
698 : 0 : daddr = &x->id.daddr;
699 : 0 : family = x->outer_mode.family;
700 : :
701 : 0 : err = xfrm_parse_spi(skb, nexthdr, &spi, &seq);
702 [ # # ]: 0 : if (err < 0) {
703 : 0 : XFRM_INC_STATS(net, LINUX_MIB_XFRMINHDRERROR);
704 : 0 : goto drop;
705 : : }
706 : 0 : crypto_done = false;
707 [ # # ]: 0 : } while (!err);
708 : :
709 : 0 : err = xfrm_rcv_cb(skb, family, x->type->proto, 0);
710 [ # # ]: 0 : if (err)
711 : 0 : goto drop;
712 : :
713 : 0 : nf_reset_ct(skb);
714 : :
715 [ # # ]: 0 : if (decaps) {
716 [ # # ]: 0 : sp = skb_sec_path(skb);
717 [ # # ]: 0 : if (sp)
718 : 0 : sp->olen = 0;
719 [ # # ]: 0 : skb_dst_drop(skb);
720 : 0 : gro_cells_receive(&gro_cells, skb);
721 : 0 : return 0;
722 : : } else {
723 [ # # ]: 0 : xo = xfrm_offload(skb);
724 [ # # ]: 0 : if (xo)
725 : 0 : xfrm_gro = xo->flags & XFRM_GRO;
726 : :
727 : 0 : err = -EAFNOSUPPORT;
728 : 0 : rcu_read_lock();
729 : 0 : afinfo = xfrm_state_afinfo_get_rcu(x->inner_mode.family);
730 [ # # ]: 0 : if (likely(afinfo))
731 : 0 : err = afinfo->transport_finish(skb, xfrm_gro || async);
732 : 0 : rcu_read_unlock();
733 [ # # ]: 0 : if (xfrm_gro) {
734 [ # # ]: 0 : sp = skb_sec_path(skb);
735 [ # # ]: 0 : if (sp)
736 : 0 : sp->olen = 0;
737 [ # # ]: 0 : skb_dst_drop(skb);
738 : 0 : gro_cells_receive(&gro_cells, skb);
739 : 0 : return err;
740 : : }
741 : :
742 : : return err;
743 : : }
744 : :
745 : 0 : drop_unlock:
746 : 0 : spin_unlock(&x->lock);
747 : 0 : drop:
748 [ # # # # ]: 0 : xfrm_rcv_cb(skb, family, x && x->type ? x->type->proto : nexthdr, -1);
749 : 0 : kfree_skb(skb);
750 : 0 : return 0;
751 : : }
752 : : EXPORT_SYMBOL(xfrm_input);
753 : :
754 : 0 : int xfrm_input_resume(struct sk_buff *skb, int nexthdr)
755 : : {
756 : 0 : return xfrm_input(skb, nexthdr, 0, -1);
757 : : }
758 : : EXPORT_SYMBOL(xfrm_input_resume);
759 : :
760 : 0 : static void xfrm_trans_reinject(unsigned long data)
761 : : {
762 : 0 : struct xfrm_trans_tasklet *trans = (void *)data;
763 : 0 : struct sk_buff_head queue;
764 : 0 : struct sk_buff *skb;
765 : :
766 [ # # ]: 0 : __skb_queue_head_init(&queue);
767 [ # # ]: 0 : skb_queue_splice_init(&trans->queue, &queue);
768 : :
769 [ # # # # ]: 0 : while ((skb = __skb_dequeue(&queue)))
770 : 0 : XFRM_TRANS_SKB_CB(skb)->finish(XFRM_TRANS_SKB_CB(skb)->net,
771 : : NULL, skb);
772 : 0 : }
773 : :
774 : 0 : int xfrm_trans_queue_net(struct net *net, struct sk_buff *skb,
775 : : int (*finish)(struct net *, struct sock *,
776 : : struct sk_buff *))
777 : : {
778 : 0 : struct xfrm_trans_tasklet *trans;
779 : :
780 : 0 : trans = this_cpu_ptr(&xfrm_trans_tasklet);
781 : :
782 [ # # ]: 0 : if (skb_queue_len(&trans->queue) >= netdev_max_backlog)
783 : : return -ENOBUFS;
784 : :
785 : 0 : BUILD_BUG_ON(sizeof(struct xfrm_trans_cb) > sizeof(skb->cb));
786 : :
787 : 0 : XFRM_TRANS_SKB_CB(skb)->finish = finish;
788 : 0 : XFRM_TRANS_SKB_CB(skb)->net = net;
789 : 0 : __skb_queue_tail(&trans->queue, skb);
790 : 0 : tasklet_schedule(&trans->tasklet);
791 : 0 : return 0;
792 : : }
793 : : EXPORT_SYMBOL(xfrm_trans_queue_net);
794 : :
795 : 0 : int xfrm_trans_queue(struct sk_buff *skb,
796 : : int (*finish)(struct net *, struct sock *,
797 : : struct sk_buff *))
798 : : {
799 : 0 : return xfrm_trans_queue_net(dev_net(skb->dev), skb, finish);
800 : : }
801 : : EXPORT_SYMBOL(xfrm_trans_queue);
802 : :
803 : 30 : void __init xfrm_input_init(void)
804 : : {
805 : 30 : int err;
806 : 30 : int i;
807 : :
808 : 30 : init_dummy_netdev(&xfrm_napi_dev);
809 : 30 : err = gro_cells_init(&gro_cells, &xfrm_napi_dev);
810 [ - + ]: 30 : if (err)
811 : 0 : gro_cells.cells = NULL;
812 : :
813 [ + + ]: 60 : for_each_possible_cpu(i) {
814 : 30 : struct xfrm_trans_tasklet *trans;
815 : :
816 : 30 : trans = &per_cpu(xfrm_trans_tasklet, i);
817 : 30 : __skb_queue_head_init(&trans->queue);
818 : 30 : tasklet_init(&trans->tasklet, xfrm_trans_reinject,
819 : : (unsigned long)trans);
820 : : }
821 : 30 : }
|
