projects / GitHub / MotorolaMobilityLLC / kernel-slsi.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
[RAMEN9610-20741]UPSTREAM: xfrm: Remove xfrmi interface ID from flowi
[GitHub/MotorolaMobilityLLC/kernel-slsi.git] / net / xfrm / xfrm_state.c
1 /*
2 * xfrm_state.c
3 *
4 * Changes:
5 * Mitsuru KANDA @USAGI
6 * Kazunori MIYAZAWA @USAGI
7 * Kunihiro Ishiguro <kunihiro@ipinfusion.com>
8 * IPv6 support
9 * YOSHIFUJI Hideaki @USAGI
10 * Split up af-specific functions
11 * Derek Atkins <derek@ihtfp.com>
12 * Add UDP Encapsulation
13 *
14 */
15
16 #include <linux/workqueue.h>
17 #include <net/xfrm.h>
18 #include <linux/pfkeyv2.h>
19 #include <linux/ipsec.h>
20 #include <linux/module.h>
21 #include <linux/cache.h>
22 #include <linux/audit.h>
23 #include <linux/uaccess.h>
24 #include <linux/ktime.h>
25 #include <linux/slab.h>
26 #include <linux/interrupt.h>
27 #include <linux/kernel.h>
28
29 #include "xfrm_hash.h"
30
31 #define xfrm_state_deref_prot(table, net) \
32 rcu_dereference_protected((table), lockdep_is_held(&(net)->xfrm.xfrm_state_lock))
33
34 static void xfrm_state_gc_task(struct work_struct *work);
35
36 /* Each xfrm_state may be linked to two tables:
37
38 1. Hash table by (spi,daddr,ah/esp) to find SA by SPI. (input,ctl)
39 2. Hash table by (daddr,family,reqid) to find what SAs exist for given
40 destination/tunnel endpoint. (output)
41 */
42
43 static unsigned int xfrm_state_hashmax __read_mostly = 1 * 1024 * 1024;
44 static __read_mostly seqcount_t xfrm_state_hash_generation = SEQCNT_ZERO(xfrm_state_hash_generation);
45
46 static DECLARE_WORK(xfrm_state_gc_work, xfrm_state_gc_task);
47 static HLIST_HEAD(xfrm_state_gc_list);
48
49 static inline bool xfrm_state_hold_rcu(struct xfrm_state __rcu *x)
50 {
51 return refcount_inc_not_zero(&x->refcnt);
52 }
53
54 static inline unsigned int xfrm_dst_hash(struct net *net,
55 const xfrm_address_t *daddr,
56 const xfrm_address_t *saddr,
57 u32 reqid,
58 unsigned short family)
59 {
60 return __xfrm_dst_hash(daddr, saddr, reqid, family, net->xfrm.state_hmask);
61 }
62
63 static inline unsigned int xfrm_src_hash(struct net *net,
64 const xfrm_address_t *daddr,
65 const xfrm_address_t *saddr,
66 unsigned short family)
67 {
68 return __xfrm_src_hash(daddr, saddr, family, net->xfrm.state_hmask);
69 }
70
71 static inline unsigned int
72 xfrm_spi_hash(struct net *net, const xfrm_address_t *daddr,
73 __be32 spi, u8 proto, unsigned short family)
74 {
75 return __xfrm_spi_hash(daddr, spi, proto, family, net->xfrm.state_hmask);
76 }
77
78 static void xfrm_hash_transfer(struct hlist_head *list,
79 struct hlist_head *ndsttable,
80 struct hlist_head *nsrctable,
81 struct hlist_head *nspitable,
82 unsigned int nhashmask)
83 {
84 struct hlist_node *tmp;
85 struct xfrm_state *x;
86
87 hlist_for_each_entry_safe(x, tmp, list, bydst) {
88 unsigned int h;
89
90 h = __xfrm_dst_hash(&x->id.daddr, &x->props.saddr,
91 x->props.reqid, x->props.family,
92 nhashmask);
93 hlist_add_head_rcu(&x->bydst, ndsttable + h);
94
95 h = __xfrm_src_hash(&x->id.daddr, &x->props.saddr,
96 x->props.family,
97 nhashmask);
98 hlist_add_head_rcu(&x->bysrc, nsrctable + h);
99
100 if (x->id.spi) {
101 h = __xfrm_spi_hash(&x->id.daddr, x->id.spi,
102 x->id.proto, x->props.family,
103 nhashmask);
104 hlist_add_head_rcu(&x->byspi, nspitable + h);
105 }
106 }
107 }
108
109 static unsigned long xfrm_hash_new_size(unsigned int state_hmask)
110 {
111 return ((state_hmask + 1) << 1) * sizeof(struct hlist_head);
112 }
113
114 static void xfrm_hash_resize(struct work_struct *work)
115 {
116 struct net *net = container_of(work, struct net, xfrm.state_hash_work);
117 struct hlist_head *ndst, *nsrc, *nspi, *odst, *osrc, *ospi;
118 unsigned long nsize, osize;
119 unsigned int nhashmask, ohashmask;
120 int i;
121
122 nsize = xfrm_hash_new_size(net->xfrm.state_hmask);
123 ndst = xfrm_hash_alloc(nsize);
124 if (!ndst)
125 return;
126 nsrc = xfrm_hash_alloc(nsize);
127 if (!nsrc) {
128 xfrm_hash_free(ndst, nsize);
129 return;
130 }
131 nspi = xfrm_hash_alloc(nsize);
132 if (!nspi) {
133 xfrm_hash_free(ndst, nsize);
134 xfrm_hash_free(nsrc, nsize);
135 return;
136 }
137
138 spin_lock_bh(&net->xfrm.xfrm_state_lock);
139 write_seqcount_begin(&xfrm_state_hash_generation);
140
141 nhashmask = (nsize / sizeof(struct hlist_head)) - 1U;
142 odst = xfrm_state_deref_prot(net->xfrm.state_bydst, net);
143 for (i = net->xfrm.state_hmask; i >= 0; i--)
144 xfrm_hash_transfer(odst + i, ndst, nsrc, nspi, nhashmask);
145
146 osrc = xfrm_state_deref_prot(net->xfrm.state_bysrc, net);
147 ospi = xfrm_state_deref_prot(net->xfrm.state_byspi, net);
148 ohashmask = net->xfrm.state_hmask;
149
150 rcu_assign_pointer(net->xfrm.state_bydst, ndst);
151 rcu_assign_pointer(net->xfrm.state_bysrc, nsrc);
152 rcu_assign_pointer(net->xfrm.state_byspi, nspi);
153 net->xfrm.state_hmask = nhashmask;
154
155 write_seqcount_end(&xfrm_state_hash_generation);
156 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
157
158 osize = (ohashmask + 1) * sizeof(struct hlist_head);
159
160 synchronize_rcu();
161
162 xfrm_hash_free(odst, osize);
163 xfrm_hash_free(osrc, osize);
164 xfrm_hash_free(ospi, osize);
165 }
166
167 static DEFINE_SPINLOCK(xfrm_state_afinfo_lock);
168 static struct xfrm_state_afinfo __rcu *xfrm_state_afinfo[NPROTO];
169
170 static DEFINE_SPINLOCK(xfrm_state_gc_lock);
171
172 int __xfrm_state_delete(struct xfrm_state *x);
173
174 int km_query(struct xfrm_state *x, struct xfrm_tmpl *t, struct xfrm_policy *pol);
175 bool km_is_alive(const struct km_event *c);
176 void km_state_expired(struct xfrm_state *x, int hard, u32 portid);
177
178 static DEFINE_SPINLOCK(xfrm_type_lock);
179 int xfrm_register_type(const struct xfrm_type *type, unsigned short family)
180 {
181 struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
182 const struct xfrm_type **typemap;
183 int err = 0;
184
185 if (unlikely(afinfo == NULL))
186 return -EAFNOSUPPORT;
187 typemap = afinfo->type_map;
188 spin_lock_bh(&xfrm_type_lock);
189
190 if (likely(typemap[type->proto] == NULL))
191 typemap[type->proto] = type;
192 else
193 err = -EEXIST;
194 spin_unlock_bh(&xfrm_type_lock);
195 rcu_read_unlock();
196 return err;
197 }
198 EXPORT_SYMBOL(xfrm_register_type);
199
200 int xfrm_unregister_type(const struct xfrm_type *type, unsigned short family)
201 {
202 struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
203 const struct xfrm_type **typemap;
204 int err = 0;
205
206 if (unlikely(afinfo == NULL))
207 return -EAFNOSUPPORT;
208 typemap = afinfo->type_map;
209 spin_lock_bh(&xfrm_type_lock);
210
211 if (unlikely(typemap[type->proto] != type))
212 err = -ENOENT;
213 else
214 typemap[type->proto] = NULL;
215 spin_unlock_bh(&xfrm_type_lock);
216 rcu_read_unlock();
217 return err;
218 }
219 EXPORT_SYMBOL(xfrm_unregister_type);
220
221 static const struct xfrm_type *xfrm_get_type(u8 proto, unsigned short family)
222 {
223 struct xfrm_state_afinfo *afinfo;
224 const struct xfrm_type **typemap;
225 const struct xfrm_type *type;
226 int modload_attempted = 0;
227
228 retry:
229 afinfo = xfrm_state_get_afinfo(family);
230 if (unlikely(afinfo == NULL))
231 return NULL;
232 typemap = afinfo->type_map;
233
234 type = READ_ONCE(typemap[proto]);
235 if (unlikely(type && !try_module_get(type->owner)))
236 type = NULL;
237
238 rcu_read_unlock();
239
240 if (!type && !modload_attempted) {
241 request_module("xfrm-type-%d-%d", family, proto);
242 modload_attempted = 1;
243 goto retry;
244 }
245
246 return type;
247 }
248
249 static void xfrm_put_type(const struct xfrm_type *type)
250 {
251 module_put(type->owner);
252 }
253
254 static DEFINE_SPINLOCK(xfrm_type_offload_lock);
255 int xfrm_register_type_offload(const struct xfrm_type_offload *type,
256 unsigned short family)
257 {
258 struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
259 const struct xfrm_type_offload **typemap;
260 int err = 0;
261
262 if (unlikely(afinfo == NULL))
263 return -EAFNOSUPPORT;
264 typemap = afinfo->type_offload_map;
265 spin_lock_bh(&xfrm_type_offload_lock);
266
267 if (likely(typemap[type->proto] == NULL))
268 typemap[type->proto] = type;
269 else
270 err = -EEXIST;
271 spin_unlock_bh(&xfrm_type_offload_lock);
272 rcu_read_unlock();
273 return err;
274 }
275 EXPORT_SYMBOL(xfrm_register_type_offload);
276
277 int xfrm_unregister_type_offload(const struct xfrm_type_offload *type,
278 unsigned short family)
279 {
280 struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
281 const struct xfrm_type_offload **typemap;
282 int err = 0;
283
284 if (unlikely(afinfo == NULL))
285 return -EAFNOSUPPORT;
286 typemap = afinfo->type_offload_map;
287 spin_lock_bh(&xfrm_type_offload_lock);
288
289 if (unlikely(typemap[type->proto] != type))
290 err = -ENOENT;
291 else
292 typemap[type->proto] = NULL;
293 spin_unlock_bh(&xfrm_type_offload_lock);
294 rcu_read_unlock();
295 return err;
296 }
297 EXPORT_SYMBOL(xfrm_unregister_type_offload);
298
299 static const struct xfrm_type_offload *
300 xfrm_get_type_offload(u8 proto, unsigned short family, bool try_load)
301 {
302 struct xfrm_state_afinfo *afinfo;
303 const struct xfrm_type_offload **typemap;
304 const struct xfrm_type_offload *type;
305
306 retry:
307 afinfo = xfrm_state_get_afinfo(family);
308 if (unlikely(afinfo == NULL))
309 return NULL;
310 typemap = afinfo->type_offload_map;
311
312 type = typemap[proto];
313 if ((type && !try_module_get(type->owner)))
314 type = NULL;
315
316 rcu_read_unlock();
317
318 if (!type && try_load) {
319 request_module("xfrm-offload-%d-%d", family, proto);
320 try_load = 0;
321 goto retry;
322 }
323
324 return type;
325 }
326
327 static void xfrm_put_type_offload(const struct xfrm_type_offload *type)
328 {
329 module_put(type->owner);
330 }
331
332 static DEFINE_SPINLOCK(xfrm_mode_lock);
333 int xfrm_register_mode(struct xfrm_mode *mode, int family)
334 {
335 struct xfrm_state_afinfo *afinfo;
336 struct xfrm_mode **modemap;
337 int err;
338
339 if (unlikely(mode->encap >= XFRM_MODE_MAX))
340 return -EINVAL;
341
342 afinfo = xfrm_state_get_afinfo(family);
343 if (unlikely(afinfo == NULL))
344 return -EAFNOSUPPORT;
345
346 err = -EEXIST;
347 modemap = afinfo->mode_map;
348 spin_lock_bh(&xfrm_mode_lock);
349 if (modemap[mode->encap])
350 goto out;
351
352 err = -ENOENT;
353 if (!try_module_get(afinfo->owner))
354 goto out;
355
356 mode->afinfo = afinfo;
357 modemap[mode->encap] = mode;
358 err = 0;
359
360 out:
361 spin_unlock_bh(&xfrm_mode_lock);
362 rcu_read_unlock();
363 return err;
364 }
365 EXPORT_SYMBOL(xfrm_register_mode);
366
367 int xfrm_unregister_mode(struct xfrm_mode *mode, int family)
368 {
369 struct xfrm_state_afinfo *afinfo;
370 struct xfrm_mode **modemap;
371 int err;
372
373 if (unlikely(mode->encap >= XFRM_MODE_MAX))
374 return -EINVAL;
375
376 afinfo = xfrm_state_get_afinfo(family);
377 if (unlikely(afinfo == NULL))
378 return -EAFNOSUPPORT;
379
380 err = -ENOENT;
381 modemap = afinfo->mode_map;
382 spin_lock_bh(&xfrm_mode_lock);
383 if (likely(modemap[mode->encap] == mode)) {
384 modemap[mode->encap] = NULL;
385 module_put(mode->afinfo->owner);
386 err = 0;
387 }
388
389 spin_unlock_bh(&xfrm_mode_lock);
390 rcu_read_unlock();
391 return err;
392 }
393 EXPORT_SYMBOL(xfrm_unregister_mode);
394
395 static struct xfrm_mode *xfrm_get_mode(unsigned int encap, int family)
396 {
397 struct xfrm_state_afinfo *afinfo;
398 struct xfrm_mode *mode;
399 int modload_attempted = 0;
400
401 if (unlikely(encap >= XFRM_MODE_MAX))
402 return NULL;
403
404 retry:
405 afinfo = xfrm_state_get_afinfo(family);
406 if (unlikely(afinfo == NULL))
407 return NULL;
408
409 mode = READ_ONCE(afinfo->mode_map[encap]);
410 if (unlikely(mode && !try_module_get(mode->owner)))
411 mode = NULL;
412
413 rcu_read_unlock();
414 if (!mode && !modload_attempted) {
415 request_module("xfrm-mode-%d-%d", family, encap);
416 modload_attempted = 1;
417 goto retry;
418 }
419
420 return mode;
421 }
422
423 static void xfrm_put_mode(struct xfrm_mode *mode)
424 {
425 module_put(mode->owner);
426 }
427
428 static void xfrm_state_gc_destroy(struct xfrm_state *x)
429 {
430 tasklet_hrtimer_cancel(&x->mtimer);
431 del_timer_sync(&x->rtimer);
432 kfree(x->aead);
433 kfree(x->aalg);
434 kfree(x->ealg);
435 kfree(x->calg);
436 kfree(x->encap);
437 kfree(x->coaddr);
438 kfree(x->replay_esn);
439 kfree(x->preplay_esn);
440 if (x->inner_mode)
441 xfrm_put_mode(x->inner_mode);
442 if (x->inner_mode_iaf)
443 xfrm_put_mode(x->inner_mode_iaf);
444 if (x->outer_mode)
445 xfrm_put_mode(x->outer_mode);
446 if (x->type_offload)
447 xfrm_put_type_offload(x->type_offload);
448 if (x->type) {
449 x->type->destructor(x);
450 xfrm_put_type(x->type);
451 }
452 xfrm_dev_state_free(x);
453 security_xfrm_state_free(x);
454 kfree(x);
455 }
456
457 static void xfrm_state_gc_task(struct work_struct *work)
458 {
459 struct xfrm_state *x;
460 struct hlist_node *tmp;
461 struct hlist_head gc_list;
462
463 spin_lock_bh(&xfrm_state_gc_lock);
464 hlist_move_list(&xfrm_state_gc_list, &gc_list);
465 spin_unlock_bh(&xfrm_state_gc_lock);
466
467 synchronize_rcu();
468
469 hlist_for_each_entry_safe(x, tmp, &gc_list, gclist)
470 xfrm_state_gc_destroy(x);
471 }
472
473 static enum hrtimer_restart xfrm_timer_handler(struct hrtimer *me)
474 {
475 struct tasklet_hrtimer *thr = container_of(me, struct tasklet_hrtimer, timer);
476 struct xfrm_state *x = container_of(thr, struct xfrm_state, mtimer);
477 unsigned long now = get_seconds();
478 long next = LONG_MAX;
479 int warn = 0;
480 int err = 0;
481
482 spin_lock(&x->lock);
483 if (x->km.state == XFRM_STATE_DEAD)
484 goto out;
485 if (x->km.state == XFRM_STATE_EXPIRED)
486 goto expired;
487 if (x->lft.hard_add_expires_seconds) {
488 long tmo = x->lft.hard_add_expires_seconds +
489 x->curlft.add_time - now;
490 if (tmo <= 0) {
491 if (x->xflags & XFRM_SOFT_EXPIRE) {
492 /* enter hard expire without soft expire first?!
493 * setting a new date could trigger this.
494 * workaround: fix x->curflt.add_time by below:
495 */
496 x->curlft.add_time = now - x->saved_tmo - 1;
497 tmo = x->lft.hard_add_expires_seconds - x->saved_tmo;
498 } else
499 goto expired;
500 }
501 if (tmo < next)
502 next = tmo;
503 }
504 if (x->lft.hard_use_expires_seconds) {
505 long tmo = x->lft.hard_use_expires_seconds +
506 (x->curlft.use_time ? : now) - now;
507 if (tmo <= 0)
508 goto expired;
509 if (tmo < next)
510 next = tmo;
511 }
512 if (x->km.dying)
513 goto resched;
514 if (x->lft.soft_add_expires_seconds) {
515 long tmo = x->lft.soft_add_expires_seconds +
516 x->curlft.add_time - now;
517 if (tmo <= 0) {
518 warn = 1;
519 x->xflags &= ~XFRM_SOFT_EXPIRE;
520 } else if (tmo < next) {
521 next = tmo;
522 x->xflags |= XFRM_SOFT_EXPIRE;
523 x->saved_tmo = tmo;
524 }
525 }
526 if (x->lft.soft_use_expires_seconds) {
527 long tmo = x->lft.soft_use_expires_seconds +
528 (x->curlft.use_time ? : now) - now;
529 if (tmo <= 0)
530 warn = 1;
531 else if (tmo < next)
532 next = tmo;
533 }
534
535 x->km.dying = warn;
536 if (warn)
537 km_state_expired(x, 0, 0);
538 resched:
539 if (next != LONG_MAX) {
540 tasklet_hrtimer_start(&x->mtimer, ktime_set(next, 0), HRTIMER_MODE_REL);
541 }
542
543 goto out;
544
545 expired:
546 if (x->km.state == XFRM_STATE_ACQ && x->id.spi == 0)
547 x->km.state = XFRM_STATE_EXPIRED;
548
549 err = __xfrm_state_delete(x);
550 if (!err)
551 km_state_expired(x, 1, 0);
552
553 xfrm_audit_state_delete(x, err ? 0 : 1, true);
554
555 out:
556 spin_unlock(&x->lock);
557 return HRTIMER_NORESTART;
558 }
559
560 static void xfrm_replay_timer_handler(unsigned long data);
561
562 struct xfrm_state *xfrm_state_alloc(struct net *net)
563 {
564 struct xfrm_state *x;
565
566 x = kzalloc(sizeof(struct xfrm_state), GFP_ATOMIC);
567
568 if (x) {
569 write_pnet(&x->xs_net, net);
570 refcount_set(&x->refcnt, 1);
571 atomic_set(&x->tunnel_users, 0);
572 INIT_LIST_HEAD(&x->km.all);
573 INIT_HLIST_NODE(&x->bydst);
574 INIT_HLIST_NODE(&x->bysrc);
575 INIT_HLIST_NODE(&x->byspi);
576 tasklet_hrtimer_init(&x->mtimer, xfrm_timer_handler,
577 CLOCK_BOOTTIME, HRTIMER_MODE_ABS);
578 setup_timer(&x->rtimer, xfrm_replay_timer_handler,
579 (unsigned long)x);
580 x->curlft.add_time = get_seconds();
581 x->lft.soft_byte_limit = XFRM_INF;
582 x->lft.soft_packet_limit = XFRM_INF;
583 x->lft.hard_byte_limit = XFRM_INF;
584 x->lft.hard_packet_limit = XFRM_INF;
585 x->replay_maxage = 0;
586 x->replay_maxdiff = 0;
587 x->inner_mode = NULL;
588 x->inner_mode_iaf = NULL;
589 spin_lock_init(&x->lock);
590 }
591 return x;
592 }
593 EXPORT_SYMBOL(xfrm_state_alloc);
594
595 void __xfrm_state_destroy(struct xfrm_state *x)
596 {
597 WARN_ON(x->km.state != XFRM_STATE_DEAD);
598
599 spin_lock_bh(&xfrm_state_gc_lock);
600 hlist_add_head(&x->gclist, &xfrm_state_gc_list);
601 spin_unlock_bh(&xfrm_state_gc_lock);
602 schedule_work(&xfrm_state_gc_work);
603 }
604 EXPORT_SYMBOL(__xfrm_state_destroy);
605
606 int __xfrm_state_delete(struct xfrm_state *x)
607 {
608 struct net *net = xs_net(x);
609 int err = -ESRCH;
610
611 if (x->km.state != XFRM_STATE_DEAD) {
612 x->km.state = XFRM_STATE_DEAD;
613 spin_lock(&net->xfrm.xfrm_state_lock);
614 list_del(&x->km.all);
615 hlist_del_rcu(&x->bydst);
616 hlist_del_rcu(&x->bysrc);
617 if (x->id.spi)
618 hlist_del_rcu(&x->byspi);
619 net->xfrm.state_num--;
620 spin_unlock(&net->xfrm.xfrm_state_lock);
621
622 xfrm_dev_state_delete(x);
623
624 /* All xfrm_state objects are created by xfrm_state_alloc.
625 * The xfrm_state_alloc call gives a reference, and that
626 * is what we are dropping here.
627 */
628 xfrm_state_put(x);
629 err = 0;
630 }
631
632 return err;
633 }
634 EXPORT_SYMBOL(__xfrm_state_delete);
635
636 int xfrm_state_delete(struct xfrm_state *x)
637 {
638 int err;
639
640 spin_lock_bh(&x->lock);
641 err = __xfrm_state_delete(x);
642 spin_unlock_bh(&x->lock);
643
644 return err;
645 }
646 EXPORT_SYMBOL(xfrm_state_delete);
647
648 #ifdef CONFIG_SECURITY_NETWORK_XFRM
649 static inline int
650 xfrm_state_flush_secctx_check(struct net *net, u8 proto, bool task_valid)
651 {
652 int i, err = 0;
653
654 for (i = 0; i <= net->xfrm.state_hmask; i++) {
655 struct xfrm_state *x;
656
657 hlist_for_each_entry(x, net->xfrm.state_bydst+i, bydst) {
658 if (xfrm_id_proto_match(x->id.proto, proto) &&
659 (err = security_xfrm_state_delete(x)) != 0) {
660 xfrm_audit_state_delete(x, 0, task_valid);
661 return err;
662 }
663 }
664 }
665
666 return err;
667 }
668
669 static inline int
670 xfrm_dev_state_flush_secctx_check(struct net *net, struct net_device *dev, bool task_valid)
671 {
672 int i, err = 0;
673
674 for (i = 0; i <= net->xfrm.state_hmask; i++) {
675 struct xfrm_state *x;
676 struct xfrm_state_offload *xso;
677
678 hlist_for_each_entry(x, net->xfrm.state_bydst+i, bydst) {
679 xso = &x->xso;
680
681 if (xso->dev == dev &&
682 (err = security_xfrm_state_delete(x)) != 0) {
683 xfrm_audit_state_delete(x, 0, task_valid);
684 return err;
685 }
686 }
687 }
688
689 return err;
690 }
691 #else
692 static inline int
693 xfrm_state_flush_secctx_check(struct net *net, u8 proto, bool task_valid)
694 {
695 return 0;
696 }
697
698 static inline int
699 xfrm_dev_state_flush_secctx_check(struct net *net, struct net_device *dev, bool task_valid)
700 {
701 return 0;
702 }
703 #endif
704
705 int xfrm_state_flush(struct net *net, u8 proto, bool task_valid)
706 {
707 int i, err = 0, cnt = 0;
708
709 spin_lock_bh(&net->xfrm.xfrm_state_lock);
710 err = xfrm_state_flush_secctx_check(net, proto, task_valid);
711 if (err)
712 goto out;
713
714 err = -ESRCH;
715 for (i = 0; i <= net->xfrm.state_hmask; i++) {
716 struct xfrm_state *x;
717 restart:
718 hlist_for_each_entry(x, net->xfrm.state_bydst+i, bydst) {
719 if (!xfrm_state_kern(x) &&
720 xfrm_id_proto_match(x->id.proto, proto)) {
721 xfrm_state_hold(x);
722 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
723
724 err = xfrm_state_delete(x);
725 xfrm_audit_state_delete(x, err ? 0 : 1,
726 task_valid);
727 xfrm_state_put(x);
728 if (!err)
729 cnt++;
730
731 spin_lock_bh(&net->xfrm.xfrm_state_lock);
732 goto restart;
733 }
734 }
735 }
736 out:
737 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
738 if (cnt) {
739 err = 0;
740 xfrm_policy_cache_flush();
741 }
742 return err;
743 }
744 EXPORT_SYMBOL(xfrm_state_flush);
745
746 int xfrm_dev_state_flush(struct net *net, struct net_device *dev, bool task_valid)
747 {
748 int i, err = 0, cnt = 0;
749
750 spin_lock_bh(&net->xfrm.xfrm_state_lock);
751 err = xfrm_dev_state_flush_secctx_check(net, dev, task_valid);
752 if (err)
753 goto out;
754
755 err = -ESRCH;
756 for (i = 0; i <= net->xfrm.state_hmask; i++) {
757 struct xfrm_state *x;
758 struct xfrm_state_offload *xso;
759 restart:
760 hlist_for_each_entry(x, net->xfrm.state_bydst+i, bydst) {
761 xso = &x->xso;
762
763 if (!xfrm_state_kern(x) && xso->dev == dev) {
764 xfrm_state_hold(x);
765 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
766
767 err = xfrm_state_delete(x);
768 xfrm_audit_state_delete(x, err ? 0 : 1,
769 task_valid);
770 xfrm_state_put(x);
771 if (!err)
772 cnt++;
773
774 spin_lock_bh(&net->xfrm.xfrm_state_lock);
775 goto restart;
776 }
777 }
778 }
779 if (cnt)
780 err = 0;
781
782 out:
783 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
784 return err;
785 }
786 EXPORT_SYMBOL(xfrm_dev_state_flush);
787
788 void xfrm_sad_getinfo(struct net *net, struct xfrmk_sadinfo *si)
789 {
790 spin_lock_bh(&net->xfrm.xfrm_state_lock);
791 si->sadcnt = net->xfrm.state_num;
792 si->sadhcnt = net->xfrm.state_hmask + 1;
793 si->sadhmcnt = xfrm_state_hashmax;
794 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
795 }
796 EXPORT_SYMBOL(xfrm_sad_getinfo);
797
798 static void
799 xfrm_init_tempstate(struct xfrm_state *x, const struct flowi *fl,
800 const struct xfrm_tmpl *tmpl,
801 const xfrm_address_t *daddr, const xfrm_address_t *saddr,
802 unsigned short family)
803 {
804 struct xfrm_state_afinfo *afinfo = xfrm_state_afinfo_get_rcu(family);
805
806 if (!afinfo)
807 return;
808
809 afinfo->init_tempsel(&x->sel, fl);
810
811 if (family != tmpl->encap_family) {
812 afinfo = xfrm_state_afinfo_get_rcu(tmpl->encap_family);
813 if (!afinfo)
814 return;
815 }
816 afinfo->init_temprop(x, tmpl, daddr, saddr);
817 }
818
819 static struct xfrm_state *__xfrm_state_lookup(struct net *net, u32 mark,
820 const xfrm_address_t *daddr,
821 __be32 spi, u8 proto,
822 unsigned short family)
823 {
824 unsigned int h = xfrm_spi_hash(net, daddr, spi, proto, family);
825 struct xfrm_state *x;
826
827 hlist_for_each_entry_rcu(x, net->xfrm.state_byspi + h, byspi) {
828 if (x->props.family != family ||
829 x->id.spi != spi ||
830 x->id.proto != proto ||
831 !xfrm_addr_equal(&x->id.daddr, daddr, family))
832 continue;
833
834 if ((mark & x->mark.m) != x->mark.v)
835 continue;
836 if (!xfrm_state_hold_rcu(x))
837 continue;
838 return x;
839 }
840
841 return NULL;
842 }
843
844 static struct xfrm_state *__xfrm_state_lookup_byaddr(struct net *net, u32 mark,
845 const xfrm_address_t *daddr,
846 const xfrm_address_t *saddr,
847 u8 proto, unsigned short family)
848 {
849 unsigned int h = xfrm_src_hash(net, daddr, saddr, family);
850 struct xfrm_state *x;
851
852 hlist_for_each_entry_rcu(x, net->xfrm.state_bysrc + h, bysrc) {
853 if (x->props.family != family ||
854 x->id.proto != proto ||
855 !xfrm_addr_equal(&x->id.daddr, daddr, family) ||
856 !xfrm_addr_equal(&x->props.saddr, saddr, family))
857 continue;
858
859 if ((mark & x->mark.m) != x->mark.v)
860 continue;
861 if (!xfrm_state_hold_rcu(x))
862 continue;
863 return x;
864 }
865
866 return NULL;
867 }
868
869 static inline struct xfrm_state *
870 __xfrm_state_locate(struct xfrm_state *x, int use_spi, int family)
871 {
872 struct net *net = xs_net(x);
873 u32 mark = x->mark.v & x->mark.m;
874
875 if (use_spi)
876 return __xfrm_state_lookup(net, mark, &x->id.daddr,
877 x->id.spi, x->id.proto, family);
878 else
879 return __xfrm_state_lookup_byaddr(net, mark,
880 &x->id.daddr,
881 &x->props.saddr,
882 x->id.proto, family);
883 }
884
885 static void xfrm_hash_grow_check(struct net *net, int have_hash_collision)
886 {
887 if (have_hash_collision &&
888 (net->xfrm.state_hmask + 1) < xfrm_state_hashmax &&
889 net->xfrm.state_num > net->xfrm.state_hmask)
890 schedule_work(&net->xfrm.state_hash_work);
891 }
892
893 static void xfrm_state_look_at(struct xfrm_policy *pol, struct xfrm_state *x,
894 const struct flowi *fl, unsigned short family,
895 struct xfrm_state **best, int *acq_in_progress,
896 int *error)
897 {
898 /* Resolution logic:
899 * 1. There is a valid state with matching selector. Done.
900 * 2. Valid state with inappropriate selector. Skip.
901 *
902 * Entering area of "sysdeps".
903 *
904 * 3. If state is not valid, selector is temporary, it selects
905 * only session which triggered previous resolution. Key
906 * manager will do something to install a state with proper
907 * selector.
908 */
909 if (x->km.state == XFRM_STATE_VALID) {
910 if ((x->sel.family &&
911 !xfrm_selector_match(&x->sel, fl, x->sel.family)) ||
912 !security_xfrm_state_pol_flow_match(x, pol, fl))
913 return;
914
915 if (!*best ||
916 (*best)->km.dying > x->km.dying ||
917 ((*best)->km.dying == x->km.dying &&
918 (*best)->curlft.add_time < x->curlft.add_time))
919 *best = x;
920 } else if (x->km.state == XFRM_STATE_ACQ) {
921 *acq_in_progress = 1;
922 } else if (x->km.state == XFRM_STATE_ERROR ||
923 x->km.state == XFRM_STATE_EXPIRED) {
924 if (xfrm_selector_match(&x->sel, fl, x->sel.family) &&
925 security_xfrm_state_pol_flow_match(x, pol, fl))
926 *error = -ESRCH;
927 }
928 }
929
930 struct xfrm_state *
931 xfrm_state_find(const xfrm_address_t *daddr, const xfrm_address_t *saddr,
932 const struct flowi *fl, struct xfrm_tmpl *tmpl,
933 struct xfrm_policy *pol, int *err,
934 unsigned short family, u32 if_id)
935 {
936 static xfrm_address_t saddr_wildcard = { };
937 struct net *net = xp_net(pol);
938 unsigned int h, h_wildcard;
939 struct xfrm_state *x, *x0, *to_put;
940 int acquire_in_progress = 0;
941 int error = 0;
942 struct xfrm_state *best = NULL;
943 u32 mark = pol->mark.v & pol->mark.m;
944 unsigned short encap_family = tmpl->encap_family;
945 unsigned int sequence;
946 struct km_event c;
947
948 to_put = NULL;
949
950 sequence = read_seqcount_begin(&xfrm_state_hash_generation);
951
952 rcu_read_lock();
953 h = xfrm_dst_hash(net, daddr, saddr, tmpl->reqid, encap_family);
954 hlist_for_each_entry_rcu(x, net->xfrm.state_bydst + h, bydst) {
955 if (x->props.family == encap_family &&
956 x->props.reqid == tmpl->reqid &&
957 (mark & x->mark.m) == x->mark.v &&
958 x->if_id == if_id &&
959 !(x->props.flags & XFRM_STATE_WILDRECV) &&
960 xfrm_state_addr_check(x, daddr, saddr, encap_family) &&
961 tmpl->mode == x->props.mode &&
962 tmpl->id.proto == x->id.proto &&
963 (tmpl->id.spi == x->id.spi || !tmpl->id.spi))
964 xfrm_state_look_at(pol, x, fl, encap_family,
965 &best, &acquire_in_progress, &error);
966 }
967 if (best || acquire_in_progress)
968 goto found;
969
970 h_wildcard = xfrm_dst_hash(net, daddr, &saddr_wildcard, tmpl->reqid, encap_family);
971 hlist_for_each_entry_rcu(x, net->xfrm.state_bydst + h_wildcard, bydst) {
972 if (x->props.family == encap_family &&
973 x->props.reqid == tmpl->reqid &&
974 (mark & x->mark.m) == x->mark.v &&
975 x->if_id == if_id &&
976 !(x->props.flags & XFRM_STATE_WILDRECV) &&
977 xfrm_addr_equal(&x->id.daddr, daddr, encap_family) &&
978 tmpl->mode == x->props.mode &&
979 tmpl->id.proto == x->id.proto &&
980 (tmpl->id.spi == x->id.spi || !tmpl->id.spi))
981 xfrm_state_look_at(pol, x, fl, encap_family,
982 &best, &acquire_in_progress, &error);
983 }
984
985 found:
986 x = best;
987 if (!x && !error && !acquire_in_progress) {
988 if (tmpl->id.spi &&
989 (x0 = __xfrm_state_lookup(net, mark, daddr, tmpl->id.spi,
990 tmpl->id.proto, encap_family)) != NULL) {
991 to_put = x0;
992 error = -EEXIST;
993 goto out;
994 }
995
996 c.net = net;
997 /* If the KMs have no listeners (yet...), avoid allocating an SA
998 * for each and every packet - garbage collection might not
999 * handle the flood.
1000 */
1001 if (!km_is_alive(&c)) {
1002 error = -ESRCH;
1003 goto out;
1004 }
1005
1006 x = xfrm_state_alloc(net);
1007 if (x == NULL) {
1008 error = -ENOMEM;
1009 goto out;
1010 }
1011 /* Initialize temporary state matching only
1012 * to current session. */
1013 xfrm_init_tempstate(x, fl, tmpl, daddr, saddr, family);
1014 memcpy(&x->mark, &pol->mark, sizeof(x->mark));
1015 x->if_id = if_id;
1016
1017 error = security_xfrm_state_alloc_acquire(x, pol->security, fl->flowi_secid);
1018 if (error) {
1019 x->km.state = XFRM_STATE_DEAD;
1020 to_put = x;
1021 x = NULL;
1022 goto out;
1023 }
1024
1025 if (km_query(x, tmpl, pol) == 0) {
1026 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1027 x->km.state = XFRM_STATE_ACQ;
1028 list_add(&x->km.all, &net->xfrm.state_all);
1029 hlist_add_head_rcu(&x->bydst, net->xfrm.state_bydst + h);
1030 h = xfrm_src_hash(net, daddr, saddr, encap_family);
1031 hlist_add_head_rcu(&x->bysrc, net->xfrm.state_bysrc + h);
1032 if (x->id.spi) {
1033 h = xfrm_spi_hash(net, &x->id.daddr, x->id.spi, x->id.proto, encap_family);
1034 hlist_add_head_rcu(&x->byspi, net->xfrm.state_byspi + h);
1035 }
1036 x->lft.hard_add_expires_seconds = net->xfrm.sysctl_acq_expires;
1037 tasklet_hrtimer_start(&x->mtimer, ktime_set(net->xfrm.sysctl_acq_expires, 0), HRTIMER_MODE_REL);
1038 net->xfrm.state_num++;
1039 xfrm_hash_grow_check(net, x->bydst.next != NULL);
1040 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1041 } else {
1042 x->km.state = XFRM_STATE_DEAD;
1043 to_put = x;
1044 x = NULL;
1045 error = -ESRCH;
1046 }
1047 }
1048 out:
1049 if (x) {
1050 if (!xfrm_state_hold_rcu(x)) {
1051 *err = -EAGAIN;
1052 x = NULL;
1053 }
1054 } else {
1055 *err = acquire_in_progress ? -EAGAIN : error;
1056 }
1057 rcu_read_unlock();
1058 if (to_put)
1059 xfrm_state_put(to_put);
1060
1061 if (read_seqcount_retry(&xfrm_state_hash_generation, sequence)) {
1062 *err = -EAGAIN;
1063 if (x) {
1064 xfrm_state_put(x);
1065 x = NULL;
1066 }
1067 }
1068
1069 return x;
1070 }
1071
1072 struct xfrm_state *
1073 xfrm_stateonly_find(struct net *net, u32 mark, u32 if_id,
1074 xfrm_address_t *daddr, xfrm_address_t *saddr,
1075 unsigned short family, u8 mode, u8 proto, u32 reqid)
1076 {
1077 unsigned int h;
1078 struct xfrm_state *rx = NULL, *x = NULL;
1079
1080 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1081 h = xfrm_dst_hash(net, daddr, saddr, reqid, family);
1082 hlist_for_each_entry(x, net->xfrm.state_bydst+h, bydst) {
1083 if (x->props.family == family &&
1084 x->props.reqid == reqid &&
1085 (mark & x->mark.m) == x->mark.v &&
1086 x->if_id == if_id &&
1087 !(x->props.flags & XFRM_STATE_WILDRECV) &&
1088 xfrm_state_addr_check(x, daddr, saddr, family) &&
1089 mode == x->props.mode &&
1090 proto == x->id.proto &&
1091 x->km.state == XFRM_STATE_VALID) {
1092 rx = x;
1093 break;
1094 }
1095 }
1096
1097 if (rx)
1098 xfrm_state_hold(rx);
1099 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1100
1101
1102 return rx;
1103 }
1104 EXPORT_SYMBOL(xfrm_stateonly_find);
1105
1106 struct xfrm_state *xfrm_state_lookup_byspi(struct net *net, __be32 spi,
1107 unsigned short family)
1108 {
1109 struct xfrm_state *x;
1110 struct xfrm_state_walk *w;
1111
1112 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1113 list_for_each_entry(w, &net->xfrm.state_all, all) {
1114 x = container_of(w, struct xfrm_state, km);
1115 if (x->props.family != family ||
1116 x->id.spi != spi)
1117 continue;
1118
1119 xfrm_state_hold(x);
1120 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1121 return x;
1122 }
1123 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1124 return NULL;
1125 }
1126 EXPORT_SYMBOL(xfrm_state_lookup_byspi);
1127
1128 static void __xfrm_state_insert(struct xfrm_state *x)
1129 {
1130 struct net *net = xs_net(x);
1131 unsigned int h;
1132
1133 list_add(&x->km.all, &net->xfrm.state_all);
1134
1135 h = xfrm_dst_hash(net, &x->id.daddr, &x->props.saddr,
1136 x->props.reqid, x->props.family);
1137 hlist_add_head_rcu(&x->bydst, net->xfrm.state_bydst + h);
1138
1139 h = xfrm_src_hash(net, &x->id.daddr, &x->props.saddr, x->props.family);
1140 hlist_add_head_rcu(&x->bysrc, net->xfrm.state_bysrc + h);
1141
1142 if (x->id.spi) {
1143 h = xfrm_spi_hash(net, &x->id.daddr, x->id.spi, x->id.proto,
1144 x->props.family);
1145
1146 hlist_add_head_rcu(&x->byspi, net->xfrm.state_byspi + h);
1147 }
1148
1149 tasklet_hrtimer_start(&x->mtimer, ktime_set(1, 0), HRTIMER_MODE_REL);
1150 if (x->replay_maxage)
1151 mod_timer(&x->rtimer, jiffies + x->replay_maxage);
1152
1153 net->xfrm.state_num++;
1154
1155 xfrm_hash_grow_check(net, x->bydst.next != NULL);
1156 }
1157
1158 /* net->xfrm.xfrm_state_lock is held */
1159 static void __xfrm_state_bump_genids(struct xfrm_state *xnew)
1160 {
1161 struct net *net = xs_net(xnew);
1162 unsigned short family = xnew->props.family;
1163 u32 reqid = xnew->props.reqid;
1164 struct xfrm_state *x;
1165 unsigned int h;
1166 u32 mark = xnew->mark.v & xnew->mark.m;
1167 u32 if_id = xnew->if_id;
1168
1169 h = xfrm_dst_hash(net, &xnew->id.daddr, &xnew->props.saddr, reqid, family);
1170 hlist_for_each_entry(x, net->xfrm.state_bydst+h, bydst) {
1171 if (x->props.family == family &&
1172 x->props.reqid == reqid &&
1173 x->if_id == if_id &&
1174 (mark & x->mark.m) == x->mark.v &&
1175 xfrm_addr_equal(&x->id.daddr, &xnew->id.daddr, family) &&
1176 xfrm_addr_equal(&x->props.saddr, &xnew->props.saddr, family))
1177 x->genid++;
1178 }
1179 }
1180
1181 void xfrm_state_insert(struct xfrm_state *x)
1182 {
1183 struct net *net = xs_net(x);
1184
1185 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1186 __xfrm_state_bump_genids(x);
1187 __xfrm_state_insert(x);
1188 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1189 }
1190 EXPORT_SYMBOL(xfrm_state_insert);
1191
1192 /* net->xfrm.xfrm_state_lock is held */
1193 static struct xfrm_state *__find_acq_core(struct net *net,
1194 const struct xfrm_mark *m,
1195 unsigned short family, u8 mode,
1196 u32 reqid, u32 if_id, u8 proto,
1197 const xfrm_address_t *daddr,
1198 const xfrm_address_t *saddr,
1199 int create)
1200 {
1201 unsigned int h = xfrm_dst_hash(net, daddr, saddr, reqid, family);
1202 struct xfrm_state *x;
1203 u32 mark = m->v & m->m;
1204
1205 hlist_for_each_entry(x, net->xfrm.state_bydst+h, bydst) {
1206 if (x->props.reqid != reqid ||
1207 x->props.mode != mode ||
1208 x->props.family != family ||
1209 x->km.state != XFRM_STATE_ACQ ||
1210 x->id.spi != 0 ||
1211 x->id.proto != proto ||
1212 (mark & x->mark.m) != x->mark.v ||
1213 !xfrm_addr_equal(&x->id.daddr, daddr, family) ||
1214 !xfrm_addr_equal(&x->props.saddr, saddr, family))
1215 continue;
1216
1217 xfrm_state_hold(x);
1218 return x;
1219 }
1220
1221 if (!create)
1222 return NULL;
1223
1224 x = xfrm_state_alloc(net);
1225 if (likely(x)) {
1226 switch (family) {
1227 case AF_INET:
1228 x->sel.daddr.a4 = daddr->a4;
1229 x->sel.saddr.a4 = saddr->a4;
1230 x->sel.prefixlen_d = 32;
1231 x->sel.prefixlen_s = 32;
1232 x->props.saddr.a4 = saddr->a4;
1233 x->id.daddr.a4 = daddr->a4;
1234 break;
1235
1236 case AF_INET6:
1237 x->sel.daddr.in6 = daddr->in6;
1238 x->sel.saddr.in6 = saddr->in6;
1239 x->sel.prefixlen_d = 128;
1240 x->sel.prefixlen_s = 128;
1241 x->props.saddr.in6 = saddr->in6;
1242 x->id.daddr.in6 = daddr->in6;
1243 break;
1244 }
1245
1246 x->km.state = XFRM_STATE_ACQ;
1247 x->id.proto = proto;
1248 x->props.family = family;
1249 x->props.mode = mode;
1250 x->props.reqid = reqid;
1251 x->if_id = if_id;
1252 x->mark.v = m->v;
1253 x->mark.m = m->m;
1254 x->lft.hard_add_expires_seconds = net->xfrm.sysctl_acq_expires;
1255 xfrm_state_hold(x);
1256 tasklet_hrtimer_start(&x->mtimer, ktime_set(net->xfrm.sysctl_acq_expires, 0), HRTIMER_MODE_REL);
1257 list_add(&x->km.all, &net->xfrm.state_all);
1258 hlist_add_head_rcu(&x->bydst, net->xfrm.state_bydst + h);
1259 h = xfrm_src_hash(net, daddr, saddr, family);
1260 hlist_add_head_rcu(&x->bysrc, net->xfrm.state_bysrc + h);
1261
1262 net->xfrm.state_num++;
1263
1264 xfrm_hash_grow_check(net, x->bydst.next != NULL);
1265 }
1266
1267 return x;
1268 }
1269
1270 static struct xfrm_state *__xfrm_find_acq_byseq(struct net *net, u32 mark, u32 seq);
1271
1272 int xfrm_state_add(struct xfrm_state *x)
1273 {
1274 struct net *net = xs_net(x);
1275 struct xfrm_state *x1, *to_put;
1276 int family;
1277 int err;
1278 u32 mark = x->mark.v & x->mark.m;
1279 int use_spi = xfrm_id_proto_match(x->id.proto, IPSEC_PROTO_ANY);
1280
1281 family = x->props.family;
1282
1283 to_put = NULL;
1284
1285 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1286
1287 x1 = __xfrm_state_locate(x, use_spi, family);
1288 if (x1) {
1289 to_put = x1;
1290 x1 = NULL;
1291 err = -EEXIST;
1292 goto out;
1293 }
1294
1295 if (use_spi && x->km.seq) {
1296 x1 = __xfrm_find_acq_byseq(net, mark, x->km.seq);
1297 if (x1 && ((x1->id.proto != x->id.proto) ||
1298 !xfrm_addr_equal(&x1->id.daddr, &x->id.daddr, family))) {
1299 to_put = x1;
1300 x1 = NULL;
1301 }
1302 }
1303
1304 if (use_spi && !x1)
1305 x1 = __find_acq_core(net, &x->mark, family, x->props.mode,
1306 x->props.reqid, x->if_id, x->id.proto,
1307 &x->id.daddr, &x->props.saddr, 0);
1308
1309 __xfrm_state_bump_genids(x);
1310 __xfrm_state_insert(x);
1311 err = 0;
1312
1313 out:
1314 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1315
1316 if (x1) {
1317 xfrm_state_delete(x1);
1318 xfrm_state_put(x1);
1319 }
1320
1321 if (to_put)
1322 xfrm_state_put(to_put);
1323
1324 return err;
1325 }
1326 EXPORT_SYMBOL(xfrm_state_add);
1327
1328 #ifdef CONFIG_XFRM_MIGRATE
1329 static struct xfrm_state *xfrm_state_clone(struct xfrm_state *orig,
1330 struct xfrm_encap_tmpl *encap)
1331 {
1332 struct net *net = xs_net(orig);
1333 struct xfrm_state *x = xfrm_state_alloc(net);
1334 if (!x)
1335 goto out;
1336
1337 memcpy(&x->id, &orig->id, sizeof(x->id));
1338 memcpy(&x->sel, &orig->sel, sizeof(x->sel));
1339 memcpy(&x->lft, &orig->lft, sizeof(x->lft));
1340 x->props.mode = orig->props.mode;
1341 x->props.replay_window = orig->props.replay_window;
1342 x->props.reqid = orig->props.reqid;
1343 x->props.family = orig->props.family;
1344 x->props.saddr = orig->props.saddr;
1345
1346 if (orig->aalg) {
1347 x->aalg = xfrm_algo_auth_clone(orig->aalg);
1348 if (!x->aalg)
1349 goto error;
1350 }
1351 x->props.aalgo = orig->props.aalgo;
1352
1353 if (orig->aead) {
1354 x->aead = xfrm_algo_aead_clone(orig->aead);
1355 x->geniv = orig->geniv;
1356 if (!x->aead)
1357 goto error;
1358 }
1359 if (orig->ealg) {
1360 x->ealg = xfrm_algo_clone(orig->ealg);
1361 if (!x->ealg)
1362 goto error;
1363 }
1364 x->props.ealgo = orig->props.ealgo;
1365
1366 if (orig->calg) {
1367 x->calg = xfrm_algo_clone(orig->calg);
1368 if (!x->calg)
1369 goto error;
1370 }
1371 x->props.calgo = orig->props.calgo;
1372
1373 if (encap || orig->encap) {
1374 if (encap)
1375 x->encap = kmemdup(encap, sizeof(*x->encap),
1376 GFP_KERNEL);
1377 else
1378 x->encap = kmemdup(orig->encap, sizeof(*x->encap),
1379 GFP_KERNEL);
1380
1381 if (!x->encap)
1382 goto error;
1383 }
1384
1385 if (orig->coaddr) {
1386 x->coaddr = kmemdup(orig->coaddr, sizeof(*x->coaddr),
1387 GFP_KERNEL);
1388 if (!x->coaddr)
1389 goto error;
1390 }
1391
1392 if (orig->replay_esn) {
1393 if (xfrm_replay_clone(x, orig))
1394 goto error;
1395 }
1396
1397 memcpy(&x->mark, &orig->mark, sizeof(x->mark));
1398
1399 if (xfrm_init_state(x) < 0)
1400 goto error;
1401
1402 x->props.flags = orig->props.flags;
1403 x->props.extra_flags = orig->props.extra_flags;
1404
1405 x->if_id = orig->if_id;
1406 x->tfcpad = orig->tfcpad;
1407 x->replay_maxdiff = orig->replay_maxdiff;
1408 x->replay_maxage = orig->replay_maxage;
1409 x->curlft.add_time = orig->curlft.add_time;
1410 x->km.state = orig->km.state;
1411 x->km.seq = orig->km.seq;
1412 x->replay = orig->replay;
1413 x->preplay = orig->preplay;
1414
1415 return x;
1416
1417 error:
1418 xfrm_state_put(x);
1419 out:
1420 return NULL;
1421 }
1422
1423 struct xfrm_state *xfrm_migrate_state_find(struct xfrm_migrate *m, struct net *net)
1424 {
1425 unsigned int h;
1426 struct xfrm_state *x = NULL;
1427
1428 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1429
1430 if (m->reqid) {
1431 h = xfrm_dst_hash(net, &m->old_daddr, &m->old_saddr,
1432 m->reqid, m->old_family);
1433 hlist_for_each_entry(x, net->xfrm.state_bydst+h, bydst) {
1434 if (x->props.mode != m->mode ||
1435 x->id.proto != m->proto)
1436 continue;
1437 if (m->reqid && x->props.reqid != m->reqid)
1438 continue;
1439 if (!xfrm_addr_equal(&x->id.daddr, &m->old_daddr,
1440 m->old_family) ||
1441 !xfrm_addr_equal(&x->props.saddr, &m->old_saddr,
1442 m->old_family))
1443 continue;
1444 xfrm_state_hold(x);
1445 break;
1446 }
1447 } else {
1448 h = xfrm_src_hash(net, &m->old_daddr, &m->old_saddr,
1449 m->old_family);
1450 hlist_for_each_entry(x, net->xfrm.state_bysrc+h, bysrc) {
1451 if (x->props.mode != m->mode ||
1452 x->id.proto != m->proto)
1453 continue;
1454 if (!xfrm_addr_equal(&x->id.daddr, &m->old_daddr,
1455 m->old_family) ||
1456 !xfrm_addr_equal(&x->props.saddr, &m->old_saddr,
1457 m->old_family))
1458 continue;
1459 xfrm_state_hold(x);
1460 break;
1461 }
1462 }
1463
1464 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1465
1466 return x;
1467 }
1468 EXPORT_SYMBOL(xfrm_migrate_state_find);
1469
1470 struct xfrm_state *xfrm_state_migrate(struct xfrm_state *x,
1471 struct xfrm_migrate *m,
1472 struct xfrm_encap_tmpl *encap)
1473 {
1474 struct xfrm_state *xc;
1475
1476 xc = xfrm_state_clone(x, encap);
1477 if (!xc)
1478 return NULL;
1479
1480 memcpy(&xc->id.daddr, &m->new_daddr, sizeof(xc->id.daddr));
1481 memcpy(&xc->props.saddr, &m->new_saddr, sizeof(xc->props.saddr));
1482
1483 /* add state */
1484 if (xfrm_addr_equal(&x->id.daddr, &m->new_daddr, m->new_family)) {
1485 /* a care is needed when the destination address of the
1486 state is to be updated as it is a part of triplet */
1487 xfrm_state_insert(xc);
1488 } else {
1489 if (xfrm_state_add(xc) < 0)
1490 goto error;
1491 }
1492
1493 return xc;
1494 error:
1495 xfrm_state_put(xc);
1496 return NULL;
1497 }
1498 EXPORT_SYMBOL(xfrm_state_migrate);
1499 #endif
1500
1501 int xfrm_state_update(struct xfrm_state *x)
1502 {
1503 struct xfrm_state *x1, *to_put;
1504 int err;
1505 int use_spi = xfrm_id_proto_match(x->id.proto, IPSEC_PROTO_ANY);
1506 struct net *net = xs_net(x);
1507
1508 to_put = NULL;
1509
1510 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1511 x1 = __xfrm_state_locate(x, use_spi, x->props.family);
1512
1513 err = -ESRCH;
1514 if (!x1)
1515 goto out;
1516
1517 if (xfrm_state_kern(x1)) {
1518 to_put = x1;
1519 err = -EEXIST;
1520 goto out;
1521 }
1522
1523 if (x1->km.state == XFRM_STATE_ACQ) {
1524 __xfrm_state_insert(x);
1525 x = NULL;
1526 }
1527 err = 0;
1528
1529 out:
1530 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1531
1532 if (to_put)
1533 xfrm_state_put(to_put);
1534
1535 if (err)
1536 return err;
1537
1538 if (!x) {
1539 xfrm_state_delete(x1);
1540 xfrm_state_put(x1);
1541 return 0;
1542 }
1543
1544 err = -EINVAL;
1545 spin_lock_bh(&x1->lock);
1546 if (likely(x1->km.state == XFRM_STATE_VALID)) {
1547 if (x->encap && x1->encap)
1548 memcpy(x1->encap, x->encap, sizeof(*x1->encap));
1549 if (x->coaddr && x1->coaddr) {
1550 memcpy(x1->coaddr, x->coaddr, sizeof(*x1->coaddr));
1551 }
1552 if (!use_spi && memcmp(&x1->sel, &x->sel, sizeof(x1->sel)))
1553 memcpy(&x1->sel, &x->sel, sizeof(x1->sel));
1554 memcpy(&x1->lft, &x->lft, sizeof(x1->lft));
1555 x1->km.dying = 0;
1556
1557 tasklet_hrtimer_start(&x1->mtimer, ktime_set(1, 0), HRTIMER_MODE_REL);
1558 if (x1->curlft.use_time)
1559 xfrm_state_check_expire(x1);
1560
1561 if (x->props.smark.m || x->props.smark.v) {
1562 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1563
1564 x1->props.smark = x->props.smark;
1565
1566 __xfrm_state_bump_genids(x1);
1567 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1568 }
1569
1570 err = 0;
1571 x->km.state = XFRM_STATE_DEAD;
1572 __xfrm_state_put(x);
1573 }
1574 spin_unlock_bh(&x1->lock);
1575
1576 xfrm_state_put(x1);
1577
1578 return err;
1579 }
1580 EXPORT_SYMBOL(xfrm_state_update);
1581
1582 int xfrm_state_check_expire(struct xfrm_state *x)
1583 {
1584 if (!x->curlft.use_time)
1585 x->curlft.use_time = get_seconds();
1586
1587 if (x->curlft.bytes >= x->lft.hard_byte_limit ||
1588 x->curlft.packets >= x->lft.hard_packet_limit) {
1589 x->km.state = XFRM_STATE_EXPIRED;
1590 tasklet_hrtimer_start(&x->mtimer, 0, HRTIMER_MODE_REL);
1591 return -EINVAL;
1592 }
1593
1594 if (!x->km.dying &&
1595 (x->curlft.bytes >= x->lft.soft_byte_limit ||
1596 x->curlft.packets >= x->lft.soft_packet_limit)) {
1597 x->km.dying = 1;
1598 km_state_expired(x, 0, 0);
1599 }
1600 return 0;
1601 }
1602 EXPORT_SYMBOL(xfrm_state_check_expire);
1603
1604 struct xfrm_state *
1605 xfrm_state_lookup(struct net *net, u32 mark, const xfrm_address_t *daddr, __be32 spi,
1606 u8 proto, unsigned short family)
1607 {
1608 struct xfrm_state *x;
1609
1610 rcu_read_lock();
1611 x = __xfrm_state_lookup(net, mark, daddr, spi, proto, family);
1612 rcu_read_unlock();
1613 return x;
1614 }
1615 EXPORT_SYMBOL(xfrm_state_lookup);
1616
1617 struct xfrm_state *
1618 xfrm_state_lookup_byaddr(struct net *net, u32 mark,
1619 const xfrm_address_t *daddr, const xfrm_address_t *saddr,
1620 u8 proto, unsigned short family)
1621 {
1622 struct xfrm_state *x;
1623
1624 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1625 x = __xfrm_state_lookup_byaddr(net, mark, daddr, saddr, proto, family);
1626 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1627 return x;
1628 }
1629 EXPORT_SYMBOL(xfrm_state_lookup_byaddr);
1630
1631 struct xfrm_state *
1632 xfrm_find_acq(struct net *net, const struct xfrm_mark *mark, u8 mode, u32 reqid,
1633 u32 if_id, u8 proto, const xfrm_address_t *daddr,
1634 const xfrm_address_t *saddr, int create, unsigned short family)
1635 {
1636 struct xfrm_state *x;
1637
1638 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1639 x = __find_acq_core(net, mark, family, mode, reqid, if_id, proto, daddr, saddr, create);
1640 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1641
1642 return x;
1643 }
1644 EXPORT_SYMBOL(xfrm_find_acq);
1645
1646 #ifdef CONFIG_XFRM_SUB_POLICY
1647 int
1648 xfrm_tmpl_sort(struct xfrm_tmpl **dst, struct xfrm_tmpl **src, int n,
1649 unsigned short family, struct net *net)
1650 {
1651 int i;
1652 int err = 0;
1653 struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
1654 if (!afinfo)
1655 return -EAFNOSUPPORT;
1656
1657 spin_lock_bh(&net->xfrm.xfrm_state_lock); /*FIXME*/
1658 if (afinfo->tmpl_sort)
1659 err = afinfo->tmpl_sort(dst, src, n);
1660 else
1661 for (i = 0; i < n; i++)
1662 dst[i] = src[i];
1663 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1664 rcu_read_unlock();
1665 return err;
1666 }
1667 EXPORT_SYMBOL(xfrm_tmpl_sort);
1668
1669 int
1670 xfrm_state_sort(struct xfrm_state **dst, struct xfrm_state **src, int n,
1671 unsigned short family)
1672 {
1673 int i;
1674 int err = 0;
1675 struct xfrm_state_afinfo *afinfo = xfrm_state_get_afinfo(family);
1676 struct net *net = xs_net(*src);
1677
1678 if (!afinfo)
1679 return -EAFNOSUPPORT;
1680
1681 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1682 if (afinfo->state_sort)
1683 err = afinfo->state_sort(dst, src, n);
1684 else
1685 for (i = 0; i < n; i++)
1686 dst[i] = src[i];
1687 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1688 rcu_read_unlock();
1689 return err;
1690 }
1691 EXPORT_SYMBOL(xfrm_state_sort);
1692 #endif
1693
1694 /* Silly enough, but I'm lazy to build resolution list */
1695
1696 static struct xfrm_state *__xfrm_find_acq_byseq(struct net *net, u32 mark, u32 seq)
1697 {
1698 int i;
1699
1700 for (i = 0; i <= net->xfrm.state_hmask; i++) {
1701 struct xfrm_state *x;
1702
1703 hlist_for_each_entry(x, net->xfrm.state_bydst+i, bydst) {
1704 if (x->km.seq == seq &&
1705 (mark & x->mark.m) == x->mark.v &&
1706 x->km.state == XFRM_STATE_ACQ) {
1707 xfrm_state_hold(x);
1708 return x;
1709 }
1710 }
1711 }
1712 return NULL;
1713 }
1714
1715 struct xfrm_state *xfrm_find_acq_byseq(struct net *net, u32 mark, u32 seq)
1716 {
1717 struct xfrm_state *x;
1718
1719 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1720 x = __xfrm_find_acq_byseq(net, mark, seq);
1721 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1722 return x;
1723 }
1724 EXPORT_SYMBOL(xfrm_find_acq_byseq);
1725
1726 u32 xfrm_get_acqseq(void)
1727 {
1728 u32 res;
1729 static atomic_t acqseq;
1730
1731 do {
1732 res = atomic_inc_return(&acqseq);
1733 } while (!res);
1734
1735 return res;
1736 }
1737 EXPORT_SYMBOL(xfrm_get_acqseq);
1738
1739 int verify_spi_info(u8 proto, u32 min, u32 max)
1740 {
1741 switch (proto) {
1742 case IPPROTO_AH:
1743 case IPPROTO_ESP:
1744 break;
1745
1746 case IPPROTO_COMP:
1747 /* IPCOMP spi is 16-bits. */
1748 if (max >= 0x10000)
1749 return -EINVAL;
1750 break;
1751
1752 default:
1753 return -EINVAL;
1754 }
1755
1756 if (min > max)
1757 return -EINVAL;
1758
1759 return 0;
1760 }
1761 EXPORT_SYMBOL(verify_spi_info);
1762
1763 int xfrm_alloc_spi(struct xfrm_state *x, u32 low, u32 high)
1764 {
1765 struct net *net = xs_net(x);
1766 unsigned int h;
1767 struct xfrm_state *x0;
1768 int err = -ENOENT;
1769 __be32 minspi = htonl(low);
1770 __be32 maxspi = htonl(high);
1771 u32 mark = x->mark.v & x->mark.m;
1772
1773 spin_lock_bh(&x->lock);
1774 if (x->km.state == XFRM_STATE_DEAD)
1775 goto unlock;
1776
1777 err = 0;
1778 if (x->id.spi)
1779 goto unlock;
1780
1781 err = -ENOENT;
1782
1783 if (minspi == maxspi) {
1784 x0 = xfrm_state_lookup(net, mark, &x->id.daddr, minspi, x->id.proto, x->props.family);
1785 if (x0) {
1786 xfrm_state_put(x0);
1787 goto unlock;
1788 }
1789 x->id.spi = minspi;
1790 } else {
1791 u32 spi = 0;
1792 for (h = 0; h < high-low+1; h++) {
1793 spi = low + prandom_u32()%(high-low+1);
1794 x0 = xfrm_state_lookup(net, mark, &x->id.daddr, htonl(spi), x->id.proto, x->props.family);
1795 if (x0 == NULL) {
1796 x->id.spi = htonl(spi);
1797 break;
1798 }
1799 xfrm_state_put(x0);
1800 }
1801 }
1802 if (x->id.spi) {
1803 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1804 h = xfrm_spi_hash(net, &x->id.daddr, x->id.spi, x->id.proto, x->props.family);
1805 hlist_add_head_rcu(&x->byspi, net->xfrm.state_byspi + h);
1806 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1807
1808 err = 0;
1809 }
1810
1811 unlock:
1812 spin_unlock_bh(&x->lock);
1813
1814 return err;
1815 }
1816 EXPORT_SYMBOL(xfrm_alloc_spi);
1817
1818 static bool __xfrm_state_filter_match(struct xfrm_state *x,
1819 struct xfrm_address_filter *filter)
1820 {
1821 if (filter) {
1822 if ((filter->family == AF_INET ||
1823 filter->family == AF_INET6) &&
1824 x->props.family != filter->family)
1825 return false;
1826
1827 return addr_match(&x->props.saddr, &filter->saddr,
1828 filter->splen) &&
1829 addr_match(&x->id.daddr, &filter->daddr,
1830 filter->dplen);
1831 }
1832 return true;
1833 }
1834
1835 int xfrm_state_walk(struct net *net, struct xfrm_state_walk *walk,
1836 int (*func)(struct xfrm_state *, int, void*),
1837 void *data)
1838 {
1839 struct xfrm_state *state;
1840 struct xfrm_state_walk *x;
1841 int err = 0;
1842
1843 if (walk->seq != 0 && list_empty(&walk->all))
1844 return 0;
1845
1846 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1847 if (list_empty(&walk->all))
1848 x = list_first_entry(&net->xfrm.state_all, struct xfrm_state_walk, all);
1849 else
1850 x = list_first_entry(&walk->all, struct xfrm_state_walk, all);
1851 list_for_each_entry_from(x, &net->xfrm.state_all, all) {
1852 if (x->state == XFRM_STATE_DEAD)
1853 continue;
1854 state = container_of(x, struct xfrm_state, km);
1855 if (!xfrm_id_proto_match(state->id.proto, walk->proto))
1856 continue;
1857 if (!__xfrm_state_filter_match(state, walk->filter))
1858 continue;
1859 err = func(state, walk->seq, data);
1860 if (err) {
1861 list_move_tail(&walk->all, &x->all);
1862 goto out;
1863 }
1864 walk->seq++;
1865 }
1866 if (walk->seq == 0) {
1867 err = -ENOENT;
1868 goto out;
1869 }
1870 list_del_init(&walk->all);
1871 out:
1872 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1873 return err;
1874 }
1875 EXPORT_SYMBOL(xfrm_state_walk);
1876
1877 void xfrm_state_walk_init(struct xfrm_state_walk *walk, u8 proto,
1878 struct xfrm_address_filter *filter)
1879 {
1880 INIT_LIST_HEAD(&walk->all);
1881 walk->proto = proto;
1882 walk->state = XFRM_STATE_DEAD;
1883 walk->seq = 0;
1884 walk->filter = filter;
1885 }
1886 EXPORT_SYMBOL(xfrm_state_walk_init);
1887
1888 void xfrm_state_walk_done(struct xfrm_state_walk *walk, struct net *net)
1889 {
1890 kfree(walk->filter);
1891
1892 if (list_empty(&walk->all))
1893 return;
1894
1895 spin_lock_bh(&net->xfrm.xfrm_state_lock);
1896 list_del(&walk->all);
1897 spin_unlock_bh(&net->xfrm.xfrm_state_lock);
1898 }
1899 EXPORT_SYMBOL(xfrm_state_walk_done);
1900
1901 static void xfrm_replay_timer_handler(unsigned long data)
1902 {
1903 struct xfrm_state *x = (struct xfrm_state *)data;
1904
1905 spin_lock(&x->lock);
1906
1907 if (x->km.state == XFRM_STATE_VALID) {
1908 if (xfrm_aevent_is_on(xs_net(x)))
1909 x->repl->notify(x, XFRM_REPLAY_TIMEOUT);
1910 else
1911 x->xflags |= XFRM_TIME_DEFER;
1912 }
1913
1914 spin_unlock(&x->lock);
1915 }
1916
1917 static LIST_HEAD(xfrm_km_list);
1918
1919 void km_policy_notify(struct xfrm_policy *xp, int dir, const struct km_event *c)
1920 {
1921 struct xfrm_mgr *km;
1922
1923 rcu_read_lock();
1924 list_for_each_entry_rcu(km, &xfrm_km_list, list)
1925 if (km->notify_policy)
1926 km->notify_policy(xp, dir, c);
1927 rcu_read_unlock();
1928 }
1929
1930 void km_state_notify(struct xfrm_state *x, const struct km_event *c)
1931 {
1932 struct xfrm_mgr *km;
1933 rcu_read_lock();
1934 list_for_each_entry_rcu(km, &xfrm_km_list, list)
1935 if (km->notify)
1936 km->notify(x, c);
1937 rcu_read_unlock();
1938 }
1939
1940 EXPORT_SYMBOL(km_policy_notify);
1941 EXPORT_SYMBOL(km_state_notify);
1942
1943 void km_state_expired(struct xfrm_state *x, int hard, u32 portid)
1944 {
1945 struct km_event c;
1946
1947 c.data.hard = hard;
1948 c.portid = portid;
1949 c.event = XFRM_MSG_EXPIRE;
1950 km_state_notify(x, &c);
1951 }
1952
1953 EXPORT_SYMBOL(km_state_expired);
1954 /*
1955 * We send to all registered managers regardless of failure
1956 * We are happy with one success
1957 */
1958 int km_query(struct xfrm_state *x, struct xfrm_tmpl *t, struct xfrm_policy *pol)
1959 {
1960 int err = -EINVAL, acqret;
1961 struct xfrm_mgr *km;
1962
1963 rcu_read_lock();
1964 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
1965 acqret = km->acquire(x, t, pol);
1966 if (!acqret)
1967 err = acqret;
1968 }
1969 rcu_read_unlock();
1970 return err;
1971 }
1972 EXPORT_SYMBOL(km_query);
1973
1974 int km_new_mapping(struct xfrm_state *x, xfrm_address_t *ipaddr, __be16 sport)
1975 {
1976 int err = -EINVAL;
1977 struct xfrm_mgr *km;
1978
1979 rcu_read_lock();
1980 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
1981 if (km->new_mapping)
1982 err = km->new_mapping(x, ipaddr, sport);
1983 if (!err)
1984 break;
1985 }
1986 rcu_read_unlock();
1987 return err;
1988 }
1989 EXPORT_SYMBOL(km_new_mapping);
1990
1991 void km_policy_expired(struct xfrm_policy *pol, int dir, int hard, u32 portid)
1992 {
1993 struct km_event c;
1994
1995 c.data.hard = hard;
1996 c.portid = portid;
1997 c.event = XFRM_MSG_POLEXPIRE;
1998 km_policy_notify(pol, dir, &c);
1999 }
2000 EXPORT_SYMBOL(km_policy_expired);
2001
2002 #ifdef CONFIG_XFRM_MIGRATE
2003 int km_migrate(const struct xfrm_selector *sel, u8 dir, u8 type,
2004 const struct xfrm_migrate *m, int num_migrate,
2005 const struct xfrm_kmaddress *k,
2006 const struct xfrm_encap_tmpl *encap)
2007 {
2008 int err = -EINVAL;
2009 int ret;
2010 struct xfrm_mgr *km;
2011
2012 rcu_read_lock();
2013 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
2014 if (km->migrate) {
2015 ret = km->migrate(sel, dir, type, m, num_migrate, k,
2016 encap);
2017 if (!ret)
2018 err = ret;
2019 }
2020 }
2021 rcu_read_unlock();
2022 return err;
2023 }
2024 EXPORT_SYMBOL(km_migrate);
2025 #endif
2026
2027 int km_report(struct net *net, u8 proto, struct xfrm_selector *sel, xfrm_address_t *addr)
2028 {
2029 int err = -EINVAL;
2030 int ret;
2031 struct xfrm_mgr *km;
2032
2033 rcu_read_lock();
2034 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
2035 if (km->report) {
2036 ret = km->report(net, proto, sel, addr);
2037 if (!ret)
2038 err = ret;
2039 }
2040 }
2041 rcu_read_unlock();
2042 return err;
2043 }
2044 EXPORT_SYMBOL(km_report);
2045
2046 bool km_is_alive(const struct km_event *c)
2047 {
2048 struct xfrm_mgr *km;
2049 bool is_alive = false;
2050
2051 rcu_read_lock();
2052 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
2053 if (km->is_alive && km->is_alive(c)) {
2054 is_alive = true;
2055 break;
2056 }
2057 }
2058 rcu_read_unlock();
2059
2060 return is_alive;
2061 }
2062 EXPORT_SYMBOL(km_is_alive);
2063
2064 int xfrm_user_policy(struct sock *sk, int optname, u8 __user *optval, int optlen)
2065 {
2066 int err;
2067 u8 *data;
2068 struct xfrm_mgr *km;
2069 struct xfrm_policy *pol = NULL;
2070
2071 #ifdef SUPPORT_STRONGSWAN_5X
2072 #ifdef CONFIG_COMPAT
2073 if (in_compat_syscall())
2074 return -EOPNOTSUPP;
2075 #endif
2076 #endif
2077
2078 if (!optval && !optlen) {
2079 xfrm_sk_policy_insert(sk, XFRM_POLICY_IN, NULL);
2080 xfrm_sk_policy_insert(sk, XFRM_POLICY_OUT, NULL);
2081 __sk_dst_reset(sk);
2082 return 0;
2083 }
2084
2085 if (optlen <= 0 || optlen > PAGE_SIZE)
2086 return -EMSGSIZE;
2087
2088 data = memdup_user(optval, optlen);
2089 if (IS_ERR(data))
2090 return PTR_ERR(data);
2091
2092 err = -EINVAL;
2093 rcu_read_lock();
2094 list_for_each_entry_rcu(km, &xfrm_km_list, list) {
2095 pol = km->compile_policy(sk, optname, data,
2096 optlen, &err);
2097 if (err >= 0)
2098 break;
2099 }
2100 rcu_read_unlock();
2101
2102 if (err >= 0) {
2103 xfrm_sk_policy_insert(sk, err, pol);
2104 xfrm_pol_put(pol);
2105 __sk_dst_reset(sk);
2106 err = 0;
2107 }
2108
2109 kfree(data);
2110 return err;
2111 }
2112 EXPORT_SYMBOL(xfrm_user_policy);
2113
2114 static DEFINE_SPINLOCK(xfrm_km_lock);
2115
2116 int xfrm_register_km(struct xfrm_mgr *km)
2117 {
2118 spin_lock_bh(&xfrm_km_lock);
2119 list_add_tail_rcu(&km->list, &xfrm_km_list);
2120 spin_unlock_bh(&xfrm_km_lock);
2121 return 0;
2122 }
2123 EXPORT_SYMBOL(xfrm_register_km);
2124
2125 int xfrm_unregister_km(struct xfrm_mgr *km)
2126 {
2127 spin_lock_bh(&xfrm_km_lock);
2128 list_del_rcu(&km->list);
2129 spin_unlock_bh(&xfrm_km_lock);
2130 synchronize_rcu();
2131 return 0;
2132 }
2133 EXPORT_SYMBOL(xfrm_unregister_km);
2134
2135 int xfrm_state_register_afinfo(struct xfrm_state_afinfo *afinfo)
2136 {
2137 int err = 0;
2138
2139 if (WARN_ON(afinfo->family >= NPROTO))
2140 return -EAFNOSUPPORT;
2141
2142 spin_lock_bh(&xfrm_state_afinfo_lock);
2143 if (unlikely(xfrm_state_afinfo[afinfo->family] != NULL))
2144 err = -EEXIST;
2145 else
2146 rcu_assign_pointer(xfrm_state_afinfo[afinfo->family], afinfo);
2147 spin_unlock_bh(&xfrm_state_afinfo_lock);
2148 return err;
2149 }
2150 EXPORT_SYMBOL(xfrm_state_register_afinfo);
2151
2152 int xfrm_state_unregister_afinfo(struct xfrm_state_afinfo *afinfo)
2153 {
2154 int err = 0, family = afinfo->family;
2155
2156 if (WARN_ON(family >= NPROTO))
2157 return -EAFNOSUPPORT;
2158
2159 spin_lock_bh(&xfrm_state_afinfo_lock);
2160 if (likely(xfrm_state_afinfo[afinfo->family] != NULL)) {
2161 if (rcu_access_pointer(xfrm_state_afinfo[family]) != afinfo)
2162 err = -EINVAL;
2163 else
2164 RCU_INIT_POINTER(xfrm_state_afinfo[afinfo->family], NULL);
2165 }
2166 spin_unlock_bh(&xfrm_state_afinfo_lock);
2167 synchronize_rcu();
2168 return err;
2169 }
2170 EXPORT_SYMBOL(xfrm_state_unregister_afinfo);
2171
2172 struct xfrm_state_afinfo *xfrm_state_afinfo_get_rcu(unsigned int family)
2173 {
2174 if (unlikely(family >= NPROTO))
2175 return NULL;
2176
2177 return rcu_dereference(xfrm_state_afinfo[family]);
2178 }
2179
2180 struct xfrm_state_afinfo *xfrm_state_get_afinfo(unsigned int family)
2181 {
2182 struct xfrm_state_afinfo *afinfo;
2183 if (unlikely(family >= NPROTO))
2184 return NULL;
2185 rcu_read_lock();
2186 afinfo = rcu_dereference(xfrm_state_afinfo[family]);
2187 if (unlikely(!afinfo))
2188 rcu_read_unlock();
2189 return afinfo;
2190 }
2191
2192 /* Temporarily located here until net/xfrm/xfrm_tunnel.c is created */
2193 void xfrm_state_delete_tunnel(struct xfrm_state *x)
2194 {
2195 if (x->tunnel) {
2196 struct xfrm_state *t = x->tunnel;
2197
2198 if (atomic_read(&t->tunnel_users) == 2)
2199 xfrm_state_delete(t);
2200 atomic_dec(&t->tunnel_users);
2201 xfrm_state_put(t);
2202 x->tunnel = NULL;
2203 }
2204 }
2205 EXPORT_SYMBOL(xfrm_state_delete_tunnel);
2206
2207 int xfrm_state_mtu(struct xfrm_state *x, int mtu)
2208 {
2209 const struct xfrm_type *type = READ_ONCE(x->type);
2210
2211 if (x->km.state == XFRM_STATE_VALID &&
2212 type && type->get_mtu)
2213 return type->get_mtu(x, mtu);
2214
2215 return mtu - x->props.header_len;
2216 }
2217
2218 int __xfrm_init_state(struct xfrm_state *x, bool init_replay, bool offload)
2219 {
2220 struct xfrm_state_afinfo *afinfo;
2221 struct xfrm_mode *inner_mode;
2222 int family = x->props.family;
2223 int err;
2224
2225 err = -EAFNOSUPPORT;
2226 afinfo = xfrm_state_get_afinfo(family);
2227 if (!afinfo)
2228 goto error;
2229
2230 err = 0;
2231 if (afinfo->init_flags)
2232 err = afinfo->init_flags(x);
2233
2234 rcu_read_unlock();
2235
2236 if (err)
2237 goto error;
2238
2239 err = -EPROTONOSUPPORT;
2240
2241 if (x->sel.family != AF_UNSPEC) {
2242 inner_mode = xfrm_get_mode(x->props.mode, x->sel.family);
2243 if (inner_mode == NULL)
2244 goto error;
2245
2246 if (!(inner_mode->flags & XFRM_MODE_FLAG_TUNNEL) &&
2247 family != x->sel.family) {
2248 xfrm_put_mode(inner_mode);
2249 goto error;
2250 }
2251
2252 x->inner_mode = inner_mode;
2253 } else {
2254 struct xfrm_mode *inner_mode_iaf;
2255 int iafamily = AF_INET;
2256
2257 inner_mode = xfrm_get_mode(x->props.mode, x->props.family);
2258 if (inner_mode == NULL)
2259 goto error;
2260
2261 if (!(inner_mode->flags & XFRM_MODE_FLAG_TUNNEL)) {
2262 xfrm_put_mode(inner_mode);
2263 goto error;
2264 }
2265 x->inner_mode = inner_mode;
2266
2267 if (x->props.family == AF_INET)
2268 iafamily = AF_INET6;
2269
2270 inner_mode_iaf = xfrm_get_mode(x->props.mode, iafamily);
2271 if (inner_mode_iaf) {
2272 if (inner_mode_iaf->flags & XFRM_MODE_FLAG_TUNNEL)
2273 x->inner_mode_iaf = inner_mode_iaf;
2274 else
2275 xfrm_put_mode(inner_mode_iaf);
2276 }
2277 }
2278
2279 x->type = xfrm_get_type(x->id.proto, family);
2280 if (x->type == NULL)
2281 goto error;
2282
2283 x->type_offload = xfrm_get_type_offload(x->id.proto, family, offload);
2284
2285 err = x->type->init_state(x);
2286 if (err)
2287 goto error;
2288
2289 x->outer_mode = xfrm_get_mode(x->props.mode, family);
2290 if (x->outer_mode == NULL) {
2291 err = -EPROTONOSUPPORT;
2292 goto error;
2293 }
2294
2295 if (init_replay) {
2296 err = xfrm_init_replay(x);
2297 if (err)
2298 goto error;
2299 }
2300
2301 x->km.state = XFRM_STATE_VALID;
2302
2303 error:
2304 return err;
2305 }
2306
2307 EXPORT_SYMBOL(__xfrm_init_state);
2308
2309 int xfrm_init_state(struct xfrm_state *x)
2310 {
2311 return __xfrm_init_state(x, true, false);
2312 }
2313
2314 EXPORT_SYMBOL(xfrm_init_state);
2315
2316 int __net_init xfrm_state_init(struct net *net)
2317 {
2318 unsigned int sz;
2319
2320 INIT_LIST_HEAD(&net->xfrm.state_all);
2321
2322 sz = sizeof(struct hlist_head) * 8;
2323
2324 net->xfrm.state_bydst = xfrm_hash_alloc(sz);
2325 if (!net->xfrm.state_bydst)
2326 goto out_bydst;
2327 net->xfrm.state_bysrc = xfrm_hash_alloc(sz);
2328 if (!net->xfrm.state_bysrc)
2329 goto out_bysrc;
2330 net->xfrm.state_byspi = xfrm_hash_alloc(sz);
2331 if (!net->xfrm.state_byspi)
2332 goto out_byspi;
2333 net->xfrm.state_hmask = ((sz / sizeof(struct hlist_head)) - 1);
2334
2335 net->xfrm.state_num = 0;
2336 INIT_WORK(&net->xfrm.state_hash_work, xfrm_hash_resize);
2337 spin_lock_init(&net->xfrm.xfrm_state_lock);
2338 return 0;
2339
2340 out_byspi:
2341 xfrm_hash_free(net->xfrm.state_bysrc, sz);
2342 out_bysrc:
2343 xfrm_hash_free(net->xfrm.state_bydst, sz);
2344 out_bydst:
2345 return -ENOMEM;
2346 }
2347
2348 void xfrm_state_fini(struct net *net)
2349 {
2350 unsigned int sz;
2351
2352 flush_work(&net->xfrm.state_hash_work);
2353 xfrm_state_flush(net, IPSEC_PROTO_ANY, false);
2354 flush_work(&xfrm_state_gc_work);
2355
2356 WARN_ON(!list_empty(&net->xfrm.state_all));
2357
2358 sz = (net->xfrm.state_hmask + 1) * sizeof(struct hlist_head);
2359 WARN_ON(!hlist_empty(net->xfrm.state_byspi));
2360 xfrm_hash_free(net->xfrm.state_byspi, sz);
2361 WARN_ON(!hlist_empty(net->xfrm.state_bysrc));
2362 xfrm_hash_free(net->xfrm.state_bysrc, sz);
2363 WARN_ON(!hlist_empty(net->xfrm.state_bydst));
2364 xfrm_hash_free(net->xfrm.state_bydst, sz);
2365 }
2366
2367 #ifdef CONFIG_AUDITSYSCALL
2368 static void xfrm_audit_helper_sainfo(struct xfrm_state *x,
2369 struct audit_buffer *audit_buf)
2370 {
2371 struct xfrm_sec_ctx *ctx = x->security;
2372 u32 spi = ntohl(x->id.spi);
2373
2374 if (ctx)
2375 audit_log_format(audit_buf, " sec_alg=%u sec_doi=%u sec_obj=%s",
2376 ctx->ctx_alg, ctx->ctx_doi, ctx->ctx_str);
2377
2378 switch (x->props.family) {
2379 case AF_INET:
2380 audit_log_format(audit_buf, " src=%pI4 dst=%pI4",
2381 &x->props.saddr.a4, &x->id.daddr.a4);
2382 break;
2383 case AF_INET6:
2384 audit_log_format(audit_buf, " src=%pI6 dst=%pI6",
2385 x->props.saddr.a6, x->id.daddr.a6);
2386 break;
2387 }
2388
2389 audit_log_format(audit_buf, " spi=%u(0x%x)", spi, spi);
2390 }
2391
2392 static void xfrm_audit_helper_pktinfo(struct sk_buff *skb, u16 family,
2393 struct audit_buffer *audit_buf)
2394 {
2395 const struct iphdr *iph4;
2396 const struct ipv6hdr *iph6;
2397
2398 switch (family) {
2399 case AF_INET:
2400 iph4 = ip_hdr(skb);
2401 audit_log_format(audit_buf, " src=%pI4 dst=%pI4",
2402 &iph4->saddr, &iph4->daddr);
2403 break;
2404 case AF_INET6:
2405 iph6 = ipv6_hdr(skb);
2406 audit_log_format(audit_buf,
2407 " src=%pI6 dst=%pI6 flowlbl=0x%x%02x%02x",
2408 &iph6->saddr, &iph6->daddr,
2409 iph6->flow_lbl[0] & 0x0f,
2410 iph6->flow_lbl[1],
2411 iph6->flow_lbl[2]);
2412 break;
2413 }
2414 }
2415
2416 void xfrm_audit_state_add(struct xfrm_state *x, int result, bool task_valid)
2417 {
2418 struct audit_buffer *audit_buf;
2419
2420 audit_buf = xfrm_audit_start("SAD-add");
2421 if (audit_buf == NULL)
2422 return;
2423 xfrm_audit_helper_usrinfo(task_valid, audit_buf);
2424 xfrm_audit_helper_sainfo(x, audit_buf);
2425 audit_log_format(audit_buf, " res=%u", result);
2426 audit_log_end(audit_buf);
2427 }
2428 EXPORT_SYMBOL_GPL(xfrm_audit_state_add);
2429
2430 void xfrm_audit_state_delete(struct xfrm_state *x, int result, bool task_valid)
2431 {
2432 struct audit_buffer *audit_buf;
2433
2434 audit_buf = xfrm_audit_start("SAD-delete");
2435 if (audit_buf == NULL)
2436 return;
2437 xfrm_audit_helper_usrinfo(task_valid, audit_buf);
2438 xfrm_audit_helper_sainfo(x, audit_buf);
2439 audit_log_format(audit_buf, " res=%u", result);
2440 audit_log_end(audit_buf);
2441 }
2442 EXPORT_SYMBOL_GPL(xfrm_audit_state_delete);
2443
2444 void xfrm_audit_state_replay_overflow(struct xfrm_state *x,
2445 struct sk_buff *skb)
2446 {
2447 struct audit_buffer *audit_buf;
2448 u32 spi;
2449
2450 audit_buf = xfrm_audit_start("SA-replay-overflow");
2451 if (audit_buf == NULL)
2452 return;
2453 xfrm_audit_helper_pktinfo(skb, x->props.family, audit_buf);
2454 /* don't record the sequence number because it's inherent in this kind
2455 * of audit message */
2456 spi = ntohl(x->id.spi);
2457 audit_log_format(audit_buf, " spi=%u(0x%x)", spi, spi);
2458 audit_log_end(audit_buf);
2459 }
2460 EXPORT_SYMBOL_GPL(xfrm_audit_state_replay_overflow);
2461
2462 void xfrm_audit_state_replay(struct xfrm_state *x,
2463 struct sk_buff *skb, __be32 net_seq)
2464 {
2465 struct audit_buffer *audit_buf;
2466 u32 spi;
2467
2468 audit_buf = xfrm_audit_start("SA-replayed-pkt");
2469 if (audit_buf == NULL)
2470 return;
2471 xfrm_audit_helper_pktinfo(skb, x->props.family, audit_buf);
2472 spi = ntohl(x->id.spi);
2473 audit_log_format(audit_buf, " spi=%u(0x%x) seqno=%u",
2474 spi, spi, ntohl(net_seq));
2475 audit_log_end(audit_buf);
2476 }
2477 EXPORT_SYMBOL_GPL(xfrm_audit_state_replay);
2478
2479 void xfrm_audit_state_notfound_simple(struct sk_buff *skb, u16 family)
2480 {
2481 struct audit_buffer *audit_buf;
2482
2483 audit_buf = xfrm_audit_start("SA-notfound");
2484 if (audit_buf == NULL)
2485 return;
2486 xfrm_audit_helper_pktinfo(skb, family, audit_buf);
2487 audit_log_end(audit_buf);
2488 }
2489 EXPORT_SYMBOL_GPL(xfrm_audit_state_notfound_simple);
2490
2491 void xfrm_audit_state_notfound(struct sk_buff *skb, u16 family,
2492 __be32 net_spi, __be32 net_seq)
2493 {
2494 struct audit_buffer *audit_buf;
2495 u32 spi;
2496
2497 audit_buf = xfrm_audit_start("SA-notfound");
2498 if (audit_buf == NULL)
2499 return;
2500 xfrm_audit_helper_pktinfo(skb, family, audit_buf);
2501 spi = ntohl(net_spi);
2502 audit_log_format(audit_buf, " spi=%u(0x%x) seqno=%u",
2503 spi, spi, ntohl(net_seq));
2504 audit_log_end(audit_buf);
2505 }
2506 EXPORT_SYMBOL_GPL(xfrm_audit_state_notfound);
2507
2508 void xfrm_audit_state_icvfail(struct xfrm_state *x,
2509 struct sk_buff *skb, u8 proto)
2510 {
2511 struct audit_buffer *audit_buf;
2512 __be32 net_spi;
2513 __be32 net_seq;
2514
2515 audit_buf = xfrm_audit_start("SA-icv-failure");
2516 if (audit_buf == NULL)
2517 return;
2518 xfrm_audit_helper_pktinfo(skb, x->props.family, audit_buf);
2519 if (xfrm_parse_spi(skb, proto, &net_spi, &net_seq) == 0) {
2520 u32 spi = ntohl(net_spi);
2521 audit_log_format(audit_buf, " spi=%u(0x%x) seqno=%u",
2522 spi, spi, ntohl(net_seq));
2523 }
2524 audit_log_end(audit_buf);
2525 }
2526 EXPORT_SYMBOL_GPL(xfrm_audit_state_icvfail);
2527 #endif /* CONFIG_AUDITSYSCALL */
Motorola kernel-slsi