]> Git Repo - linux.git/blame - net/xfrm/xfrm_state.c
xfrm: Cache used outbound xfrm states at the policy.
[linux.git] / net / xfrm / xfrm_state.c
CommitLineData
457c8996 1// SPDX-License-Identifier: GPL-2.0-only
1da177e4
LT
2/*
3 * xfrm_state.c
4 *
5 * Changes:
6 * Mitsuru KANDA @USAGI
7 * Kazunori MIYAZAWA @USAGI
8 * Kunihiro Ishiguro <[email protected]>
9 * IPv6 support
10 * YOSHIFUJI Hideaki @USAGI
11 * Split up af-specific functions
12 * Derek Atkins <[email protected]>
13 * Add UDP Encapsulation
df71837d 14 *
1da177e4
LT
15 */
16
b6459415 17#include <linux/compat.h>
1da177e4
LT
18#include <linux/workqueue.h>
19#include <net/xfrm.h>
20#include <linux/pfkeyv2.h>
21#include <linux/ipsec.h>
22#include <linux/module.h>
f034b5d4 23#include <linux/cache.h>
68277acc 24#include <linux/audit.h>
7c0f6ba6 25#include <linux/uaccess.h>
9e0d57fd 26#include <linux/ktime.h>
5a0e3ad6 27#include <linux/slab.h>
9e0d57fd
YP
28#include <linux/interrupt.h>
29#include <linux/kernel.h>
1da177e4 30
c7b37c76
FW
31#include <crypto/aead.h>
32
44e36b42
DM
33#include "xfrm_hash.h"
34
c8406998
FW
35#define xfrm_state_deref_prot(table, net) \
36 rcu_dereference_protected((table), lockdep_is_held(&(net)->xfrm.xfrm_state_lock))
37
35db57bb
FW
38static void xfrm_state_gc_task(struct work_struct *work);
39
1da177e4
LT
40/* Each xfrm_state may be linked to two tables:
41
42 1. Hash table by (spi,daddr,ah/esp) to find SA by SPI. (input,ctl)
a624c108 43 2. Hash table by (daddr,family,reqid) to find what SAs exist for given
1da177e4
LT
44 destination/tunnel endpoint. (output)
45 */
46
f034b5d4 47static unsigned int xfrm_state_hashmax __read_mostly = 1 * 1024 * 1024;
565f0fa9 48static struct kmem_cache *xfrm_state_cache __ro_after_init;
f034b5d4 49
35db57bb
FW
50static DECLARE_WORK(xfrm_state_gc_work, xfrm_state_gc_task);
51static HLIST_HEAD(xfrm_state_gc_list);
07b87f9e 52static HLIST_HEAD(xfrm_state_dev_gc_list);
35db57bb 53
02efdff7
FW
54static inline bool xfrm_state_hold_rcu(struct xfrm_state __rcu *x)
55{
88755e9c 56 return refcount_inc_not_zero(&x->refcnt);
02efdff7
FW
57}
58
64d0cd00 59static inline unsigned int xfrm_dst_hash(struct net *net,
2ab38503
DM
60 const xfrm_address_t *daddr,
61 const xfrm_address_t *saddr,
c1969f29 62 u32 reqid,
a624c108 63 unsigned short family)
f034b5d4 64{
64d0cd00 65 return __xfrm_dst_hash(daddr, saddr, reqid, family, net->xfrm.state_hmask);
f034b5d4
DM
66}
67
64d0cd00 68static inline unsigned int xfrm_src_hash(struct net *net,
2ab38503
DM
69 const xfrm_address_t *daddr,
70 const xfrm_address_t *saddr,
44e36b42 71 unsigned short family)
f034b5d4 72{
64d0cd00 73 return __xfrm_src_hash(daddr, saddr, family, net->xfrm.state_hmask);
f034b5d4
DM
74}
75
f034b5d4 76static inline unsigned int
2ab38503
DM
77xfrm_spi_hash(struct net *net, const xfrm_address_t *daddr,
78 __be32 spi, u8 proto, unsigned short family)
f034b5d4 79{
64d0cd00 80 return __xfrm_spi_hash(daddr, spi, proto, family, net->xfrm.state_hmask);
f034b5d4
DM
81}
82
fe9f1d87
SD
83static unsigned int xfrm_seq_hash(struct net *net, u32 seq)
84{
85 return __xfrm_seq_hash(seq, net->xfrm.state_hmask);
86}
87
3c611d40
LR
88#define XFRM_STATE_INSERT(by, _n, _h, _type) \
89 { \
90 struct xfrm_state *_x = NULL; \
91 \
92 if (_type != XFRM_DEV_OFFLOAD_PACKET) { \
93 hlist_for_each_entry_rcu(_x, _h, by) { \
94 if (_x->xso.type == XFRM_DEV_OFFLOAD_PACKET) \
95 continue; \
96 break; \
97 } \
98 } \
99 \
100 if (!_x || _x->xso.type == XFRM_DEV_OFFLOAD_PACKET) \
101 /* SAD is empty or consist from HW SAs only */ \
102 hlist_add_head_rcu(_n, _h); \
103 else \
104 hlist_add_before_rcu(_n, &_x->by); \
105 }
106
f034b5d4
DM
107static void xfrm_hash_transfer(struct hlist_head *list,
108 struct hlist_head *ndsttable,
109 struct hlist_head *nsrctable,
110 struct hlist_head *nspitable,
fe9f1d87 111 struct hlist_head *nseqtable,
f034b5d4
DM
112 unsigned int nhashmask)
113{
b67bfe0d 114 struct hlist_node *tmp;
f034b5d4
DM
115 struct xfrm_state *x;
116
b67bfe0d 117 hlist_for_each_entry_safe(x, tmp, list, bydst) {
f034b5d4
DM
118 unsigned int h;
119
c1969f29
DM
120 h = __xfrm_dst_hash(&x->id.daddr, &x->props.saddr,
121 x->props.reqid, x->props.family,
122 nhashmask);
3c611d40 123 XFRM_STATE_INSERT(bydst, &x->bydst, ndsttable + h, x->xso.type);
f034b5d4 124
667bbcb6
MN
125 h = __xfrm_src_hash(&x->id.daddr, &x->props.saddr,
126 x->props.family,
f034b5d4 127 nhashmask);
3c611d40 128 XFRM_STATE_INSERT(bysrc, &x->bysrc, nsrctable + h, x->xso.type);
f034b5d4 129
7b4dc360
MN
130 if (x->id.spi) {
131 h = __xfrm_spi_hash(&x->id.daddr, x->id.spi,
132 x->id.proto, x->props.family,
133 nhashmask);
3c611d40
LR
134 XFRM_STATE_INSERT(byspi, &x->byspi, nspitable + h,
135 x->xso.type);
7b4dc360 136 }
fe9f1d87
SD
137
138 if (x->km.seq) {
139 h = __xfrm_seq_hash(x->km.seq, nhashmask);
3c611d40
LR
140 XFRM_STATE_INSERT(byseq, &x->byseq, nseqtable + h,
141 x->xso.type);
fe9f1d87 142 }
f034b5d4
DM
143 }
144}
145
63082733 146static unsigned long xfrm_hash_new_size(unsigned int state_hmask)
f034b5d4 147{
63082733 148 return ((state_hmask + 1) << 1) * sizeof(struct hlist_head);
f034b5d4
DM
149}
150
63082733 151static void xfrm_hash_resize(struct work_struct *work)
f034b5d4 152{
63082733 153 struct net *net = container_of(work, struct net, xfrm.state_hash_work);
fe9f1d87 154 struct hlist_head *ndst, *nsrc, *nspi, *nseq, *odst, *osrc, *ospi, *oseq;
f034b5d4
DM
155 unsigned long nsize, osize;
156 unsigned int nhashmask, ohashmask;
157 int i;
158
63082733 159 nsize = xfrm_hash_new_size(net->xfrm.state_hmask);
44e36b42 160 ndst = xfrm_hash_alloc(nsize);
f034b5d4 161 if (!ndst)
0244790c 162 return;
44e36b42 163 nsrc = xfrm_hash_alloc(nsize);
f034b5d4 164 if (!nsrc) {
44e36b42 165 xfrm_hash_free(ndst, nsize);
0244790c 166 return;
f034b5d4 167 }
44e36b42 168 nspi = xfrm_hash_alloc(nsize);
f034b5d4 169 if (!nspi) {
44e36b42
DM
170 xfrm_hash_free(ndst, nsize);
171 xfrm_hash_free(nsrc, nsize);
0244790c 172 return;
f034b5d4 173 }
fe9f1d87
SD
174 nseq = xfrm_hash_alloc(nsize);
175 if (!nseq) {
176 xfrm_hash_free(ndst, nsize);
177 xfrm_hash_free(nsrc, nsize);
178 xfrm_hash_free(nspi, nsize);
179 return;
180 }
f034b5d4 181
283bc9f3 182 spin_lock_bh(&net->xfrm.xfrm_state_lock);
e88add19 183 write_seqcount_begin(&net->xfrm.xfrm_state_hash_generation);
f034b5d4
DM
184
185 nhashmask = (nsize / sizeof(struct hlist_head)) - 1U;
c8406998 186 odst = xfrm_state_deref_prot(net->xfrm.state_bydst, net);
63082733 187 for (i = net->xfrm.state_hmask; i >= 0; i--)
fe9f1d87 188 xfrm_hash_transfer(odst + i, ndst, nsrc, nspi, nseq, nhashmask);
f034b5d4 189
c8406998
FW
190 osrc = xfrm_state_deref_prot(net->xfrm.state_bysrc, net);
191 ospi = xfrm_state_deref_prot(net->xfrm.state_byspi, net);
fe9f1d87 192 oseq = xfrm_state_deref_prot(net->xfrm.state_byseq, net);
63082733 193 ohashmask = net->xfrm.state_hmask;
f034b5d4 194
c8406998
FW
195 rcu_assign_pointer(net->xfrm.state_bydst, ndst);
196 rcu_assign_pointer(net->xfrm.state_bysrc, nsrc);
197 rcu_assign_pointer(net->xfrm.state_byspi, nspi);
fe9f1d87 198 rcu_assign_pointer(net->xfrm.state_byseq, nseq);
63082733 199 net->xfrm.state_hmask = nhashmask;
f034b5d4 200
e88add19 201 write_seqcount_end(&net->xfrm.xfrm_state_hash_generation);
283bc9f3 202 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
f034b5d4
DM
203
204 osize = (ohashmask + 1) * sizeof(struct hlist_head);
df7274eb
FW
205
206 synchronize_rcu();
207
44e36b42
DM
208 xfrm_hash_free(odst, osize);
209 xfrm_hash_free(osrc, osize);
210 xfrm_hash_free(ospi, osize);
fe9f1d87 211 xfrm_hash_free(oseq, osize);
f034b5d4
DM
212}
213
44abdc30
CW
214static DEFINE_SPINLOCK(xfrm_state_afinfo_lock);
215static struct xfrm_state_afinfo __rcu *xfrm_state_afinfo[NPROTO];
1da177e4 216
1da177e4 217static DEFINE_SPINLOCK(xfrm_state_gc_lock);
07b87f9e 218static DEFINE_SPINLOCK(xfrm_state_dev_gc_lock);
1da177e4 219
53bc6b4d 220int __xfrm_state_delete(struct xfrm_state *x);
1da177e4 221
980ebd25 222int km_query(struct xfrm_state *x, struct xfrm_tmpl *t, struct xfrm_policy *pol);
bb9cd077 223static bool km_is_alive(const struct km_event *c);
15e47304 224void km_state_expired(struct xfrm_state *x, int hard, u32 portid);
1da177e4 225
533cb5b0 226int xfrm_register_type(const struct xfrm_type *type, unsigned short family)
aa5d62cc 227{
7a9885b9 228 struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
aa5d62cc
HX
229 int err = 0;
230
4f518e80 231 if (!afinfo)
aa5d62cc 232 return -EAFNOSUPPORT;
4f518e80
FW
233
234#define X(afi, T, name) do { \
235 WARN_ON((afi)->type_ ## name); \
236 (afi)->type_ ## name = (T); \
237 } while (0)
238
239 switch (type->proto) {
240 case IPPROTO_COMP:
241 X(afinfo, type, comp);
242 break;
243 case IPPROTO_AH:
244 X(afinfo, type, ah);
245 break;
246 case IPPROTO_ESP:
247 X(afinfo, type, esp);
248 break;
249 case IPPROTO_IPIP:
250 X(afinfo, type, ipip);
251 break;
252 case IPPROTO_DSTOPTS:
253 X(afinfo, type, dstopts);
254 break;
255 case IPPROTO_ROUTING:
256 X(afinfo, type, routing);
257 break;
258 case IPPROTO_IPV6:
259 X(afinfo, type, ipip6);
260 break;
261 default:
262 WARN_ON(1);
263 err = -EPROTONOSUPPORT;
264 break;
265 }
266#undef X
af5d27c4 267 rcu_read_unlock();
aa5d62cc
HX
268 return err;
269}
270EXPORT_SYMBOL(xfrm_register_type);
271
4f518e80 272void xfrm_unregister_type(const struct xfrm_type *type, unsigned short family)
aa5d62cc 273{
7a9885b9 274 struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
aa5d62cc
HX
275
276 if (unlikely(afinfo == NULL))
4f518e80
FW
277 return;
278
279#define X(afi, T, name) do { \
280 WARN_ON((afi)->type_ ## name != (T)); \
281 (afi)->type_ ## name = NULL; \
282 } while (0)
283
284 switch (type->proto) {
285 case IPPROTO_COMP:
286 X(afinfo, type, comp);
287 break;
288 case IPPROTO_AH:
289 X(afinfo, type, ah);
290 break;
291 case IPPROTO_ESP:
292 X(afinfo, type, esp);
293 break;
294 case IPPROTO_IPIP:
295 X(afinfo, type, ipip);
296 break;
297 case IPPROTO_DSTOPTS:
298 X(afinfo, type, dstopts);
299 break;
300 case IPPROTO_ROUTING:
301 X(afinfo, type, routing);
302 break;
303 case IPPROTO_IPV6:
304 X(afinfo, type, ipip6);
305 break;
306 default:
307 WARN_ON(1);
308 break;
309 }
310#undef X
af5d27c4 311 rcu_read_unlock();
aa5d62cc
HX
312}
313EXPORT_SYMBOL(xfrm_unregister_type);
314
533cb5b0 315static const struct xfrm_type *xfrm_get_type(u8 proto, unsigned short family)
aa5d62cc 316{
4f518e80 317 const struct xfrm_type *type = NULL;
aa5d62cc 318 struct xfrm_state_afinfo *afinfo;
aa5d62cc
HX
319 int modload_attempted = 0;
320
321retry:
322 afinfo = xfrm_state_get_afinfo(family);
323 if (unlikely(afinfo == NULL))
324 return NULL;
aa5d62cc 325
4f518e80
FW
326 switch (proto) {
327 case IPPROTO_COMP:
328 type = afinfo->type_comp;
329 break;
330 case IPPROTO_AH:
331 type = afinfo->type_ah;
332 break;
333 case IPPROTO_ESP:
334 type = afinfo->type_esp;
335 break;
336 case IPPROTO_IPIP:
337 type = afinfo->type_ipip;
338 break;
339 case IPPROTO_DSTOPTS:
340 type = afinfo->type_dstopts;
341 break;
342 case IPPROTO_ROUTING:
343 type = afinfo->type_routing;
344 break;
345 case IPPROTO_IPV6:
346 type = afinfo->type_ipip6;
347 break;
348 default:
349 break;
350 }
351
aa5d62cc
HX
352 if (unlikely(type && !try_module_get(type->owner)))
353 type = NULL;
75cda62d
FW
354
355 rcu_read_unlock();
356
aa5d62cc 357 if (!type && !modload_attempted) {
aa5d62cc
HX
358 request_module("xfrm-type-%d-%d", family, proto);
359 modload_attempted = 1;
360 goto retry;
361 }
362
aa5d62cc
HX
363 return type;
364}
365
533cb5b0 366static void xfrm_put_type(const struct xfrm_type *type)
aa5d62cc
HX
367{
368 module_put(type->owner);
369}
370
9d389d7f
SK
371int xfrm_register_type_offload(const struct xfrm_type_offload *type,
372 unsigned short family)
373{
374 struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
9d389d7f
SK
375 int err = 0;
376
377 if (unlikely(afinfo == NULL))
378 return -EAFNOSUPPORT;
4f518e80
FW
379
380 switch (type->proto) {
381 case IPPROTO_ESP:
382 WARN_ON(afinfo->type_offload_esp);
383 afinfo->type_offload_esp = type;
384 break;
385 default:
386 WARN_ON(1);
387 err = -EPROTONOSUPPORT;
388 break;
389 }
390
9d389d7f
SK
391 rcu_read_unlock();
392 return err;
393}
394EXPORT_SYMBOL(xfrm_register_type_offload);
395
4f518e80
FW
396void xfrm_unregister_type_offload(const struct xfrm_type_offload *type,
397 unsigned short family)
9d389d7f
SK
398{
399 struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
9d389d7f
SK
400
401 if (unlikely(afinfo == NULL))
4f518e80
FW
402 return;
403
404 switch (type->proto) {
405 case IPPROTO_ESP:
406 WARN_ON(afinfo->type_offload_esp != type);
407 afinfo->type_offload_esp = NULL;
408 break;
409 default:
410 WARN_ON(1);
411 break;
412 }
9d389d7f 413 rcu_read_unlock();
9d389d7f
SK
414}
415EXPORT_SYMBOL(xfrm_unregister_type_offload);
416
ffdb5211
IT
417static const struct xfrm_type_offload *
418xfrm_get_type_offload(u8 proto, unsigned short family, bool try_load)
9d389d7f 419{
4f518e80 420 const struct xfrm_type_offload *type = NULL;
9d389d7f 421 struct xfrm_state_afinfo *afinfo;
9d389d7f 422
ffdb5211 423retry:
9d389d7f
SK
424 afinfo = xfrm_state_get_afinfo(family);
425 if (unlikely(afinfo == NULL))
426 return NULL;
9d389d7f 427
4f518e80
FW
428 switch (proto) {
429 case IPPROTO_ESP:
430 type = afinfo->type_offload_esp;
431 break;
432 default:
433 break;
434 }
435
9d389d7f
SK
436 if ((type && !try_module_get(type->owner)))
437 type = NULL;
438
2f10a61c
SD
439 rcu_read_unlock();
440
ffdb5211
IT
441 if (!type && try_load) {
442 request_module("xfrm-offload-%d-%d", family, proto);
545d8ae7 443 try_load = false;
ffdb5211
IT
444 goto retry;
445 }
446
9d389d7f
SK
447 return type;
448}
449
450static void xfrm_put_type_offload(const struct xfrm_type_offload *type)
451{
452 module_put(type->owner);
453}
454
4c145dce
FW
455static const struct xfrm_mode xfrm4_mode_map[XFRM_MODE_MAX] = {
456 [XFRM_MODE_BEET] = {
457 .encap = XFRM_MODE_BEET,
458 .flags = XFRM_MODE_FLAG_TUNNEL,
459 .family = AF_INET,
460 },
461 [XFRM_MODE_TRANSPORT] = {
462 .encap = XFRM_MODE_TRANSPORT,
463 .family = AF_INET,
464 },
465 [XFRM_MODE_TUNNEL] = {
466 .encap = XFRM_MODE_TUNNEL,
467 .flags = XFRM_MODE_FLAG_TUNNEL,
468 .family = AF_INET,
469 },
470};
471
472static const struct xfrm_mode xfrm6_mode_map[XFRM_MODE_MAX] = {
473 [XFRM_MODE_BEET] = {
474 .encap = XFRM_MODE_BEET,
475 .flags = XFRM_MODE_FLAG_TUNNEL,
476 .family = AF_INET6,
477 },
478 [XFRM_MODE_ROUTEOPTIMIZATION] = {
479 .encap = XFRM_MODE_ROUTEOPTIMIZATION,
480 .family = AF_INET6,
481 },
482 [XFRM_MODE_TRANSPORT] = {
483 .encap = XFRM_MODE_TRANSPORT,
484 .family = AF_INET6,
485 },
486 [XFRM_MODE_TUNNEL] = {
487 .encap = XFRM_MODE_TUNNEL,
488 .flags = XFRM_MODE_FLAG_TUNNEL,
489 .family = AF_INET6,
490 },
491};
492
493static const struct xfrm_mode *xfrm_get_mode(unsigned int encap, int family)
494{
495 const struct xfrm_mode *mode;
aa5d62cc
HX
496
497 if (unlikely(encap >= XFRM_MODE_MAX))
498 return NULL;
499
4c145dce
FW
500 switch (family) {
501 case AF_INET:
502 mode = &xfrm4_mode_map[encap];
503 if (mode->family == family)
504 return mode;
505 break;
506 case AF_INET6:
507 mode = &xfrm6_mode_map[encap];
508 if (mode->family == family)
509 return mode;
510 break;
511 default:
512 break;
aa5d62cc
HX
513 }
514
4c145dce 515 return NULL;
aa5d62cc
HX
516}
517
4a135e53
MK
518void xfrm_state_free(struct xfrm_state *x)
519{
520 kmem_cache_free(xfrm_state_cache, x);
521}
522EXPORT_SYMBOL(xfrm_state_free);
523
f75a2804 524static void ___xfrm_state_destroy(struct xfrm_state *x)
1da177e4 525{
671422b2 526 hrtimer_cancel(&x->mtimer);
a47f0ce0 527 del_timer_sync(&x->rtimer);
b5884793 528 kfree(x->aead);
a51482bd
JJ
529 kfree(x->aalg);
530 kfree(x->ealg);
531 kfree(x->calg);
532 kfree(x->encap);
060f02a3 533 kfree(x->coaddr);
d8647b79
SK
534 kfree(x->replay_esn);
535 kfree(x->preplay_esn);
9d389d7f
SK
536 if (x->type_offload)
537 xfrm_put_type_offload(x->type_offload);
1da177e4
LT
538 if (x->type) {
539 x->type->destructor(x);
540 xfrm_put_type(x->type);
541 }
86c6739e
SK
542 if (x->xfrag.page)
543 put_page(x->xfrag.page);
d77e38e6 544 xfrm_dev_state_free(x);
df71837d 545 security_xfrm_state_free(x);
4a135e53 546 xfrm_state_free(x);
1da177e4
LT
547}
548
c7837144 549static void xfrm_state_gc_task(struct work_struct *work)
1da177e4 550{
12a169e7 551 struct xfrm_state *x;
b67bfe0d 552 struct hlist_node *tmp;
12a169e7 553 struct hlist_head gc_list;
1da177e4 554
1da177e4 555 spin_lock_bh(&xfrm_state_gc_lock);
35db57bb 556 hlist_move_list(&xfrm_state_gc_list, &gc_list);
1da177e4
LT
557 spin_unlock_bh(&xfrm_state_gc_lock);
558
df7274eb
FW
559 synchronize_rcu();
560
b67bfe0d 561 hlist_for_each_entry_safe(x, tmp, &gc_list, gclist)
f75a2804 562 ___xfrm_state_destroy(x);
1da177e4
LT
563}
564
3e94c2dc 565static enum hrtimer_restart xfrm_timer_handler(struct hrtimer *me)
1da177e4 566{
671422b2
TG
567 struct xfrm_state *x = container_of(me, struct xfrm_state, mtimer);
568 enum hrtimer_restart ret = HRTIMER_NORESTART;
386c5680
AB
569 time64_t now = ktime_get_real_seconds();
570 time64_t next = TIME64_MAX;
1da177e4 571 int warn = 0;
161a09e7 572 int err = 0;
1da177e4
LT
573
574 spin_lock(&x->lock);
fd2bc419 575 xfrm_dev_state_update_stats(x);
f3da86dc 576
1da177e4
LT
577 if (x->km.state == XFRM_STATE_DEAD)
578 goto out;
579 if (x->km.state == XFRM_STATE_EXPIRED)
580 goto expired;
581 if (x->lft.hard_add_expires_seconds) {
195e4aac 582 time64_t tmo = x->lft.hard_add_expires_seconds +
1da177e4 583 x->curlft.add_time - now;
e3c0d047
FD
584 if (tmo <= 0) {
585 if (x->xflags & XFRM_SOFT_EXPIRE) {
586 /* enter hard expire without soft expire first?!
587 * setting a new date could trigger this.
1365e547 588 * workaround: fix x->curflt.add_time by below:
e3c0d047
FD
589 */
590 x->curlft.add_time = now - x->saved_tmo - 1;
591 tmo = x->lft.hard_add_expires_seconds - x->saved_tmo;
592 } else
593 goto expired;
594 }
1da177e4
LT
595 if (tmo < next)
596 next = tmo;
597 }
598 if (x->lft.hard_use_expires_seconds) {
195e4aac 599 time64_t tmo = x->lft.hard_use_expires_seconds +
0a9e5794 600 (READ_ONCE(x->curlft.use_time) ? : now) - now;
1da177e4
LT
601 if (tmo <= 0)
602 goto expired;
603 if (tmo < next)
604 next = tmo;
605 }
606 if (x->km.dying)
607 goto resched;
608 if (x->lft.soft_add_expires_seconds) {
195e4aac 609 time64_t tmo = x->lft.soft_add_expires_seconds +
1da177e4 610 x->curlft.add_time - now;
e3c0d047 611 if (tmo <= 0) {
1da177e4 612 warn = 1;
e3c0d047
FD
613 x->xflags &= ~XFRM_SOFT_EXPIRE;
614 } else if (tmo < next) {
1da177e4 615 next = tmo;
e3c0d047
FD
616 x->xflags |= XFRM_SOFT_EXPIRE;
617 x->saved_tmo = tmo;
618 }
1da177e4
LT
619 }
620 if (x->lft.soft_use_expires_seconds) {
195e4aac 621 time64_t tmo = x->lft.soft_use_expires_seconds +
0a9e5794 622 (READ_ONCE(x->curlft.use_time) ? : now) - now;
1da177e4
LT
623 if (tmo <= 0)
624 warn = 1;
625 else if (tmo < next)
626 next = tmo;
627 }
628
4666faab 629 x->km.dying = warn;
1da177e4 630 if (warn)
53bc6b4d 631 km_state_expired(x, 0, 0);
1da177e4 632resched:
386c5680 633 if (next != TIME64_MAX) {
671422b2
TG
634 hrtimer_forward_now(&x->mtimer, ktime_set(next, 0));
635 ret = HRTIMER_RESTART;
9e0d57fd 636 }
a47f0ce0 637
1da177e4
LT
638 goto out;
639
640expired:
5b8ef341 641 if (x->km.state == XFRM_STATE_ACQ && x->id.spi == 0)
1da177e4 642 x->km.state = XFRM_STATE_EXPIRED;
161a09e7
JL
643
644 err = __xfrm_state_delete(x);
0806ae4c 645 if (!err)
53bc6b4d 646 km_state_expired(x, 1, 0);
1da177e4 647
2e71029e 648 xfrm_audit_state_delete(x, err ? 0 : 1, true);
161a09e7 649
1da177e4
LT
650out:
651 spin_unlock(&x->lock);
671422b2 652 return ret;
1da177e4
LT
653}
654
e99e88a9 655static void xfrm_replay_timer_handler(struct timer_list *t);
0ac84752 656
673c09be 657struct xfrm_state *xfrm_state_alloc(struct net *net)
1da177e4
LT
658{
659 struct xfrm_state *x;
660
a4c278d1 661 x = kmem_cache_zalloc(xfrm_state_cache, GFP_ATOMIC);
1da177e4
LT
662
663 if (x) {
673c09be 664 write_pnet(&x->xs_net, net);
88755e9c 665 refcount_set(&x->refcnt, 1);
1da177e4 666 atomic_set(&x->tunnel_users, 0);
12a169e7 667 INIT_LIST_HEAD(&x->km.all);
0045e3d8 668 INIT_HLIST_NODE(&x->state_cache);
8f126e37
DM
669 INIT_HLIST_NODE(&x->bydst);
670 INIT_HLIST_NODE(&x->bysrc);
671 INIT_HLIST_NODE(&x->byspi);
fe9f1d87 672 INIT_HLIST_NODE(&x->byseq);
671422b2
TG
673 hrtimer_init(&x->mtimer, CLOCK_BOOTTIME, HRTIMER_MODE_ABS_SOFT);
674 x->mtimer.function = xfrm_timer_handler;
e99e88a9 675 timer_setup(&x->rtimer, xfrm_replay_timer_handler, 0);
386c5680 676 x->curlft.add_time = ktime_get_real_seconds();
1da177e4
LT
677 x->lft.soft_byte_limit = XFRM_INF;
678 x->lft.soft_packet_limit = XFRM_INF;
679 x->lft.hard_byte_limit = XFRM_INF;
680 x->lft.hard_packet_limit = XFRM_INF;
f8cd5488
JHS
681 x->replay_maxage = 0;
682 x->replay_maxdiff = 0;
1ddf9916 683 x->pcpu_num = UINT_MAX;
1da177e4
LT
684 spin_lock_init(&x->lock);
685 }
686 return x;
687}
688EXPORT_SYMBOL(xfrm_state_alloc);
689
07b87f9e
SK
690#ifdef CONFIG_XFRM_OFFLOAD
691void xfrm_dev_state_delete(struct xfrm_state *x)
692{
693 struct xfrm_dev_offload *xso = &x->xso;
694 struct net_device *dev = READ_ONCE(xso->dev);
695
696 if (dev) {
697 dev->xfrmdev_ops->xdo_dev_state_delete(x);
698 spin_lock_bh(&xfrm_state_dev_gc_lock);
699 hlist_add_head(&x->dev_gclist, &xfrm_state_dev_gc_list);
700 spin_unlock_bh(&xfrm_state_dev_gc_lock);
701 }
702}
2d531775 703EXPORT_SYMBOL_GPL(xfrm_dev_state_delete);
07b87f9e
SK
704
705void xfrm_dev_state_free(struct xfrm_state *x)
706{
707 struct xfrm_dev_offload *xso = &x->xso;
708 struct net_device *dev = READ_ONCE(xso->dev);
709
710 if (dev && dev->xfrmdev_ops) {
711 spin_lock_bh(&xfrm_state_dev_gc_lock);
712 if (!hlist_unhashed(&x->dev_gclist))
713 hlist_del(&x->dev_gclist);
714 spin_unlock_bh(&xfrm_state_dev_gc_lock);
715
716 if (dev->xfrmdev_ops->xdo_dev_state_free)
717 dev->xfrmdev_ops->xdo_dev_state_free(x);
718 WRITE_ONCE(xso->dev, NULL);
719 xso->type = XFRM_DEV_OFFLOAD_UNSPECIFIED;
720 netdev_put(dev, &xso->dev_tracker);
721 }
722}
723#endif
724
f75a2804 725void __xfrm_state_destroy(struct xfrm_state *x, bool sync)
1da177e4 726{
547b792c 727 WARN_ON(x->km.state != XFRM_STATE_DEAD);
1da177e4 728
f75a2804
CW
729 if (sync) {
730 synchronize_rcu();
731 ___xfrm_state_destroy(x);
732 } else {
733 spin_lock_bh(&xfrm_state_gc_lock);
734 hlist_add_head(&x->gclist, &xfrm_state_gc_list);
735 spin_unlock_bh(&xfrm_state_gc_lock);
736 schedule_work(&xfrm_state_gc_work);
737 }
1da177e4
LT
738}
739EXPORT_SYMBOL(__xfrm_state_destroy);
740
53bc6b4d 741int __xfrm_state_delete(struct xfrm_state *x)
1da177e4 742{
98806f75 743 struct net *net = xs_net(x);
26b15dad
JHS
744 int err = -ESRCH;
745
1da177e4
LT
746 if (x->km.state != XFRM_STATE_DEAD) {
747 x->km.state = XFRM_STATE_DEAD;
0045e3d8 748
283bc9f3 749 spin_lock(&net->xfrm.xfrm_state_lock);
12a169e7 750 list_del(&x->km.all);
ae3fb6d3
FW
751 hlist_del_rcu(&x->bydst);
752 hlist_del_rcu(&x->bysrc);
fe9f1d87
SD
753 if (x->km.seq)
754 hlist_del_rcu(&x->byseq);
0045e3d8
SK
755 if (!hlist_unhashed(&x->state_cache))
756 hlist_del_rcu(&x->state_cache);
a47f0ce0 757 if (x->id.spi)
ae3fb6d3 758 hlist_del_rcu(&x->byspi);
98806f75 759 net->xfrm.state_num--;
f531d13b 760 xfrm_nat_keepalive_state_updated(x);
283bc9f3 761 spin_unlock(&net->xfrm.xfrm_state_lock);
1da177e4 762
e27cca96
SD
763 if (x->encap_sk)
764 sock_put(rcu_dereference_raw(x->encap_sk));
765
d77e38e6
SK
766 xfrm_dev_state_delete(x);
767
1da177e4
LT
768 /* All xfrm_state objects are created by xfrm_state_alloc.
769 * The xfrm_state_alloc call gives a reference, and that
770 * is what we are dropping here.
771 */
5dba4797 772 xfrm_state_put(x);
26b15dad 773 err = 0;
1da177e4 774 }
26b15dad
JHS
775
776 return err;
1da177e4 777}
53bc6b4d 778EXPORT_SYMBOL(__xfrm_state_delete);
1da177e4 779
26b15dad 780int xfrm_state_delete(struct xfrm_state *x)
1da177e4 781{
26b15dad
JHS
782 int err;
783
1da177e4 784 spin_lock_bh(&x->lock);
26b15dad 785 err = __xfrm_state_delete(x);
1da177e4 786 spin_unlock_bh(&x->lock);
26b15dad
JHS
787
788 return err;
1da177e4
LT
789}
790EXPORT_SYMBOL(xfrm_state_delete);
791
4aa2e62c
JL
792#ifdef CONFIG_SECURITY_NETWORK_XFRM
793static inline int
2e71029e 794xfrm_state_flush_secctx_check(struct net *net, u8 proto, bool task_valid)
1da177e4 795{
4aa2e62c
JL
796 int i, err = 0;
797
0e602451 798 for (i = 0; i <= net->xfrm.state_hmask; i++) {
4aa2e62c
JL
799 struct xfrm_state *x;
800
b67bfe0d 801 hlist_for_each_entry(x, net->xfrm.state_bydst+i, bydst) {
4aa2e62c
JL
802 if (xfrm_id_proto_match(x->id.proto, proto) &&
803 (err = security_xfrm_state_delete(x)) != 0) {
2e71029e 804 xfrm_audit_state_delete(x, 0, task_valid);
4aa2e62c
JL
805 return err;
806 }
807 }
808 }
809
810 return err;
811}
d77e38e6
SK
812
813static inline int
814xfrm_dev_state_flush_secctx_check(struct net *net, struct net_device *dev, bool task_valid)
815{
816 int i, err = 0;
817
818 for (i = 0; i <= net->xfrm.state_hmask; i++) {
819 struct xfrm_state *x;
87e0a94e 820 struct xfrm_dev_offload *xso;
d77e38e6
SK
821
822 hlist_for_each_entry(x, net->xfrm.state_bydst+i, bydst) {
823 xso = &x->xso;
824
825 if (xso->dev == dev &&
826 (err = security_xfrm_state_delete(x)) != 0) {
827 xfrm_audit_state_delete(x, 0, task_valid);
828 return err;
829 }
830 }
831 }
832
833 return err;
834}
4aa2e62c
JL
835#else
836static inline int
2e71029e 837xfrm_state_flush_secctx_check(struct net *net, u8 proto, bool task_valid)
4aa2e62c
JL
838{
839 return 0;
840}
d77e38e6
SK
841
842static inline int
843xfrm_dev_state_flush_secctx_check(struct net *net, struct net_device *dev, bool task_valid)
844{
845 return 0;
846}
4aa2e62c
JL
847#endif
848
f75a2804 849int xfrm_state_flush(struct net *net, u8 proto, bool task_valid, bool sync)
4aa2e62c 850{
9e64cc95 851 int i, err = 0, cnt = 0;
1da177e4 852
283bc9f3 853 spin_lock_bh(&net->xfrm.xfrm_state_lock);
2e71029e 854 err = xfrm_state_flush_secctx_check(net, proto, task_valid);
4aa2e62c
JL
855 if (err)
856 goto out;
857
9e64cc95 858 err = -ESRCH;
0e602451 859 for (i = 0; i <= net->xfrm.state_hmask; i++) {
8f126e37 860 struct xfrm_state *x;
1da177e4 861restart:
b67bfe0d 862 hlist_for_each_entry(x, net->xfrm.state_bydst+i, bydst) {
1da177e4 863 if (!xfrm_state_kern(x) &&
5794708f 864 xfrm_id_proto_match(x->id.proto, proto)) {
1da177e4 865 xfrm_state_hold(x);
283bc9f3 866 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1da177e4 867
161a09e7 868 err = xfrm_state_delete(x);
ab5f5e8b 869 xfrm_audit_state_delete(x, err ? 0 : 1,
2e71029e 870 task_valid);
f75a2804
CW
871 if (sync)
872 xfrm_state_put_sync(x);
873 else
874 xfrm_state_put(x);
9e64cc95
JHS
875 if (!err)
876 cnt++;
1da177e4 877
283bc9f3 878 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1da177e4
LT
879 goto restart;
880 }
881 }
882 }
dd269db8
AS
883out:
884 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
e4db5b61 885 if (cnt)
9e64cc95 886 err = 0;
e4db5b61 887
4aa2e62c 888 return err;
1da177e4
LT
889}
890EXPORT_SYMBOL(xfrm_state_flush);
891
d77e38e6
SK
892int xfrm_dev_state_flush(struct net *net, struct net_device *dev, bool task_valid)
893{
07b87f9e
SK
894 struct xfrm_state *x;
895 struct hlist_node *tmp;
896 struct xfrm_dev_offload *xso;
d77e38e6
SK
897 int i, err = 0, cnt = 0;
898
899 spin_lock_bh(&net->xfrm.xfrm_state_lock);
900 err = xfrm_dev_state_flush_secctx_check(net, dev, task_valid);
901 if (err)
902 goto out;
903
904 err = -ESRCH;
905 for (i = 0; i <= net->xfrm.state_hmask; i++) {
d77e38e6
SK
906restart:
907 hlist_for_each_entry(x, net->xfrm.state_bydst+i, bydst) {
908 xso = &x->xso;
909
910 if (!xfrm_state_kern(x) && xso->dev == dev) {
911 xfrm_state_hold(x);
912 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
913
914 err = xfrm_state_delete(x);
07b87f9e
SK
915 xfrm_dev_state_free(x);
916
d77e38e6
SK
917 xfrm_audit_state_delete(x, err ? 0 : 1,
918 task_valid);
919 xfrm_state_put(x);
920 if (!err)
921 cnt++;
922
923 spin_lock_bh(&net->xfrm.xfrm_state_lock);
924 goto restart;
925 }
926 }
927 }
928 if (cnt)
929 err = 0;
930
931out:
932 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
07b87f9e
SK
933
934 spin_lock_bh(&xfrm_state_dev_gc_lock);
935restart_gc:
936 hlist_for_each_entry_safe(x, tmp, &xfrm_state_dev_gc_list, dev_gclist) {
937 xso = &x->xso;
938
939 if (xso->dev == dev) {
940 spin_unlock_bh(&xfrm_state_dev_gc_lock);
941 xfrm_dev_state_free(x);
942 spin_lock_bh(&xfrm_state_dev_gc_lock);
943 goto restart_gc;
944 }
945
946 }
947 spin_unlock_bh(&xfrm_state_dev_gc_lock);
948
949 xfrm_flush_gc();
950
d77e38e6
SK
951 return err;
952}
953EXPORT_SYMBOL(xfrm_dev_state_flush);
954
e071041b 955void xfrm_sad_getinfo(struct net *net, struct xfrmk_sadinfo *si)
28d8909b 956{
283bc9f3 957 spin_lock_bh(&net->xfrm.xfrm_state_lock);
e071041b 958 si->sadcnt = net->xfrm.state_num;
ca92e173 959 si->sadhcnt = net->xfrm.state_hmask + 1;
28d8909b 960 si->sadhmcnt = xfrm_state_hashmax;
283bc9f3 961 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
28d8909b
JHS
962}
963EXPORT_SYMBOL(xfrm_sad_getinfo);
964
bac95935
FW
965static void
966__xfrm4_init_tempsel(struct xfrm_selector *sel, const struct flowi *fl)
967{
968 const struct flowi4 *fl4 = &fl->u.ip4;
969
970 sel->daddr.a4 = fl4->daddr;
971 sel->saddr.a4 = fl4->saddr;
972 sel->dport = xfrm_flowi_dport(fl, &fl4->uli);
973 sel->dport_mask = htons(0xffff);
974 sel->sport = xfrm_flowi_sport(fl, &fl4->uli);
975 sel->sport_mask = htons(0xffff);
976 sel->family = AF_INET;
977 sel->prefixlen_d = 32;
978 sel->prefixlen_s = 32;
979 sel->proto = fl4->flowi4_proto;
980 sel->ifindex = fl4->flowi4_oif;
981}
982
983static void
984__xfrm6_init_tempsel(struct xfrm_selector *sel, const struct flowi *fl)
985{
986 const struct flowi6 *fl6 = &fl->u.ip6;
987
988 /* Initialize temporary selector matching only to current session. */
989 *(struct in6_addr *)&sel->daddr = fl6->daddr;
990 *(struct in6_addr *)&sel->saddr = fl6->saddr;
991 sel->dport = xfrm_flowi_dport(fl, &fl6->uli);
992 sel->dport_mask = htons(0xffff);
993 sel->sport = xfrm_flowi_sport(fl, &fl6->uli);
994 sel->sport_mask = htons(0xffff);
995 sel->family = AF_INET6;
996 sel->prefixlen_d = 128;
997 sel->prefixlen_s = 128;
998 sel->proto = fl6->flowi6_proto;
999 sel->ifindex = fl6->flowi6_oif;
1000}
1001
711059b9 1002static void
1a898592 1003xfrm_init_tempstate(struct xfrm_state *x, const struct flowi *fl,
04686013 1004 const struct xfrm_tmpl *tmpl,
33765d06 1005 const xfrm_address_t *daddr, const xfrm_address_t *saddr,
8444cf71 1006 unsigned short family)
1da177e4 1007{
bac95935
FW
1008 switch (family) {
1009 case AF_INET:
1010 __xfrm4_init_tempsel(&x->sel, fl);
1011 break;
1012 case AF_INET6:
1013 __xfrm6_init_tempsel(&x->sel, fl);
1014 break;
1015 }
1016
5c1b9ab3 1017 x->id = tmpl->id;
bac95935 1018
5c1b9ab3
FW
1019 switch (tmpl->encap_family) {
1020 case AF_INET:
1021 if (x->id.daddr.a4 == 0)
1022 x->id.daddr.a4 = daddr->a4;
1023 x->props.saddr = tmpl->saddr;
1024 if (x->props.saddr.a4 == 0)
1025 x->props.saddr.a4 = saddr->a4;
1026 break;
1027 case AF_INET6:
1028 if (ipv6_addr_any((struct in6_addr *)&x->id.daddr))
1029 memcpy(&x->id.daddr, daddr, sizeof(x->sel.daddr));
1030 memcpy(&x->props.saddr, &tmpl->saddr, sizeof(x->props.saddr));
1031 if (ipv6_addr_any((struct in6_addr *)&x->props.saddr))
1032 memcpy(&x->props.saddr, saddr, sizeof(x->props.saddr));
1033 break;
1034 }
3819a35f 1035
5c1b9ab3
FW
1036 x->props.mode = tmpl->mode;
1037 x->props.reqid = tmpl->reqid;
1038 x->props.family = tmpl->encap_family;
1da177e4
LT
1039}
1040
f8a70afa
LR
1041static struct xfrm_state *__xfrm_state_lookup_all(struct net *net, u32 mark,
1042 const xfrm_address_t *daddr,
1043 __be32 spi, u8 proto,
1044 unsigned short family,
1045 struct xfrm_dev_offload *xdo)
1046{
1047 unsigned int h = xfrm_spi_hash(net, daddr, spi, proto, family);
1048 struct xfrm_state *x;
1049
1050 hlist_for_each_entry_rcu(x, net->xfrm.state_byspi + h, byspi) {
1051#ifdef CONFIG_XFRM_OFFLOAD
1052 if (xdo->type == XFRM_DEV_OFFLOAD_PACKET) {
1053 if (x->xso.type != XFRM_DEV_OFFLOAD_PACKET)
1054 /* HW states are in the head of list, there is
1055 * no need to iterate further.
1056 */
1057 break;
1058
1059 /* Packet offload: both policy and SA should
1060 * have same device.
1061 */
1062 if (xdo->dev != x->xso.dev)
1063 continue;
1064 } else if (x->xso.type == XFRM_DEV_OFFLOAD_PACKET)
1065 /* Skip HW policy for SW lookups */
1066 continue;
1067#endif
1068 if (x->props.family != family ||
1069 x->id.spi != spi ||
1070 x->id.proto != proto ||
1071 !xfrm_addr_equal(&x->id.daddr, daddr, family))
1072 continue;
1073
1074 if ((mark & x->mark.m) != x->mark.v)
1075 continue;
1076 if (!xfrm_state_hold_rcu(x))
1077 continue;
1078 return x;
1079 }
1080
1081 return NULL;
1082}
1083
9aa60088
DM
1084static struct xfrm_state *__xfrm_state_lookup(struct net *net, u32 mark,
1085 const xfrm_address_t *daddr,
1086 __be32 spi, u8 proto,
1087 unsigned short family)
edcd5821 1088{
221df1ed 1089 unsigned int h = xfrm_spi_hash(net, daddr, spi, proto, family);
edcd5821
DM
1090 struct xfrm_state *x;
1091
ae3fb6d3 1092 hlist_for_each_entry_rcu(x, net->xfrm.state_byspi + h, byspi) {
edcd5821
DM
1093 if (x->props.family != family ||
1094 x->id.spi != spi ||
1802571b 1095 x->id.proto != proto ||
70e94e66 1096 !xfrm_addr_equal(&x->id.daddr, daddr, family))
edcd5821
DM
1097 continue;
1098
3d6acfa7
JHS
1099 if ((mark & x->mark.m) != x->mark.v)
1100 continue;
02efdff7
FW
1101 if (!xfrm_state_hold_rcu(x))
1102 continue;
edcd5821
DM
1103 return x;
1104 }
1105
1106 return NULL;
1107}
1108
9aa60088
DM
1109static struct xfrm_state *__xfrm_state_lookup_byaddr(struct net *net, u32 mark,
1110 const xfrm_address_t *daddr,
1111 const xfrm_address_t *saddr,
1112 u8 proto, unsigned short family)
edcd5821 1113{
221df1ed 1114 unsigned int h = xfrm_src_hash(net, daddr, saddr, family);
edcd5821
DM
1115 struct xfrm_state *x;
1116
ae3fb6d3 1117 hlist_for_each_entry_rcu(x, net->xfrm.state_bysrc + h, bysrc) {
edcd5821 1118 if (x->props.family != family ||
1802571b 1119 x->id.proto != proto ||
70e94e66
YH
1120 !xfrm_addr_equal(&x->id.daddr, daddr, family) ||
1121 !xfrm_addr_equal(&x->props.saddr, saddr, family))
edcd5821
DM
1122 continue;
1123
3d6acfa7
JHS
1124 if ((mark & x->mark.m) != x->mark.v)
1125 continue;
02efdff7
FW
1126 if (!xfrm_state_hold_rcu(x))
1127 continue;
edcd5821
DM
1128 return x;
1129 }
1130
1131 return NULL;
1132}
1133
1134static inline struct xfrm_state *
1135__xfrm_state_locate(struct xfrm_state *x, int use_spi, int family)
1136{
221df1ed 1137 struct net *net = xs_net(x);
bd55775c 1138 u32 mark = x->mark.v & x->mark.m;
221df1ed 1139
edcd5821 1140 if (use_spi)
bd55775c
JHS
1141 return __xfrm_state_lookup(net, mark, &x->id.daddr,
1142 x->id.spi, x->id.proto, family);
edcd5821 1143 else
bd55775c
JHS
1144 return __xfrm_state_lookup_byaddr(net, mark,
1145 &x->id.daddr,
edcd5821
DM
1146 &x->props.saddr,
1147 x->id.proto, family);
1148}
1149
98806f75 1150static void xfrm_hash_grow_check(struct net *net, int have_hash_collision)
2fab22f2
PM
1151{
1152 if (have_hash_collision &&
98806f75
AD
1153 (net->xfrm.state_hmask + 1) < xfrm_state_hashmax &&
1154 net->xfrm.state_num > net->xfrm.state_hmask)
1155 schedule_work(&net->xfrm.state_hash_work);
2fab22f2
PM
1156}
1157
08ec9af1 1158static void xfrm_state_look_at(struct xfrm_policy *pol, struct xfrm_state *x,
4a08ab0f 1159 const struct flowi *fl, unsigned short family,
08ec9af1
DM
1160 struct xfrm_state **best, int *acq_in_progress,
1161 int *error)
1162{
1ddf9916
SK
1163 /* We need the cpu id just as a lookup key,
1164 * we don't require it to be stable.
1165 */
1166 unsigned int pcpu_id = get_cpu();
1167 put_cpu();
1168
08ec9af1
DM
1169 /* Resolution logic:
1170 * 1. There is a valid state with matching selector. Done.
1171 * 2. Valid state with inappropriate selector. Skip.
1172 *
1173 * Entering area of "sysdeps".
1174 *
1175 * 3. If state is not valid, selector is temporary, it selects
1176 * only session which triggered previous resolution. Key
1177 * manager will do something to install a state with proper
1178 * selector.
1179 */
1180 if (x->km.state == XFRM_STATE_VALID) {
1181 if ((x->sel.family &&
e94ee171
HX
1182 (x->sel.family != family ||
1183 !xfrm_selector_match(&x->sel, fl, family))) ||
3df98d79
PM
1184 !security_xfrm_state_pol_flow_match(x, pol,
1185 &fl->u.__fl_common))
08ec9af1
DM
1186 return;
1187
1ddf9916
SK
1188 if (x->pcpu_num != UINT_MAX && x->pcpu_num != pcpu_id)
1189 return;
1190
08ec9af1 1191 if (!*best ||
1ddf9916 1192 ((*best)->pcpu_num == UINT_MAX && x->pcpu_num == pcpu_id) ||
08ec9af1
DM
1193 (*best)->km.dying > x->km.dying ||
1194 ((*best)->km.dying == x->km.dying &&
1195 (*best)->curlft.add_time < x->curlft.add_time))
1196 *best = x;
1197 } else if (x->km.state == XFRM_STATE_ACQ) {
1ddf9916
SK
1198 if (!*best || x->pcpu_num == pcpu_id)
1199 *acq_in_progress = 1;
08ec9af1
DM
1200 } else if (x->km.state == XFRM_STATE_ERROR ||
1201 x->km.state == XFRM_STATE_EXPIRED) {
e94ee171
HX
1202 if ((!x->sel.family ||
1203 (x->sel.family == family &&
1204 xfrm_selector_match(&x->sel, fl, family))) &&
3df98d79
PM
1205 security_xfrm_state_pol_flow_match(x, pol,
1206 &fl->u.__fl_common))
08ec9af1
DM
1207 *error = -ESRCH;
1208 }
1209}
1210
1da177e4 1211struct xfrm_state *
33765d06 1212xfrm_state_find(const xfrm_address_t *daddr, const xfrm_address_t *saddr,
b520e9f6 1213 const struct flowi *fl, struct xfrm_tmpl *tmpl,
1da177e4 1214 struct xfrm_policy *pol, int *err,
bc56b334 1215 unsigned short family, u32 if_id)
1da177e4 1216{
08ec9af1 1217 static xfrm_address_t saddr_wildcard = { };
5447c5e4 1218 struct net *net = xp_net(pol);
6a783c90 1219 unsigned int h, h_wildcard;
37b08e34 1220 struct xfrm_state *x, *x0, *to_put;
1da177e4
LT
1221 int acquire_in_progress = 0;
1222 int error = 0;
1223 struct xfrm_state *best = NULL;
bd55775c 1224 u32 mark = pol->mark.v & pol->mark.m;
8444cf71 1225 unsigned short encap_family = tmpl->encap_family;
b65e3d7b 1226 unsigned int sequence;
0f24558e 1227 struct km_event c;
1ddf9916 1228 unsigned int pcpu_id;
0045e3d8 1229 bool cached = false;
1ddf9916
SK
1230
1231 /* We need the cpu id just as a lookup key,
1232 * we don't require it to be stable.
1233 */
1234 pcpu_id = get_cpu();
1235 put_cpu();
a716c119 1236
37b08e34
DM
1237 to_put = NULL;
1238
e88add19 1239 sequence = read_seqcount_begin(&net->xfrm.xfrm_state_hash_generation);
b65e3d7b 1240
d737a580 1241 rcu_read_lock();
0045e3d8
SK
1242 hlist_for_each_entry_rcu(x, &pol->state_cache_list, state_cache) {
1243 if (x->props.family == encap_family &&
1244 x->props.reqid == tmpl->reqid &&
1245 (mark & x->mark.m) == x->mark.v &&
1246 x->if_id == if_id &&
1247 !(x->props.flags & XFRM_STATE_WILDRECV) &&
1248 xfrm_state_addr_check(x, daddr, saddr, encap_family) &&
1249 tmpl->mode == x->props.mode &&
1250 tmpl->id.proto == x->id.proto &&
1251 (tmpl->id.spi == x->id.spi || !tmpl->id.spi))
1252 xfrm_state_look_at(pol, x, fl, encap_family,
1253 &best, &acquire_in_progress, &error);
1254 }
1255
1256 if (best)
1257 goto cached;
1258
1259 hlist_for_each_entry_rcu(x, &pol->state_cache_list, state_cache) {
1260 if (x->props.family == encap_family &&
1261 x->props.reqid == tmpl->reqid &&
1262 (mark & x->mark.m) == x->mark.v &&
1263 x->if_id == if_id &&
1264 !(x->props.flags & XFRM_STATE_WILDRECV) &&
1265 xfrm_addr_equal(&x->id.daddr, daddr, encap_family) &&
1266 tmpl->mode == x->props.mode &&
1267 tmpl->id.proto == x->id.proto &&
1268 (tmpl->id.spi == x->id.spi || !tmpl->id.spi))
1269 xfrm_state_look_at(pol, x, fl, family,
1270 &best, &acquire_in_progress, &error);
1271 }
1272
1273cached:
1274 cached = true;
1275 if (best)
1276 goto found;
1277 else if (error)
1278 best = NULL;
1279 else if (acquire_in_progress) /* XXX: acquire_in_progress should not happen */
1280 WARN_ON(1);
1281
8444cf71 1282 h = xfrm_dst_hash(net, daddr, saddr, tmpl->reqid, encap_family);
ae3fb6d3 1283 hlist_for_each_entry_rcu(x, net->xfrm.state_bydst + h, bydst) {
f8a70afa
LR
1284#ifdef CONFIG_XFRM_OFFLOAD
1285 if (pol->xdo.type == XFRM_DEV_OFFLOAD_PACKET) {
1286 if (x->xso.type != XFRM_DEV_OFFLOAD_PACKET)
1287 /* HW states are in the head of list, there is
1288 * no need to iterate further.
1289 */
1290 break;
1291
1292 /* Packet offload: both policy and SA should
1293 * have same device.
1294 */
1295 if (pol->xdo.dev != x->xso.dev)
1296 continue;
1297 } else if (x->xso.type == XFRM_DEV_OFFLOAD_PACKET)
1298 /* Skip HW policy for SW lookups */
1299 continue;
1300#endif
8444cf71 1301 if (x->props.family == encap_family &&
1da177e4 1302 x->props.reqid == tmpl->reqid &&
3d6acfa7 1303 (mark & x->mark.m) == x->mark.v &&
7e652640 1304 x->if_id == if_id &&
fbd9a5b4 1305 !(x->props.flags & XFRM_STATE_WILDRECV) &&
8444cf71 1306 xfrm_state_addr_check(x, daddr, saddr, encap_family) &&
1da177e4
LT
1307 tmpl->mode == x->props.mode &&
1308 tmpl->id.proto == x->id.proto &&
08ec9af1 1309 (tmpl->id.spi == x->id.spi || !tmpl->id.spi))
e94ee171 1310 xfrm_state_look_at(pol, x, fl, family,
08ec9af1
DM
1311 &best, &acquire_in_progress, &error);
1312 }
6f115638 1313 if (best || acquire_in_progress)
08ec9af1
DM
1314 goto found;
1315
8444cf71 1316 h_wildcard = xfrm_dst_hash(net, daddr, &saddr_wildcard, tmpl->reqid, encap_family);
ae3fb6d3 1317 hlist_for_each_entry_rcu(x, net->xfrm.state_bydst + h_wildcard, bydst) {
f8a70afa
LR
1318#ifdef CONFIG_XFRM_OFFLOAD
1319 if (pol->xdo.type == XFRM_DEV_OFFLOAD_PACKET) {
1320 if (x->xso.type != XFRM_DEV_OFFLOAD_PACKET)
1321 /* HW states are in the head of list, there is
1322 * no need to iterate further.
1323 */
1324 break;
1325
1326 /* Packet offload: both policy and SA should
1327 * have same device.
1328 */
1329 if (pol->xdo.dev != x->xso.dev)
1330 continue;
1331 } else if (x->xso.type == XFRM_DEV_OFFLOAD_PACKET)
1332 /* Skip HW policy for SW lookups */
1333 continue;
1334#endif
8444cf71 1335 if (x->props.family == encap_family &&
08ec9af1 1336 x->props.reqid == tmpl->reqid &&
3d6acfa7 1337 (mark & x->mark.m) == x->mark.v &&
7e652640 1338 x->if_id == if_id &&
08ec9af1 1339 !(x->props.flags & XFRM_STATE_WILDRECV) &&
f59bbdfa 1340 xfrm_addr_equal(&x->id.daddr, daddr, encap_family) &&
08ec9af1
DM
1341 tmpl->mode == x->props.mode &&
1342 tmpl->id.proto == x->id.proto &&
1343 (tmpl->id.spi == x->id.spi || !tmpl->id.spi))
e94ee171 1344 xfrm_state_look_at(pol, x, fl, family,
08ec9af1 1345 &best, &acquire_in_progress, &error);
1da177e4
LT
1346 }
1347
08ec9af1 1348found:
1ddf9916
SK
1349 if (!(pol->flags & XFRM_POLICY_CPU_ACQUIRE) ||
1350 (best && (best->pcpu_num == pcpu_id)))
1351 x = best;
1352
1da177e4 1353 if (!x && !error && !acquire_in_progress) {
5c5d281a 1354 if (tmpl->id.spi &&
f8a70afa
LR
1355 (x0 = __xfrm_state_lookup_all(net, mark, daddr,
1356 tmpl->id.spi, tmpl->id.proto,
1357 encap_family,
1358 &pol->xdo)) != NULL) {
37b08e34 1359 to_put = x0;
1da177e4
LT
1360 error = -EEXIST;
1361 goto out;
1362 }
0f24558e
HG
1363
1364 c.net = net;
1365 /* If the KMs have no listeners (yet...), avoid allocating an SA
1366 * for each and every packet - garbage collection might not
1367 * handle the flood.
1368 */
1369 if (!km_is_alive(&c)) {
1370 error = -ESRCH;
1371 goto out;
1372 }
1373
5447c5e4 1374 x = xfrm_state_alloc(net);
1da177e4
LT
1375 if (x == NULL) {
1376 error = -ENOMEM;
1377 goto out;
1378 }
8444cf71 1379 /* Initialize temporary state matching only
1da177e4 1380 * to current session. */
8444cf71 1381 xfrm_init_tempstate(x, fl, tmpl, daddr, saddr, family);
bd55775c 1382 memcpy(&x->mark, &pol->mark, sizeof(x->mark));
7e652640 1383 x->if_id = if_id;
1ddf9916
SK
1384 if ((pol->flags & XFRM_POLICY_CPU_ACQUIRE) && best)
1385 x->pcpu_num = pcpu_id;
1da177e4 1386
1d28f42c 1387 error = security_xfrm_state_alloc_acquire(x, pol->security, fl->flowi_secid);
e0d1caa7
VY
1388 if (error) {
1389 x->km.state = XFRM_STATE_DEAD;
37b08e34 1390 to_put = x;
e0d1caa7
VY
1391 x = NULL;
1392 goto out;
1393 }
f8a70afa
LR
1394#ifdef CONFIG_XFRM_OFFLOAD
1395 if (pol->xdo.type == XFRM_DEV_OFFLOAD_PACKET) {
1396 struct xfrm_dev_offload *xdo = &pol->xdo;
1397 struct xfrm_dev_offload *xso = &x->xso;
1398
1399 xso->type = XFRM_DEV_OFFLOAD_PACKET;
1400 xso->dir = xdo->dir;
1401 xso->dev = xdo->dev;
1402 xso->real_dev = xdo->real_dev;
e0aeb9b9 1403 xso->flags = XFRM_DEV_OFFLOAD_FLAG_ACQ;
9199b915 1404 netdev_hold(xso->dev, &xso->dev_tracker, GFP_ATOMIC);
7681a4f5 1405 error = xso->dev->xfrmdev_ops->xdo_dev_state_add(x, NULL);
f8a70afa
LR
1406 if (error) {
1407 xso->dir = 0;
1408 netdev_put(xso->dev, &xso->dev_tracker);
1409 xso->dev = NULL;
1410 xso->real_dev = NULL;
1411 xso->type = XFRM_DEV_OFFLOAD_UNSPECIFIED;
1412 x->km.state = XFRM_STATE_DEAD;
1413 to_put = x;
1414 x = NULL;
1415 goto out;
1416 }
1417 }
1418#endif
1da177e4 1419 if (km_query(x, tmpl, pol) == 0) {
d737a580 1420 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1da177e4 1421 x->km.state = XFRM_STATE_ACQ;
a4a87fa4 1422 x->dir = XFRM_SA_DIR_OUT;
5447c5e4 1423 list_add(&x->km.all, &net->xfrm.state_all);
3c611d40
LR
1424 XFRM_STATE_INSERT(bydst, &x->bydst,
1425 net->xfrm.state_bydst + h,
1426 x->xso.type);
8444cf71 1427 h = xfrm_src_hash(net, daddr, saddr, encap_family);
3c611d40
LR
1428 XFRM_STATE_INSERT(bysrc, &x->bysrc,
1429 net->xfrm.state_bysrc + h,
1430 x->xso.type);
0045e3d8 1431 INIT_HLIST_NODE(&x->state_cache);
1da177e4 1432 if (x->id.spi) {
8444cf71 1433 h = xfrm_spi_hash(net, &x->id.daddr, x->id.spi, x->id.proto, encap_family);
3c611d40
LR
1434 XFRM_STATE_INSERT(byspi, &x->byspi,
1435 net->xfrm.state_byspi + h,
1436 x->xso.type);
1da177e4 1437 }
fe9f1d87
SD
1438 if (x->km.seq) {
1439 h = xfrm_seq_hash(net, x->km.seq);
3c611d40
LR
1440 XFRM_STATE_INSERT(byseq, &x->byseq,
1441 net->xfrm.state_byseq + h,
1442 x->xso.type);
fe9f1d87 1443 }
b27aeadb 1444 x->lft.hard_add_expires_seconds = net->xfrm.sysctl_acq_expires;
671422b2
TG
1445 hrtimer_start(&x->mtimer,
1446 ktime_set(net->xfrm.sysctl_acq_expires, 0),
1447 HRTIMER_MODE_REL_SOFT);
5447c5e4
AD
1448 net->xfrm.state_num++;
1449 xfrm_hash_grow_check(net, x->bydst.next != NULL);
d737a580 1450 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1da177e4 1451 } else {
f8a70afa
LR
1452#ifdef CONFIG_XFRM_OFFLOAD
1453 struct xfrm_dev_offload *xso = &x->xso;
1454
1455 if (xso->type == XFRM_DEV_OFFLOAD_PACKET) {
f3ec2b5d
LR
1456 xfrm_dev_state_delete(x);
1457 xfrm_dev_state_free(x);
f8a70afa
LR
1458 }
1459#endif
1da177e4 1460 x->km.state = XFRM_STATE_DEAD;
37b08e34 1461 to_put = x;
1da177e4
LT
1462 x = NULL;
1463 error = -ESRCH;
1464 }
1ddf9916
SK
1465
1466 /* Use the already installed 'fallback' while the CPU-specific
1467 * SA acquire is handled*/
1468 if (best)
1469 x = best;
1da177e4
LT
1470 }
1471out:
02efdff7
FW
1472 if (x) {
1473 if (!xfrm_state_hold_rcu(x)) {
1474 *err = -EAGAIN;
1475 x = NULL;
1476 }
1477 } else {
1da177e4 1478 *err = acquire_in_progress ? -EAGAIN : error;
02efdff7 1479 }
0045e3d8
SK
1480
1481 if (x && x->km.state == XFRM_STATE_VALID && !cached &&
1482 (!(pol->flags & XFRM_POLICY_CPU_ACQUIRE) || x->pcpu_num == pcpu_id)) {
1483 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1484 if (hlist_unhashed(&x->state_cache))
1485 hlist_add_head_rcu(&x->state_cache, &pol->state_cache_list);
1486 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1487 }
1488
d737a580 1489 rcu_read_unlock();
37b08e34
DM
1490 if (to_put)
1491 xfrm_state_put(to_put);
b65e3d7b 1492
e88add19 1493 if (read_seqcount_retry(&net->xfrm.xfrm_state_hash_generation, sequence)) {
b65e3d7b
FW
1494 *err = -EAGAIN;
1495 if (x) {
1496 xfrm_state_put(x);
1497 x = NULL;
1498 }
1499 }
1500
1da177e4
LT
1501 return x;
1502}
1503
628529b6 1504struct xfrm_state *
7e652640 1505xfrm_stateonly_find(struct net *net, u32 mark, u32 if_id,
5447c5e4 1506 xfrm_address_t *daddr, xfrm_address_t *saddr,
628529b6
JHS
1507 unsigned short family, u8 mode, u8 proto, u32 reqid)
1508{
4bda4f25 1509 unsigned int h;
628529b6 1510 struct xfrm_state *rx = NULL, *x = NULL;
628529b6 1511
4ae770bf 1512 spin_lock_bh(&net->xfrm.xfrm_state_lock);
5447c5e4 1513 h = xfrm_dst_hash(net, daddr, saddr, reqid, family);
b67bfe0d 1514 hlist_for_each_entry(x, net->xfrm.state_bydst+h, bydst) {
628529b6
JHS
1515 if (x->props.family == family &&
1516 x->props.reqid == reqid &&
3d6acfa7 1517 (mark & x->mark.m) == x->mark.v &&
7e652640 1518 x->if_id == if_id &&
628529b6
JHS
1519 !(x->props.flags & XFRM_STATE_WILDRECV) &&
1520 xfrm_state_addr_check(x, daddr, saddr, family) &&
1521 mode == x->props.mode &&
1522 proto == x->id.proto &&
1523 x->km.state == XFRM_STATE_VALID) {
1524 rx = x;
1525 break;
1526 }
1527 }
1528
1529 if (rx)
1530 xfrm_state_hold(rx);
4ae770bf 1531 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
628529b6
JHS
1532
1533
1534 return rx;
1535}
1536EXPORT_SYMBOL(xfrm_stateonly_find);
1537
c454997e
FD
1538struct xfrm_state *xfrm_state_lookup_byspi(struct net *net, __be32 spi,
1539 unsigned short family)
1540{
1541 struct xfrm_state *x;
1542 struct xfrm_state_walk *w;
1543
1544 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1545 list_for_each_entry(w, &net->xfrm.state_all, all) {
1546 x = container_of(w, struct xfrm_state, km);
1547 if (x->props.family != family ||
1548 x->id.spi != spi)
1549 continue;
1550
c454997e 1551 xfrm_state_hold(x);
bdddbf69 1552 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
c454997e
FD
1553 return x;
1554 }
1555 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1556 return NULL;
1557}
1558EXPORT_SYMBOL(xfrm_state_lookup_byspi);
1559
1da177e4
LT
1560static void __xfrm_state_insert(struct xfrm_state *x)
1561{
98806f75 1562 struct net *net = xs_net(x);
a624c108 1563 unsigned int h;
1da177e4 1564
98806f75 1565 list_add(&x->km.all, &net->xfrm.state_all);
4c563f76 1566
98806f75 1567 h = xfrm_dst_hash(net, &x->id.daddr, &x->props.saddr,
c1969f29 1568 x->props.reqid, x->props.family);
3c611d40
LR
1569 XFRM_STATE_INSERT(bydst, &x->bydst, net->xfrm.state_bydst + h,
1570 x->xso.type);
1da177e4 1571
98806f75 1572 h = xfrm_src_hash(net, &x->id.daddr, &x->props.saddr, x->props.family);
3c611d40
LR
1573 XFRM_STATE_INSERT(bysrc, &x->bysrc, net->xfrm.state_bysrc + h,
1574 x->xso.type);
1da177e4 1575
7b4dc360 1576 if (x->id.spi) {
98806f75 1577 h = xfrm_spi_hash(net, &x->id.daddr, x->id.spi, x->id.proto,
6c44e6b7
MN
1578 x->props.family);
1579
3c611d40
LR
1580 XFRM_STATE_INSERT(byspi, &x->byspi, net->xfrm.state_byspi + h,
1581 x->xso.type);
6c44e6b7
MN
1582 }
1583
fe9f1d87
SD
1584 if (x->km.seq) {
1585 h = xfrm_seq_hash(net, x->km.seq);
1586
3c611d40
LR
1587 XFRM_STATE_INSERT(byseq, &x->byseq, net->xfrm.state_byseq + h,
1588 x->xso.type);
fe9f1d87
SD
1589 }
1590
671422b2 1591 hrtimer_start(&x->mtimer, ktime_set(1, 0), HRTIMER_MODE_REL_SOFT);
a47f0ce0
DM
1592 if (x->replay_maxage)
1593 mod_timer(&x->rtimer, jiffies + x->replay_maxage);
f8cd5488 1594
98806f75 1595 net->xfrm.state_num++;
f034b5d4 1596
98806f75 1597 xfrm_hash_grow_check(net, x->bydst.next != NULL);
f531d13b 1598 xfrm_nat_keepalive_state_updated(x);
1da177e4
LT
1599}
1600
283bc9f3 1601/* net->xfrm.xfrm_state_lock is held */
c7f5ea3a
DM
1602static void __xfrm_state_bump_genids(struct xfrm_state *xnew)
1603{
98806f75 1604 struct net *net = xs_net(xnew);
c7f5ea3a
DM
1605 unsigned short family = xnew->props.family;
1606 u32 reqid = xnew->props.reqid;
1607 struct xfrm_state *x;
c7f5ea3a 1608 unsigned int h;
3d6acfa7 1609 u32 mark = xnew->mark.v & xnew->mark.m;
7e652640 1610 u32 if_id = xnew->if_id;
1ddf9916 1611 u32 cpu_id = xnew->pcpu_num;
c7f5ea3a 1612
98806f75 1613 h = xfrm_dst_hash(net, &xnew->id.daddr, &xnew->props.saddr, reqid, family);
b67bfe0d 1614 hlist_for_each_entry(x, net->xfrm.state_bydst+h, bydst) {
c7f5ea3a
DM
1615 if (x->props.family == family &&
1616 x->props.reqid == reqid &&
7e652640 1617 x->if_id == if_id &&
1ddf9916 1618 x->pcpu_num == cpu_id &&
3d6acfa7 1619 (mark & x->mark.m) == x->mark.v &&
70e94e66
YH
1620 xfrm_addr_equal(&x->id.daddr, &xnew->id.daddr, family) &&
1621 xfrm_addr_equal(&x->props.saddr, &xnew->props.saddr, family))
34996cb9 1622 x->genid++;
c7f5ea3a
DM
1623 }
1624}
1625
1da177e4
LT
1626void xfrm_state_insert(struct xfrm_state *x)
1627{
283bc9f3
FD
1628 struct net *net = xs_net(x);
1629
1630 spin_lock_bh(&net->xfrm.xfrm_state_lock);
c7f5ea3a 1631 __xfrm_state_bump_genids(x);
1da177e4 1632 __xfrm_state_insert(x);
283bc9f3 1633 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1da177e4
LT
1634}
1635EXPORT_SYMBOL(xfrm_state_insert);
1636
283bc9f3 1637/* net->xfrm.xfrm_state_lock is held */
e473fcb4
MK
1638static struct xfrm_state *__find_acq_core(struct net *net,
1639 const struct xfrm_mark *m,
a70486f0 1640 unsigned short family, u8 mode,
1ddf9916 1641 u32 reqid, u32 if_id, u32 pcpu_num, u8 proto,
a70486f0 1642 const xfrm_address_t *daddr,
e473fcb4
MK
1643 const xfrm_address_t *saddr,
1644 int create)
2770834c 1645{
5447c5e4 1646 unsigned int h = xfrm_dst_hash(net, daddr, saddr, reqid, family);
2770834c 1647 struct xfrm_state *x;
3d6acfa7 1648 u32 mark = m->v & m->m;
2770834c 1649
b67bfe0d 1650 hlist_for_each_entry(x, net->xfrm.state_bydst+h, bydst) {
2770834c
DM
1651 if (x->props.reqid != reqid ||
1652 x->props.mode != mode ||
1653 x->props.family != family ||
1654 x->km.state != XFRM_STATE_ACQ ||
75e252d9 1655 x->id.spi != 0 ||
1802571b 1656 x->id.proto != proto ||
3d6acfa7 1657 (mark & x->mark.m) != x->mark.v ||
1ddf9916 1658 x->pcpu_num != pcpu_num ||
70e94e66
YH
1659 !xfrm_addr_equal(&x->id.daddr, daddr, family) ||
1660 !xfrm_addr_equal(&x->props.saddr, saddr, family))
2770834c
DM
1661 continue;
1662
2770834c
DM
1663 xfrm_state_hold(x);
1664 return x;
1665 }
1666
1667 if (!create)
1668 return NULL;
1669
5447c5e4 1670 x = xfrm_state_alloc(net);
2770834c
DM
1671 if (likely(x)) {
1672 switch (family) {
1673 case AF_INET:
1674 x->sel.daddr.a4 = daddr->a4;
1675 x->sel.saddr.a4 = saddr->a4;
1676 x->sel.prefixlen_d = 32;
1677 x->sel.prefixlen_s = 32;
1678 x->props.saddr.a4 = saddr->a4;
1679 x->id.daddr.a4 = daddr->a4;
1680 break;
1681
1682 case AF_INET6:
15e318bd
JB
1683 x->sel.daddr.in6 = daddr->in6;
1684 x->sel.saddr.in6 = saddr->in6;
2770834c
DM
1685 x->sel.prefixlen_d = 128;
1686 x->sel.prefixlen_s = 128;
15e318bd
JB
1687 x->props.saddr.in6 = saddr->in6;
1688 x->id.daddr.in6 = daddr->in6;
2770834c 1689 break;
3ff50b79 1690 }
2770834c 1691
1ddf9916 1692 x->pcpu_num = pcpu_num;
2770834c
DM
1693 x->km.state = XFRM_STATE_ACQ;
1694 x->id.proto = proto;
1695 x->props.family = family;
1696 x->props.mode = mode;
1697 x->props.reqid = reqid;
7e652640 1698 x->if_id = if_id;
bd55775c
JHS
1699 x->mark.v = m->v;
1700 x->mark.m = m->m;
b27aeadb 1701 x->lft.hard_add_expires_seconds = net->xfrm.sysctl_acq_expires;
2770834c 1702 xfrm_state_hold(x);
671422b2
TG
1703 hrtimer_start(&x->mtimer,
1704 ktime_set(net->xfrm.sysctl_acq_expires, 0),
1705 HRTIMER_MODE_REL_SOFT);
5447c5e4 1706 list_add(&x->km.all, &net->xfrm.state_all);
3c611d40
LR
1707 XFRM_STATE_INSERT(bydst, &x->bydst, net->xfrm.state_bydst + h,
1708 x->xso.type);
5447c5e4 1709 h = xfrm_src_hash(net, daddr, saddr, family);
3c611d40
LR
1710 XFRM_STATE_INSERT(bysrc, &x->bysrc, net->xfrm.state_bysrc + h,
1711 x->xso.type);
918049f0 1712
5447c5e4 1713 net->xfrm.state_num++;
918049f0 1714
5447c5e4 1715 xfrm_hash_grow_check(net, x->bydst.next != NULL);
2770834c
DM
1716 }
1717
1718 return x;
1719}
1720
1ddf9916 1721static struct xfrm_state *__xfrm_find_acq_byseq(struct net *net, u32 mark, u32 seq, u32 pcpu_num);
1da177e4
LT
1722
1723int xfrm_state_add(struct xfrm_state *x)
1724{
5447c5e4 1725 struct net *net = xs_net(x);
37b08e34 1726 struct xfrm_state *x1, *to_put;
1da177e4
LT
1727 int family;
1728 int err;
bd55775c 1729 u32 mark = x->mark.v & x->mark.m;
eb2971b6 1730 int use_spi = xfrm_id_proto_match(x->id.proto, IPSEC_PROTO_ANY);
1da177e4
LT
1731
1732 family = x->props.family;
1da177e4 1733
37b08e34
DM
1734 to_put = NULL;
1735
283bc9f3 1736 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1da177e4 1737
edcd5821 1738 x1 = __xfrm_state_locate(x, use_spi, family);
1da177e4 1739 if (x1) {
37b08e34 1740 to_put = x1;
1da177e4
LT
1741 x1 = NULL;
1742 err = -EEXIST;
1743 goto out;
1744 }
1745
eb2971b6 1746 if (use_spi && x->km.seq) {
1ddf9916 1747 x1 = __xfrm_find_acq_byseq(net, mark, x->km.seq, x->pcpu_num);
75e252d9 1748 if (x1 && ((x1->id.proto != x->id.proto) ||
70e94e66 1749 !xfrm_addr_equal(&x1->id.daddr, &x->id.daddr, family))) {
37b08e34 1750 to_put = x1;
1da177e4
LT
1751 x1 = NULL;
1752 }
1753 }
1754
eb2971b6 1755 if (use_spi && !x1)
bd55775c 1756 x1 = __find_acq_core(net, &x->mark, family, x->props.mode,
1ddf9916 1757 x->props.reqid, x->if_id, x->pcpu_num, x->id.proto,
2770834c 1758 &x->id.daddr, &x->props.saddr, 0);
1da177e4 1759
c7f5ea3a 1760 __xfrm_state_bump_genids(x);
1da177e4
LT
1761 __xfrm_state_insert(x);
1762 err = 0;
1763
1764out:
283bc9f3 1765 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1da177e4
LT
1766
1767 if (x1) {
1768 xfrm_state_delete(x1);
1769 xfrm_state_put(x1);
1770 }
1771
37b08e34
DM
1772 if (to_put)
1773 xfrm_state_put(to_put);
1774
1da177e4
LT
1775 return err;
1776}
1777EXPORT_SYMBOL(xfrm_state_add);
1778
80c9abaa 1779#ifdef CONFIG_XFRM_MIGRATE
7aa05d30
AA
1780static inline int clone_security(struct xfrm_state *x, struct xfrm_sec_ctx *security)
1781{
1782 struct xfrm_user_sec_ctx *uctx;
1783 int size = sizeof(*uctx) + security->ctx_len;
1784 int err;
1785
1786 uctx = kmalloc(size, GFP_KERNEL);
1787 if (!uctx)
1788 return -ENOMEM;
1789
1790 uctx->exttype = XFRMA_SEC_CTX;
1791 uctx->len = size;
1792 uctx->ctx_doi = security->ctx_doi;
1793 uctx->ctx_alg = security->ctx_alg;
1794 uctx->ctx_len = security->ctx_len;
1795 memcpy(uctx + 1, security->ctx_str, security->ctx_len);
1796 err = security_xfrm_state_alloc(x, uctx);
1797 kfree(uctx);
1798 if (err)
1799 return err;
1800
1801 return 0;
1802}
1803
4ab47d47
AA
1804static struct xfrm_state *xfrm_state_clone(struct xfrm_state *orig,
1805 struct xfrm_encap_tmpl *encap)
80c9abaa 1806{
98806f75 1807 struct net *net = xs_net(orig);
98806f75 1808 struct xfrm_state *x = xfrm_state_alloc(net);
80c9abaa 1809 if (!x)
553f9118 1810 goto out;
80c9abaa
SS
1811
1812 memcpy(&x->id, &orig->id, sizeof(x->id));
1813 memcpy(&x->sel, &orig->sel, sizeof(x->sel));
1814 memcpy(&x->lft, &orig->lft, sizeof(x->lft));
1815 x->props.mode = orig->props.mode;
1816 x->props.replay_window = orig->props.replay_window;
1817 x->props.reqid = orig->props.reqid;
1818 x->props.family = orig->props.family;
1819 x->props.saddr = orig->props.saddr;
1820
1821 if (orig->aalg) {
4447bb33 1822 x->aalg = xfrm_algo_auth_clone(orig->aalg);
80c9abaa
SS
1823 if (!x->aalg)
1824 goto error;
1825 }
1826 x->props.aalgo = orig->props.aalgo;
1827
ee5c2317
SK
1828 if (orig->aead) {
1829 x->aead = xfrm_algo_aead_clone(orig->aead);
75bf50f4 1830 x->geniv = orig->geniv;
ee5c2317
SK
1831 if (!x->aead)
1832 goto error;
1833 }
80c9abaa
SS
1834 if (orig->ealg) {
1835 x->ealg = xfrm_algo_clone(orig->ealg);
1836 if (!x->ealg)
1837 goto error;
1838 }
1839 x->props.ealgo = orig->props.ealgo;
1840
1841 if (orig->calg) {
1842 x->calg = xfrm_algo_clone(orig->calg);
1843 if (!x->calg)
1844 goto error;
1845 }
1846 x->props.calgo = orig->props.calgo;
1847
4ab47d47
AA
1848 if (encap || orig->encap) {
1849 if (encap)
1850 x->encap = kmemdup(encap, sizeof(*x->encap),
1851 GFP_KERNEL);
1852 else
1853 x->encap = kmemdup(orig->encap, sizeof(*x->encap),
1854 GFP_KERNEL);
1855
80c9abaa
SS
1856 if (!x->encap)
1857 goto error;
1858 }
1859
7aa05d30
AA
1860 if (orig->security)
1861 if (clone_security(x, orig->security))
1862 goto error;
1863
80c9abaa
SS
1864 if (orig->coaddr) {
1865 x->coaddr = kmemdup(orig->coaddr, sizeof(*x->coaddr),
1866 GFP_KERNEL);
1867 if (!x->coaddr)
1868 goto error;
1869 }
1870
af2f464e 1871 if (orig->replay_esn) {
cc9ab60e 1872 if (xfrm_replay_clone(x, orig))
af2f464e
SK
1873 goto error;
1874 }
1875
bd55775c 1876 memcpy(&x->mark, &orig->mark, sizeof(x->mark));
545e5c57 1877 memcpy(&x->props.smark, &orig->props.smark, sizeof(x->props.smark));
bd55775c 1878
80c9abaa 1879 x->props.flags = orig->props.flags;
a947b0a9 1880 x->props.extra_flags = orig->props.extra_flags;
80c9abaa 1881
1ddf9916 1882 x->pcpu_num = orig->pcpu_num;
7e652640 1883 x->if_id = orig->if_id;
ee5c2317
SK
1884 x->tfcpad = orig->tfcpad;
1885 x->replay_maxdiff = orig->replay_maxdiff;
1886 x->replay_maxage = orig->replay_maxage;
8366685b 1887 memcpy(&x->curlft, &orig->curlft, sizeof(x->curlft));
80c9abaa
SS
1888 x->km.state = orig->km.state;
1889 x->km.seq = orig->km.seq;
a486cd23
AA
1890 x->replay = orig->replay;
1891 x->preplay = orig->preplay;
4e484b3e 1892 x->mapping_maxage = orig->mapping_maxage;
6aa811ac 1893 x->lastused = orig->lastused;
4e484b3e
AA
1894 x->new_mapping = 0;
1895 x->new_mapping_sport = 0;
a4a87fa4 1896 x->dir = orig->dir;
80c9abaa
SS
1897
1898 return x;
1899
1900 error:
553f9118
HX
1901 xfrm_state_put(x);
1902out:
80c9abaa
SS
1903 return NULL;
1904}
80c9abaa 1905
c1aca308
YY
1906struct xfrm_state *xfrm_migrate_state_find(struct xfrm_migrate *m, struct net *net,
1907 u32 if_id)
80c9abaa
SS
1908{
1909 unsigned int h;
8c0cba22
SK
1910 struct xfrm_state *x = NULL;
1911
1912 spin_lock_bh(&net->xfrm.xfrm_state_lock);
80c9abaa
SS
1913
1914 if (m->reqid) {
283bc9f3 1915 h = xfrm_dst_hash(net, &m->old_daddr, &m->old_saddr,
80c9abaa 1916 m->reqid, m->old_family);
283bc9f3 1917 hlist_for_each_entry(x, net->xfrm.state_bydst+h, bydst) {
80c9abaa
SS
1918 if (x->props.mode != m->mode ||
1919 x->id.proto != m->proto)
1920 continue;
1921 if (m->reqid && x->props.reqid != m->reqid)
1922 continue;
c1aca308
YY
1923 if (if_id != 0 && x->if_id != if_id)
1924 continue;
70e94e66
YH
1925 if (!xfrm_addr_equal(&x->id.daddr, &m->old_daddr,
1926 m->old_family) ||
1927 !xfrm_addr_equal(&x->props.saddr, &m->old_saddr,
1928 m->old_family))
80c9abaa
SS
1929 continue;
1930 xfrm_state_hold(x);
8c0cba22 1931 break;
80c9abaa
SS
1932 }
1933 } else {
283bc9f3 1934 h = xfrm_src_hash(net, &m->old_daddr, &m->old_saddr,
80c9abaa 1935 m->old_family);
283bc9f3 1936 hlist_for_each_entry(x, net->xfrm.state_bysrc+h, bysrc) {
80c9abaa
SS
1937 if (x->props.mode != m->mode ||
1938 x->id.proto != m->proto)
1939 continue;
c1aca308
YY
1940 if (if_id != 0 && x->if_id != if_id)
1941 continue;
70e94e66
YH
1942 if (!xfrm_addr_equal(&x->id.daddr, &m->old_daddr,
1943 m->old_family) ||
1944 !xfrm_addr_equal(&x->props.saddr, &m->old_saddr,
1945 m->old_family))
80c9abaa
SS
1946 continue;
1947 xfrm_state_hold(x);
8c0cba22 1948 break;
80c9abaa
SS
1949 }
1950 }
1951
8c0cba22
SK
1952 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1953
1954 return x;
80c9abaa
SS
1955}
1956EXPORT_SYMBOL(xfrm_migrate_state_find);
1957
3e94c2dc 1958struct xfrm_state *xfrm_state_migrate(struct xfrm_state *x,
4ab47d47
AA
1959 struct xfrm_migrate *m,
1960 struct xfrm_encap_tmpl *encap)
80c9abaa
SS
1961{
1962 struct xfrm_state *xc;
80c9abaa 1963
4ab47d47 1964 xc = xfrm_state_clone(x, encap);
80c9abaa
SS
1965 if (!xc)
1966 return NULL;
1967
e03c3bba
YY
1968 xc->props.family = m->new_family;
1969
1970 if (xfrm_init_state(xc) < 0)
1971 goto error;
1972
80c9abaa
SS
1973 memcpy(&xc->id.daddr, &m->new_daddr, sizeof(xc->id.daddr));
1974 memcpy(&xc->props.saddr, &m->new_saddr, sizeof(xc->props.saddr));
1975
1976 /* add state */
70e94e66 1977 if (xfrm_addr_equal(&x->id.daddr, &m->new_daddr, m->new_family)) {
80c9abaa
SS
1978 /* a care is needed when the destination address of the
1979 state is to be updated as it is a part of triplet */
1980 xfrm_state_insert(xc);
1981 } else {
cc9ab60e 1982 if (xfrm_state_add(xc) < 0)
80c9abaa
SS
1983 goto error;
1984 }
1985
1986 return xc;
1987error:
78347c8c 1988 xfrm_state_put(xc);
80c9abaa
SS
1989 return NULL;
1990}
1991EXPORT_SYMBOL(xfrm_state_migrate);
1992#endif
1993
1da177e4
LT
1994int xfrm_state_update(struct xfrm_state *x)
1995{
37b08e34 1996 struct xfrm_state *x1, *to_put;
1da177e4 1997 int err;
eb2971b6 1998 int use_spi = xfrm_id_proto_match(x->id.proto, IPSEC_PROTO_ANY);
283bc9f3 1999 struct net *net = xs_net(x);
1da177e4 2000
37b08e34
DM
2001 to_put = NULL;
2002
283bc9f3 2003 spin_lock_bh(&net->xfrm.xfrm_state_lock);
edcd5821 2004 x1 = __xfrm_state_locate(x, use_spi, x->props.family);
1da177e4
LT
2005
2006 err = -ESRCH;
2007 if (!x1)
2008 goto out;
2009
2010 if (xfrm_state_kern(x1)) {
37b08e34 2011 to_put = x1;
1da177e4
LT
2012 err = -EEXIST;
2013 goto out;
2014 }
2015
2016 if (x1->km.state == XFRM_STATE_ACQ) {
a4a87fa4
AA
2017 if (x->dir && x1->dir != x->dir)
2018 goto out;
2019
1da177e4
LT
2020 __xfrm_state_insert(x);
2021 x = NULL;
a4a87fa4
AA
2022 } else {
2023 if (x1->dir != x->dir)
2024 goto out;
1da177e4
LT
2025 }
2026 err = 0;
2027
2028out:
283bc9f3 2029 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1da177e4 2030
37b08e34
DM
2031 if (to_put)
2032 xfrm_state_put(to_put);
2033
1da177e4
LT
2034 if (err)
2035 return err;
2036
2037 if (!x) {
2038 xfrm_state_delete(x1);
2039 xfrm_state_put(x1);
2040 return 0;
2041 }
2042
2043 err = -EINVAL;
2044 spin_lock_bh(&x1->lock);
2045 if (likely(x1->km.state == XFRM_STATE_VALID)) {
257a4b01
HX
2046 if (x->encap && x1->encap &&
2047 x->encap->encap_type == x1->encap->encap_type)
1da177e4 2048 memcpy(x1->encap, x->encap, sizeof(*x1->encap));
257a4b01
HX
2049 else if (x->encap || x1->encap)
2050 goto fail;
2051
060f02a3
NT
2052 if (x->coaddr && x1->coaddr) {
2053 memcpy(x1->coaddr, x->coaddr, sizeof(*x1->coaddr));
2054 }
2055 if (!use_spi && memcmp(&x1->sel, &x->sel, sizeof(x1->sel)))
2056 memcpy(&x1->sel, &x->sel, sizeof(x1->sel));
1da177e4
LT
2057 memcpy(&x1->lft, &x->lft, sizeof(x1->lft));
2058 x1->km.dying = 0;
2059
671422b2
TG
2060 hrtimer_start(&x1->mtimer, ktime_set(1, 0),
2061 HRTIMER_MODE_REL_SOFT);
0a9e5794 2062 if (READ_ONCE(x1->curlft.use_time))
1da177e4
LT
2063 xfrm_state_check_expire(x1);
2064
5baf4f9c 2065 if (x->props.smark.m || x->props.smark.v || x->if_id) {
6d8e85ff
NH
2066 spin_lock_bh(&net->xfrm.xfrm_state_lock);
2067
5baf4f9c
NH
2068 if (x->props.smark.m || x->props.smark.v)
2069 x1->props.smark = x->props.smark;
2070
2071 if (x->if_id)
2072 x1->if_id = x->if_id;
6d8e85ff
NH
2073
2074 __xfrm_state_bump_genids(x1);
2075 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
2076 }
2077
1da177e4 2078 err = 0;
8fcbc637
TG
2079 x->km.state = XFRM_STATE_DEAD;
2080 __xfrm_state_put(x);
1da177e4 2081 }
257a4b01
HX
2082
2083fail:
1da177e4
LT
2084 spin_unlock_bh(&x1->lock);
2085
2086 xfrm_state_put(x1);
2087
2088 return err;
2089}
2090EXPORT_SYMBOL(xfrm_state_update);
2091
2092int xfrm_state_check_expire(struct xfrm_state *x)
2093{
fd2bc419 2094 xfrm_dev_state_update_stats(x);
f3da86dc 2095
0a9e5794
ED
2096 if (!READ_ONCE(x->curlft.use_time))
2097 WRITE_ONCE(x->curlft.use_time, ktime_get_real_seconds());
1da177e4 2098
1da177e4
LT
2099 if (x->curlft.bytes >= x->lft.hard_byte_limit ||
2100 x->curlft.packets >= x->lft.hard_packet_limit) {
4666faab 2101 x->km.state = XFRM_STATE_EXPIRED;
671422b2 2102 hrtimer_start(&x->mtimer, 0, HRTIMER_MODE_REL_SOFT);
1da177e4
LT
2103 return -EINVAL;
2104 }
2105
2106 if (!x->km.dying &&
2107 (x->curlft.bytes >= x->lft.soft_byte_limit ||
4666faab
HX
2108 x->curlft.packets >= x->lft.soft_packet_limit)) {
2109 x->km.dying = 1;
53bc6b4d 2110 km_state_expired(x, 0, 0);
4666faab 2111 }
1da177e4
LT
2112 return 0;
2113}
2114EXPORT_SYMBOL(xfrm_state_check_expire);
2115
f9f221c9
LR
2116void xfrm_state_update_stats(struct net *net)
2117{
2118 struct xfrm_state *x;
2119 int i;
2120
2121 spin_lock_bh(&net->xfrm.xfrm_state_lock);
2122 for (i = 0; i <= net->xfrm.state_hmask; i++) {
2123 hlist_for_each_entry(x, net->xfrm.state_bydst + i, bydst)
2124 xfrm_dev_state_update_stats(x);
2125 }
2126 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
2127}
2128
1da177e4 2129struct xfrm_state *
a70486f0 2130xfrm_state_lookup(struct net *net, u32 mark, const xfrm_address_t *daddr, __be32 spi,
bd55775c 2131 u8 proto, unsigned short family)
1da177e4
LT
2132{
2133 struct xfrm_state *x;
1da177e4 2134
c2f672fc 2135 rcu_read_lock();
bd55775c 2136 x = __xfrm_state_lookup(net, mark, daddr, spi, proto, family);
c2f672fc 2137 rcu_read_unlock();
1da177e4
LT
2138 return x;
2139}
2140EXPORT_SYMBOL(xfrm_state_lookup);
2141
2142struct xfrm_state *
bd55775c 2143xfrm_state_lookup_byaddr(struct net *net, u32 mark,
a70486f0 2144 const xfrm_address_t *daddr, const xfrm_address_t *saddr,
eb2971b6
MN
2145 u8 proto, unsigned short family)
2146{
2147 struct xfrm_state *x;
eb2971b6 2148
283bc9f3 2149 spin_lock_bh(&net->xfrm.xfrm_state_lock);
bd55775c 2150 x = __xfrm_state_lookup_byaddr(net, mark, daddr, saddr, proto, family);
283bc9f3 2151 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
eb2971b6
MN
2152 return x;
2153}
2154EXPORT_SYMBOL(xfrm_state_lookup_byaddr);
2155
2156struct xfrm_state *
e473fcb4 2157xfrm_find_acq(struct net *net, const struct xfrm_mark *mark, u8 mode, u32 reqid,
1ddf9916 2158 u32 if_id, u32 pcpu_num, u8 proto, const xfrm_address_t *daddr,
e473fcb4 2159 const xfrm_address_t *saddr, int create, unsigned short family)
1da177e4
LT
2160{
2161 struct xfrm_state *x;
1da177e4 2162
283bc9f3 2163 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1ddf9916
SK
2164 x = __find_acq_core(net, mark, family, mode, reqid, if_id, pcpu_num,
2165 proto, daddr, saddr, create);
283bc9f3 2166 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
2770834c 2167
1da177e4
LT
2168 return x;
2169}
2170EXPORT_SYMBOL(xfrm_find_acq);
2171
41a49cc3 2172#ifdef CONFIG_XFRM_SUB_POLICY
3aaf3915
FW
2173#if IS_ENABLED(CONFIG_IPV6)
2174/* distribution counting sort function for xfrm_state and xfrm_tmpl */
2175static void
2176__xfrm6_sort(void **dst, void **src, int n,
2177 int (*cmp)(const void *p), int maxclass)
2178{
2179 int count[XFRM_MAX_DEPTH] = { };
2180 int class[XFRM_MAX_DEPTH];
2181 int i;
2182
2183 for (i = 0; i < n; i++) {
2184 int c = cmp(src[i]);
2185
2186 class[i] = c;
2187 count[c]++;
2188 }
2189
2190 for (i = 2; i < maxclass; i++)
2191 count[i] += count[i - 1];
2192
2193 for (i = 0; i < n; i++) {
2194 dst[count[class[i] - 1]++] = src[i];
2195 src[i] = NULL;
2196 }
2197}
2198
2199/* Rule for xfrm_state:
2200 *
2201 * rule 1: select IPsec transport except AH
2202 * rule 2: select MIPv6 RO or inbound trigger
2203 * rule 3: select IPsec transport AH
2204 * rule 4: select IPsec tunnel
2205 * rule 5: others
2206 */
2207static int __xfrm6_state_sort_cmp(const void *p)
2208{
2209 const struct xfrm_state *v = p;
2210
2211 switch (v->props.mode) {
2212 case XFRM_MODE_TRANSPORT:
2213 if (v->id.proto != IPPROTO_AH)
2214 return 1;
2215 else
2216 return 3;
2217#if IS_ENABLED(CONFIG_IPV6_MIP6)
2218 case XFRM_MODE_ROUTEOPTIMIZATION:
2219 case XFRM_MODE_IN_TRIGGER:
2220 return 2;
2221#endif
2222 case XFRM_MODE_TUNNEL:
2223 case XFRM_MODE_BEET:
2224 return 4;
2225 }
2226 return 5;
2227}
2228
2229/* Rule for xfrm_tmpl:
2230 *
2231 * rule 1: select IPsec transport
2232 * rule 2: select MIPv6 RO or inbound trigger
2233 * rule 3: select IPsec tunnel
2234 * rule 4: others
2235 */
2236static int __xfrm6_tmpl_sort_cmp(const void *p)
2237{
2238 const struct xfrm_tmpl *v = p;
2239
2240 switch (v->mode) {
2241 case XFRM_MODE_TRANSPORT:
2242 return 1;
2243#if IS_ENABLED(CONFIG_IPV6_MIP6)
2244 case XFRM_MODE_ROUTEOPTIMIZATION:
2245 case XFRM_MODE_IN_TRIGGER:
2246 return 2;
2247#endif
2248 case XFRM_MODE_TUNNEL:
2249 case XFRM_MODE_BEET:
2250 return 3;
2251 }
2252 return 4;
2253}
2254#else
2255static inline int __xfrm6_state_sort_cmp(const void *p) { return 5; }
2256static inline int __xfrm6_tmpl_sort_cmp(const void *p) { return 4; }
2257
2258static inline void
2259__xfrm6_sort(void **dst, void **src, int n,
2260 int (*cmp)(const void *p), int maxclass)
2261{
2262 int i;
2263
2264 for (i = 0; i < n; i++)
2265 dst[i] = src[i];
2266}
2267#endif /* CONFIG_IPV6 */
2268
2269void
41a49cc3 2270xfrm_tmpl_sort(struct xfrm_tmpl **dst, struct xfrm_tmpl **src, int n,
3aaf3915 2271 unsigned short family)
41a49cc3 2272{
3f5a95ad 2273 int i;
41a49cc3 2274
3aaf3915
FW
2275 if (family == AF_INET6)
2276 __xfrm6_sort((void **)dst, (void **)src, n,
2277 __xfrm6_tmpl_sort_cmp, 5);
3f5a95ad
KD
2278 else
2279 for (i = 0; i < n; i++)
2280 dst[i] = src[i];
41a49cc3 2281}
41a49cc3 2282
3aaf3915 2283void
41a49cc3
MN
2284xfrm_state_sort(struct xfrm_state **dst, struct xfrm_state **src, int n,
2285 unsigned short family)
2286{
3f5a95ad 2287 int i;
283bc9f3 2288
3aaf3915
FW
2289 if (family == AF_INET6)
2290 __xfrm6_sort((void **)dst, (void **)src, n,
2291 __xfrm6_state_sort_cmp, 6);
3f5a95ad
KD
2292 else
2293 for (i = 0; i < n; i++)
2294 dst[i] = src[i];
41a49cc3 2295}
41a49cc3
MN
2296#endif
2297
1da177e4
LT
2298/* Silly enough, but I'm lazy to build resolution list */
2299
1ddf9916 2300static struct xfrm_state *__xfrm_find_acq_byseq(struct net *net, u32 mark, u32 seq, u32 pcpu_num)
1da177e4 2301{
fe9f1d87
SD
2302 unsigned int h = xfrm_seq_hash(net, seq);
2303 struct xfrm_state *x;
8f126e37 2304
fe9f1d87
SD
2305 hlist_for_each_entry_rcu(x, net->xfrm.state_byseq + h, byseq) {
2306 if (x->km.seq == seq &&
2307 (mark & x->mark.m) == x->mark.v &&
1ddf9916 2308 x->pcpu_num == pcpu_num &&
fe9f1d87
SD
2309 x->km.state == XFRM_STATE_ACQ) {
2310 xfrm_state_hold(x);
2311 return x;
1da177e4
LT
2312 }
2313 }
fe9f1d87 2314
1da177e4
LT
2315 return NULL;
2316}
2317
1ddf9916 2318struct xfrm_state *xfrm_find_acq_byseq(struct net *net, u32 mark, u32 seq, u32 pcpu_num)
1da177e4
LT
2319{
2320 struct xfrm_state *x;
2321
283bc9f3 2322 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1ddf9916 2323 x = __xfrm_find_acq_byseq(net, mark, seq, pcpu_num);
283bc9f3 2324 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1da177e4
LT
2325 return x;
2326}
2327EXPORT_SYMBOL(xfrm_find_acq_byseq);
2328
2329u32 xfrm_get_acqseq(void)
2330{
2331 u32 res;
6836b9bd 2332 static atomic_t acqseq;
2333
2334 do {
2335 res = atomic_inc_return(&acqseq);
2336 } while (!res);
1da177e4 2337
1da177e4
LT
2338 return res;
2339}
2340EXPORT_SYMBOL(xfrm_get_acqseq);
2341
c2dad11e 2342int verify_spi_info(u8 proto, u32 min, u32 max, struct netlink_ext_ack *extack)
776e9dd9
FD
2343{
2344 switch (proto) {
2345 case IPPROTO_AH:
2346 case IPPROTO_ESP:
2347 break;
2348
2349 case IPPROTO_COMP:
2350 /* IPCOMP spi is 16-bits. */
c2dad11e
SD
2351 if (max >= 0x10000) {
2352 NL_SET_ERR_MSG(extack, "IPCOMP SPI must be <= 65535");
776e9dd9 2353 return -EINVAL;
c2dad11e 2354 }
776e9dd9
FD
2355 break;
2356
2357 default:
c2dad11e 2358 NL_SET_ERR_MSG(extack, "Invalid protocol, must be one of AH, ESP, IPCOMP");
776e9dd9
FD
2359 return -EINVAL;
2360 }
2361
c2dad11e
SD
2362 if (min > max) {
2363 NL_SET_ERR_MSG(extack, "Invalid SPI range: min > max");
776e9dd9 2364 return -EINVAL;
c2dad11e 2365 }
776e9dd9
FD
2366
2367 return 0;
2368}
2369EXPORT_SYMBOL(verify_spi_info);
2370
c2dad11e
SD
2371int xfrm_alloc_spi(struct xfrm_state *x, u32 low, u32 high,
2372 struct netlink_ext_ack *extack)
1da177e4 2373{
221df1ed 2374 struct net *net = xs_net(x);
f034b5d4 2375 unsigned int h;
1da177e4 2376 struct xfrm_state *x0;
658b219e
HX
2377 int err = -ENOENT;
2378 __be32 minspi = htonl(low);
2379 __be32 maxspi = htonl(high);
a779d913 2380 __be32 newspi = 0;
bd55775c 2381 u32 mark = x->mark.v & x->mark.m;
1da177e4 2382
658b219e 2383 spin_lock_bh(&x->lock);
c2dad11e
SD
2384 if (x->km.state == XFRM_STATE_DEAD) {
2385 NL_SET_ERR_MSG(extack, "Target ACQUIRE is in DEAD state");
658b219e 2386 goto unlock;
c2dad11e 2387 }
658b219e
HX
2388
2389 err = 0;
1da177e4 2390 if (x->id.spi)
658b219e
HX
2391 goto unlock;
2392
2393 err = -ENOENT;
1da177e4
LT
2394
2395 if (minspi == maxspi) {
bd55775c 2396 x0 = xfrm_state_lookup(net, mark, &x->id.daddr, minspi, x->id.proto, x->props.family);
1da177e4 2397 if (x0) {
c2dad11e 2398 NL_SET_ERR_MSG(extack, "Requested SPI is already in use");
1da177e4 2399 xfrm_state_put(x0);
658b219e 2400 goto unlock;
1da177e4 2401 }
a779d913 2402 newspi = minspi;
1da177e4
LT
2403 } else {
2404 u32 spi = 0;
9b7a787d 2405 for (h = 0; h < high-low+1; h++) {
e8a533cb 2406 spi = get_random_u32_inclusive(low, high);
bd55775c 2407 x0 = xfrm_state_lookup(net, mark, &x->id.daddr, htonl(spi), x->id.proto, x->props.family);
1da177e4 2408 if (x0 == NULL) {
a779d913 2409 newspi = htonl(spi);
1da177e4
LT
2410 break;
2411 }
2412 xfrm_state_put(x0);
2413 }
2414 }
a779d913 2415 if (newspi) {
283bc9f3 2416 spin_lock_bh(&net->xfrm.xfrm_state_lock);
a779d913 2417 x->id.spi = newspi;
12604d8a 2418 h = xfrm_spi_hash(net, &x->id.daddr, x->id.spi, x->id.proto, x->props.family);
3c611d40
LR
2419 XFRM_STATE_INSERT(byspi, &x->byspi, net->xfrm.state_byspi + h,
2420 x->xso.type);
283bc9f3 2421 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
658b219e
HX
2422
2423 err = 0;
c2dad11e
SD
2424 } else {
2425 NL_SET_ERR_MSG(extack, "No SPI available in the requested range");
1da177e4 2426 }
658b219e
HX
2427
2428unlock:
2429 spin_unlock_bh(&x->lock);
2430
2431 return err;
1da177e4
LT
2432}
2433EXPORT_SYMBOL(xfrm_alloc_spi);
2434
d3623099 2435static bool __xfrm_state_filter_match(struct xfrm_state *x,
870a2df4 2436 struct xfrm_address_filter *filter)
d3623099
ND
2437{
2438 if (filter) {
2439 if ((filter->family == AF_INET ||
2440 filter->family == AF_INET6) &&
2441 x->props.family != filter->family)
2442 return false;
2443
2444 return addr_match(&x->props.saddr, &filter->saddr,
2445 filter->splen) &&
2446 addr_match(&x->id.daddr, &filter->daddr,
2447 filter->dplen);
2448 }
2449 return true;
2450}
2451
284fa7da 2452int xfrm_state_walk(struct net *net, struct xfrm_state_walk *walk,
4c563f76 2453 int (*func)(struct xfrm_state *, int, void*),
1da177e4
LT
2454 void *data)
2455{
12a169e7
HX
2456 struct xfrm_state *state;
2457 struct xfrm_state_walk *x;
1da177e4
LT
2458 int err = 0;
2459
12a169e7 2460 if (walk->seq != 0 && list_empty(&walk->all))
4c563f76
TT
2461 return 0;
2462
283bc9f3 2463 spin_lock_bh(&net->xfrm.xfrm_state_lock);
12a169e7 2464 if (list_empty(&walk->all))
284fa7da 2465 x = list_first_entry(&net->xfrm.state_all, struct xfrm_state_walk, all);
12a169e7 2466 else
80077702 2467 x = list_first_entry(&walk->all, struct xfrm_state_walk, all);
284fa7da 2468 list_for_each_entry_from(x, &net->xfrm.state_all, all) {
12a169e7 2469 if (x->state == XFRM_STATE_DEAD)
4c563f76 2470 continue;
12a169e7
HX
2471 state = container_of(x, struct xfrm_state, km);
2472 if (!xfrm_id_proto_match(state->id.proto, walk->proto))
4c563f76 2473 continue;
d3623099
ND
2474 if (!__xfrm_state_filter_match(state, walk->filter))
2475 continue;
12a169e7
HX
2476 err = func(state, walk->seq, data);
2477 if (err) {
2478 list_move_tail(&walk->all, &x->all);
2479 goto out;
1da177e4 2480 }
12a169e7 2481 walk->seq++;
1da177e4 2482 }
12a169e7 2483 if (walk->seq == 0) {
1da177e4
LT
2484 err = -ENOENT;
2485 goto out;
2486 }
12a169e7 2487 list_del_init(&walk->all);
1da177e4 2488out:
283bc9f3 2489 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1da177e4
LT
2490 return err;
2491}
2492EXPORT_SYMBOL(xfrm_state_walk);
2493
d3623099 2494void xfrm_state_walk_init(struct xfrm_state_walk *walk, u8 proto,
870a2df4 2495 struct xfrm_address_filter *filter)
5c182458 2496{
12a169e7 2497 INIT_LIST_HEAD(&walk->all);
5c182458 2498 walk->proto = proto;
12a169e7
HX
2499 walk->state = XFRM_STATE_DEAD;
2500 walk->seq = 0;
d3623099 2501 walk->filter = filter;
5c182458
HX
2502}
2503EXPORT_SYMBOL(xfrm_state_walk_init);
2504
283bc9f3 2505void xfrm_state_walk_done(struct xfrm_state_walk *walk, struct net *net)
abb81c4f 2506{
d3623099
ND
2507 kfree(walk->filter);
2508
12a169e7 2509 if (list_empty(&walk->all))
5c182458 2510 return;
5c182458 2511
283bc9f3 2512 spin_lock_bh(&net->xfrm.xfrm_state_lock);
12a169e7 2513 list_del(&walk->all);
283bc9f3 2514 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
abb81c4f
HX
2515}
2516EXPORT_SYMBOL(xfrm_state_walk_done);
2517
e99e88a9 2518static void xfrm_replay_timer_handler(struct timer_list *t)
f8cd5488 2519{
e99e88a9 2520 struct xfrm_state *x = from_timer(x, t, rtimer);
f8cd5488
JHS
2521
2522 spin_lock(&x->lock);
2523
2717096a 2524 if (x->km.state == XFRM_STATE_VALID) {
a6483b79 2525 if (xfrm_aevent_is_on(xs_net(x)))
cfc61c59 2526 xfrm_replay_notify(x, XFRM_REPLAY_TIMEOUT);
2717096a
JHS
2527 else
2528 x->xflags |= XFRM_TIME_DEFER;
2529 }
f8cd5488
JHS
2530
2531 spin_unlock(&x->lock);
2532}
2533
df01812e 2534static LIST_HEAD(xfrm_km_list);
1da177e4 2535
214e005b 2536void km_policy_notify(struct xfrm_policy *xp, int dir, const struct km_event *c)
1da177e4
LT
2537{
2538 struct xfrm_mgr *km;
2539
85168c00
CW
2540 rcu_read_lock();
2541 list_for_each_entry_rcu(km, &xfrm_km_list, list)
26b15dad
JHS
2542 if (km->notify_policy)
2543 km->notify_policy(xp, dir, c);
85168c00 2544 rcu_read_unlock();
26b15dad 2545}
1da177e4 2546
214e005b 2547void km_state_notify(struct xfrm_state *x, const struct km_event *c)
26b15dad
JHS
2548{
2549 struct xfrm_mgr *km;
85168c00
CW
2550 rcu_read_lock();
2551 list_for_each_entry_rcu(km, &xfrm_km_list, list)
26b15dad
JHS
2552 if (km->notify)
2553 km->notify(x, c);
85168c00 2554 rcu_read_unlock();
26b15dad
JHS
2555}
2556
2557EXPORT_SYMBOL(km_policy_notify);
2558EXPORT_SYMBOL(km_state_notify);
2559
15e47304 2560void km_state_expired(struct xfrm_state *x, int hard, u32 portid)
26b15dad
JHS
2561{
2562 struct km_event c;
2563
bf08867f 2564 c.data.hard = hard;
15e47304 2565 c.portid = portid;
f60f6b8f 2566 c.event = XFRM_MSG_EXPIRE;
26b15dad 2567 km_state_notify(x, &c);
1da177e4
LT
2568}
2569
53bc6b4d 2570EXPORT_SYMBOL(km_state_expired);
26b15dad
JHS
2571/*
2572 * We send to all registered managers regardless of failure
2573 * We are happy with one success
2574*/
980ebd25 2575int km_query(struct xfrm_state *x, struct xfrm_tmpl *t, struct xfrm_policy *pol)
1da177e4 2576{
26b15dad 2577 int err = -EINVAL, acqret;
1da177e4
LT
2578 struct xfrm_mgr *km;
2579
85168c00
CW
2580 rcu_read_lock();
2581 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
65e0736b 2582 acqret = km->acquire(x, t, pol);
26b15dad
JHS
2583 if (!acqret)
2584 err = acqret;
1da177e4 2585 }
85168c00 2586 rcu_read_unlock();
1da177e4
LT
2587 return err;
2588}
980ebd25 2589EXPORT_SYMBOL(km_query);
1da177e4 2590
4e484b3e 2591static int __km_new_mapping(struct xfrm_state *x, xfrm_address_t *ipaddr, __be16 sport)
1da177e4
LT
2592{
2593 int err = -EINVAL;
2594 struct xfrm_mgr *km;
2595
85168c00
CW
2596 rcu_read_lock();
2597 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
1da177e4
LT
2598 if (km->new_mapping)
2599 err = km->new_mapping(x, ipaddr, sport);
2600 if (!err)
2601 break;
2602 }
85168c00 2603 rcu_read_unlock();
1da177e4
LT
2604 return err;
2605}
4e484b3e
AA
2606
2607int km_new_mapping(struct xfrm_state *x, xfrm_address_t *ipaddr, __be16 sport)
2608{
2609 int ret = 0;
2610
2611 if (x->mapping_maxage) {
2612 if ((jiffies / HZ - x->new_mapping) > x->mapping_maxage ||
2613 x->new_mapping_sport != sport) {
2614 x->new_mapping_sport = sport;
2615 x->new_mapping = jiffies / HZ;
2616 ret = __km_new_mapping(x, ipaddr, sport);
2617 }
2618 } else {
2619 ret = __km_new_mapping(x, ipaddr, sport);
2620 }
2621
2622 return ret;
2623}
1da177e4
LT
2624EXPORT_SYMBOL(km_new_mapping);
2625
15e47304 2626void km_policy_expired(struct xfrm_policy *pol, int dir, int hard, u32 portid)
1da177e4 2627{
26b15dad 2628 struct km_event c;
1da177e4 2629
bf08867f 2630 c.data.hard = hard;
15e47304 2631 c.portid = portid;
f60f6b8f 2632 c.event = XFRM_MSG_POLEXPIRE;
26b15dad 2633 km_policy_notify(pol, dir, &c);
1da177e4 2634}
a70fcb0b 2635EXPORT_SYMBOL(km_policy_expired);
1da177e4 2636
2d60abc2 2637#ifdef CONFIG_XFRM_MIGRATE
183cad12
DM
2638int km_migrate(const struct xfrm_selector *sel, u8 dir, u8 type,
2639 const struct xfrm_migrate *m, int num_migrate,
8bafd730
AA
2640 const struct xfrm_kmaddress *k,
2641 const struct xfrm_encap_tmpl *encap)
80c9abaa
SS
2642{
2643 int err = -EINVAL;
2644 int ret;
2645 struct xfrm_mgr *km;
2646
85168c00
CW
2647 rcu_read_lock();
2648 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
80c9abaa 2649 if (km->migrate) {
8bafd730
AA
2650 ret = km->migrate(sel, dir, type, m, num_migrate, k,
2651 encap);
80c9abaa
SS
2652 if (!ret)
2653 err = ret;
2654 }
2655 }
85168c00 2656 rcu_read_unlock();
80c9abaa
SS
2657 return err;
2658}
2659EXPORT_SYMBOL(km_migrate);
2d60abc2 2660#endif
80c9abaa 2661
db983c11 2662int km_report(struct net *net, u8 proto, struct xfrm_selector *sel, xfrm_address_t *addr)
97a64b45
MN
2663{
2664 int err = -EINVAL;
2665 int ret;
2666 struct xfrm_mgr *km;
2667
85168c00
CW
2668 rcu_read_lock();
2669 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
97a64b45 2670 if (km->report) {
db983c11 2671 ret = km->report(net, proto, sel, addr);
97a64b45
MN
2672 if (!ret)
2673 err = ret;
2674 }
2675 }
85168c00 2676 rcu_read_unlock();
97a64b45
MN
2677 return err;
2678}
2679EXPORT_SYMBOL(km_report);
2680
bb9cd077 2681static bool km_is_alive(const struct km_event *c)
0f24558e
HG
2682{
2683 struct xfrm_mgr *km;
2684 bool is_alive = false;
2685
2686 rcu_read_lock();
2687 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
2688 if (km->is_alive && km->is_alive(c)) {
2689 is_alive = true;
2690 break;
2691 }
2692 }
2693 rcu_read_unlock();
2694
2695 return is_alive;
2696}
0f24558e 2697
c9e7c76d
DS
2698#if IS_ENABLED(CONFIG_XFRM_USER_COMPAT)
2699static DEFINE_SPINLOCK(xfrm_translator_lock);
2700static struct xfrm_translator __rcu *xfrm_translator;
2701
2702struct xfrm_translator *xfrm_get_translator(void)
2703{
2704 struct xfrm_translator *xtr;
2705
2706 rcu_read_lock();
2707 xtr = rcu_dereference(xfrm_translator);
2708 if (unlikely(!xtr))
2709 goto out;
2710 if (!try_module_get(xtr->owner))
2711 xtr = NULL;
2712out:
2713 rcu_read_unlock();
2714 return xtr;
2715}
2716EXPORT_SYMBOL_GPL(xfrm_get_translator);
2717
2718void xfrm_put_translator(struct xfrm_translator *xtr)
2719{
2720 module_put(xtr->owner);
2721}
2722EXPORT_SYMBOL_GPL(xfrm_put_translator);
2723
2724int xfrm_register_translator(struct xfrm_translator *xtr)
2725{
2726 int err = 0;
2727
2728 spin_lock_bh(&xfrm_translator_lock);
2729 if (unlikely(xfrm_translator != NULL))
2730 err = -EEXIST;
2731 else
2732 rcu_assign_pointer(xfrm_translator, xtr);
2733 spin_unlock_bh(&xfrm_translator_lock);
2734
2735 return err;
2736}
2737EXPORT_SYMBOL_GPL(xfrm_register_translator);
2738
2739int xfrm_unregister_translator(struct xfrm_translator *xtr)
2740{
2741 int err = 0;
2742
2743 spin_lock_bh(&xfrm_translator_lock);
2744 if (likely(xfrm_translator != NULL)) {
2745 if (rcu_access_pointer(xfrm_translator) != xtr)
2746 err = -EINVAL;
2747 else
2748 RCU_INIT_POINTER(xfrm_translator, NULL);
2749 }
2750 spin_unlock_bh(&xfrm_translator_lock);
2751 synchronize_rcu();
2752
2753 return err;
2754}
2755EXPORT_SYMBOL_GPL(xfrm_unregister_translator);
2756#endif
2757
c6d1b26a 2758int xfrm_user_policy(struct sock *sk, int optname, sockptr_t optval, int optlen)
1da177e4
LT
2759{
2760 int err;
2761 u8 *data;
2762 struct xfrm_mgr *km;
2763 struct xfrm_policy *pol = NULL;
2764
c6d1b26a 2765 if (sockptr_is_null(optval) && !optlen) {
be8f8284
LC
2766 xfrm_sk_policy_insert(sk, XFRM_POLICY_IN, NULL);
2767 xfrm_sk_policy_insert(sk, XFRM_POLICY_OUT, NULL);
2768 __sk_dst_reset(sk);
2769 return 0;
2770 }
2771
1da177e4
LT
2772 if (optlen <= 0 || optlen > PAGE_SIZE)
2773 return -EMSGSIZE;
2774
c6d1b26a 2775 data = memdup_sockptr(optval, optlen);
a133d930
GT
2776 if (IS_ERR(data))
2777 return PTR_ERR(data);
1da177e4 2778
96392ee5
DS
2779 if (in_compat_syscall()) {
2780 struct xfrm_translator *xtr = xfrm_get_translator();
2781
48f486e1
YK
2782 if (!xtr) {
2783 kfree(data);
96392ee5 2784 return -EOPNOTSUPP;
48f486e1 2785 }
96392ee5
DS
2786
2787 err = xtr->xlate_user_policy_sockptr(&data, optlen);
2788 xfrm_put_translator(xtr);
2789 if (err) {
2790 kfree(data);
2791 return err;
2792 }
2793 }
2794
1da177e4 2795 err = -EINVAL;
85168c00
CW
2796 rcu_read_lock();
2797 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
cb969f07 2798 pol = km->compile_policy(sk, optname, data,
1da177e4
LT
2799 optlen, &err);
2800 if (err >= 0)
2801 break;
2802 }
85168c00 2803 rcu_read_unlock();
1da177e4
LT
2804
2805 if (err >= 0) {
2806 xfrm_sk_policy_insert(sk, err, pol);
2807 xfrm_pol_put(pol);
2b06cdf3 2808 __sk_dst_reset(sk);
1da177e4
LT
2809 err = 0;
2810 }
2811
1da177e4
LT
2812 kfree(data);
2813 return err;
2814}
2815EXPORT_SYMBOL(xfrm_user_policy);
2816
85168c00
CW
2817static DEFINE_SPINLOCK(xfrm_km_lock);
2818
f41b284a 2819void xfrm_register_km(struct xfrm_mgr *km)
1da177e4 2820{
85168c00
CW
2821 spin_lock_bh(&xfrm_km_lock);
2822 list_add_tail_rcu(&km->list, &xfrm_km_list);
2823 spin_unlock_bh(&xfrm_km_lock);
1da177e4
LT
2824}
2825EXPORT_SYMBOL(xfrm_register_km);
2826
f41b284a 2827void xfrm_unregister_km(struct xfrm_mgr *km)
1da177e4 2828{
85168c00
CW
2829 spin_lock_bh(&xfrm_km_lock);
2830 list_del_rcu(&km->list);
2831 spin_unlock_bh(&xfrm_km_lock);
2832 synchronize_rcu();
1da177e4
LT
2833}
2834EXPORT_SYMBOL(xfrm_unregister_km);
2835
2836int xfrm_state_register_afinfo(struct xfrm_state_afinfo *afinfo)
2837{
2838 int err = 0;
423826a7
FW
2839
2840 if (WARN_ON(afinfo->family >= NPROTO))
1da177e4 2841 return -EAFNOSUPPORT;
423826a7 2842
44abdc30 2843 spin_lock_bh(&xfrm_state_afinfo_lock);
1da177e4 2844 if (unlikely(xfrm_state_afinfo[afinfo->family] != NULL))
f31e8d4f 2845 err = -EEXIST;
edcd5821 2846 else
44abdc30
CW
2847 rcu_assign_pointer(xfrm_state_afinfo[afinfo->family], afinfo);
2848 spin_unlock_bh(&xfrm_state_afinfo_lock);
1da177e4
LT
2849 return err;
2850}
2851EXPORT_SYMBOL(xfrm_state_register_afinfo);
2852
2853int xfrm_state_unregister_afinfo(struct xfrm_state_afinfo *afinfo)
2854{
423826a7
FW
2855 int err = 0, family = afinfo->family;
2856
2857 if (WARN_ON(family >= NPROTO))
1da177e4 2858 return -EAFNOSUPPORT;
423826a7 2859
44abdc30 2860 spin_lock_bh(&xfrm_state_afinfo_lock);
1da177e4 2861 if (likely(xfrm_state_afinfo[afinfo->family] != NULL)) {
423826a7 2862 if (rcu_access_pointer(xfrm_state_afinfo[family]) != afinfo)
1da177e4 2863 err = -EINVAL;
edcd5821 2864 else
44abdc30 2865 RCU_INIT_POINTER(xfrm_state_afinfo[afinfo->family], NULL);
1da177e4 2866 }
44abdc30
CW
2867 spin_unlock_bh(&xfrm_state_afinfo_lock);
2868 synchronize_rcu();
1da177e4
LT
2869 return err;
2870}
2871EXPORT_SYMBOL(xfrm_state_unregister_afinfo);
2872
711059b9
FW
2873struct xfrm_state_afinfo *xfrm_state_afinfo_get_rcu(unsigned int family)
2874{
2875 if (unlikely(family >= NPROTO))
2876 return NULL;
2877
2878 return rcu_dereference(xfrm_state_afinfo[family]);
2879}
733a5fac 2880EXPORT_SYMBOL_GPL(xfrm_state_afinfo_get_rcu);
711059b9 2881
628e341f 2882struct xfrm_state_afinfo *xfrm_state_get_afinfo(unsigned int family)
1da177e4
LT
2883{
2884 struct xfrm_state_afinfo *afinfo;
2885 if (unlikely(family >= NPROTO))
2886 return NULL;
44abdc30
CW
2887 rcu_read_lock();
2888 afinfo = rcu_dereference(xfrm_state_afinfo[family]);
546be240 2889 if (unlikely(!afinfo))
44abdc30 2890 rcu_read_unlock();
1da177e4
LT
2891 return afinfo;
2892}
2893
b48c05ab
SK
2894void xfrm_flush_gc(void)
2895{
2896 flush_work(&xfrm_state_gc_work);
2897}
2898EXPORT_SYMBOL(xfrm_flush_gc);
2899
1da177e4
LT
2900/* Temporarily located here until net/xfrm/xfrm_tunnel.c is created */
2901void xfrm_state_delete_tunnel(struct xfrm_state *x)
2902{
2903 if (x->tunnel) {
2904 struct xfrm_state *t = x->tunnel;
2905
2906 if (atomic_read(&t->tunnel_users) == 2)
2907 xfrm_state_delete(t);
2908 atomic_dec(&t->tunnel_users);
f75a2804 2909 xfrm_state_put_sync(t);
1da177e4
LT
2910 x->tunnel = NULL;
2911 }
2912}
2913EXPORT_SYMBOL(xfrm_state_delete_tunnel);
2914
a6d95c5a 2915u32 xfrm_state_mtu(struct xfrm_state *x, int mtu)
1da177e4 2916{
b3b73b8e 2917 const struct xfrm_type *type = READ_ONCE(x->type);
c7b37c76
FW
2918 struct crypto_aead *aead;
2919 u32 blksize, net_adj = 0;
2920
2921 if (x->km.state != XFRM_STATE_VALID ||
2922 !type || type->proto != IPPROTO_ESP)
2923 return mtu - x->props.header_len;
2924
2925 aead = x->data;
2926 blksize = ALIGN(crypto_aead_blocksize(aead), 4);
1da177e4 2927
c7b37c76
FW
2928 switch (x->props.mode) {
2929 case XFRM_MODE_TRANSPORT:
2930 case XFRM_MODE_BEET:
2931 if (x->props.family == AF_INET)
2932 net_adj = sizeof(struct iphdr);
2933 else if (x->props.family == AF_INET6)
2934 net_adj = sizeof(struct ipv6hdr);
2935 break;
2936 case XFRM_MODE_TUNNEL:
2937 break;
2938 default:
2939 WARN_ON_ONCE(1);
2940 break;
2941 }
b3b73b8e 2942
c7b37c76
FW
2943 return ((mtu - x->props.header_len - crypto_aead_authsize(aead) -
2944 net_adj) & ~(blksize - 1)) + net_adj - 2;
1da177e4 2945}
a6d95c5a 2946EXPORT_SYMBOL_GPL(xfrm_state_mtu);
1da177e4 2947
741f9a10
SD
2948int __xfrm_init_state(struct xfrm_state *x, bool init_replay, bool offload,
2949 struct netlink_ext_ack *extack)
72cb6962 2950{
c9500d7b
FW
2951 const struct xfrm_mode *inner_mode;
2952 const struct xfrm_mode *outer_mode;
d094cd83 2953 int family = x->props.family;
72cb6962
HX
2954 int err;
2955
e4681747 2956 if (family == AF_INET &&
0968d2a4 2957 READ_ONCE(xs_net(x)->ipv4.sysctl_ip_no_pmtu_disc))
e4681747 2958 x->props.flags |= XFRM_STATE_NOPMTUDISC;
d094cd83
HX
2959
2960 err = -EPROTONOSUPPORT;
13996378 2961
df9dcb45
KM
2962 if (x->sel.family != AF_UNSPEC) {
2963 inner_mode = xfrm_get_mode(x->props.mode, x->sel.family);
741f9a10
SD
2964 if (inner_mode == NULL) {
2965 NL_SET_ERR_MSG(extack, "Requested mode not found");
df9dcb45 2966 goto error;
741f9a10 2967 }
df9dcb45
KM
2968
2969 if (!(inner_mode->flags & XFRM_MODE_FLAG_TUNNEL) &&
741f9a10
SD
2970 family != x->sel.family) {
2971 NL_SET_ERR_MSG(extack, "Only tunnel modes can accommodate a change of family");
df9dcb45 2972 goto error;
741f9a10 2973 }
df9dcb45 2974
c9500d7b 2975 x->inner_mode = *inner_mode;
df9dcb45 2976 } else {
4c145dce 2977 const struct xfrm_mode *inner_mode_iaf;
d81d2285 2978 int iafamily = AF_INET;
df9dcb45 2979
d81d2285 2980 inner_mode = xfrm_get_mode(x->props.mode, x->props.family);
741f9a10
SD
2981 if (inner_mode == NULL) {
2982 NL_SET_ERR_MSG(extack, "Requested mode not found");
df9dcb45 2983 goto error;
741f9a10 2984 }
df9dcb45 2985
c9500d7b 2986 x->inner_mode = *inner_mode;
df9dcb45 2987
d81d2285
MW
2988 if (x->props.family == AF_INET)
2989 iafamily = AF_INET6;
df9dcb45 2990
d81d2285
MW
2991 inner_mode_iaf = xfrm_get_mode(x->props.mode, iafamily);
2992 if (inner_mode_iaf) {
2993 if (inner_mode_iaf->flags & XFRM_MODE_FLAG_TUNNEL)
c9500d7b 2994 x->inner_mode_iaf = *inner_mode_iaf;
df9dcb45
KM
2995 }
2996 }
13996378 2997
d094cd83 2998 x->type = xfrm_get_type(x->id.proto, family);
741f9a10
SD
2999 if (x->type == NULL) {
3000 NL_SET_ERR_MSG(extack, "Requested type not found");
72cb6962 3001 goto error;
741f9a10 3002 }
72cb6962 3003
ffdb5211 3004 x->type_offload = xfrm_get_type_offload(x->id.proto, family, offload);
9d389d7f 3005
e1e10b44 3006 err = x->type->init_state(x, extack);
72cb6962
HX
3007 if (err)
3008 goto error;
3009
c9500d7b
FW
3010 outer_mode = xfrm_get_mode(x->props.mode, family);
3011 if (!outer_mode) {
741f9a10 3012 NL_SET_ERR_MSG(extack, "Requested mode not found");
599901c3 3013 err = -EPROTONOSUPPORT;
b59f45d0 3014 goto error;
599901c3 3015 }
b59f45d0 3016
c9500d7b 3017 x->outer_mode = *outer_mode;
a454f0cc 3018 if (init_replay) {
1cf9a3ae 3019 err = xfrm_init_replay(x, extack);
a454f0cc
WY
3020 if (err)
3021 goto error;
3022 }
3023
f531d13b
EB
3024 if (x->nat_keepalive_interval) {
3025 if (x->dir != XFRM_SA_DIR_OUT) {
3026 NL_SET_ERR_MSG(extack, "NAT keepalive is only supported for outbound SAs");
3027 err = -EINVAL;
3028 goto error;
3029 }
3030
3031 if (!x->encap || x->encap->encap_type != UDP_ENCAP_ESPINUDP) {
3032 NL_SET_ERR_MSG(extack,
3033 "NAT keepalive is only supported for UDP encapsulation");
3034 err = -EINVAL;
3035 goto error;
3036 }
3037 }
3038
72cb6962
HX
3039error:
3040 return err;
3041}
3042
a454f0cc
WY
3043EXPORT_SYMBOL(__xfrm_init_state);
3044
3045int xfrm_init_state(struct xfrm_state *x)
3046{
cc01572e
YK
3047 int err;
3048
741f9a10 3049 err = __xfrm_init_state(x, true, false, NULL);
cc01572e
YK
3050 if (!err)
3051 x->km.state = XFRM_STATE_VALID;
3052
3053 return err;
a454f0cc
WY
3054}
3055
72cb6962 3056EXPORT_SYMBOL(xfrm_init_state);
a716c119 3057
d62ddc21 3058int __net_init xfrm_state_init(struct net *net)
1da177e4 3059{
f034b5d4
DM
3060 unsigned int sz;
3061
565f0fa9
MK
3062 if (net_eq(net, &init_net))
3063 xfrm_state_cache = KMEM_CACHE(xfrm_state,
3064 SLAB_HWCACHE_ALIGN | SLAB_PANIC);
3065
9d4139c7
AD
3066 INIT_LIST_HEAD(&net->xfrm.state_all);
3067
f034b5d4
DM
3068 sz = sizeof(struct hlist_head) * 8;
3069
73d189dc
AD
3070 net->xfrm.state_bydst = xfrm_hash_alloc(sz);
3071 if (!net->xfrm.state_bydst)
3072 goto out_bydst;
d320bbb3
AD
3073 net->xfrm.state_bysrc = xfrm_hash_alloc(sz);
3074 if (!net->xfrm.state_bysrc)
3075 goto out_bysrc;
b754a4fd
AD
3076 net->xfrm.state_byspi = xfrm_hash_alloc(sz);
3077 if (!net->xfrm.state_byspi)
3078 goto out_byspi;
fe9f1d87
SD
3079 net->xfrm.state_byseq = xfrm_hash_alloc(sz);
3080 if (!net->xfrm.state_byseq)
3081 goto out_byseq;
529983ec 3082 net->xfrm.state_hmask = ((sz / sizeof(struct hlist_head)) - 1);
1da177e4 3083
0bf7c5b0 3084 net->xfrm.state_num = 0;
63082733 3085 INIT_WORK(&net->xfrm.state_hash_work, xfrm_hash_resize);
283bc9f3 3086 spin_lock_init(&net->xfrm.xfrm_state_lock);
bc8e0adf
AD
3087 seqcount_spinlock_init(&net->xfrm.xfrm_state_hash_generation,
3088 &net->xfrm.xfrm_state_lock);
d62ddc21 3089 return 0;
73d189dc 3090
fe9f1d87
SD
3091out_byseq:
3092 xfrm_hash_free(net->xfrm.state_byspi, sz);
b754a4fd
AD
3093out_byspi:
3094 xfrm_hash_free(net->xfrm.state_bysrc, sz);
d320bbb3
AD
3095out_bysrc:
3096 xfrm_hash_free(net->xfrm.state_bydst, sz);
73d189dc
AD
3097out_bydst:
3098 return -ENOMEM;
d62ddc21
AD
3099}
3100
3101void xfrm_state_fini(struct net *net)
3102{
73d189dc
AD
3103 unsigned int sz;
3104
7c2776ee 3105 flush_work(&net->xfrm.state_hash_work);
35db57bb 3106 flush_work(&xfrm_state_gc_work);
dbb2483b 3107 xfrm_state_flush(net, 0, false, true);
7c2776ee 3108
9d4139c7 3109 WARN_ON(!list_empty(&net->xfrm.state_all));
73d189dc 3110
529983ec 3111 sz = (net->xfrm.state_hmask + 1) * sizeof(struct hlist_head);
fe9f1d87
SD
3112 WARN_ON(!hlist_empty(net->xfrm.state_byseq));
3113 xfrm_hash_free(net->xfrm.state_byseq, sz);
b754a4fd
AD
3114 WARN_ON(!hlist_empty(net->xfrm.state_byspi));
3115 xfrm_hash_free(net->xfrm.state_byspi, sz);
d320bbb3
AD
3116 WARN_ON(!hlist_empty(net->xfrm.state_bysrc));
3117 xfrm_hash_free(net->xfrm.state_bysrc, sz);
73d189dc
AD
3118 WARN_ON(!hlist_empty(net->xfrm.state_bydst));
3119 xfrm_hash_free(net->xfrm.state_bydst, sz);
1da177e4
LT
3120}
3121
ab5f5e8b 3122#ifdef CONFIG_AUDITSYSCALL
cf35f43e
IJ
3123static void xfrm_audit_helper_sainfo(struct xfrm_state *x,
3124 struct audit_buffer *audit_buf)
ab5f5e8b 3125{
68277acc
PM
3126 struct xfrm_sec_ctx *ctx = x->security;
3127 u32 spi = ntohl(x->id.spi);
3128
3129 if (ctx)
ab5f5e8b 3130 audit_log_format(audit_buf, " sec_alg=%u sec_doi=%u sec_obj=%s",
68277acc 3131 ctx->ctx_alg, ctx->ctx_doi, ctx->ctx_str);
ab5f5e8b 3132
9b7a787d 3133 switch (x->props.family) {
ab5f5e8b 3134 case AF_INET:
21454aaa
HH
3135 audit_log_format(audit_buf, " src=%pI4 dst=%pI4",
3136 &x->props.saddr.a4, &x->id.daddr.a4);
ab5f5e8b
JL
3137 break;
3138 case AF_INET6:
5b095d98 3139 audit_log_format(audit_buf, " src=%pI6 dst=%pI6",
fdb46ee7 3140 x->props.saddr.a6, x->id.daddr.a6);
ab5f5e8b
JL
3141 break;
3142 }
68277acc
PM
3143
3144 audit_log_format(audit_buf, " spi=%u(0x%x)", spi, spi);
ab5f5e8b
JL
3145}
3146
cf35f43e
IJ
3147static void xfrm_audit_helper_pktinfo(struct sk_buff *skb, u16 family,
3148 struct audit_buffer *audit_buf)
afeb14b4 3149{
b71d1d42
ED
3150 const struct iphdr *iph4;
3151 const struct ipv6hdr *iph6;
afeb14b4
PM
3152
3153 switch (family) {
3154 case AF_INET:
3155 iph4 = ip_hdr(skb);
21454aaa
HH
3156 audit_log_format(audit_buf, " src=%pI4 dst=%pI4",
3157 &iph4->saddr, &iph4->daddr);
afeb14b4
PM
3158 break;
3159 case AF_INET6:
3160 iph6 = ipv6_hdr(skb);
3161 audit_log_format(audit_buf,
5b095d98 3162 " src=%pI6 dst=%pI6 flowlbl=0x%x%02x%02x",
9b7a787d 3163 &iph6->saddr, &iph6->daddr,
afeb14b4
PM
3164 iph6->flow_lbl[0] & 0x0f,
3165 iph6->flow_lbl[1],
3166 iph6->flow_lbl[2]);
3167 break;
3168 }
3169}
3170
2e71029e 3171void xfrm_audit_state_add(struct xfrm_state *x, int result, bool task_valid)
ab5f5e8b
JL
3172{
3173 struct audit_buffer *audit_buf;
ab5f5e8b 3174
afeb14b4 3175 audit_buf = xfrm_audit_start("SAD-add");
ab5f5e8b
JL
3176 if (audit_buf == NULL)
3177 return;
2e71029e 3178 xfrm_audit_helper_usrinfo(task_valid, audit_buf);
afeb14b4
PM
3179 xfrm_audit_helper_sainfo(x, audit_buf);
3180 audit_log_format(audit_buf, " res=%u", result);
ab5f5e8b
JL
3181 audit_log_end(audit_buf);
3182}
3183EXPORT_SYMBOL_GPL(xfrm_audit_state_add);
3184
2e71029e 3185void xfrm_audit_state_delete(struct xfrm_state *x, int result, bool task_valid)
ab5f5e8b
JL
3186{
3187 struct audit_buffer *audit_buf;
ab5f5e8b 3188
afeb14b4 3189 audit_buf = xfrm_audit_start("SAD-delete");
ab5f5e8b
JL
3190 if (audit_buf == NULL)
3191 return;
2e71029e 3192 xfrm_audit_helper_usrinfo(task_valid, audit_buf);
afeb14b4
PM
3193 xfrm_audit_helper_sainfo(x, audit_buf);
3194 audit_log_format(audit_buf, " res=%u", result);
ab5f5e8b
JL
3195 audit_log_end(audit_buf);
3196}
3197EXPORT_SYMBOL_GPL(xfrm_audit_state_delete);
afeb14b4
PM
3198
3199void xfrm_audit_state_replay_overflow(struct xfrm_state *x,
3200 struct sk_buff *skb)
3201{
3202 struct audit_buffer *audit_buf;
3203 u32 spi;
3204
3205 audit_buf = xfrm_audit_start("SA-replay-overflow");
3206 if (audit_buf == NULL)
3207 return;
3208 xfrm_audit_helper_pktinfo(skb, x->props.family, audit_buf);
3209 /* don't record the sequence number because it's inherent in this kind
3210 * of audit message */
3211 spi = ntohl(x->id.spi);
3212 audit_log_format(audit_buf, " spi=%u(0x%x)", spi, spi);
3213 audit_log_end(audit_buf);
3214}
3215EXPORT_SYMBOL_GPL(xfrm_audit_state_replay_overflow);
3216
9fdc4883 3217void xfrm_audit_state_replay(struct xfrm_state *x,
afeb14b4
PM
3218 struct sk_buff *skb, __be32 net_seq)
3219{
3220 struct audit_buffer *audit_buf;
3221 u32 spi;
3222
3223 audit_buf = xfrm_audit_start("SA-replayed-pkt");
3224 if (audit_buf == NULL)
3225 return;
3226 xfrm_audit_helper_pktinfo(skb, x->props.family, audit_buf);
3227 spi = ntohl(x->id.spi);
3228 audit_log_format(audit_buf, " spi=%u(0x%x) seqno=%u",
3229 spi, spi, ntohl(net_seq));
3230 audit_log_end(audit_buf);
3231}
9fdc4883 3232EXPORT_SYMBOL_GPL(xfrm_audit_state_replay);
afeb14b4
PM
3233
3234void xfrm_audit_state_notfound_simple(struct sk_buff *skb, u16 family)
3235{
3236 struct audit_buffer *audit_buf;
3237
3238 audit_buf = xfrm_audit_start("SA-notfound");
3239 if (audit_buf == NULL)
3240 return;
3241 xfrm_audit_helper_pktinfo(skb, family, audit_buf);
3242 audit_log_end(audit_buf);
3243}
3244EXPORT_SYMBOL_GPL(xfrm_audit_state_notfound_simple);
3245
3246void xfrm_audit_state_notfound(struct sk_buff *skb, u16 family,
3247 __be32 net_spi, __be32 net_seq)
3248{
3249 struct audit_buffer *audit_buf;
3250 u32 spi;
3251
3252 audit_buf = xfrm_audit_start("SA-notfound");
3253 if (audit_buf == NULL)
3254 return;
3255 xfrm_audit_helper_pktinfo(skb, family, audit_buf);
3256 spi = ntohl(net_spi);
3257 audit_log_format(audit_buf, " spi=%u(0x%x) seqno=%u",
3258 spi, spi, ntohl(net_seq));
3259 audit_log_end(audit_buf);
3260}
3261EXPORT_SYMBOL_GPL(xfrm_audit_state_notfound);
3262
3263void xfrm_audit_state_icvfail(struct xfrm_state *x,
3264 struct sk_buff *skb, u8 proto)
3265{
3266 struct audit_buffer *audit_buf;
3267 __be32 net_spi;
3268 __be32 net_seq;
3269
3270 audit_buf = xfrm_audit_start("SA-icv-failure");
3271 if (audit_buf == NULL)
3272 return;
3273 xfrm_audit_helper_pktinfo(skb, x->props.family, audit_buf);
3274 if (xfrm_parse_spi(skb, proto, &net_spi, &net_seq) == 0) {
3275 u32 spi = ntohl(net_spi);
3276 audit_log_format(audit_buf, " spi=%u(0x%x) seqno=%u",
3277 spi, spi, ntohl(net_seq));
3278 }
3279 audit_log_end(audit_buf);
3280}
3281EXPORT_SYMBOL_GPL(xfrm_audit_state_icvfail);
ab5f5e8b 3282#endif /* CONFIG_AUDITSYSCALL */
This page took 2.987735 seconds and 4 git commands to generate.