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