Linux Audio

Check our new training course

Linux kernel drivers training

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