]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - net/xfrm/xfrm_policy.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge tag 'nfs-for-4.3-1' of git://git.linux-nfs.org/projects/trondmy/linux-nfs
[mirror_ubuntu-bionic-kernel.git] / net / xfrm / xfrm_policy.c
CommitLineData
a716c119 1/*
1da177e4
LT		 2 * xfrm_policy.c
3 *
4 * Changes:
5 * Mitsuru KANDA @USAGI
6 * Kazunori MIYAZAWA @USAGI
7 * Kunihiro Ishiguro <kunihiro@ipinfusion.com>
8 * IPv6 support
9 * Kazunori MIYAZAWA @USAGI
10 * YOSHIFUJI Hideaki
11 * Split up af-specific portion
12 * Derek Atkins <derek@ihtfp.com> Add the post_input processor
df71837d 13 *
1da177e4
LT		 14 */
15
66cdb3ca 16#include <linux/err.h>
1da177e4
LT		 17#include <linux/slab.h>
18#include <linux/kmod.h>
19#include <linux/list.h>
20#include <linux/spinlock.h>
21#include <linux/workqueue.h>
22#include <linux/notifier.h>
23#include <linux/netdevice.h>
eb9c7ebe 24#include <linux/netfilter.h>
1da177e4 25#include <linux/module.h>
2518c7c2 26#include <linux/cache.h>
68277acc 27#include <linux/audit.h>
25ee3286 28#include <net/dst.h>
6ce74ec7 29#include <net/flow.h>
1da177e4
LT		 30#include <net/xfrm.h>
31#include <net/ip.h>
558f82ef
MN		 32#ifdef CONFIG_XFRM_STATISTICS
33#include <net/snmp.h>
34#endif
1da177e4 35
44e36b42
DM		 36#include "xfrm_hash.h"
37
a0073fe1
SK		 38#define XFRM_QUEUE_TMO_MIN ((unsigned)(HZ/10))
39#define XFRM_QUEUE_TMO_MAX ((unsigned)(60*HZ))
40#define XFRM_MAX_QUEUE_LEN 100
41
b8c203b2
SK		 42struct xfrm_flo {
43 struct dst_entry *dst_orig;
44 u8 flags;
45};
46
418a99ac
PJ		 47static DEFINE_SPINLOCK(xfrm_policy_afinfo_lock);
48static struct xfrm_policy_afinfo __rcu *xfrm_policy_afinfo[NPROTO]
49 __read_mostly;
1da177e4 50
e18b890b 51static struct kmem_cache *xfrm_dst_cache __read_mostly;
1da177e4 52
25ee3286 53static void xfrm_init_pmtu(struct dst_entry *dst);
80c802f3 54static int stale_bundle(struct dst_entry *dst);
12fdb4d3 55static int xfrm_bundle_ok(struct xfrm_dst *xdst);
a0073fe1 56static void xfrm_policy_queue_process(unsigned long arg);
1da177e4 57
12bfa8bd 58static void __xfrm_policy_link(struct xfrm_policy *pol, int dir);
29fa0b30
WY		 59static struct xfrm_policy *__xfrm_policy_unlink(struct xfrm_policy *pol,
60 int dir);
61
bc9b35ad 62static inline bool
200ce96e 63__xfrm4_selector_match(const struct xfrm_selector *sel, const struct flowi *fl)
77681021 64{
7e1dc7b6
DM		 65 const struct flowi4 *fl4 = &fl->u.ip4;
66
26bff940
AD		 67 return addr4_match(fl4->daddr, sel->daddr.a4, sel->prefixlen_d) &&
68 addr4_match(fl4->saddr, sel->saddr.a4, sel->prefixlen_s) &&
7e1dc7b6
DM		 69 !((xfrm_flowi_dport(fl, &fl4->uli) ^ sel->dport) & sel->dport_mask) &&
70 !((xfrm_flowi_sport(fl, &fl4->uli) ^ sel->sport) & sel->sport_mask) &&
71 (fl4->flowi4_proto == sel->proto || !sel->proto) &&
72 (fl4->flowi4_oif == sel->ifindex || !sel->ifindex);
77681021
AM		 73}
74
bc9b35ad 75static inline bool
200ce96e 76__xfrm6_selector_match(const struct xfrm_selector *sel, const struct flowi *fl)
77681021 77{
7e1dc7b6
DM		 78 const struct flowi6 *fl6 = &fl->u.ip6;
79
80 return addr_match(&fl6->daddr, &sel->daddr, sel->prefixlen_d) &&
81 addr_match(&fl6->saddr, &sel->saddr, sel->prefixlen_s) &&
82 !((xfrm_flowi_dport(fl, &fl6->uli) ^ sel->dport) & sel->dport_mask) &&
83 !((xfrm_flowi_sport(fl, &fl6->uli) ^ sel->sport) & sel->sport_mask) &&
84 (fl6->flowi6_proto == sel->proto || !sel->proto) &&
85 (fl6->flowi6_oif == sel->ifindex || !sel->ifindex);
77681021
AM		 86}
87
bc9b35ad
DM		 88bool xfrm_selector_match(const struct xfrm_selector *sel, const struct flowi *fl,
89 unsigned short family)
77681021
AM		 90{
91 switch (family) {
92 case AF_INET:
93 return __xfrm4_selector_match(sel, fl);
94 case AF_INET6:
95 return __xfrm6_selector_match(sel, fl);
96 }
bc9b35ad 97 return false;
77681021
AM		 98}
99
ef8531b6
ED		 100static struct xfrm_policy_afinfo *xfrm_policy_get_afinfo(unsigned short family)
101{
102 struct xfrm_policy_afinfo *afinfo;
103
104 if (unlikely(family >= NPROTO))
105 return NULL;
106 rcu_read_lock();
107 afinfo = rcu_dereference(xfrm_policy_afinfo[family]);
108 if (unlikely(!afinfo))
109 rcu_read_unlock();
110 return afinfo;
111}
112
113static void xfrm_policy_put_afinfo(struct xfrm_policy_afinfo *afinfo)
114{
115 rcu_read_unlock();
116}
117
42a7b32b
DA		 118static inline struct dst_entry *__xfrm_dst_lookup(struct net *net,
119 int tos, int oif,
6418c4e0
DM		 120 const xfrm_address_t *saddr,
121 const xfrm_address_t *daddr,
9bb182a7
YH		 122 int family)
123{
124 struct xfrm_policy_afinfo *afinfo;
125 struct dst_entry *dst;
126
127 afinfo = xfrm_policy_get_afinfo(family);
128 if (unlikely(afinfo == NULL))
129 return ERR_PTR(-EAFNOSUPPORT);
130
42a7b32b 131 dst = afinfo->dst_lookup(net, tos, oif, saddr, daddr);
9bb182a7
YH		 132
133 xfrm_policy_put_afinfo(afinfo);
134
135 return dst;
136}
137
42a7b32b
DA		 138static inline struct dst_entry *xfrm_dst_lookup(struct xfrm_state *x,
139 int tos, int oif,
9bb182a7
YH		 140 xfrm_address_t *prev_saddr,
141 xfrm_address_t *prev_daddr,
25ee3286 142 int family)
1da177e4 143{
c5b3cf46 144 struct net *net = xs_net(x);
66cdb3ca
HX		 145 xfrm_address_t *saddr = &x->props.saddr;
146 xfrm_address_t *daddr = &x->id.daddr;
66cdb3ca
HX		 147 struct dst_entry *dst;
148
9bb182a7 149 if (x->type->flags & XFRM_TYPE_LOCAL_COADDR) {
66cdb3ca 150 saddr = x->coaddr;
9bb182a7
YH		 151 daddr = prev_daddr;
152 }
153 if (x->type->flags & XFRM_TYPE_REMOTE_COADDR) {
154 saddr = prev_saddr;
66cdb3ca 155 daddr = x->coaddr;
9bb182a7 156 }
1da177e4 157
42a7b32b 158 dst = __xfrm_dst_lookup(net, tos, oif, saddr, daddr, family);
9bb182a7
YH		 159
160 if (!IS_ERR(dst)) {
161 if (prev_saddr != saddr)
162 memcpy(prev_saddr, saddr, sizeof(*prev_saddr));
163 if (prev_daddr != daddr)
164 memcpy(prev_daddr, daddr, sizeof(*prev_daddr));
165 }
1da177e4 166
66cdb3ca 167 return dst;
1da177e4 168}
1da177e4 169
1da177e4
LT		 170static inline unsigned long make_jiffies(long secs)
171{
172 if (secs >= (MAX_SCHEDULE_TIMEOUT-1)/HZ)
173 return MAX_SCHEDULE_TIMEOUT-1;
174 else
a716c119 175 return secs*HZ;
1da177e4
LT		 176}
177
178static void xfrm_policy_timer(unsigned long data)
179{
3e94c2dc 180 struct xfrm_policy *xp = (struct xfrm_policy *)data;
9d729f72 181 unsigned long now = get_seconds();
1da177e4
LT		 182 long next = LONG_MAX;
183 int warn = 0;
184 int dir;
185
186 read_lock(&xp->lock);
187
ea2dea9d 188 if (unlikely(xp->walk.dead))
1da177e4
LT		 189 goto out;
190
77d8d7a6 191 dir = xfrm_policy_id2dir(xp->index);
1da177e4
LT		 192
193 if (xp->lft.hard_add_expires_seconds) {
194 long tmo = xp->lft.hard_add_expires_seconds +
195 xp->curlft.add_time - now;
196 if (tmo <= 0)
197 goto expired;
198 if (tmo < next)
199 next = tmo;
200 }
201 if (xp->lft.hard_use_expires_seconds) {
202 long tmo = xp->lft.hard_use_expires_seconds +
203 (xp->curlft.use_time ? : xp->curlft.add_time) - now;
204 if (tmo <= 0)
205 goto expired;
206 if (tmo < next)
207 next = tmo;
208 }
209 if (xp->lft.soft_add_expires_seconds) {
210 long tmo = xp->lft.soft_add_expires_seconds +
211 xp->curlft.add_time - now;
212 if (tmo <= 0) {
213 warn = 1;
214 tmo = XFRM_KM_TIMEOUT;
215 }
216 if (tmo < next)
217 next = tmo;
218 }
219 if (xp->lft.soft_use_expires_seconds) {
220 long tmo = xp->lft.soft_use_expires_seconds +
221 (xp->curlft.use_time ? : xp->curlft.add_time) - now;
222 if (tmo <= 0) {
223 warn = 1;
224 tmo = XFRM_KM_TIMEOUT;
225 }
226 if (tmo < next)
227 next = tmo;
228 }
229
230 if (warn)
6c5c8ca7 231 km_policy_expired(xp, dir, 0, 0);
1da177e4
LT		 232 if (next != LONG_MAX &&
233 !mod_timer(&xp->timer, jiffies + make_jiffies(next)))
234 xfrm_pol_hold(xp);
235
236out:
237 read_unlock(&xp->lock);
238 xfrm_pol_put(xp);
239 return;
240
241expired:
242 read_unlock(&xp->lock);
4666faab 243 if (!xfrm_policy_delete(xp, dir))
6c5c8ca7 244 km_policy_expired(xp, dir, 1, 0);
1da177e4
LT		 245 xfrm_pol_put(xp);
246}
247
fe1a5f03
TT		 248static struct flow_cache_object *xfrm_policy_flo_get(struct flow_cache_object *flo)
249{
250 struct xfrm_policy *pol = container_of(flo, struct xfrm_policy, flo);
251
252 if (unlikely(pol->walk.dead))
253 flo = NULL;
254 else
255 xfrm_pol_hold(pol);
256
257 return flo;
258}
259
260static int xfrm_policy_flo_check(struct flow_cache_object *flo)
261{
262 struct xfrm_policy *pol = container_of(flo, struct xfrm_policy, flo);
263
264 return !pol->walk.dead;
265}
266
267static void xfrm_policy_flo_delete(struct flow_cache_object *flo)
268{
269 xfrm_pol_put(container_of(flo, struct xfrm_policy, flo));
270}
271
272static const struct flow_cache_ops xfrm_policy_fc_ops = {
273 .get = xfrm_policy_flo_get,
274 .check = xfrm_policy_flo_check,
275 .delete = xfrm_policy_flo_delete,
276};
1da177e4
LT		 277
278/* Allocate xfrm_policy. Not used here, it is supposed to be used by pfkeyv2
279 * SPD calls.
280 */
281
0331b1f3 282struct xfrm_policy *xfrm_policy_alloc(struct net *net, gfp_t gfp)
1da177e4
LT		 283{
284 struct xfrm_policy *policy;
285
0da974f4 286 policy = kzalloc(sizeof(struct xfrm_policy), gfp);
1da177e4
LT		 287
288 if (policy) {
0331b1f3 289 write_pnet(&policy->xp_net, net);
12a169e7 290 INIT_LIST_HEAD(&policy->walk.all);
2518c7c2
DM		 291 INIT_HLIST_NODE(&policy->bydst);
292 INIT_HLIST_NODE(&policy->byidx);
1da177e4 293 rwlock_init(&policy->lock);
2518c7c2 294 atomic_set(&policy->refcnt, 1);
a0073fe1 295 skb_queue_head_init(&policy->polq.hold_queue);
b24b8a24
PE		 296 setup_timer(&policy->timer, xfrm_policy_timer,
297 (unsigned long)policy);
a0073fe1
SK		 298 setup_timer(&policy->polq.hold_timer, xfrm_policy_queue_process,
299 (unsigned long)policy);
fe1a5f03 300 policy->flo.ops = &xfrm_policy_fc_ops;
1da177e4
LT		 301 }
302 return policy;
303}
304EXPORT_SYMBOL(xfrm_policy_alloc);
305
306/* Destroy xfrm_policy: descendant resources must be released to this moment. */
307
64c31b3f 308void xfrm_policy_destroy(struct xfrm_policy *policy)
1da177e4 309{
12a169e7 310 BUG_ON(!policy->walk.dead);
1da177e4 311
0659eea9 312 if (del_timer(&policy->timer) || del_timer(&policy->polq.hold_timer))
1da177e4
LT		 313 BUG();
314
03e1ad7b 315 security_xfrm_policy_free(policy->security);
1da177e4
LT		 316 kfree(policy);
317}
64c31b3f 318EXPORT_SYMBOL(xfrm_policy_destroy);
1da177e4 319
1da177e4
LT		 320/* Rule must be locked. Release descentant resources, announce
321 * entry dead. The rule must be unlinked from lists to the moment.
322 */
323
324static void xfrm_policy_kill(struct xfrm_policy *policy)
325{
12a169e7 326 policy->walk.dead = 1;
1da177e4 327
285ead17 328 atomic_inc(&policy->genid);
1da177e4 329
e7d8f6cb
SK		 330 if (del_timer(&policy->polq.hold_timer))
331 xfrm_pol_put(policy);
1ee5e667 332 skb_queue_purge(&policy->polq.hold_queue);
a0073fe1 333
285ead17
TT		 334 if (del_timer(&policy->timer))
335 xfrm_pol_put(policy);
336
337 xfrm_pol_put(policy);
1da177e4
LT		 338}
339
2518c7c2
DM		 340static unsigned int xfrm_policy_hashmax __read_mostly = 1 * 1024 * 1024;
341
e92303f8 342static inline unsigned int idx_hash(struct net *net, u32 index)
2518c7c2 343{
e92303f8 344 return __idx_hash(index, net->xfrm.policy_idx_hmask);
2518c7c2
DM		 345}
346
b58555f1
CG		 347/* calculate policy hash thresholds */
348static void __get_hash_thresh(struct net *net,
349 unsigned short family, int dir,
350 u8 *dbits, u8 *sbits)
351{
352 switch (family) {
353 case AF_INET:
354 *dbits = net->xfrm.policy_bydst[dir].dbits4;
355 *sbits = net->xfrm.policy_bydst[dir].sbits4;
356 break;
357
358 case AF_INET6:
359 *dbits = net->xfrm.policy_bydst[dir].dbits6;
360 *sbits = net->xfrm.policy_bydst[dir].sbits6;
361 break;
362
363 default:
364 *dbits = 0;
365 *sbits = 0;
366 }
367}
368
5f803b58
DM		 369static struct hlist_head *policy_hash_bysel(struct net *net,
370 const struct xfrm_selector *sel,
371 unsigned short family, int dir)
2518c7c2 372{
1121994c 373 unsigned int hmask = net->xfrm.policy_bydst[dir].hmask;
b58555f1
CG		 374 unsigned int hash;
375 u8 dbits;
376 u8 sbits;
377
378 __get_hash_thresh(net, family, dir, &dbits, &sbits);
379 hash = __sel_hash(sel, family, hmask, dbits, sbits);
2518c7c2
DM		 380
381 return (hash == hmask + 1 ?
1121994c
AD		 382 &net->xfrm.policy_inexact[dir] :
383 net->xfrm.policy_bydst[dir].table + hash);
2518c7c2
DM		 384}
385
5f803b58
DM		 386static struct hlist_head *policy_hash_direct(struct net *net,
387 const xfrm_address_t *daddr,
388 const xfrm_address_t *saddr,
389 unsigned short family, int dir)
2518c7c2 390{
1121994c 391 unsigned int hmask = net->xfrm.policy_bydst[dir].hmask;
b58555f1
CG		 392 unsigned int hash;
393 u8 dbits;
394 u8 sbits;
395
396 __get_hash_thresh(net, family, dir, &dbits, &sbits);
397 hash = __addr_hash(daddr, saddr, family, hmask, dbits, sbits);
2518c7c2 398
1121994c 399 return net->xfrm.policy_bydst[dir].table + hash;
2518c7c2
DM		 400}
401
b58555f1
CG		 402static void xfrm_dst_hash_transfer(struct net *net,
403 struct hlist_head *list,
2518c7c2 404 struct hlist_head *ndsttable,
b58555f1
CG		 405 unsigned int nhashmask,
406 int dir)
2518c7c2 407{
b67bfe0d 408 struct hlist_node *tmp, *entry0 = NULL;
2518c7c2 409 struct xfrm_policy *pol;
b791160b 410 unsigned int h0 = 0;
b58555f1
CG		 411 u8 dbits;
412 u8 sbits;
2518c7c2 413
b791160b 414redo:
b67bfe0d 415 hlist_for_each_entry_safe(pol, tmp, list, bydst) {
2518c7c2
DM		 416 unsigned int h;
417
b58555f1 418 __get_hash_thresh(net, pol->family, dir, &dbits, &sbits);
2518c7c2 419 h = __addr_hash(&pol->selector.daddr, &pol->selector.saddr,
b58555f1 420 pol->family, nhashmask, dbits, sbits);
b791160b 421 if (!entry0) {
b67bfe0d 422 hlist_del(&pol->bydst);
b791160b
YH		 423 hlist_add_head(&pol->bydst, ndsttable+h);
424 h0 = h;
425 } else {
426 if (h != h0)
427 continue;
b67bfe0d 428 hlist_del(&pol->bydst);
1d023284 429 hlist_add_behind(&pol->bydst, entry0);
b791160b 430 }
b67bfe0d 431 entry0 = &pol->bydst;
b791160b
YH		 432 }
433 if (!hlist_empty(list)) {
434 entry0 = NULL;
435 goto redo;
2518c7c2
DM		 436 }
437}
438
439static void xfrm_idx_hash_transfer(struct hlist_head *list,
440 struct hlist_head *nidxtable,
441 unsigned int nhashmask)
442{
b67bfe0d 443 struct hlist_node *tmp;
2518c7c2
DM		 444 struct xfrm_policy *pol;
445
b67bfe0d 446 hlist_for_each_entry_safe(pol, tmp, list, byidx) {
2518c7c2
DM		 447 unsigned int h;
448
449 h = __idx_hash(pol->index, nhashmask);
450 hlist_add_head(&pol->byidx, nidxtable+h);
451 }
452}
453
454static unsigned long xfrm_new_hash_mask(unsigned int old_hmask)
455{
456 return ((old_hmask + 1) << 1) - 1;
457}
458
66caf628 459static void xfrm_bydst_resize(struct net *net, int dir)
2518c7c2 460{
66caf628 461 unsigned int hmask = net->xfrm.policy_bydst[dir].hmask;
2518c7c2
DM		 462 unsigned int nhashmask = xfrm_new_hash_mask(hmask);
463 unsigned int nsize = (nhashmask + 1) * sizeof(struct hlist_head);
66caf628 464 struct hlist_head *odst = net->xfrm.policy_bydst[dir].table;
44e36b42 465 struct hlist_head *ndst = xfrm_hash_alloc(nsize);
2518c7c2
DM		 466 int i;
467
468 if (!ndst)
469 return;
470
283bc9f3 471 write_lock_bh(&net->xfrm.xfrm_policy_lock);
2518c7c2
DM		 472
473 for (i = hmask; i >= 0; i--)
b58555f1 474 xfrm_dst_hash_transfer(net, odst + i, ndst, nhashmask, dir);
2518c7c2 475
66caf628
AD		 476 net->xfrm.policy_bydst[dir].table = ndst;
477 net->xfrm.policy_bydst[dir].hmask = nhashmask;
2518c7c2 478
283bc9f3 479 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
2518c7c2 480
44e36b42 481 xfrm_hash_free(odst, (hmask + 1) * sizeof(struct hlist_head));
2518c7c2
DM		 482}
483
66caf628 484static void xfrm_byidx_resize(struct net *net, int total)
2518c7c2 485{
66caf628 486 unsigned int hmask = net->xfrm.policy_idx_hmask;
2518c7c2
DM		 487 unsigned int nhashmask = xfrm_new_hash_mask(hmask);
488 unsigned int nsize = (nhashmask + 1) * sizeof(struct hlist_head);
66caf628 489 struct hlist_head *oidx = net->xfrm.policy_byidx;
44e36b42 490 struct hlist_head *nidx = xfrm_hash_alloc(nsize);
2518c7c2
DM		 491 int i;
492
493 if (!nidx)
494 return;
495
283bc9f3 496 write_lock_bh(&net->xfrm.xfrm_policy_lock);
2518c7c2
DM		 497
498 for (i = hmask; i >= 0; i--)
499 xfrm_idx_hash_transfer(oidx + i, nidx, nhashmask);
500
66caf628
AD		 501 net->xfrm.policy_byidx = nidx;
502 net->xfrm.policy_idx_hmask = nhashmask;
2518c7c2 503
283bc9f3 504 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
2518c7c2 505
44e36b42 506 xfrm_hash_free(oidx, (hmask + 1) * sizeof(struct hlist_head));
2518c7c2
DM		 507}
508
66caf628 509static inline int xfrm_bydst_should_resize(struct net *net, int dir, int *total)
2518c7c2 510{
66caf628
AD		 511 unsigned int cnt = net->xfrm.policy_count[dir];
512 unsigned int hmask = net->xfrm.policy_bydst[dir].hmask;
2518c7c2
DM		 513
514 if (total)
515 *total += cnt;
516
517 if ((hmask + 1) < xfrm_policy_hashmax &&
518 cnt > hmask)
519 return 1;
520
521 return 0;
522}
523
66caf628 524static inline int xfrm_byidx_should_resize(struct net *net, int total)
2518c7c2 525{
66caf628 526 unsigned int hmask = net->xfrm.policy_idx_hmask;
2518c7c2
DM		 527
528 if ((hmask + 1) < xfrm_policy_hashmax &&
529 total > hmask)
530 return 1;
531
532 return 0;
533}
534
e071041b 535void xfrm_spd_getinfo(struct net *net, struct xfrmk_spdinfo *si)
ecfd6b18 536{
283bc9f3 537 read_lock_bh(&net->xfrm.xfrm_policy_lock);
e071041b
AD		 538 si->incnt = net->xfrm.policy_count[XFRM_POLICY_IN];
539 si->outcnt = net->xfrm.policy_count[XFRM_POLICY_OUT];
540 si->fwdcnt = net->xfrm.policy_count[XFRM_POLICY_FWD];
541 si->inscnt = net->xfrm.policy_count[XFRM_POLICY_IN+XFRM_POLICY_MAX];
542 si->outscnt = net->xfrm.policy_count[XFRM_POLICY_OUT+XFRM_POLICY_MAX];
543 si->fwdscnt = net->xfrm.policy_count[XFRM_POLICY_FWD+XFRM_POLICY_MAX];
544 si->spdhcnt = net->xfrm.policy_idx_hmask;
ecfd6b18 545 si->spdhmcnt = xfrm_policy_hashmax;
283bc9f3 546 read_unlock_bh(&net->xfrm.xfrm_policy_lock);
ecfd6b18
JHS		 547}
548EXPORT_SYMBOL(xfrm_spd_getinfo);
2518c7c2 549
ecfd6b18 550static DEFINE_MUTEX(hash_resize_mutex);
66caf628 551static void xfrm_hash_resize(struct work_struct *work)
2518c7c2 552{
66caf628 553 struct net *net = container_of(work, struct net, xfrm.policy_hash_work);
2518c7c2
DM		 554 int dir, total;
555
556 mutex_lock(&hash_resize_mutex);
557
558 total = 0;
53c2e285 559 for (dir = 0; dir < XFRM_POLICY_MAX; dir++) {
66caf628
AD		 560 if (xfrm_bydst_should_resize(net, dir, &total))
561 xfrm_bydst_resize(net, dir);
2518c7c2 562 }
66caf628
AD		 563 if (xfrm_byidx_should_resize(net, total))
564 xfrm_byidx_resize(net, total);
2518c7c2
DM		 565
566 mutex_unlock(&hash_resize_mutex);
567}
568
880a6fab
CG		 569static void xfrm_hash_rebuild(struct work_struct *work)
570{
571 struct net *net = container_of(work, struct net,
572 xfrm.policy_hthresh.work);
573 unsigned int hmask;
574 struct xfrm_policy *pol;
575 struct xfrm_policy *policy;
576 struct hlist_head *chain;
577 struct hlist_head *odst;
578 struct hlist_node *newpos;
579 int i;
580 int dir;
581 unsigned seq;
582 u8 lbits4, rbits4, lbits6, rbits6;
583
584 mutex_lock(&hash_resize_mutex);
585
586 /* read selector prefixlen thresholds */
587 do {
588 seq = read_seqbegin(&net->xfrm.policy_hthresh.lock);
589
590 lbits4 = net->xfrm.policy_hthresh.lbits4;
591 rbits4 = net->xfrm.policy_hthresh.rbits4;
592 lbits6 = net->xfrm.policy_hthresh.lbits6;
593 rbits6 = net->xfrm.policy_hthresh.rbits6;
594 } while (read_seqretry(&net->xfrm.policy_hthresh.lock, seq));
595
596 write_lock_bh(&net->xfrm.xfrm_policy_lock);
597
598 /* reset the bydst and inexact table in all directions */
53c2e285 599 for (dir = 0; dir < XFRM_POLICY_MAX; dir++) {
880a6fab
CG		 600 INIT_HLIST_HEAD(&net->xfrm.policy_inexact[dir]);
601 hmask = net->xfrm.policy_bydst[dir].hmask;
602 odst = net->xfrm.policy_bydst[dir].table;
603 for (i = hmask; i >= 0; i--)
604 INIT_HLIST_HEAD(odst + i);
605 if ((dir & XFRM_POLICY_MASK) == XFRM_POLICY_OUT) {
606 /* dir out => dst = remote, src = local */
607 net->xfrm.policy_bydst[dir].dbits4 = rbits4;
608 net->xfrm.policy_bydst[dir].sbits4 = lbits4;
609 net->xfrm.policy_bydst[dir].dbits6 = rbits6;
610 net->xfrm.policy_bydst[dir].sbits6 = lbits6;
611 } else {
612 /* dir in/fwd => dst = local, src = remote */
613 net->xfrm.policy_bydst[dir].dbits4 = lbits4;
614 net->xfrm.policy_bydst[dir].sbits4 = rbits4;
615 net->xfrm.policy_bydst[dir].dbits6 = lbits6;
616 net->xfrm.policy_bydst[dir].sbits6 = rbits6;
617 }
618 }
619
620 /* re-insert all policies by order of creation */
621 list_for_each_entry_reverse(policy, &net->xfrm.policy_all, walk.all) {
622 newpos = NULL;
623 chain = policy_hash_bysel(net, &policy->selector,
624 policy->family,
625 xfrm_policy_id2dir(policy->index));
626 hlist_for_each_entry(pol, chain, bydst) {
627 if (policy->priority >= pol->priority)
628 newpos = &pol->bydst;
629 else
630 break;
631 }
632 if (newpos)
633 hlist_add_behind(&policy->bydst, newpos);
634 else
635 hlist_add_head(&policy->bydst, chain);
636 }
637
638 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
639
640 mutex_unlock(&hash_resize_mutex);
641}
642
643void xfrm_policy_hash_rebuild(struct net *net)
644{
645 schedule_work(&net->xfrm.policy_hthresh.work);
646}
647EXPORT_SYMBOL(xfrm_policy_hash_rebuild);
648
1da177e4
LT		 649/* Generate new index... KAME seems to generate them ordered by cost
650 * of an absolute inpredictability of ordering of rules. This will not pass. */
e682adf0 651static u32 xfrm_gen_index(struct net *net, int dir, u32 index)
1da177e4 652{
1da177e4
LT		 653 static u32 idx_generator;
654
655 for (;;) {
2518c7c2
DM		 656 struct hlist_head *list;
657 struct xfrm_policy *p;
658 u32 idx;
659 int found;
660
e682adf0
FD		 661 if (!index) {
662 idx = (idx_generator | dir);
663 idx_generator += 8;
664 } else {
665 idx = index;
666 index = 0;
667 }
668
1da177e4
LT		 669 if (idx == 0)
670 idx = 8;
1121994c 671 list = net->xfrm.policy_byidx + idx_hash(net, idx);
2518c7c2 672 found = 0;
b67bfe0d 673 hlist_for_each_entry(p, list, byidx) {
2518c7c2
DM		 674 if (p->index == idx) {
675 found = 1;
1da177e4 676 break;
2518c7c2 677 }
1da177e4 678 }
2518c7c2 679 if (!found)
1da177e4
LT		 680 return idx;
681 }
682}
683
2518c7c2
DM		 684static inline int selector_cmp(struct xfrm_selector *s1, struct xfrm_selector *s2)
685{
686 u32 *p1 = (u32 *) s1;
687 u32 *p2 = (u32 *) s2;
688 int len = sizeof(struct xfrm_selector) / sizeof(u32);
689 int i;
690
691 for (i = 0; i < len; i++) {
692 if (p1[i] != p2[i])
693 return 1;
694 }
695
696 return 0;
697}
698
a0073fe1
SK		 699static void xfrm_policy_requeue(struct xfrm_policy *old,
700 struct xfrm_policy *new)
701{
702 struct xfrm_policy_queue *pq = &old->polq;
703 struct sk_buff_head list;
704
de2ad486
LR		 705 if (skb_queue_empty(&pq->hold_queue))
706 return;
707
a0073fe1
SK		 708 __skb_queue_head_init(&list);
709
710 spin_lock_bh(&pq->hold_queue.lock);
711 skb_queue_splice_init(&pq->hold_queue, &list);
e7d8f6cb
SK		 712 if (del_timer(&pq->hold_timer))
713 xfrm_pol_put(old);
a0073fe1
SK		 714 spin_unlock_bh(&pq->hold_queue.lock);
715
a0073fe1
SK		 716 pq = &new->polq;
717
718 spin_lock_bh(&pq->hold_queue.lock);
719 skb_queue_splice(&list, &pq->hold_queue);
720 pq->timeout = XFRM_QUEUE_TMO_MIN;
e7d8f6cb
SK		 721 if (!mod_timer(&pq->hold_timer, jiffies))
722 xfrm_pol_hold(new);
a0073fe1
SK		 723 spin_unlock_bh(&pq->hold_queue.lock);
724}
725
7cb8a939
SK		 726static bool xfrm_policy_mark_match(struct xfrm_policy *policy,
727 struct xfrm_policy *pol)
728{
729 u32 mark = policy->mark.v & policy->mark.m;
730
731 if (policy->mark.v == pol->mark.v && policy->mark.m == pol->mark.m)
732 return true;
733
734 if ((mark & pol->mark.m) == pol->mark.v &&
735 policy->priority == pol->priority)
736 return true;
737
738 return false;
739}
740
1da177e4
LT		 741int xfrm_policy_insert(int dir, struct xfrm_policy *policy, int excl)
742{
1121994c 743 struct net *net = xp_net(policy);
2518c7c2
DM		 744 struct xfrm_policy *pol;
745 struct xfrm_policy *delpol;
746 struct hlist_head *chain;
b67bfe0d 747 struct hlist_node *newpos;
1da177e4 748
283bc9f3 749 write_lock_bh(&net->xfrm.xfrm_policy_lock);
1121994c 750 chain = policy_hash_bysel(net, &policy->selector, policy->family, dir);
2518c7c2
DM		 751 delpol = NULL;
752 newpos = NULL;
b67bfe0d 753 hlist_for_each_entry(pol, chain, bydst) {
a6c7ab55 754 if (pol->type == policy->type &&
2518c7c2 755 !selector_cmp(&pol->selector, &policy->selector) &&
7cb8a939 756 xfrm_policy_mark_match(policy, pol) &&
a6c7ab55
HX		 757 xfrm_sec_ctx_match(pol->security, policy->security) &&
758 !WARN_ON(delpol)) {
1da177e4 759 if (excl) {
283bc9f3 760 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4
LT		 761 return -EEXIST;
762 }
1da177e4
LT		 763 delpol = pol;
764 if (policy->priority > pol->priority)
765 continue;
766 } else if (policy->priority >= pol->priority) {
a6c7ab55 767 newpos = &pol->bydst;
1da177e4
LT		 768 continue;
769 }
1da177e4
LT		 770 if (delpol)
771 break;
1da177e4
LT		 772 }
773 if (newpos)
1d023284 774 hlist_add_behind(&policy->bydst, newpos);
2518c7c2
DM		 775 else
776 hlist_add_head(&policy->bydst, chain);
12bfa8bd 777 __xfrm_policy_link(policy, dir);
ca925cf1 778 atomic_inc(&net->xfrm.flow_cache_genid);
ca4c3fc2 779
780 /* After previous checking, family can either be AF_INET or AF_INET6 */
781 if (policy->family == AF_INET)
782 rt_genid_bump_ipv4(net);
783 else
784 rt_genid_bump_ipv6(net);
785
a0073fe1
SK		 786 if (delpol) {
787 xfrm_policy_requeue(delpol, policy);
29fa0b30 788 __xfrm_policy_unlink(delpol, dir);
a0073fe1 789 }
e682adf0 790 policy->index = delpol ? delpol->index : xfrm_gen_index(net, dir, policy->index);
1121994c 791 hlist_add_head(&policy->byidx, net->xfrm.policy_byidx+idx_hash(net, policy->index));
9d729f72 792 policy->curlft.add_time = get_seconds();
1da177e4
LT		 793 policy->curlft.use_time = 0;
794 if (!mod_timer(&policy->timer, jiffies + HZ))
795 xfrm_pol_hold(policy);
283bc9f3 796 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4 797
9b78a82c 798 if (delpol)
1da177e4 799 xfrm_policy_kill(delpol);
1121994c
AD		 800 else if (xfrm_bydst_should_resize(net, dir, NULL))
801 schedule_work(&net->xfrm.policy_hash_work);
9b78a82c 802
1da177e4
LT		 803 return 0;
804}
805EXPORT_SYMBOL(xfrm_policy_insert);
806
8ca2e93b
JHS		 807struct xfrm_policy *xfrm_policy_bysel_ctx(struct net *net, u32 mark, u8 type,
808 int dir, struct xfrm_selector *sel,
ef41aaa0
EP		 809 struct xfrm_sec_ctx *ctx, int delete,
810 int *err)
1da177e4 811{
2518c7c2
DM		 812 struct xfrm_policy *pol, *ret;
813 struct hlist_head *chain;
1da177e4 814
ef41aaa0 815 *err = 0;
283bc9f3 816 write_lock_bh(&net->xfrm.xfrm_policy_lock);
8d1211a6 817 chain = policy_hash_bysel(net, sel, sel->family, dir);
2518c7c2 818 ret = NULL;
b67bfe0d 819 hlist_for_each_entry(pol, chain, bydst) {
2518c7c2 820 if (pol->type == type &&
34f8d884 821 (mark & pol->mark.m) == pol->mark.v &&
2518c7c2
DM		 822 !selector_cmp(sel, &pol->selector) &&
823 xfrm_sec_ctx_match(ctx, pol->security)) {
1da177e4 824 xfrm_pol_hold(pol);
2518c7c2 825 if (delete) {
03e1ad7b
PM		 826 *err = security_xfrm_policy_delete(
827 pol->security);
ef41aaa0 828 if (*err) {
283bc9f3 829 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
ef41aaa0
EP		 830 return pol;
831 }
29fa0b30 832 __xfrm_policy_unlink(pol, dir);
2518c7c2
DM		 833 }
834 ret = pol;
1da177e4
LT		 835 break;
836 }
837 }
283bc9f3 838 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4 839
fe1a5f03 840 if (ret && delete)
2518c7c2 841 xfrm_policy_kill(ret);
2518c7c2 842 return ret;
1da177e4 843}
df71837d 844EXPORT_SYMBOL(xfrm_policy_bysel_ctx);
1da177e4 845
8ca2e93b
JHS		 846struct xfrm_policy *xfrm_policy_byid(struct net *net, u32 mark, u8 type,
847 int dir, u32 id, int delete, int *err)
1da177e4 848{
2518c7c2
DM		 849 struct xfrm_policy *pol, *ret;
850 struct hlist_head *chain;
1da177e4 851
b5505c6e
HX		 852 *err = -ENOENT;
853 if (xfrm_policy_id2dir(id) != dir)
854 return NULL;
855
ef41aaa0 856 *err = 0;
283bc9f3 857 write_lock_bh(&net->xfrm.xfrm_policy_lock);
8d1211a6 858 chain = net->xfrm.policy_byidx + idx_hash(net, id);
2518c7c2 859 ret = NULL;
b67bfe0d 860 hlist_for_each_entry(pol, chain, byidx) {
34f8d884
JHS		 861 if (pol->type == type && pol->index == id &&
862 (mark & pol->mark.m) == pol->mark.v) {
1da177e4 863 xfrm_pol_hold(pol);
2518c7c2 864 if (delete) {
03e1ad7b
PM		 865 *err = security_xfrm_policy_delete(
866 pol->security);
ef41aaa0 867 if (*err) {
283bc9f3 868 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
ef41aaa0
EP		 869 return pol;
870 }
29fa0b30 871 __xfrm_policy_unlink(pol, dir);
2518c7c2
DM		 872 }
873 ret = pol;
1da177e4
LT		 874 break;
875 }
876 }
283bc9f3 877 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4 878
fe1a5f03 879 if (ret && delete)
2518c7c2 880 xfrm_policy_kill(ret);
2518c7c2 881 return ret;
1da177e4
LT		 882}
883EXPORT_SYMBOL(xfrm_policy_byid);
884
4aa2e62c
JL		 885#ifdef CONFIG_SECURITY_NETWORK_XFRM
886static inline int
2e71029e 887xfrm_policy_flush_secctx_check(struct net *net, u8 type, bool task_valid)
1da177e4 888{
4aa2e62c
JL		 889 int dir, err = 0;
890
891 for (dir = 0; dir < XFRM_POLICY_MAX; dir++) {
892 struct xfrm_policy *pol;
4aa2e62c
JL		 893 int i;
894
b67bfe0d 895 hlist_for_each_entry(pol,
33ffbbd5 896 &net->xfrm.policy_inexact[dir], bydst) {
4aa2e62c
JL		 897 if (pol->type != type)
898 continue;
03e1ad7b 899 err = security_xfrm_policy_delete(pol->security);
4aa2e62c 900 if (err) {
2e71029e 901 xfrm_audit_policy_delete(pol, 0, task_valid);
4aa2e62c
JL		 902 return err;
903 }
7dc12d6d 904 }
33ffbbd5 905 for (i = net->xfrm.policy_bydst[dir].hmask; i >= 0; i--) {
b67bfe0d 906 hlist_for_each_entry(pol,
33ffbbd5 907 net->xfrm.policy_bydst[dir].table + i,
4aa2e62c
JL		 908 bydst) {
909 if (pol->type != type)
910 continue;
03e1ad7b
PM		 911 err = security_xfrm_policy_delete(
912 pol->security);
4aa2e62c 913 if (err) {
ab5f5e8b 914 xfrm_audit_policy_delete(pol, 0,
2e71029e 915 task_valid);
4aa2e62c
JL		 916 return err;
917 }
918 }
919 }
920 }
921 return err;
922}
923#else
924static inline int
2e71029e 925xfrm_policy_flush_secctx_check(struct net *net, u8 type, bool task_valid)
4aa2e62c
JL		 926{
927 return 0;
928}
929#endif
930
2e71029e 931int xfrm_policy_flush(struct net *net, u8 type, bool task_valid)
4aa2e62c 932{
2f1eb65f 933 int dir, err = 0, cnt = 0;
1da177e4 934
283bc9f3 935 write_lock_bh(&net->xfrm.xfrm_policy_lock);
4aa2e62c 936
2e71029e 937 err = xfrm_policy_flush_secctx_check(net, type, task_valid);
4aa2e62c
JL		 938 if (err)
939 goto out;
940
1da177e4 941 for (dir = 0; dir < XFRM_POLICY_MAX; dir++) {
2518c7c2 942 struct xfrm_policy *pol;
29fa0b30 943 int i;
2518c7c2
DM		 944
945 again1:
b67bfe0d 946 hlist_for_each_entry(pol,
33ffbbd5 947 &net->xfrm.policy_inexact[dir], bydst) {
2518c7c2
DM		 948 if (pol->type != type)
949 continue;
ea2dea9d 950 __xfrm_policy_unlink(pol, dir);
283bc9f3 951 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
ea2dea9d 952 cnt++;
1da177e4 953
2e71029e 954 xfrm_audit_policy_delete(pol, 1, task_valid);
161a09e7 955
2518c7c2 956 xfrm_policy_kill(pol);
1da177e4 957
283bc9f3 958 write_lock_bh(&net->xfrm.xfrm_policy_lock);
2518c7c2
DM		 959 goto again1;
960 }
961
33ffbbd5 962 for (i = net->xfrm.policy_bydst[dir].hmask; i >= 0; i--) {
2518c7c2 963 again2:
b67bfe0d 964 hlist_for_each_entry(pol,
33ffbbd5 965 net->xfrm.policy_bydst[dir].table + i,
2518c7c2
DM		 966 bydst) {
967 if (pol->type != type)
968 continue;
ea2dea9d 969 __xfrm_policy_unlink(pol, dir);
283bc9f3 970 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
ea2dea9d 971 cnt++;
2518c7c2 972
2e71029e 973 xfrm_audit_policy_delete(pol, 1, task_valid);
2518c7c2
DM		 974 xfrm_policy_kill(pol);
975
283bc9f3 976 write_lock_bh(&net->xfrm.xfrm_policy_lock);
2518c7c2
DM		 977 goto again2;
978 }
1da177e4 979 }
2518c7c2 980
1da177e4 981 }
2f1eb65f
JHS		 982 if (!cnt)
983 err = -ESRCH;
4aa2e62c 984out:
283bc9f3 985 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
4aa2e62c 986 return err;
1da177e4
LT		 987}
988EXPORT_SYMBOL(xfrm_policy_flush);
989
cdcbca7c 990int xfrm_policy_walk(struct net *net, struct xfrm_policy_walk *walk,
4c563f76 991 int (*func)(struct xfrm_policy *, int, int, void*),
1da177e4
LT		 992 void *data)
993{
12a169e7
HX		 994 struct xfrm_policy *pol;
995 struct xfrm_policy_walk_entry *x;
4c563f76
TT		 996 int error = 0;
997
998 if (walk->type >= XFRM_POLICY_TYPE_MAX &&
999 walk->type != XFRM_POLICY_TYPE_ANY)
1000 return -EINVAL;
1da177e4 1001
12a169e7 1002 if (list_empty(&walk->walk.all) && walk->seq != 0)
4c563f76
TT		 1003 return 0;
1004
283bc9f3 1005 write_lock_bh(&net->xfrm.xfrm_policy_lock);
12a169e7 1006 if (list_empty(&walk->walk.all))
cdcbca7c 1007 x = list_first_entry(&net->xfrm.policy_all, struct xfrm_policy_walk_entry, all);
12a169e7 1008 else
80077702
LR		 1009 x = list_first_entry(&walk->walk.all,
1010 struct xfrm_policy_walk_entry, all);
1011
cdcbca7c 1012 list_for_each_entry_from(x, &net->xfrm.policy_all, all) {
12a169e7 1013 if (x->dead)
4c563f76 1014 continue;
12a169e7
HX		 1015 pol = container_of(x, struct xfrm_policy, walk);
1016 if (walk->type != XFRM_POLICY_TYPE_ANY &&
1017 walk->type != pol->type)
1018 continue;
1019 error = func(pol, xfrm_policy_id2dir(pol->index),
1020 walk->seq, data);
1021 if (error) {
1022 list_move_tail(&walk->walk.all, &x->all);
1023 goto out;
2518c7c2 1024 }
12a169e7 1025 walk->seq++;
1da177e4 1026 }
12a169e7 1027 if (walk->seq == 0) {
baf5d743
JHS		 1028 error = -ENOENT;
1029 goto out;
1030 }
12a169e7 1031 list_del_init(&walk->walk.all);
1da177e4 1032out:
283bc9f3 1033 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4
LT		 1034 return error;
1035}
1036EXPORT_SYMBOL(xfrm_policy_walk);
1037
12a169e7
HX		 1038void xfrm_policy_walk_init(struct xfrm_policy_walk *walk, u8 type)
1039{
1040 INIT_LIST_HEAD(&walk->walk.all);
1041 walk->walk.dead = 1;
1042 walk->type = type;
1043 walk->seq = 0;
1044}
1045EXPORT_SYMBOL(xfrm_policy_walk_init);
1046
283bc9f3 1047void xfrm_policy_walk_done(struct xfrm_policy_walk *walk, struct net *net)
12a169e7
HX		 1048{
1049 if (list_empty(&walk->walk.all))
1050 return;
1051
283bc9f3 1052 write_lock_bh(&net->xfrm.xfrm_policy_lock); /*FIXME where is net? */
12a169e7 1053 list_del(&walk->walk.all);
283bc9f3 1054 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
12a169e7
HX		 1055}
1056EXPORT_SYMBOL(xfrm_policy_walk_done);
1057
134b0fc5
JM		 1058/*
1059 * Find policy to apply to this flow.
1060 *
1061 * Returns 0 if policy found, else an -errno.
1062 */
f299d557
DM		 1063static int xfrm_policy_match(const struct xfrm_policy *pol,
1064 const struct flowi *fl,
2518c7c2 1065 u8 type, u16 family, int dir)
1da177e4 1066{
f299d557 1067 const struct xfrm_selector *sel = &pol->selector;
bc9b35ad
DM		 1068 int ret = -ESRCH;
1069 bool match;
1da177e4 1070
2518c7c2 1071 if (pol->family != family ||
1d28f42c 1072 (fl->flowi_mark & pol->mark.m) != pol->mark.v ||
2518c7c2 1073 pol->type != type)
134b0fc5 1074 return ret;
1da177e4 1075
2518c7c2 1076 match = xfrm_selector_match(sel, fl, family);
134b0fc5 1077 if (match)
1d28f42c 1078 ret = security_xfrm_policy_lookup(pol->security, fl->flowi_secid,
03e1ad7b 1079 dir);
2518c7c2 1080
134b0fc5 1081 return ret;
2518c7c2 1082}
1da177e4 1083
52479b62 1084static struct xfrm_policy *xfrm_policy_lookup_bytype(struct net *net, u8 type,
062cdb43 1085 const struct flowi *fl,
2518c7c2
DM		 1086 u16 family, u8 dir)
1087{
134b0fc5 1088 int err;
2518c7c2 1089 struct xfrm_policy *pol, *ret;
0b597e7e 1090 const xfrm_address_t *daddr, *saddr;
2518c7c2 1091 struct hlist_head *chain;
acba48e1 1092 u32 priority = ~0U;
df71837d 1093
2518c7c2
DM		 1094 daddr = xfrm_flowi_daddr(fl, family);
1095 saddr = xfrm_flowi_saddr(fl, family);
1096 if (unlikely(!daddr || !saddr))
1097 return NULL;
1098
283bc9f3 1099 read_lock_bh(&net->xfrm.xfrm_policy_lock);
52479b62 1100 chain = policy_hash_direct(net, daddr, saddr, family, dir);
2518c7c2 1101 ret = NULL;
b67bfe0d 1102 hlist_for_each_entry(pol, chain, bydst) {
134b0fc5
JM		 1103 err = xfrm_policy_match(pol, fl, type, family, dir);
1104 if (err) {
1105 if (err == -ESRCH)
1106 continue;
1107 else {
1108 ret = ERR_PTR(err);
1109 goto fail;
1110 }
1111 } else {
2518c7c2 1112 ret = pol;
acba48e1 1113 priority = ret->priority;
2518c7c2
DM		 1114 break;
1115 }
1116 }
52479b62 1117 chain = &net->xfrm.policy_inexact[dir];
b67bfe0d 1118 hlist_for_each_entry(pol, chain, bydst) {
8faf491e
LR		 1119 if ((pol->priority >= priority) && ret)
1120 break;
1121
134b0fc5
JM		 1122 err = xfrm_policy_match(pol, fl, type, family, dir);
1123 if (err) {
1124 if (err == -ESRCH)
1125 continue;
1126 else {
1127 ret = ERR_PTR(err);
1128 goto fail;
1129 }
8faf491e 1130 } else {
acba48e1
DM		 1131 ret = pol;
1132 break;
1da177e4
LT		 1133 }
1134 }
586f2eb4
LR		 1135
1136 xfrm_pol_hold(ret);
134b0fc5 1137fail:
283bc9f3 1138 read_unlock_bh(&net->xfrm.xfrm_policy_lock);
4e81bb83 1139
2518c7c2 1140 return ret;
4e81bb83
MN		 1141}
1142
80c802f3 1143static struct xfrm_policy *
73ff93cd 1144__xfrm_policy_lookup(struct net *net, const struct flowi *fl, u16 family, u8 dir)
80c802f3
TT		 1145{
1146#ifdef CONFIG_XFRM_SUB_POLICY
1147 struct xfrm_policy *pol;
1148
1149 pol = xfrm_policy_lookup_bytype(net, XFRM_POLICY_TYPE_SUB, fl, family, dir);
1150 if (pol != NULL)
1151 return pol;
1152#endif
1153 return xfrm_policy_lookup_bytype(net, XFRM_POLICY_TYPE_MAIN, fl, family, dir);
1154}
1155
b5fb82c4
BZ		 1156static int flow_to_policy_dir(int dir)
1157{
1158 if (XFRM_POLICY_IN == FLOW_DIR_IN &&
1159 XFRM_POLICY_OUT == FLOW_DIR_OUT &&
1160 XFRM_POLICY_FWD == FLOW_DIR_FWD)
1161 return dir;
1162
1163 switch (dir) {
1164 default:
1165 case FLOW_DIR_IN:
1166 return XFRM_POLICY_IN;
1167 case FLOW_DIR_OUT:
1168 return XFRM_POLICY_OUT;
1169 case FLOW_DIR_FWD:
1170 return XFRM_POLICY_FWD;
1171 }
1172}
1173
fe1a5f03 1174static struct flow_cache_object *
dee9f4bc 1175xfrm_policy_lookup(struct net *net, const struct flowi *fl, u16 family,
fe1a5f03 1176 u8 dir, struct flow_cache_object *old_obj, void *ctx)
4e81bb83
MN		 1177{
1178 struct xfrm_policy *pol;
fe1a5f03
TT		 1179
1180 if (old_obj)
1181 xfrm_pol_put(container_of(old_obj, struct xfrm_policy, flo));
4e81bb83 1182
b5fb82c4 1183 pol = __xfrm_policy_lookup(net, fl, family, flow_to_policy_dir(dir));
80c802f3 1184 if (IS_ERR_OR_NULL(pol))
fe1a5f03 1185 return ERR_CAST(pol);
fe1a5f03 1186
fe1a5f03
TT		 1187 /* Resolver returns two references:
1188 * one for cache and one for caller of flow_cache_lookup() */
1189 xfrm_pol_hold(pol);
1190
1191 return &pol->flo;
1da177e4
LT		 1192}
1193
df71837d
TJ		 1194static inline int policy_to_flow_dir(int dir)
1195{
1196 if (XFRM_POLICY_IN == FLOW_DIR_IN &&
a716c119
YH		 1197 XFRM_POLICY_OUT == FLOW_DIR_OUT &&
1198 XFRM_POLICY_FWD == FLOW_DIR_FWD)
1199 return dir;
1200 switch (dir) {
1201 default:
1202 case XFRM_POLICY_IN:
1203 return FLOW_DIR_IN;
1204 case XFRM_POLICY_OUT:
1205 return FLOW_DIR_OUT;
1206 case XFRM_POLICY_FWD:
1207 return FLOW_DIR_FWD;
3ff50b79 1208 }
df71837d
TJ		 1209}
1210
dee9f4bc
DM		 1211static struct xfrm_policy *xfrm_sk_policy_lookup(struct sock *sk, int dir,
1212 const struct flowi *fl)
1da177e4
LT		 1213{
1214 struct xfrm_policy *pol;
283bc9f3 1215 struct net *net = sock_net(sk);
1da177e4 1216
283bc9f3 1217 read_lock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4 1218 if ((pol = sk->sk_policy[dir]) != NULL) {
bc9b35ad
DM		 1219 bool match = xfrm_selector_match(&pol->selector, fl,
1220 sk->sk_family);
a716c119 1221 int err = 0;
df71837d 1222
3bccfbc7 1223 if (match) {
34f8d884
JHS		 1224 if ((sk->sk_mark & pol->mark.m) != pol->mark.v) {
1225 pol = NULL;
1226 goto out;
1227 }
03e1ad7b 1228 err = security_xfrm_policy_lookup(pol->security,
1d28f42c 1229 fl->flowi_secid,
03e1ad7b 1230 policy_to_flow_dir(dir));
3bccfbc7
VY		 1231 if (!err)
1232 xfrm_pol_hold(pol);
1233 else if (err == -ESRCH)
1234 pol = NULL;
1235 else
1236 pol = ERR_PTR(err);
1237 } else
1da177e4
LT		 1238 pol = NULL;
1239 }
34f8d884 1240out:
283bc9f3 1241 read_unlock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4
LT		 1242 return pol;
1243}
1244
1245static void __xfrm_policy_link(struct xfrm_policy *pol, int dir)
1246{
98806f75 1247 struct net *net = xp_net(pol);
4e81bb83 1248
98806f75 1249 list_add(&pol->walk.all, &net->xfrm.policy_all);
98806f75 1250 net->xfrm.policy_count[dir]++;
1da177e4
LT		 1251 xfrm_pol_hold(pol);
1252}
1253
1254static struct xfrm_policy *__xfrm_policy_unlink(struct xfrm_policy *pol,
1255 int dir)
1256{
98806f75
AD		 1257 struct net *net = xp_net(pol);
1258
53c2e285 1259 if (list_empty(&pol->walk.all))
2518c7c2 1260 return NULL;
1da177e4 1261
53c2e285
HX		 1262 /* Socket policies are not hashed. */
1263 if (!hlist_unhashed(&pol->bydst)) {
1264 hlist_del(&pol->bydst);
1265 hlist_del(&pol->byidx);
1266 }
1267
1268 list_del_init(&pol->walk.all);
98806f75 1269 net->xfrm.policy_count[dir]--;
2518c7c2
DM		 1270
1271 return pol;
1da177e4
LT		 1272}
1273
53c2e285
HX		 1274static void xfrm_sk_policy_link(struct xfrm_policy *pol, int dir)
1275{
1276 __xfrm_policy_link(pol, XFRM_POLICY_MAX + dir);
1277}
1278
1279static void xfrm_sk_policy_unlink(struct xfrm_policy *pol, int dir)
1280{
1281 __xfrm_policy_unlink(pol, XFRM_POLICY_MAX + dir);
1282}
1283
4666faab 1284int xfrm_policy_delete(struct xfrm_policy *pol, int dir)
1da177e4 1285{
283bc9f3
FD		 1286 struct net *net = xp_net(pol);
1287
1288 write_lock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4 1289 pol = __xfrm_policy_unlink(pol, dir);
283bc9f3 1290 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4 1291 if (pol) {
1da177e4 1292 xfrm_policy_kill(pol);
4666faab 1293 return 0;
1da177e4 1294 }
4666faab 1295 return -ENOENT;
1da177e4 1296}
a70fcb0b 1297EXPORT_SYMBOL(xfrm_policy_delete);
1da177e4
LT		 1298
1299int xfrm_sk_policy_insert(struct sock *sk, int dir, struct xfrm_policy *pol)
1300{
1121994c 1301 struct net *net = xp_net(pol);
1da177e4
LT		 1302 struct xfrm_policy *old_pol;
1303
4e81bb83
MN		 1304#ifdef CONFIG_XFRM_SUB_POLICY
1305 if (pol && pol->type != XFRM_POLICY_TYPE_MAIN)
1306 return -EINVAL;
1307#endif
1308
283bc9f3 1309 write_lock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4
LT		 1310 old_pol = sk->sk_policy[dir];
1311 sk->sk_policy[dir] = pol;
1312 if (pol) {
9d729f72 1313 pol->curlft.add_time = get_seconds();
e682adf0 1314 pol->index = xfrm_gen_index(net, XFRM_POLICY_MAX+dir, 0);
53c2e285 1315 xfrm_sk_policy_link(pol, dir);
1da177e4 1316 }
a0073fe1
SK		 1317 if (old_pol) {
1318 if (pol)
1319 xfrm_policy_requeue(old_pol, pol);
1320
ea2dea9d
TT		 1321 /* Unlinking succeeds always. This is the only function
1322 * allowed to delete or replace socket policy.
1323 */
53c2e285 1324 xfrm_sk_policy_unlink(old_pol, dir);
a0073fe1 1325 }
283bc9f3 1326 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4
LT		 1327
1328 if (old_pol) {
1329 xfrm_policy_kill(old_pol);
1330 }
1331 return 0;
1332}
1333
d3e40a9f 1334static struct xfrm_policy *clone_policy(const struct xfrm_policy *old, int dir)
1da177e4 1335{
0331b1f3 1336 struct xfrm_policy *newp = xfrm_policy_alloc(xp_net(old), GFP_ATOMIC);
283bc9f3 1337 struct net *net = xp_net(old);
1da177e4
LT		 1338
1339 if (newp) {
1340 newp->selector = old->selector;
03e1ad7b
PM		 1341 if (security_xfrm_policy_clone(old->security,
1342 &newp->security)) {
df71837d
TJ		 1343 kfree(newp);
1344 return NULL; /* ENOMEM */
1345 }
1da177e4
LT		 1346 newp->lft = old->lft;
1347 newp->curlft = old->curlft;
fb977e2c 1348 newp->mark = old->mark;
1da177e4
LT		 1349 newp->action = old->action;
1350 newp->flags = old->flags;
1351 newp->xfrm_nr = old->xfrm_nr;
1352 newp->index = old->index;
4e81bb83 1353 newp->type = old->type;
1da177e4
LT		 1354 memcpy(newp->xfrm_vec, old->xfrm_vec,
1355 newp->xfrm_nr*sizeof(struct xfrm_tmpl));
283bc9f3 1356 write_lock_bh(&net->xfrm.xfrm_policy_lock);
53c2e285 1357 xfrm_sk_policy_link(newp, dir);
283bc9f3 1358 write_unlock_bh(&net->xfrm.xfrm_policy_lock);
1da177e4
LT		 1359 xfrm_pol_put(newp);
1360 }
1361 return newp;
1362}
1363
1364int __xfrm_sk_clone_policy(struct sock *sk)
1365{
1366 struct xfrm_policy *p0 = sk->sk_policy[0],
1367 *p1 = sk->sk_policy[1];
1368
1369 sk->sk_policy[0] = sk->sk_policy[1] = NULL;
1370 if (p0 && (sk->sk_policy[0] = clone_policy(p0, 0)) == NULL)
1371 return -ENOMEM;
1372 if (p1 && (sk->sk_policy[1] = clone_policy(p1, 1)) == NULL)
1373 return -ENOMEM;
1374 return 0;
1375}
1376
a1e59abf 1377static int
42a7b32b
DA		 1378xfrm_get_saddr(struct net *net, int oif, xfrm_address_t *local,
1379 xfrm_address_t *remote, unsigned short family)
a1e59abf
PM		 1380{
1381 int err;
1382 struct xfrm_policy_afinfo *afinfo = xfrm_policy_get_afinfo(family);
1383
1384 if (unlikely(afinfo == NULL))
1385 return -EINVAL;
42a7b32b 1386 err = afinfo->get_saddr(net, oif, local, remote);
a1e59abf
PM		 1387 xfrm_policy_put_afinfo(afinfo);
1388 return err;
1389}
1390
1da177e4
LT		 1391/* Resolve list of templates for the flow, given policy. */
1392
1393static int
a6c2e611
DM		 1394xfrm_tmpl_resolve_one(struct xfrm_policy *policy, const struct flowi *fl,
1395 struct xfrm_state **xfrm, unsigned short family)
1da177e4 1396{
fbda33b2 1397 struct net *net = xp_net(policy);
1da177e4
LT		 1398 int nx;
1399 int i, error;
1400 xfrm_address_t *daddr = xfrm_flowi_daddr(fl, family);
1401 xfrm_address_t *saddr = xfrm_flowi_saddr(fl, family);
a1e59abf 1402 xfrm_address_t tmp;
1da177e4 1403
9b7a787d 1404 for (nx = 0, i = 0; i < policy->xfrm_nr; i++) {
1da177e4
LT		 1405 struct xfrm_state *x;
1406 xfrm_address_t *remote = daddr;
1407 xfrm_address_t *local = saddr;
1408 struct xfrm_tmpl *tmpl = &policy->xfrm_vec[i];
1409
48b8d783
JK		 1410 if (tmpl->mode == XFRM_MODE_TUNNEL ||
1411 tmpl->mode == XFRM_MODE_BEET) {
1da177e4
LT		 1412 remote = &tmpl->id.daddr;
1413 local = &tmpl->saddr;
8444cf71 1414 if (xfrm_addr_any(local, tmpl->encap_family)) {
42a7b32b
DA		 1415 error = xfrm_get_saddr(net, fl->flowi_oif,
1416 &tmp, remote,
1417 tmpl->encap_family);
a1e59abf
PM		 1418 if (error)
1419 goto fail;
1420 local = &tmp;
1421 }
1da177e4
LT		 1422 }
1423
1424 x = xfrm_state_find(remote, local, fl, tmpl, policy, &error, family);
1425
1426 if (x && x->km.state == XFRM_STATE_VALID) {
1427 xfrm[nx++] = x;
1428 daddr = remote;
1429 saddr = local;
1430 continue;
1431 }
1432 if (x) {
1433 error = (x->km.state == XFRM_STATE_ERROR ?
1434 -EINVAL : -EAGAIN);
1435 xfrm_state_put(x);
42054569 1436 } else if (error == -ESRCH) {
a4322266 1437 error = -EAGAIN;
42054569 1438 }
1da177e4
LT		 1439
1440 if (!tmpl->optional)
1441 goto fail;
1442 }
1443 return nx;
1444
1445fail:
9b7a787d 1446 for (nx--; nx >= 0; nx--)
1da177e4
LT		 1447 xfrm_state_put(xfrm[nx]);
1448 return error;
1449}
1450
4e81bb83 1451static int
a6c2e611
DM		 1452xfrm_tmpl_resolve(struct xfrm_policy **pols, int npols, const struct flowi *fl,
1453 struct xfrm_state **xfrm, unsigned short family)
4e81bb83 1454{
41a49cc3
MN		 1455 struct xfrm_state *tp[XFRM_MAX_DEPTH];
1456 struct xfrm_state **tpp = (npols > 1) ? tp : xfrm;
4e81bb83
MN		 1457 int cnx = 0;
1458 int error;
1459 int ret;
1460 int i;
1461
1462 for (i = 0; i < npols; i++) {
1463 if (cnx + pols[i]->xfrm_nr >= XFRM_MAX_DEPTH) {
1464 error = -ENOBUFS;
1465 goto fail;
1466 }
41a49cc3
MN		 1467
1468 ret = xfrm_tmpl_resolve_one(pols[i], fl, &tpp[cnx], family);
4e81bb83
MN		 1469 if (ret < 0) {
1470 error = ret;
1471 goto fail;
1472 } else
1473 cnx += ret;
1474 }
1475
41a49cc3
MN		 1476 /* found states are sorted for outbound processing */
1477 if (npols > 1)
1478 xfrm_state_sort(xfrm, tpp, cnx, family);
1479
4e81bb83
MN		 1480 return cnx;
1481
1482 fail:
9b7a787d 1483 for (cnx--; cnx >= 0; cnx--)
41a49cc3 1484 xfrm_state_put(tpp[cnx]);
4e81bb83
MN		 1485 return error;
1486
1487}
1488
1da177e4
LT		 1489/* Check that the bundle accepts the flow and its components are
1490 * still valid.
1491 */
1492
05d84025 1493static inline int xfrm_get_tos(const struct flowi *fl, int family)
25ee3286
HX		 1494{
1495 struct xfrm_policy_afinfo *afinfo = xfrm_policy_get_afinfo(family);
1496 int tos;
1da177e4 1497
25ee3286
HX		 1498 if (!afinfo)
1499 return -EINVAL;
1500
1501 tos = afinfo->get_tos(fl);
1502
1503 xfrm_policy_put_afinfo(afinfo);
1504
1505 return tos;
1506}
1507
80c802f3
TT		 1508static struct flow_cache_object *xfrm_bundle_flo_get(struct flow_cache_object *flo)
1509{
1510 struct xfrm_dst *xdst = container_of(flo, struct xfrm_dst, flo);
1511 struct dst_entry *dst = &xdst->u.dst;
1512
1513 if (xdst->route == NULL) {
1514 /* Dummy bundle - if it has xfrms we were not
1515 * able to build bundle as template resolution failed.
1516 * It means we need to try again resolving. */
1517 if (xdst->num_xfrms > 0)
1518 return NULL;
a0073fe1
SK		 1519 } else if (dst->flags & DST_XFRM_QUEUE) {
1520 return NULL;
80c802f3
TT		 1521 } else {
1522 /* Real bundle */
1523 if (stale_bundle(dst))
1524 return NULL;
1525 }
1526
1527 dst_hold(dst);
1528 return flo;
1529}
1530
1531static int xfrm_bundle_flo_check(struct flow_cache_object *flo)
1532{
1533 struct xfrm_dst *xdst = container_of(flo, struct xfrm_dst, flo);
1534 struct dst_entry *dst = &xdst->u.dst;
1535
1536 if (!xdst->route)
1537 return 0;
1538 if (stale_bundle(dst))
1539 return 0;
1540
1541 return 1;
1542}
1543
1544static void xfrm_bundle_flo_delete(struct flow_cache_object *flo)
1545{
1546 struct xfrm_dst *xdst = container_of(flo, struct xfrm_dst, flo);
1547 struct dst_entry *dst = &xdst->u.dst;
1548
1549 dst_free(dst);
1550}
1551
1552static const struct flow_cache_ops xfrm_bundle_fc_ops = {
1553 .get = xfrm_bundle_flo_get,
1554 .check = xfrm_bundle_flo_check,
1555 .delete = xfrm_bundle_flo_delete,
1556};
1557
d7c7544c 1558static inline struct xfrm_dst *xfrm_alloc_dst(struct net *net, int family)
1da177e4 1559{
1da177e4 1560 struct xfrm_policy_afinfo *afinfo = xfrm_policy_get_afinfo(family);
d7c7544c 1561 struct dst_ops *dst_ops;
25ee3286
HX		 1562 struct xfrm_dst *xdst;
1563
1564 if (!afinfo)
1565 return ERR_PTR(-EINVAL);
1566
d7c7544c
AD		 1567 switch (family) {
1568 case AF_INET:
1569 dst_ops = &net->xfrm.xfrm4_dst_ops;
1570 break;
dfd56b8b 1571#if IS_ENABLED(CONFIG_IPV6)
d7c7544c
AD		 1572 case AF_INET6:
1573 dst_ops = &net->xfrm.xfrm6_dst_ops;
1574 break;
1575#endif
1576 default:
1577 BUG();
1578 }
f5b0a874 1579 xdst = dst_alloc(dst_ops, NULL, 0, DST_OBSOLETE_NONE, 0);
25ee3286 1580
d4cae562 1581 if (likely(xdst)) {
141e369d
SK		 1582 struct dst_entry *dst = &xdst->u.dst;
1583
1584 memset(dst + 1, 0, sizeof(*xdst) - sizeof(*dst));
0b150932 1585 xdst->flo.ops = &xfrm_bundle_fc_ops;
9d7b0fc1
PM		 1586 if (afinfo->init_dst)
1587 afinfo->init_dst(net, xdst);
d4cae562 1588 } else
0b150932 1589 xdst = ERR_PTR(-ENOBUFS);
80c802f3 1590
d4cae562
MB		 1591 xfrm_policy_put_afinfo(afinfo);
1592
25ee3286
HX		 1593 return xdst;
1594}
1595
a1b05140
MN		 1596static inline int xfrm_init_path(struct xfrm_dst *path, struct dst_entry *dst,
1597 int nfheader_len)
1598{
1599 struct xfrm_policy_afinfo *afinfo =
1600 xfrm_policy_get_afinfo(dst->ops->family);
1601 int err;
1602
1603 if (!afinfo)
1604 return -EINVAL;
1605
1606 err = afinfo->init_path(path, dst, nfheader_len);
1607
1608 xfrm_policy_put_afinfo(afinfo);
1609
1610 return err;
1611}
1612
87c1e12b 1613static inline int xfrm_fill_dst(struct xfrm_dst *xdst, struct net_device *dev,
0c7b3eef 1614 const struct flowi *fl)
25ee3286
HX		 1615{
1616 struct xfrm_policy_afinfo *afinfo =
1617 xfrm_policy_get_afinfo(xdst->u.dst.ops->family);
1618 int err;
1619
1620 if (!afinfo)
1da177e4 1621 return -EINVAL;
25ee3286 1622
87c1e12b 1623 err = afinfo->fill_dst(xdst, dev, fl);
25ee3286 1624
1da177e4 1625 xfrm_policy_put_afinfo(afinfo);
25ee3286 1626
1da177e4
LT		 1627 return err;
1628}
1629
80c802f3 1630
25ee3286
HX		 1631/* Allocate chain of dst_entry's, attach known xfrm's, calculate
1632 * all the metrics... Shortly, bundle a bundle.
1633 */
1634
1635static struct dst_entry *xfrm_bundle_create(struct xfrm_policy *policy,
1636 struct xfrm_state **xfrm, int nx,
98313ada 1637 const struct flowi *fl,
25ee3286
HX		 1638 struct dst_entry *dst)
1639{
d7c7544c 1640 struct net *net = xp_net(policy);
25ee3286
HX		 1641 unsigned long now = jiffies;
1642 struct net_device *dev;
43a4dea4 1643 struct xfrm_mode *inner_mode;
25ee3286
HX		 1644 struct dst_entry *dst_prev = NULL;
1645 struct dst_entry *dst0 = NULL;
1646 int i = 0;
1647 int err;
1648 int header_len = 0;
a1b05140 1649 int nfheader_len = 0;
25ee3286
HX		 1650 int trailer_len = 0;
1651 int tos;
1652 int family = policy->selector.family;
9bb182a7
YH		 1653 xfrm_address_t saddr, daddr;
1654
1655 xfrm_flowi_addr_get(fl, &saddr, &daddr, family);
25ee3286
HX		 1656
1657 tos = xfrm_get_tos(fl, family);
1658 err = tos;
1659 if (tos < 0)
1660 goto put_states;
1661
1662 dst_hold(dst);
1663
1664 for (; i < nx; i++) {
d7c7544c 1665 struct xfrm_dst *xdst = xfrm_alloc_dst(net, family);
25ee3286
HX		 1666 struct dst_entry *dst1 = &xdst->u.dst;
1667
1668 err = PTR_ERR(xdst);
1669 if (IS_ERR(xdst)) {
1670 dst_release(dst);
1671 goto put_states;
1672 }
1673
43a4dea4
SK		 1674 if (xfrm[i]->sel.family == AF_UNSPEC) {
1675 inner_mode = xfrm_ip2inner_mode(xfrm[i],
1676 xfrm_af2proto(family));
1677 if (!inner_mode) {
1678 err = -EAFNOSUPPORT;
1679 dst_release(dst);
1680 goto put_states;
1681 }
1682 } else
1683 inner_mode = xfrm[i]->inner_mode;
1684
25ee3286
HX		 1685 if (!dst_prev)
1686 dst0 = dst1;
1687 else {
1688 dst_prev->child = dst_clone(dst1);
1689 dst1->flags |= DST_NOHASH;
1690 }
1691
1692 xdst->route = dst;
defb3519 1693 dst_copy_metrics(dst1, dst);
25ee3286
HX		 1694
1695 if (xfrm[i]->props.mode != XFRM_MODE_TRANSPORT) {
1696 family = xfrm[i]->props.family;
42a7b32b
DA		 1697 dst = xfrm_dst_lookup(xfrm[i], tos, fl->flowi_oif,
1698 &saddr, &daddr, family);
25ee3286
HX		 1699 err = PTR_ERR(dst);
1700 if (IS_ERR(dst))
1701 goto put_states;
1702 } else
1703 dst_hold(dst);
1704
1705 dst1->xfrm = xfrm[i];
80c802f3 1706 xdst->xfrm_genid = xfrm[i]->genid;
25ee3286 1707
f5b0a874 1708 dst1->obsolete = DST_OBSOLETE_FORCE_CHK;
25ee3286
HX		 1709 dst1->flags |= DST_HOST;
1710 dst1->lastuse = now;
1711
1712 dst1->input = dst_discard;
43a4dea4 1713 dst1->output = inner_mode->afinfo->output;
25ee3286
HX		 1714
1715 dst1->next = dst_prev;
1716 dst_prev = dst1;
1717
1718 header_len += xfrm[i]->props.header_len;
a1b05140
MN		 1719 if (xfrm[i]->type->flags & XFRM_TYPE_NON_FRAGMENT)
1720 nfheader_len += xfrm[i]->props.header_len;
25ee3286
HX		 1721 trailer_len += xfrm[i]->props.trailer_len;
1722 }
1723
1724 dst_prev->child = dst;
1725 dst0->path = dst;
1726
1727 err = -ENODEV;
1728 dev = dst->dev;
1729 if (!dev)
1730 goto free_dst;
1731
a1b05140 1732 xfrm_init_path((struct xfrm_dst *)dst0, dst, nfheader_len);
25ee3286
HX		 1733 xfrm_init_pmtu(dst_prev);
1734
1735 for (dst_prev = dst0; dst_prev != dst; dst_prev = dst_prev->child) {
1736 struct xfrm_dst *xdst = (struct xfrm_dst *)dst_prev;
1737
87c1e12b 1738 err = xfrm_fill_dst(xdst, dev, fl);
25ee3286
HX		 1739 if (err)
1740 goto free_dst;
1741
1742 dst_prev->header_len = header_len;
1743 dst_prev->trailer_len = trailer_len;
1744 header_len -= xdst->u.dst.xfrm->props.header_len;
1745 trailer_len -= xdst->u.dst.xfrm->props.trailer_len;
1746 }
1747
1748out:
1749 return dst0;
1750
1751put_states:
1752 for (; i < nx; i++)
1753 xfrm_state_put(xfrm[i]);
1754free_dst:
1755 if (dst0)
1756 dst_free(dst0);
1757 dst0 = ERR_PTR(err);
1758 goto out;
1759}
1760
da7c224b 1761#ifdef CONFIG_XFRM_SUB_POLICY
be7928d2 1762static int xfrm_dst_alloc_copy(void **target, const void *src, int size)
157bfc25
MN		 1763{
1764 if (!*target) {
1765 *target = kmalloc(size, GFP_ATOMIC);
1766 if (!*target)
1767 return -ENOMEM;
1768 }
be7928d2 1769
157bfc25
MN		 1770 memcpy(*target, src, size);
1771 return 0;
1772}
da7c224b 1773#endif
157bfc25 1774
be7928d2
DB		 1775static int xfrm_dst_update_parent(struct dst_entry *dst,
1776 const struct xfrm_selector *sel)
157bfc25
MN		 1777{
1778#ifdef CONFIG_XFRM_SUB_POLICY
1779 struct xfrm_dst *xdst = (struct xfrm_dst *)dst;
1780 return xfrm_dst_alloc_copy((void **)&(xdst->partner),
1781 sel, sizeof(*sel));
1782#else
1783 return 0;
1784#endif
1785}
1786
be7928d2
DB		 1787static int xfrm_dst_update_origin(struct dst_entry *dst,
1788 const struct flowi *fl)
157bfc25
MN		 1789{
1790#ifdef CONFIG_XFRM_SUB_POLICY
1791 struct xfrm_dst *xdst = (struct xfrm_dst *)dst;
1792 return xfrm_dst_alloc_copy((void **)&(xdst->origin), fl, sizeof(*fl));
1793#else
1794 return 0;
1795#endif
1796}
1da177e4 1797
73ff93cd 1798static int xfrm_expand_policies(const struct flowi *fl, u16 family,
80c802f3
TT		 1799 struct xfrm_policy **pols,
1800 int *num_pols, int *num_xfrms)
1801{
1802 int i;
1803
1804 if (*num_pols == 0 || !pols[0]) {
1805 *num_pols = 0;
1806 *num_xfrms = 0;
1807 return 0;
1808 }
1809 if (IS_ERR(pols[0]))
1810 return PTR_ERR(pols[0]);
1811
1812 *num_xfrms = pols[0]->xfrm_nr;
1813
1814#ifdef CONFIG_XFRM_SUB_POLICY
1815 if (pols[0] && pols[0]->action == XFRM_POLICY_ALLOW &&
1816 pols[0]->type != XFRM_POLICY_TYPE_MAIN) {
1817 pols[1] = xfrm_policy_lookup_bytype(xp_net(pols[0]),
1818 XFRM_POLICY_TYPE_MAIN,
1819 fl, family,
1820 XFRM_POLICY_OUT);
1821 if (pols[1]) {
1822 if (IS_ERR(pols[1])) {
1823 xfrm_pols_put(pols, *num_pols);
1824 return PTR_ERR(pols[1]);
1825 }
02d0892f 1826 (*num_pols)++;
80c802f3
TT		 1827 (*num_xfrms) += pols[1]->xfrm_nr;
1828 }
1829 }
1830#endif
1831 for (i = 0; i < *num_pols; i++) {
1832 if (pols[i]->action != XFRM_POLICY_ALLOW) {
1833 *num_xfrms = -1;
1834 break;
1835 }
1836 }
1837
1838 return 0;
1839
1840}
1841
1842static struct xfrm_dst *
1843xfrm_resolve_and_create_bundle(struct xfrm_policy **pols, int num_pols,
4ca2e685 1844 const struct flowi *fl, u16 family,
80c802f3
TT		 1845 struct dst_entry *dst_orig)
1846{
1847 struct net *net = xp_net(pols[0]);
1848 struct xfrm_state *xfrm[XFRM_MAX_DEPTH];
1849 struct dst_entry *dst;
1850 struct xfrm_dst *xdst;
1851 int err;
1852
1853 /* Try to instantiate a bundle */
1854 err = xfrm_tmpl_resolve(pols, num_pols, fl, xfrm, family);
d809ec89
TT		 1855 if (err <= 0) {
1856 if (err != 0 && err != -EAGAIN)
80c802f3
TT		 1857 XFRM_INC_STATS(net, LINUX_MIB_XFRMOUTPOLERROR);
1858 return ERR_PTR(err);
1859 }
1860
1861 dst = xfrm_bundle_create(pols[0], xfrm, err, fl, dst_orig);
1862 if (IS_ERR(dst)) {
1863 XFRM_INC_STATS(net, LINUX_MIB_XFRMOUTBUNDLEGENERROR);
1864 return ERR_CAST(dst);
1865 }
1866
1867 xdst = (struct xfrm_dst *)dst;
1868 xdst->num_xfrms = err;
1869 if (num_pols > 1)
1870 err = xfrm_dst_update_parent(dst, &pols[1]->selector);
1871 else
1872 err = xfrm_dst_update_origin(dst, fl);
1873 if (unlikely(err)) {
1874 dst_free(dst);
1875 XFRM_INC_STATS(net, LINUX_MIB_XFRMOUTBUNDLECHECKERROR);
1876 return ERR_PTR(err);
1877 }
1878
1879 xdst->num_pols = num_pols;
3e94c2dc 1880 memcpy(xdst->pols, pols, sizeof(struct xfrm_policy *) * num_pols);
80c802f3
TT		 1881 xdst->policy_genid = atomic_read(&pols[0]->genid);
1882
1883 return xdst;
1884}
1885
a0073fe1
SK		 1886static void xfrm_policy_queue_process(unsigned long arg)
1887{
a0073fe1
SK		 1888 struct sk_buff *skb;
1889 struct sock *sk;
1890 struct dst_entry *dst;
a0073fe1
SK		 1891 struct xfrm_policy *pol = (struct xfrm_policy *)arg;
1892 struct xfrm_policy_queue *pq = &pol->polq;
1893 struct flowi fl;
1894 struct sk_buff_head list;
1895
1896 spin_lock(&pq->hold_queue.lock);
1897 skb = skb_peek(&pq->hold_queue);
2bb53e25
SK		 1898 if (!skb) {
1899 spin_unlock(&pq->hold_queue.lock);
1900 goto out;
1901 }
a0073fe1
SK		 1902 dst = skb_dst(skb);
1903 sk = skb->sk;
1904 xfrm_decode_session(skb, &fl, dst->ops->family);
1905 spin_unlock(&pq->hold_queue.lock);
1906
1907 dst_hold(dst->path);
1908 dst = xfrm_lookup(xp_net(pol), dst->path, &fl,
1909 sk, 0);
1910 if (IS_ERR(dst))
1911 goto purge_queue;
1912
1913 if (dst->flags & DST_XFRM_QUEUE) {
1914 dst_release(dst);
1915
1916 if (pq->timeout >= XFRM_QUEUE_TMO_MAX)
1917 goto purge_queue;
1918
1919 pq->timeout = pq->timeout << 1;
e7d8f6cb
SK		 1920 if (!mod_timer(&pq->hold_timer, jiffies + pq->timeout))
1921 xfrm_pol_hold(pol);
1922 goto out;
a0073fe1
SK		 1923 }
1924
1925 dst_release(dst);
1926
1927 __skb_queue_head_init(&list);
1928
1929 spin_lock(&pq->hold_queue.lock);
1930 pq->timeout = 0;
1931 skb_queue_splice_init(&pq->hold_queue, &list);
1932 spin_unlock(&pq->hold_queue.lock);
1933
1934 while (!skb_queue_empty(&list)) {
1935 skb = __skb_dequeue(&list);
1936
1937 xfrm_decode_session(skb, &fl, skb_dst(skb)->ops->family);
1938 dst_hold(skb_dst(skb)->path);
1939 dst = xfrm_lookup(xp_net(pol), skb_dst(skb)->path,
1940 &fl, skb->sk, 0);
1941 if (IS_ERR(dst)) {
a0073fe1
SK		 1942 kfree_skb(skb);
1943 continue;
1944 }
1945
1946 nf_reset(skb);
1947 skb_dst_drop(skb);
1948 skb_dst_set(skb, dst);
1949
5c1e9f2c 1950 dst_output(skb);
a0073fe1
SK		 1951 }
1952
e7d8f6cb
SK		 1953out:
1954 xfrm_pol_put(pol);
a0073fe1
SK		 1955 return;
1956
1957purge_queue:
1958 pq->timeout = 0;
1ee5e667 1959 skb_queue_purge(&pq->hold_queue);
e7d8f6cb 1960 xfrm_pol_put(pol);
a0073fe1
SK		 1961}
1962
aad88724 1963static int xdst_queue_output(struct sock *sk, struct sk_buff *skb)
a0073fe1
SK		 1964{
1965 unsigned long sched_next;
1966 struct dst_entry *dst = skb_dst(skb);
1967 struct xfrm_dst *xdst = (struct xfrm_dst *) dst;
e7d8f6cb
SK		 1968 struct xfrm_policy *pol = xdst->pols[0];
1969 struct xfrm_policy_queue *pq = &pol->polq;
4d53eff4 1970
39bb5e62 1971 if (unlikely(skb_fclone_busy(sk, skb))) {
4d53eff4
SK		 1972 kfree_skb(skb);
1973 return 0;
1974 }
a0073fe1
SK		 1975
1976 if (pq->hold_queue.qlen > XFRM_MAX_QUEUE_LEN) {
1977 kfree_skb(skb);
1978 return -EAGAIN;
1979 }
1980
1981 skb_dst_force(skb);
a0073fe1
SK		 1982
1983 spin_lock_bh(&pq->hold_queue.lock);
1984
1985 if (!pq->timeout)
1986 pq->timeout = XFRM_QUEUE_TMO_MIN;
1987
1988 sched_next = jiffies + pq->timeout;
1989
1990 if (del_timer(&pq->hold_timer)) {
1991 if (time_before(pq->hold_timer.expires, sched_next))
1992 sched_next = pq->hold_timer.expires;
e7d8f6cb 1993 xfrm_pol_put(pol);
a0073fe1
SK		 1994 }
1995
1996 __skb_queue_tail(&pq->hold_queue, skb);
e7d8f6cb
SK		 1997 if (!mod_timer(&pq->hold_timer, sched_next))
1998 xfrm_pol_hold(pol);
a0073fe1
SK		 1999
2000 spin_unlock_bh(&pq->hold_queue.lock);
2001
2002 return 0;
2003}
2004
2005static struct xfrm_dst *xfrm_create_dummy_bundle(struct net *net,
b8c203b2 2006 struct xfrm_flo *xflo,
a0073fe1
SK		 2007 const struct flowi *fl,
2008 int num_xfrms,
2009 u16 family)
2010{
2011 int err;
2012 struct net_device *dev;
b8c203b2 2013 struct dst_entry *dst;
a0073fe1
SK		 2014 struct dst_entry *dst1;
2015 struct xfrm_dst *xdst;
2016
2017 xdst = xfrm_alloc_dst(net, family);
2018 if (IS_ERR(xdst))
2019 return xdst;
2020
b8c203b2
SK		 2021 if (!(xflo->flags & XFRM_LOOKUP_QUEUE) ||
2022 net->xfrm.sysctl_larval_drop ||
2023 num_xfrms <= 0)
a0073fe1
SK		 2024 return xdst;
2025
b8c203b2 2026 dst = xflo->dst_orig;
a0073fe1
SK		 2027 dst1 = &xdst->u.dst;
2028 dst_hold(dst);
2029 xdst->route = dst;
2030
2031 dst_copy_metrics(dst1, dst);
2032
2033 dst1->obsolete = DST_OBSOLETE_FORCE_CHK;
2034 dst1->flags |= DST_HOST | DST_XFRM_QUEUE;
2035 dst1->lastuse = jiffies;
2036
2037 dst1->input = dst_discard;
2038 dst1->output = xdst_queue_output;
2039
2040 dst_hold(dst);
2041 dst1->child = dst;
2042 dst1->path = dst;
2043
2044 xfrm_init_path((struct xfrm_dst *)dst1, dst, 0);
2045
2046 err = -ENODEV;
2047 dev = dst->dev;
2048 if (!dev)
2049 goto free_dst;
2050
2051 err = xfrm_fill_dst(xdst, dev, fl);
2052 if (err)
2053 goto free_dst;
2054
2055out:
2056 return xdst;
2057
2058free_dst:
2059 dst_release(dst1);
2060 xdst = ERR_PTR(err);
2061 goto out;
2062}
2063
80c802f3 2064static struct flow_cache_object *
dee9f4bc 2065xfrm_bundle_lookup(struct net *net, const struct flowi *fl, u16 family, u8 dir,
80c802f3
TT		 2066 struct flow_cache_object *oldflo, void *ctx)
2067{
b8c203b2 2068 struct xfrm_flo *xflo = (struct xfrm_flo *)ctx;
80c802f3
TT		 2069 struct xfrm_policy *pols[XFRM_POLICY_TYPE_MAX];
2070 struct xfrm_dst *xdst, *new_xdst;
2071 int num_pols = 0, num_xfrms = 0, i, err, pol_dead;
2072
2073 /* Check if the policies from old bundle are usable */
2074 xdst = NULL;
2075 if (oldflo) {
2076 xdst = container_of(oldflo, struct xfrm_dst, flo);
2077 num_pols = xdst->num_pols;
2078 num_xfrms = xdst->num_xfrms;
2079 pol_dead = 0;
2080 for (i = 0; i < num_pols; i++) {
2081 pols[i] = xdst->pols[i];
2082 pol_dead |= pols[i]->walk.dead;
2083 }
2084 if (pol_dead) {
2085 dst_free(&xdst->u.dst);
2086 xdst = NULL;
2087 num_pols = 0;
2088 num_xfrms = 0;
2089 oldflo = NULL;
2090 }
2091 }
2092
2093 /* Resolve policies to use if we couldn't get them from
2094 * previous cache entry */
2095 if (xdst == NULL) {
2096 num_pols = 1;
b5fb82c4
BZ		 2097 pols[0] = __xfrm_policy_lookup(net, fl, family,
2098 flow_to_policy_dir(dir));
80c802f3
TT		 2099 err = xfrm_expand_policies(fl, family, pols,
2100 &num_pols, &num_xfrms);
2101 if (err < 0)
2102 goto inc_error;
2103 if (num_pols == 0)
2104 return NULL;
2105 if (num_xfrms <= 0)
2106 goto make_dummy_bundle;
2107 }
2108
b8c203b2
SK		 2109 new_xdst = xfrm_resolve_and_create_bundle(pols, num_pols, fl, family,
2110 xflo->dst_orig);
80c802f3
TT		 2111 if (IS_ERR(new_xdst)) {
2112 err = PTR_ERR(new_xdst);
2113 if (err != -EAGAIN)
2114 goto error;
2115 if (oldflo == NULL)
2116 goto make_dummy_bundle;
2117 dst_hold(&xdst->u.dst);
2118 return oldflo;
d809ec89
TT		 2119 } else if (new_xdst == NULL) {
2120 num_xfrms = 0;
2121 if (oldflo == NULL)
2122 goto make_dummy_bundle;
2123 xdst->num_xfrms = 0;
2124 dst_hold(&xdst->u.dst);
2125 return oldflo;
80c802f3
TT		 2126 }
2127
2128 /* Kill the previous bundle */
2129 if (xdst) {
2130 /* The policies were stolen for newly generated bundle */
2131 xdst->num_pols = 0;
2132 dst_free(&xdst->u.dst);
2133 }
2134
2135 /* Flow cache does not have reference, it dst_free()'s,
2136 * but we do need to return one reference for original caller */
2137 dst_hold(&new_xdst->u.dst);
2138 return &new_xdst->flo;
2139
2140make_dummy_bundle:
2141 /* We found policies, but there's no bundles to instantiate:
2142 * either because the policy blocks, has no transformations or
2143 * we could not build template (no xfrm_states).*/
b8c203b2 2144 xdst = xfrm_create_dummy_bundle(net, xflo, fl, num_xfrms, family);
80c802f3
TT		 2145 if (IS_ERR(xdst)) {
2146 xfrm_pols_put(pols, num_pols);
2147 return ERR_CAST(xdst);
2148 }
2149 xdst->num_pols = num_pols;
2150 xdst->num_xfrms = num_xfrms;
3e94c2dc 2151 memcpy(xdst->pols, pols, sizeof(struct xfrm_policy *) * num_pols);
80c802f3
TT		 2152
2153 dst_hold(&xdst->u.dst);
2154 return &xdst->flo;
2155
2156inc_error:
2157 XFRM_INC_STATS(net, LINUX_MIB_XFRMOUTPOLERROR);
2158error:
2159 if (xdst != NULL)
2160 dst_free(&xdst->u.dst);
2161 else
2162 xfrm_pols_put(pols, num_pols);
2163 return ERR_PTR(err);
2164}
1da177e4 2165
2774c131
DM		 2166static struct dst_entry *make_blackhole(struct net *net, u16 family,
2167 struct dst_entry *dst_orig)
2168{
2169 struct xfrm_policy_afinfo *afinfo = xfrm_policy_get_afinfo(family);
2170 struct dst_entry *ret;
2171
2172 if (!afinfo) {
2173 dst_release(dst_orig);
433a1954 2174 return ERR_PTR(-EINVAL);
2774c131
DM		 2175 } else {
2176 ret = afinfo->blackhole_route(net, dst_orig);
2177 }
2178 xfrm_policy_put_afinfo(afinfo);
2179
2180 return ret;
2181}
2182
1da177e4
LT		 2183/* Main function: finds/creates a bundle for given flow.
2184 *
2185 * At the moment we eat a raw IP route. Mostly to speed up lookups
2186 * on interfaces with disabled IPsec.
2187 */
452edd59
DM		 2188struct dst_entry *xfrm_lookup(struct net *net, struct dst_entry *dst_orig,
2189 const struct flowi *fl,
2190 struct sock *sk, int flags)
1da177e4 2191{
4e81bb83 2192 struct xfrm_policy *pols[XFRM_POLICY_TYPE_MAX];
80c802f3
TT		 2193 struct flow_cache_object *flo;
2194 struct xfrm_dst *xdst;
452edd59 2195 struct dst_entry *dst, *route;
80c802f3 2196 u16 family = dst_orig->ops->family;
df71837d 2197 u8 dir = policy_to_flow_dir(XFRM_POLICY_OUT);
4b021628 2198 int i, err, num_pols, num_xfrms = 0, drop_pols = 0;
e0d1caa7 2199
80c802f3
TT		 2200 dst = NULL;
2201 xdst = NULL;
2202 route = NULL;
4e81bb83 2203
f7944fb1 2204 if (sk && sk->sk_policy[XFRM_POLICY_OUT]) {
80c802f3
TT		 2205 num_pols = 1;
2206 pols[0] = xfrm_sk_policy_lookup(sk, XFRM_POLICY_OUT, fl);
2207 err = xfrm_expand_policies(fl, family, pols,
2208 &num_pols, &num_xfrms);
2209 if (err < 0)
75b8c133 2210 goto dropdst;
80c802f3
TT		 2211
2212 if (num_pols) {
2213 if (num_xfrms <= 0) {
2214 drop_pols = num_pols;
2215 goto no_transform;
2216 }
2217
2218 xdst = xfrm_resolve_and_create_bundle(
2219 pols, num_pols, fl,
2220 family, dst_orig);
2221 if (IS_ERR(xdst)) {
2222 xfrm_pols_put(pols, num_pols);
2223 err = PTR_ERR(xdst);
2224 goto dropdst;
d809ec89
TT		 2225 } else if (xdst == NULL) {
2226 num_xfrms = 0;
2227 drop_pols = num_pols;
2228 goto no_transform;
80c802f3
TT		 2229 }
2230
b7eea454
SK		 2231 dst_hold(&xdst->u.dst);
2232 xdst->u.dst.flags |= DST_NOCACHE;
80c802f3 2233 route = xdst->route;
0aa64774 2234 }
3bccfbc7 2235 }
1da177e4 2236
80c802f3 2237 if (xdst == NULL) {
b8c203b2
SK		 2238 struct xfrm_flo xflo;
2239
2240 xflo.dst_orig = dst_orig;
2241 xflo.flags = flags;
2242
1da177e4 2243 /* To accelerate a bit... */
2518c7c2 2244 if ((dst_orig->flags & DST_NOXFRM) ||
52479b62 2245 !net->xfrm.policy_count[XFRM_POLICY_OUT])
8b7817f3 2246 goto nopol;
1da177e4 2247
80c802f3 2248 flo = flow_cache_lookup(net, fl, family, dir,
b8c203b2 2249 xfrm_bundle_lookup, &xflo);
80c802f3
TT		 2250 if (flo == NULL)
2251 goto nopol;
fe1a5f03 2252 if (IS_ERR(flo)) {
80c802f3 2253 err = PTR_ERR(flo);
75b8c133 2254 goto dropdst;
d66e37a9 2255 }
80c802f3
TT		 2256 xdst = container_of(flo, struct xfrm_dst, flo);
2257
2258 num_pols = xdst->num_pols;
2259 num_xfrms = xdst->num_xfrms;
3e94c2dc 2260 memcpy(pols, xdst->pols, sizeof(struct xfrm_policy *) * num_pols);
80c802f3
TT		 2261 route = xdst->route;
2262 }
2263
2264 dst = &xdst->u.dst;
2265 if (route == NULL && num_xfrms > 0) {
2266 /* The only case when xfrm_bundle_lookup() returns a
2267 * bundle with null route, is when the template could
2268 * not be resolved. It means policies are there, but
2269 * bundle could not be created, since we don't yet
2270 * have the xfrm_state's. We need to wait for KM to
2271 * negotiate new SA's or bail out with error.*/
2272 if (net->xfrm.sysctl_larval_drop) {
80c802f3 2273 XFRM_INC_STATS(net, LINUX_MIB_XFRMOUTNOSTATES);
ac37e251
W		 2274 err = -EREMOTE;
2275 goto error;
80c802f3 2276 }
80c802f3 2277
5b8ef341 2278 err = -EAGAIN;
80c802f3
TT		 2279
2280 XFRM_INC_STATS(net, LINUX_MIB_XFRMOUTNOSTATES);
2281 goto error;
1da177e4
LT		 2282 }
2283
80c802f3
TT		 2284no_transform:
2285 if (num_pols == 0)
8b7817f3 2286 goto nopol;
1da177e4 2287
80c802f3
TT		 2288 if ((flags & XFRM_LOOKUP_ICMP) &&
2289 !(pols[0]->flags & XFRM_POLICY_ICMP)) {
2290 err = -ENOENT;
8b7817f3 2291 goto error;
80c802f3 2292 }
8b7817f3 2293
80c802f3
TT		 2294 for (i = 0; i < num_pols; i++)
2295 pols[i]->curlft.use_time = get_seconds();
8b7817f3 2296
80c802f3 2297 if (num_xfrms < 0) {
1da177e4 2298 /* Prohibit the flow */
59c9940e 2299 XFRM_INC_STATS(net, LINUX_MIB_XFRMOUTPOLBLOCK);
e104411b
PM		 2300 err = -EPERM;
2301 goto error;
80c802f3
TT		 2302 } else if (num_xfrms > 0) {
2303 /* Flow transformed */
80c802f3
TT		 2304 dst_release(dst_orig);
2305 } else {
2306 /* Flow passes untransformed */
2307 dst_release(dst);
452edd59 2308 dst = dst_orig;
1da177e4 2309 }
80c802f3
TT		 2310ok:
2311 xfrm_pols_put(pols, drop_pols);
0c183379
G		 2312 if (dst && dst->xfrm &&
2313 dst->xfrm->props.mode == XFRM_MODE_TUNNEL)
2314 dst->flags |= DST_XFRM_TUNNEL;
452edd59 2315 return dst;
1da177e4 2316
80c802f3 2317nopol:
452edd59
DM		 2318 if (!(flags & XFRM_LOOKUP_ICMP)) {
2319 dst = dst_orig;
80c802f3 2320 goto ok;
452edd59 2321 }
80c802f3 2322 err = -ENOENT;
1da177e4 2323error:
80c802f3 2324 dst_release(dst);
75b8c133 2325dropdst:
ac37e251
W		 2326 if (!(flags & XFRM_LOOKUP_KEEP_DST_REF))
2327 dst_release(dst_orig);
80c802f3 2328 xfrm_pols_put(pols, drop_pols);
452edd59 2329 return ERR_PTR(err);
1da177e4
LT		 2330}
2331EXPORT_SYMBOL(xfrm_lookup);
2332
f92ee619
SK		 2333/* Callers of xfrm_lookup_route() must ensure a call to dst_output().
2334 * Otherwise we may send out blackholed packets.
2335 */
2336struct dst_entry *xfrm_lookup_route(struct net *net, struct dst_entry *dst_orig,
2337 const struct flowi *fl,
2338 struct sock *sk, int flags)
2339{
b8c203b2 2340 struct dst_entry *dst = xfrm_lookup(net, dst_orig, fl, sk,
ac37e251
W		 2341 flags | XFRM_LOOKUP_QUEUE |
2342 XFRM_LOOKUP_KEEP_DST_REF);
f92ee619
SK		 2343
2344 if (IS_ERR(dst) && PTR_ERR(dst) == -EREMOTE)
2345 return make_blackhole(net, dst_orig->ops->family, dst_orig);
2346
2347 return dst;
2348}
2349EXPORT_SYMBOL(xfrm_lookup_route);
2350
df0ba92a 2351static inline int
8f029de2 2352xfrm_secpath_reject(int idx, struct sk_buff *skb, const struct flowi *fl)
df0ba92a
MN		 2353{
2354 struct xfrm_state *x;
df0ba92a
MN		 2355
2356 if (!skb->sp || idx < 0 || idx >= skb->sp->len)
2357 return 0;
2358 x = skb->sp->xvec[idx];
2359 if (!x->type->reject)
2360 return 0;
1ecafede 2361 return x->type->reject(x, skb, fl);
df0ba92a
MN		 2362}
2363
1da177e4
LT		 2364/* When skb is transformed back to its "native" form, we have to
2365 * check policy restrictions. At the moment we make this in maximally
2366 * stupid way. Shame on me. :-) Of course, connected sockets must
2367 * have policy cached at them.
2368 */
2369
2370static inline int
7db454b9 2371xfrm_state_ok(const struct xfrm_tmpl *tmpl, const struct xfrm_state *x,
1da177e4
LT		 2372 unsigned short family)
2373{
2374 if (xfrm_state_kern(x))
928ba416 2375 return tmpl->optional && !xfrm_state_addr_cmp(tmpl, x, tmpl->encap_family);
1da177e4
LT		 2376 return x->id.proto == tmpl->id.proto &&
2377 (x->id.spi == tmpl->id.spi || !tmpl->id.spi) &&
2378 (x->props.reqid == tmpl->reqid || !tmpl->reqid) &&
2379 x->props.mode == tmpl->mode &&
c5d18e98 2380 (tmpl->allalgs || (tmpl->aalgos & (1<<x->props.aalgo)) ||
f3bd4840 2381 !(xfrm_id_proto_match(tmpl->id.proto, IPSEC_PROTO_ANY))) &&
7e49e6de
MN		 2382 !(x->props.mode != XFRM_MODE_TRANSPORT &&
2383 xfrm_state_addr_cmp(tmpl, x, family));
1da177e4
LT		 2384}
2385
df0ba92a
MN		 2386/*
2387 * 0 or more than 0 is returned when validation is succeeded (either bypass
2388 * because of optional transport mode, or next index of the mathced secpath
2389 * state with the template.
2390 * -1 is returned when no matching template is found.
2391 * Otherwise "-2 - errored_index" is returned.
2392 */
1da177e4 2393static inline int
22cccb7e 2394xfrm_policy_ok(const struct xfrm_tmpl *tmpl, const struct sec_path *sp, int start,
1da177e4
LT		 2395 unsigned short family)
2396{
2397 int idx = start;
2398
2399 if (tmpl->optional) {
7e49e6de 2400 if (tmpl->mode == XFRM_MODE_TRANSPORT)
1da177e4
LT		 2401 return start;
2402 } else
2403 start = -1;
2404 for (; idx < sp->len; idx++) {
dbe5b4aa 2405 if (xfrm_state_ok(tmpl, sp->xvec[idx], family))
1da177e4 2406 return ++idx;
df0ba92a
MN		 2407 if (sp->xvec[idx]->props.mode != XFRM_MODE_TRANSPORT) {
2408 if (start == -1)
2409 start = -2-idx;
1da177e4 2410 break;
df0ba92a 2411 }
1da177e4
LT		 2412 }
2413 return start;
2414}
2415
d5422efe
HX		 2416int __xfrm_decode_session(struct sk_buff *skb, struct flowi *fl,
2417 unsigned int family, int reverse)
1da177e4
LT		 2418{
2419 struct xfrm_policy_afinfo *afinfo = xfrm_policy_get_afinfo(family);
e0d1caa7 2420 int err;
1da177e4
LT		 2421
2422 if (unlikely(afinfo == NULL))
2423 return -EAFNOSUPPORT;
2424
d5422efe 2425 afinfo->decode_session(skb, fl, reverse);
1d28f42c 2426 err = security_xfrm_decode_session(skb, &fl->flowi_secid);
1da177e4 2427 xfrm_policy_put_afinfo(afinfo);
e0d1caa7 2428 return err;
1da177e4 2429}
d5422efe 2430EXPORT_SYMBOL(__xfrm_decode_session);
1da177e4 2431
9a7386ec 2432static inline int secpath_has_nontransport(const struct sec_path *sp, int k, int *idxp)
1da177e4
LT		 2433{
2434 for (; k < sp->len; k++) {
df0ba92a 2435 if (sp->xvec[k]->props.mode != XFRM_MODE_TRANSPORT) {
d1d9facf 2436 *idxp = k;
1da177e4 2437 return 1;
df0ba92a 2438 }
1da177e4
LT		 2439 }
2440
2441 return 0;
2442}
2443
a716c119 2444int __xfrm_policy_check(struct sock *sk, int dir, struct sk_buff *skb,
1da177e4
LT		 2445 unsigned short family)
2446{
f6e1e25d 2447 struct net *net = dev_net(skb->dev);
1da177e4 2448 struct xfrm_policy *pol;
4e81bb83
MN		 2449 struct xfrm_policy *pols[XFRM_POLICY_TYPE_MAX];
2450 int npols = 0;
2451 int xfrm_nr;
2452 int pi;
d5422efe 2453 int reverse;
1da177e4 2454 struct flowi fl;
d5422efe 2455 u8 fl_dir;
df0ba92a 2456 int xerr_idx = -1;
1da177e4 2457
d5422efe
HX		 2458 reverse = dir & ~XFRM_POLICY_MASK;
2459 dir &= XFRM_POLICY_MASK;
2460 fl_dir = policy_to_flow_dir(dir);
2461
0aa64774 2462 if (__xfrm_decode_session(skb, &fl, family, reverse) < 0) {
59c9940e 2463 XFRM_INC_STATS(net, LINUX_MIB_XFRMINHDRERROR);
1da177e4 2464 return 0;
0aa64774
MN		 2465 }
2466
eb9c7ebe 2467 nf_nat_decode_session(skb, &fl, family);
1da177e4
LT		 2468
2469 /* First, check used SA against their selectors. */
2470 if (skb->sp) {
2471 int i;
2472
9b7a787d 2473 for (i = skb->sp->len-1; i >= 0; i--) {
dbe5b4aa 2474 struct xfrm_state *x = skb->sp->xvec[i];
0aa64774 2475 if (!xfrm_selector_match(&x->sel, &fl, family)) {
59c9940e 2476 XFRM_INC_STATS(net, LINUX_MIB_XFRMINSTATEMISMATCH);
1da177e4 2477 return 0;
0aa64774 2478 }
1da177e4
LT		 2479 }
2480 }
2481
2482 pol = NULL;
3bccfbc7 2483 if (sk && sk->sk_policy[dir]) {
e0d1caa7 2484 pol = xfrm_sk_policy_lookup(sk, dir, &fl);
0aa64774 2485 if (IS_ERR(pol)) {
59c9940e 2486 XFRM_INC_STATS(net, LINUX_MIB_XFRMINPOLERROR);
3bccfbc7 2487 return 0;
0aa64774 2488 }
3bccfbc7 2489 }
1da177e4 2490
fe1a5f03
TT		 2491 if (!pol) {
2492 struct flow_cache_object *flo;
2493
2494 flo = flow_cache_lookup(net, &fl, family, fl_dir,
2495 xfrm_policy_lookup, NULL);
2496 if (IS_ERR_OR_NULL(flo))
2497 pol = ERR_CAST(flo);
2498 else
2499 pol = container_of(flo, struct xfrm_policy, flo);
2500 }
1da177e4 2501
0aa64774 2502 if (IS_ERR(pol)) {
59c9940e 2503 XFRM_INC_STATS(net, LINUX_MIB_XFRMINPOLERROR);
134b0fc5 2504 return 0;
0aa64774 2505 }
134b0fc5 2506
df0ba92a 2507 if (!pol) {
d1d9facf 2508 if (skb->sp && secpath_has_nontransport(skb->sp, 0, &xerr_idx)) {
df0ba92a 2509 xfrm_secpath_reject(xerr_idx, skb, &fl);
59c9940e 2510 XFRM_INC_STATS(net, LINUX_MIB_XFRMINNOPOLS);
df0ba92a
MN		 2511 return 0;
2512 }
2513 return 1;
2514 }
1da177e4 2515
9d729f72 2516 pol->curlft.use_time = get_seconds();
1da177e4 2517
4e81bb83 2518 pols[0] = pol;
02d0892f 2519 npols++;
4e81bb83
MN		 2520#ifdef CONFIG_XFRM_SUB_POLICY
2521 if (pols[0]->type != XFRM_POLICY_TYPE_MAIN) {
f6e1e25d 2522 pols[1] = xfrm_policy_lookup_bytype(net, XFRM_POLICY_TYPE_MAIN,
4e81bb83
MN		 2523 &fl, family,
2524 XFRM_POLICY_IN);
2525 if (pols[1]) {
0aa64774 2526 if (IS_ERR(pols[1])) {
59c9940e 2527 XFRM_INC_STATS(net, LINUX_MIB_XFRMINPOLERROR);
134b0fc5 2528 return 0;
0aa64774 2529 }
9d729f72 2530 pols[1]->curlft.use_time = get_seconds();
02d0892f 2531 npols++;
4e81bb83
MN		 2532 }
2533 }
2534#endif
2535
1da177e4
LT		 2536 if (pol->action == XFRM_POLICY_ALLOW) {
2537 struct sec_path *sp;
2538 static struct sec_path dummy;
4e81bb83 2539 struct xfrm_tmpl *tp[XFRM_MAX_DEPTH];
41a49cc3 2540 struct xfrm_tmpl *stp[XFRM_MAX_DEPTH];
4e81bb83
MN		 2541 struct xfrm_tmpl **tpp = tp;
2542 int ti = 0;
1da177e4
LT		 2543 int i, k;
2544
2545 if ((sp = skb->sp) == NULL)
2546 sp = &dummy;
2547
4e81bb83
MN		 2548 for (pi = 0; pi < npols; pi++) {
2549 if (pols[pi] != pol &&
0aa64774 2550 pols[pi]->action != XFRM_POLICY_ALLOW) {
59c9940e 2551 XFRM_INC_STATS(net, LINUX_MIB_XFRMINPOLBLOCK);
4e81bb83 2552 goto reject;
0aa64774
MN		 2553 }
2554 if (ti + pols[pi]->xfrm_nr >= XFRM_MAX_DEPTH) {
59c9940e 2555 XFRM_INC_STATS(net, LINUX_MIB_XFRMINBUFFERERROR);
4e81bb83 2556 goto reject_error;
0aa64774 2557 }
4e81bb83
MN		 2558 for (i = 0; i < pols[pi]->xfrm_nr; i++)
2559 tpp[ti++] = &pols[pi]->xfrm_vec[i];
2560 }
2561 xfrm_nr = ti;
41a49cc3 2562 if (npols > 1) {
283bc9f3 2563 xfrm_tmpl_sort(stp, tpp, xfrm_nr, family, net);
41a49cc3
MN		 2564 tpp = stp;
2565 }
4e81bb83 2566
1da177e4
LT		 2567 /* For each tunnel xfrm, find the first matching tmpl.
2568 * For each tmpl before that, find corresponding xfrm.
2569 * Order is _important_. Later we will implement
2570 * some barriers, but at the moment barriers
2571 * are implied between each two transformations.
2572 */
4e81bb83
MN		 2573 for (i = xfrm_nr-1, k = 0; i >= 0; i--) {
2574 k = xfrm_policy_ok(tpp[i], sp, k, family);
df0ba92a 2575 if (k < 0) {
d1d9facf
JM		 2576 if (k < -1)
2577 /* "-2 - errored_index" returned */
2578 xerr_idx = -(2+k);
59c9940e 2579 XFRM_INC_STATS(net, LINUX_MIB_XFRMINTMPLMISMATCH);
1da177e4 2580 goto reject;
df0ba92a 2581 }
1da177e4
LT		 2582 }
2583
0aa64774 2584 if (secpath_has_nontransport(sp, k, &xerr_idx)) {
59c9940e 2585 XFRM_INC_STATS(net, LINUX_MIB_XFRMINTMPLMISMATCH);
1da177e4 2586 goto reject;
0aa64774 2587 }
1da177e4 2588
4e81bb83 2589 xfrm_pols_put(pols, npols);
1da177e4
LT		 2590 return 1;
2591 }
59c9940e 2592 XFRM_INC_STATS(net, LINUX_MIB_XFRMINPOLBLOCK);
1da177e4
LT		 2593
2594reject:
df0ba92a 2595 xfrm_secpath_reject(xerr_idx, skb, &fl);
4e81bb83
MN		 2596reject_error:
2597 xfrm_pols_put(pols, npols);
1da177e4
LT		 2598 return 0;
2599}
2600EXPORT_SYMBOL(__xfrm_policy_check);
2601
2602int __xfrm_route_forward(struct sk_buff *skb, unsigned short family)
2603{
99a66657 2604 struct net *net = dev_net(skb->dev);
1da177e4 2605 struct flowi fl;
adf30907 2606 struct dst_entry *dst;
73137147 2607 int res = 1;
1da177e4 2608
0aa64774 2609 if (xfrm_decode_session(skb, &fl, family) < 0) {
72032fdb 2610 XFRM_INC_STATS(net, LINUX_MIB_XFRMFWDHDRERROR);
1da177e4 2611 return 0;
0aa64774 2612 }
1da177e4 2613
fafeeb6c 2614 skb_dst_force(skb);
adf30907 2615
b8c203b2 2616 dst = xfrm_lookup(net, skb_dst(skb), &fl, NULL, XFRM_LOOKUP_QUEUE);
452edd59 2617 if (IS_ERR(dst)) {
73137147 2618 res = 0;
452edd59
DM		 2619 dst = NULL;
2620 }
adf30907
ED		 2621 skb_dst_set(skb, dst);
2622 return res;
1da177e4
LT		 2623}
2624EXPORT_SYMBOL(__xfrm_route_forward);
2625
d49c73c7
DM		 2626/* Optimize later using cookies and generation ids. */
2627
1da177e4
LT		 2628static struct dst_entry *xfrm_dst_check(struct dst_entry *dst, u32 cookie)
2629{
d49c73c7 2630 /* Code (such as __xfrm4_bundle_create()) sets dst->obsolete
f5b0a874
DM		 2631 * to DST_OBSOLETE_FORCE_CHK to force all XFRM destinations to
2632 * get validated by dst_ops->check on every use. We do this
2633 * because when a normal route referenced by an XFRM dst is
2634 * obsoleted we do not go looking around for all parent
2635 * referencing XFRM dsts so that we can invalidate them. It
2636 * is just too much work. Instead we make the checks here on
2637 * every use. For example:
d49c73c7
DM		 2638 *
2639 * XFRM dst A --> IPv4 dst X
2640 *
2641 * X is the "xdst->route" of A (X is also the "dst->path" of A
2642 * in this example). If X is marked obsolete, "A" will not
2643 * notice. That's what we are validating here via the
2644 * stale_bundle() check.
2645 *
2646 * When a policy's bundle is pruned, we dst_free() the XFRM
f5b0a874
DM		 2647 * dst which causes it's ->obsolete field to be set to
2648 * DST_OBSOLETE_DEAD. If an XFRM dst has been pruned like
2649 * this, we want to force a new route lookup.
399c180a 2650 */
d49c73c7
DM		 2651 if (dst->obsolete < 0 && !stale_bundle(dst))
2652 return dst;
2653
1da177e4
LT		 2654 return NULL;
2655}
2656
2657static int stale_bundle(struct dst_entry *dst)
2658{
12fdb4d3 2659 return !xfrm_bundle_ok((struct xfrm_dst *)dst);
1da177e4
LT		 2660}
2661
aabc9761 2662void xfrm_dst_ifdown(struct dst_entry *dst, struct net_device *dev)
1da177e4 2663{
1da177e4 2664 while ((dst = dst->child) && dst->xfrm && dst->dev == dev) {
c346dca1 2665 dst->dev = dev_net(dev)->loopback_dev;
de3cb747 2666 dev_hold(dst->dev);
1da177e4
LT		 2667 dev_put(dev);
2668 }
2669}
aabc9761 2670EXPORT_SYMBOL(xfrm_dst_ifdown);
1da177e4
LT		 2671
2672static void xfrm_link_failure(struct sk_buff *skb)
2673{
2674 /* Impossible. Such dst must be popped before reaches point of failure. */
1da177e4
LT		 2675}
2676
2677static struct dst_entry *xfrm_negative_advice(struct dst_entry *dst)
2678{
2679 if (dst) {
2680 if (dst->obsolete) {
2681 dst_release(dst);
2682 dst = NULL;
2683 }
2684 }
2685 return dst;
2686}
2687
e4c17216 2688void xfrm_garbage_collect(struct net *net)
c0ed1c14 2689{
ca925cf1 2690 flow_cache_flush(net);
c0ed1c14 2691}
e4c17216 2692EXPORT_SYMBOL(xfrm_garbage_collect);
c0ed1c14
SK		 2693
2694static void xfrm_garbage_collect_deferred(struct net *net)
2695{
ca925cf1 2696 flow_cache_flush_deferred(net);
c0ed1c14
SK		 2697}
2698
25ee3286 2699static void xfrm_init_pmtu(struct dst_entry *dst)
1da177e4
LT		 2700{
2701 do {
2702 struct xfrm_dst *xdst = (struct xfrm_dst *)dst;
2703 u32 pmtu, route_mtu_cached;
2704
2705 pmtu = dst_mtu(dst->child);
2706 xdst->child_mtu_cached = pmtu;
2707
2708 pmtu = xfrm_state_mtu(dst->xfrm, pmtu);
2709
2710 route_mtu_cached = dst_mtu(xdst->route);
2711 xdst->route_mtu_cached = route_mtu_cached;
2712
2713 if (pmtu > route_mtu_cached)
2714 pmtu = route_mtu_cached;
2715
defb3519 2716 dst_metric_set(dst, RTAX_MTU, pmtu);
1da177e4
LT		 2717 } while ((dst = dst->next));
2718}
2719
1da177e4
LT		 2720/* Check that the bundle accepts the flow and its components are
2721 * still valid.
2722 */
2723
12fdb4d3 2724static int xfrm_bundle_ok(struct xfrm_dst *first)
1da177e4
LT		 2725{
2726 struct dst_entry *dst = &first->u.dst;
2727 struct xfrm_dst *last;
2728 u32 mtu;
2729
92d63dec 2730 if (!dst_check(dst->path, ((struct xfrm_dst *)dst)->path_cookie) ||
1da177e4
LT		 2731 (dst->dev && !netif_running(dst->dev)))
2732 return 0;
2733
a0073fe1
SK		 2734 if (dst->flags & DST_XFRM_QUEUE)
2735 return 1;
2736
1da177e4
LT		 2737 last = NULL;
2738
2739 do {
2740 struct xfrm_dst *xdst = (struct xfrm_dst *)dst;
2741
1da177e4
LT		 2742 if (dst->xfrm->km.state != XFRM_STATE_VALID)
2743 return 0;
80c802f3
TT		 2744 if (xdst->xfrm_genid != dst->xfrm->genid)
2745 return 0;
b1312c89
TT		 2746 if (xdst->num_pols > 0 &&
2747 xdst->policy_genid != atomic_read(&xdst->pols[0]->genid))
9d4a706d 2748 return 0;
e53820de 2749
1da177e4
LT		 2750 mtu = dst_mtu(dst->child);
2751 if (xdst->child_mtu_cached != mtu) {
2752 last = xdst;
2753 xdst->child_mtu_cached = mtu;
2754 }
2755
92d63dec 2756 if (!dst_check(xdst->route, xdst->route_cookie))
1da177e4
LT		 2757 return 0;
2758 mtu = dst_mtu(xdst->route);
2759 if (xdst->route_mtu_cached != mtu) {
2760 last = xdst;
2761 xdst->route_mtu_cached = mtu;
2762 }
2763
2764 dst = dst->child;
2765 } while (dst->xfrm);
2766
2767 if (likely(!last))
2768 return 1;
2769
2770 mtu = last->child_mtu_cached;
2771 for (;;) {
2772 dst = &last->u.dst;
2773
2774 mtu = xfrm_state_mtu(dst->xfrm, mtu);
2775 if (mtu > last->route_mtu_cached)
2776 mtu = last->route_mtu_cached;
defb3519 2777 dst_metric_set(dst, RTAX_MTU, mtu);
1da177e4
LT		 2778
2779 if (last == first)
2780 break;
2781
bd0bf076 2782 last = (struct xfrm_dst *)last->u.dst.next;
1da177e4
LT		 2783 last->child_mtu_cached = mtu;
2784 }
2785
2786 return 1;
2787}
2788
0dbaee3b
DM		 2789static unsigned int xfrm_default_advmss(const struct dst_entry *dst)
2790{
2791 return dst_metric_advmss(dst->path);
2792}
2793
ebb762f2 2794static unsigned int xfrm_mtu(const struct dst_entry *dst)
d33e4553 2795{
618f9bc7
SK		 2796 unsigned int mtu = dst_metric_raw(dst, RTAX_MTU);
2797
2798 return mtu ? : dst_mtu(dst->path);
d33e4553
DM		 2799}
2800
f894cbf8
DM		 2801static struct neighbour *xfrm_neigh_lookup(const struct dst_entry *dst,
2802 struct sk_buff *skb,
2803 const void *daddr)
d3aaeb38 2804{
f894cbf8 2805 return dst->path->ops->neigh_lookup(dst, skb, daddr);
d3aaeb38
DM		 2806}
2807
1da177e4
LT		 2808int xfrm_policy_register_afinfo(struct xfrm_policy_afinfo *afinfo)
2809{
d7c7544c 2810 struct net *net;
1da177e4
LT		 2811 int err = 0;
2812 if (unlikely(afinfo == NULL))
2813 return -EINVAL;
2814 if (unlikely(afinfo->family >= NPROTO))
2815 return -EAFNOSUPPORT;
ef8531b6 2816 spin_lock(&xfrm_policy_afinfo_lock);
1da177e4 2817 if (unlikely(xfrm_policy_afinfo[afinfo->family] != NULL))
f31e8d4f 2818 err = -EEXIST;
1da177e4
LT		 2819 else {
2820 struct dst_ops *dst_ops = afinfo->dst_ops;
2821 if (likely(dst_ops->kmem_cachep == NULL))
2822 dst_ops->kmem_cachep = xfrm_dst_cache;
2823 if (likely(dst_ops->check == NULL))
2824 dst_ops->check = xfrm_dst_check;
0dbaee3b
DM		 2825 if (likely(dst_ops->default_advmss == NULL))
2826 dst_ops->default_advmss = xfrm_default_advmss;
ebb762f2
SK		 2827 if (likely(dst_ops->mtu == NULL))
2828 dst_ops->mtu = xfrm_mtu;
1da177e4
LT		 2829 if (likely(dst_ops->negative_advice == NULL))
2830 dst_ops->negative_advice = xfrm_negative_advice;
2831 if (likely(dst_ops->link_failure == NULL))
2832 dst_ops->link_failure = xfrm_link_failure;
d3aaeb38
DM		 2833 if (likely(dst_ops->neigh_lookup == NULL))
2834 dst_ops->neigh_lookup = xfrm_neigh_lookup;
1da177e4 2835 if (likely(afinfo->garbage_collect == NULL))
c0ed1c14 2836 afinfo->garbage_collect = xfrm_garbage_collect_deferred;
418a99ac 2837 rcu_assign_pointer(xfrm_policy_afinfo[afinfo->family], afinfo);
1da177e4 2838 }
ef8531b6 2839 spin_unlock(&xfrm_policy_afinfo_lock);
d7c7544c
AD		 2840
2841 rtnl_lock();
2842 for_each_net(net) {
2843 struct dst_ops *xfrm_dst_ops;
2844
2845 switch (afinfo->family) {
2846 case AF_INET:
2847 xfrm_dst_ops = &net->xfrm.xfrm4_dst_ops;
2848 break;
dfd56b8b 2849#if IS_ENABLED(CONFIG_IPV6)
d7c7544c
AD		 2850 case AF_INET6:
2851 xfrm_dst_ops = &net->xfrm.xfrm6_dst_ops;
2852 break;
2853#endif
2854 default:
2855 BUG();
2856 }
2857 *xfrm_dst_ops = *afinfo->dst_ops;
2858 }
2859 rtnl_unlock();
2860
1da177e4
LT		 2861 return err;
2862}
2863EXPORT_SYMBOL(xfrm_policy_register_afinfo);
2864
2865int xfrm_policy_unregister_afinfo(struct xfrm_policy_afinfo *afinfo)
2866{
2867 int err = 0;
2868 if (unlikely(afinfo == NULL))
2869 return -EINVAL;
2870 if (unlikely(afinfo->family >= NPROTO))
2871 return -EAFNOSUPPORT;
ef8531b6 2872 spin_lock(&xfrm_policy_afinfo_lock);
1da177e4
LT		 2873 if (likely(xfrm_policy_afinfo[afinfo->family] != NULL)) {
2874 if (unlikely(xfrm_policy_afinfo[afinfo->family] != afinfo))
2875 err = -EINVAL;
ef8531b6
ED		 2876 else
2877 RCU_INIT_POINTER(xfrm_policy_afinfo[afinfo->family],
2878 NULL);
2879 }
2880 spin_unlock(&xfrm_policy_afinfo_lock);
2881 if (!err) {
2882 struct dst_ops *dst_ops = afinfo->dst_ops;
2883
2884 synchronize_rcu();
2885
2886 dst_ops->kmem_cachep = NULL;
2887 dst_ops->check = NULL;
2888 dst_ops->negative_advice = NULL;
2889 dst_ops->link_failure = NULL;
2890 afinfo->garbage_collect = NULL;
1da177e4 2891 }
1da177e4
LT		 2892 return err;
2893}
2894EXPORT_SYMBOL(xfrm_policy_unregister_afinfo);
2895
d7c7544c
AD		 2896static void __net_init xfrm_dst_ops_init(struct net *net)
2897{
2898 struct xfrm_policy_afinfo *afinfo;
2899
ef8531b6
ED		 2900 rcu_read_lock();
2901 afinfo = rcu_dereference(xfrm_policy_afinfo[AF_INET]);
d7c7544c
AD		 2902 if (afinfo)
2903 net->xfrm.xfrm4_dst_ops = *afinfo->dst_ops;
dfd56b8b 2904#if IS_ENABLED(CONFIG_IPV6)
ef8531b6 2905 afinfo = rcu_dereference(xfrm_policy_afinfo[AF_INET6]);
d7c7544c
AD		 2906 if (afinfo)
2907 net->xfrm.xfrm6_dst_ops = *afinfo->dst_ops;
2908#endif
418a99ac 2909 rcu_read_unlock();
546be240
HX		 2910}
2911
1da177e4
LT		 2912static int xfrm_dev_event(struct notifier_block *this, unsigned long event, void *ptr)
2913{
351638e7 2914 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
e9dc8653 2915
1da177e4
LT		 2916 switch (event) {
2917 case NETDEV_DOWN:
c0ed1c14 2918 xfrm_garbage_collect(dev_net(dev));
1da177e4
LT		 2919 }
2920 return NOTIFY_DONE;
2921}
2922
2923static struct notifier_block xfrm_dev_notifier = {
d5917a35 2924 .notifier_call = xfrm_dev_event,
1da177e4
LT		 2925};
2926
558f82ef 2927#ifdef CONFIG_XFRM_STATISTICS
59c9940e 2928static int __net_init xfrm_statistics_init(struct net *net)
558f82ef 2929{
c68cd1a0 2930 int rv;
698365fa
WC		 2931 net->mib.xfrm_statistics = alloc_percpu(struct linux_xfrm_mib);
2932 if (!net->mib.xfrm_statistics)
558f82ef 2933 return -ENOMEM;
c68cd1a0
AD		 2934 rv = xfrm_proc_init(net);
2935 if (rv < 0)
698365fa 2936 free_percpu(net->mib.xfrm_statistics);
c68cd1a0 2937 return rv;
558f82ef 2938}
59c9940e
AD		 2939
2940static void xfrm_statistics_fini(struct net *net)
2941{
c68cd1a0 2942 xfrm_proc_fini(net);
698365fa 2943 free_percpu(net->mib.xfrm_statistics);
59c9940e
AD		 2944}
2945#else
2946static int __net_init xfrm_statistics_init(struct net *net)
2947{
2948 return 0;
2949}
2950
2951static void xfrm_statistics_fini(struct net *net)
2952{
2953}
558f82ef
MN		 2954#endif
2955
d62ddc21 2956static int __net_init xfrm_policy_init(struct net *net)
1da177e4 2957{
2518c7c2
DM		 2958 unsigned int hmask, sz;
2959 int dir;
2960
d62ddc21
AD		 2961 if (net_eq(net, &init_net))
2962 xfrm_dst_cache = kmem_cache_create("xfrm_dst_cache",
1da177e4 2963 sizeof(struct xfrm_dst),
e5d679f3 2964 0, SLAB_HWCACHE_ALIGN|SLAB_PANIC,
20c2df83 2965 NULL);
1da177e4 2966
2518c7c2
DM		 2967 hmask = 8 - 1;
2968 sz = (hmask+1) * sizeof(struct hlist_head);
2969
93b851c1
AD		 2970 net->xfrm.policy_byidx = xfrm_hash_alloc(sz);
2971 if (!net->xfrm.policy_byidx)
2972 goto out_byidx;
8100bea7 2973 net->xfrm.policy_idx_hmask = hmask;
2518c7c2 2974
53c2e285 2975 for (dir = 0; dir < XFRM_POLICY_MAX; dir++) {
2518c7c2
DM		 2976 struct xfrm_policy_hash *htab;
2977
dc2caba7 2978 net->xfrm.policy_count[dir] = 0;
53c2e285 2979 net->xfrm.policy_count[XFRM_POLICY_MAX + dir] = 0;
8b18f8ea 2980 INIT_HLIST_HEAD(&net->xfrm.policy_inexact[dir]);
2518c7c2 2981
a35f6c5d 2982 htab = &net->xfrm.policy_bydst[dir];
44e36b42 2983 htab->table = xfrm_hash_alloc(sz);
2518c7c2 2984 if (!htab->table)
a35f6c5d
AD		 2985 goto out_bydst;
2986 htab->hmask = hmask;
b58555f1
CG		 2987 htab->dbits4 = 32;
2988 htab->sbits4 = 32;
2989 htab->dbits6 = 128;
2990 htab->sbits6 = 128;
2518c7c2 2991 }
880a6fab
CG		 2992 net->xfrm.policy_hthresh.lbits4 = 32;
2993 net->xfrm.policy_hthresh.rbits4 = 32;
2994 net->xfrm.policy_hthresh.lbits6 = 128;
2995 net->xfrm.policy_hthresh.rbits6 = 128;
2996
2997 seqlock_init(&net->xfrm.policy_hthresh.lock);
2518c7c2 2998
adfcf0b2 2999 INIT_LIST_HEAD(&net->xfrm.policy_all);
66caf628 3000 INIT_WORK(&net->xfrm.policy_hash_work, xfrm_hash_resize);
880a6fab 3001 INIT_WORK(&net->xfrm.policy_hthresh.work, xfrm_hash_rebuild);
d62ddc21
AD		 3002 if (net_eq(net, &init_net))
3003 register_netdevice_notifier(&xfrm_dev_notifier);
3004 return 0;
93b851c1 3005
a35f6c5d
AD		 3006out_bydst:
3007 for (dir--; dir >= 0; dir--) {
3008 struct xfrm_policy_hash *htab;
3009
3010 htab = &net->xfrm.policy_bydst[dir];
3011 xfrm_hash_free(htab->table, sz);
3012 }
3013 xfrm_hash_free(net->xfrm.policy_byidx, sz);
93b851c1
AD		 3014out_byidx:
3015 return -ENOMEM;
d62ddc21
AD		 3016}
3017
3018static void xfrm_policy_fini(struct net *net)
3019{
93b851c1 3020 unsigned int sz;
8b18f8ea 3021 int dir;
93b851c1 3022
7c2776ee
AD		 3023 flush_work(&net->xfrm.policy_hash_work);
3024#ifdef CONFIG_XFRM_SUB_POLICY
2e71029e 3025 xfrm_policy_flush(net, XFRM_POLICY_TYPE_SUB, false);
7c2776ee 3026#endif
2e71029e 3027 xfrm_policy_flush(net, XFRM_POLICY_TYPE_MAIN, false);
7c2776ee 3028
adfcf0b2 3029 WARN_ON(!list_empty(&net->xfrm.policy_all));
93b851c1 3030
53c2e285 3031 for (dir = 0; dir < XFRM_POLICY_MAX; dir++) {
a35f6c5d
AD		 3032 struct xfrm_policy_hash *htab;
3033
8b18f8ea 3034 WARN_ON(!hlist_empty(&net->xfrm.policy_inexact[dir]));
a35f6c5d
AD		 3035
3036 htab = &net->xfrm.policy_bydst[dir];
5b653b2a 3037 sz = (htab->hmask + 1) * sizeof(struct hlist_head);
a35f6c5d
AD		 3038 WARN_ON(!hlist_empty(htab->table));
3039 xfrm_hash_free(htab->table, sz);
8b18f8ea
AD		 3040 }
3041
8100bea7 3042 sz = (net->xfrm.policy_idx_hmask + 1) * sizeof(struct hlist_head);
93b851c1
AD		 3043 WARN_ON(!hlist_empty(net->xfrm.policy_byidx));
3044 xfrm_hash_free(net->xfrm.policy_byidx, sz);
1da177e4
LT		 3045}
3046
d62ddc21
AD		 3047static int __net_init xfrm_net_init(struct net *net)
3048{
3049 int rv;
3050
59c9940e
AD		 3051 rv = xfrm_statistics_init(net);
3052 if (rv < 0)
3053 goto out_statistics;
d62ddc21
AD		 3054 rv = xfrm_state_init(net);
3055 if (rv < 0)
3056 goto out_state;
3057 rv = xfrm_policy_init(net);
3058 if (rv < 0)
3059 goto out_policy;
d7c7544c 3060 xfrm_dst_ops_init(net);
b27aeadb
AD		 3061 rv = xfrm_sysctl_init(net);
3062 if (rv < 0)
3063 goto out_sysctl;
4a93f509
SK		 3064 rv = flow_cache_init(net);
3065 if (rv < 0)
3066 goto out;
283bc9f3
FD		 3067
3068 /* Initialize the per-net locks here */
3069 spin_lock_init(&net->xfrm.xfrm_state_lock);
3070 rwlock_init(&net->xfrm.xfrm_policy_lock);
283bc9f3
FD		 3071 mutex_init(&net->xfrm.xfrm_cfg_mutex);
3072
d62ddc21
AD		 3073 return 0;
3074
4a93f509
SK		 3075out:
3076 xfrm_sysctl_fini(net);
b27aeadb
AD		 3077out_sysctl:
3078 xfrm_policy_fini(net);
d62ddc21
AD		 3079out_policy:
3080 xfrm_state_fini(net);
3081out_state:
59c9940e
AD		 3082 xfrm_statistics_fini(net);
3083out_statistics:
d62ddc21
AD		 3084 return rv;
3085}
3086
3087static void __net_exit xfrm_net_exit(struct net *net)
3088{
4a93f509 3089 flow_cache_fini(net);
b27aeadb 3090 xfrm_sysctl_fini(net);
d62ddc21
AD		 3091 xfrm_policy_fini(net);
3092 xfrm_state_fini(net);
59c9940e 3093 xfrm_statistics_fini(net);
d62ddc21
AD		 3094}
3095
3096static struct pernet_operations __net_initdata xfrm_net_ops = {
3097 .init = xfrm_net_init,
3098 .exit = xfrm_net_exit,
3099};
3100
1da177e4
LT		 3101void __init xfrm_init(void)
3102{
d62ddc21 3103 register_pernet_subsys(&xfrm_net_ops);
1da177e4
LT		 3104 xfrm_input_init();
3105}
3106
ab5f5e8b 3107#ifdef CONFIG_AUDITSYSCALL
1486cbd7
IJ		 3108static void xfrm_audit_common_policyinfo(struct xfrm_policy *xp,
3109 struct audit_buffer *audit_buf)
ab5f5e8b 3110{
875179fa
PM		 3111 struct xfrm_sec_ctx *ctx = xp->security;
3112 struct xfrm_selector *sel = &xp->selector;
3113
3114 if (ctx)
ab5f5e8b 3115 audit_log_format(audit_buf, " sec_alg=%u sec_doi=%u sec_obj=%s",
875179fa 3116 ctx->ctx_alg, ctx->ctx_doi, ctx->ctx_str);
ab5f5e8b 3117
9b7a787d 3118 switch (sel->family) {
ab5f5e8b 3119 case AF_INET:
21454aaa 3120 audit_log_format(audit_buf, " src=%pI4", &sel->saddr.a4);
875179fa
PM		 3121 if (sel->prefixlen_s != 32)
3122 audit_log_format(audit_buf, " src_prefixlen=%d",
3123 sel->prefixlen_s);
21454aaa 3124 audit_log_format(audit_buf, " dst=%pI4", &sel->daddr.a4);
875179fa
PM		 3125 if (sel->prefixlen_d != 32)
3126 audit_log_format(audit_buf, " dst_prefixlen=%d",
3127 sel->prefixlen_d);
ab5f5e8b
JL		 3128 break;
3129 case AF_INET6:
5b095d98 3130 audit_log_format(audit_buf, " src=%pI6", sel->saddr.a6);
875179fa
PM		 3131 if (sel->prefixlen_s != 128)
3132 audit_log_format(audit_buf, " src_prefixlen=%d",
3133 sel->prefixlen_s);
5b095d98 3134 audit_log_format(audit_buf, " dst=%pI6", sel->daddr.a6);
875179fa
PM		 3135 if (sel->prefixlen_d != 128)
3136 audit_log_format(audit_buf, " dst_prefixlen=%d",
3137 sel->prefixlen_d);
ab5f5e8b
JL		 3138 break;
3139 }
3140}
3141
2e71029e 3142void xfrm_audit_policy_add(struct xfrm_policy *xp, int result, bool task_valid)
ab5f5e8b
JL		 3143{
3144 struct audit_buffer *audit_buf;
ab5f5e8b 3145
afeb14b4 3146 audit_buf = xfrm_audit_start("SPD-add");
ab5f5e8b
JL		 3147 if (audit_buf == NULL)
3148 return;
2e71029e 3149 xfrm_audit_helper_usrinfo(task_valid, audit_buf);
afeb14b4 3150 audit_log_format(audit_buf, " res=%u", result);
ab5f5e8b
JL		 3151 xfrm_audit_common_policyinfo(xp, audit_buf);
3152 audit_log_end(audit_buf);
3153}
3154EXPORT_SYMBOL_GPL(xfrm_audit_policy_add);
3155
68277acc 3156void xfrm_audit_policy_delete(struct xfrm_policy *xp, int result,
2e71029e 3157 bool task_valid)
ab5f5e8b
JL		 3158{
3159 struct audit_buffer *audit_buf;
ab5f5e8b 3160
afeb14b4 3161 audit_buf = xfrm_audit_start("SPD-delete");
ab5f5e8b
JL		 3162 if (audit_buf == NULL)
3163 return;
2e71029e 3164 xfrm_audit_helper_usrinfo(task_valid, audit_buf);
afeb14b4 3165 audit_log_format(audit_buf, " res=%u", result);
ab5f5e8b
JL		 3166 xfrm_audit_common_policyinfo(xp, audit_buf);
3167 audit_log_end(audit_buf);
3168}
3169EXPORT_SYMBOL_GPL(xfrm_audit_policy_delete);
3170#endif
3171
80c9abaa 3172#ifdef CONFIG_XFRM_MIGRATE
bc9b35ad
DM		 3173static bool xfrm_migrate_selector_match(const struct xfrm_selector *sel_cmp,
3174 const struct xfrm_selector *sel_tgt)
80c9abaa
SS		 3175{
3176 if (sel_cmp->proto == IPSEC_ULPROTO_ANY) {
3177 if (sel_tgt->family == sel_cmp->family &&
70e94e66
YH		 3178 xfrm_addr_equal(&sel_tgt->daddr, &sel_cmp->daddr,
3179 sel_cmp->family) &&
3180 xfrm_addr_equal(&sel_tgt->saddr, &sel_cmp->saddr,
3181 sel_cmp->family) &&
80c9abaa
SS		 3182 sel_tgt->prefixlen_d == sel_cmp->prefixlen_d &&
3183 sel_tgt->prefixlen_s == sel_cmp->prefixlen_s) {
bc9b35ad 3184 return true;
80c9abaa
SS		 3185 }
3186 } else {
3187 if (memcmp(sel_tgt, sel_cmp, sizeof(*sel_tgt)) == 0) {
bc9b35ad 3188 return true;
80c9abaa
SS		 3189 }
3190 }
bc9b35ad 3191 return false;
80c9abaa
SS		 3192}
3193
3e94c2dc
WC		 3194static struct xfrm_policy *xfrm_migrate_policy_find(const struct xfrm_selector *sel,
3195 u8 dir, u8 type, struct net *net)
80c9abaa
SS		 3196{
3197 struct xfrm_policy *pol, *ret = NULL;
80c9abaa
SS		 3198 struct hlist_head *chain;
3199 u32 priority = ~0U;
3200
283bc9f3 3201 read_lock_bh(&net->xfrm.xfrm_policy_lock); /*FIXME*/
8d549c4f 3202 chain = policy_hash_direct(net, &sel->daddr, &sel->saddr, sel->family, dir);
b67bfe0d 3203 hlist_for_each_entry(pol, chain, bydst) {
80c9abaa
SS		 3204 if (xfrm_migrate_selector_match(sel, &pol->selector) &&
3205 pol->type == type) {
3206 ret = pol;
3207 priority = ret->priority;
3208 break;
3209 }
3210 }
8d549c4f 3211 chain = &net->xfrm.policy_inexact[dir];
b67bfe0d 3212 hlist_for_each_entry(pol, chain, bydst) {
8faf491e
LR		 3213 if ((pol->priority >= priority) && ret)
3214 break;
3215
80c9abaa 3216 if (xfrm_migrate_selector_match(sel, &pol->selector) &&
8faf491e 3217 pol->type == type) {
80c9abaa
SS		 3218 ret = pol;
3219 break;
3220 }
3221 }
3222
586f2eb4 3223 xfrm_pol_hold(ret);
80c9abaa 3224
283bc9f3 3225 read_unlock_bh(&net->xfrm.xfrm_policy_lock);
80c9abaa
SS		 3226
3227 return ret;
3228}
3229
dd701754 3230static int migrate_tmpl_match(const struct xfrm_migrate *m, const struct xfrm_tmpl *t)
80c9abaa
SS		 3231{
3232 int match = 0;
3233
3234 if (t->mode == m->mode && t->id.proto == m->proto &&
3235 (m->reqid == 0 || t->reqid == m->reqid)) {
3236 switch (t->mode) {
3237 case XFRM_MODE_TUNNEL:
3238 case XFRM_MODE_BEET:
70e94e66
YH		 3239 if (xfrm_addr_equal(&t->id.daddr, &m->old_daddr,
3240 m->old_family) &&
3241 xfrm_addr_equal(&t->saddr, &m->old_saddr,
3242 m->old_family)) {
80c9abaa
SS		 3243 match = 1;
3244 }
3245 break;
3246 case XFRM_MODE_TRANSPORT:
3247 /* in case of transport mode, template does not store
3248 any IP addresses, hence we just compare mode and
3249 protocol */
3250 match = 1;
3251 break;
3252 default:
3253 break;
3254 }
3255 }
3256 return match;
3257}
3258
3259/* update endpoint address(es) of template(s) */
3260static int xfrm_policy_migrate(struct xfrm_policy *pol,
3261 struct xfrm_migrate *m, int num_migrate)
3262{
3263 struct xfrm_migrate *mp;
80c9abaa
SS		 3264 int i, j, n = 0;
3265
3266 write_lock_bh(&pol->lock);
12a169e7 3267 if (unlikely(pol->walk.dead)) {
80c9abaa
SS		 3268 /* target policy has been deleted */
3269 write_unlock_bh(&pol->lock);
3270 return -ENOENT;
3271 }
3272
3273 for (i = 0; i < pol->xfrm_nr; i++) {
3274 for (j = 0, mp = m; j < num_migrate; j++, mp++) {
3275 if (!migrate_tmpl_match(mp, &pol->xfrm_vec[i]))
3276 continue;
3277 n++;
1bfcb10f
HX		 3278 if (pol->xfrm_vec[i].mode != XFRM_MODE_TUNNEL &&
3279 pol->xfrm_vec[i].mode != XFRM_MODE_BEET)
80c9abaa
SS		 3280 continue;
3281 /* update endpoints */
3282 memcpy(&pol->xfrm_vec[i].id.daddr, &mp->new_daddr,
3283 sizeof(pol->xfrm_vec[i].id.daddr));
3284 memcpy(&pol->xfrm_vec[i].saddr, &mp->new_saddr,
3285 sizeof(pol->xfrm_vec[i].saddr));
3286 pol->xfrm_vec[i].encap_family = mp->new_family;
3287 /* flush bundles */
80c802f3 3288 atomic_inc(&pol->genid);
80c9abaa
SS		 3289 }
3290 }
3291
3292 write_unlock_bh(&pol->lock);
3293
3294 if (!n)
3295 return -ENODATA;
3296
3297 return 0;
3298}
3299
dd701754 3300static int xfrm_migrate_check(const struct xfrm_migrate *m, int num_migrate)
80c9abaa
SS		 3301{
3302 int i, j;
3303
3304 if (num_migrate < 1 || num_migrate > XFRM_MAX_DEPTH)
3305 return -EINVAL;
3306
3307 for (i = 0; i < num_migrate; i++) {
70e94e66
YH		 3308 if (xfrm_addr_equal(&m[i].old_daddr, &m[i].new_daddr,
3309 m[i].old_family) &&
3310 xfrm_addr_equal(&m[i].old_saddr, &m[i].new_saddr,
3311 m[i].old_family))
80c9abaa
SS		 3312 return -EINVAL;
3313 if (xfrm_addr_any(&m[i].new_daddr, m[i].new_family) ||
3314 xfrm_addr_any(&m[i].new_saddr, m[i].new_family))
3315 return -EINVAL;
3316
3317 /* check if there is any duplicated entry */
3318 for (j = i + 1; j < num_migrate; j++) {
3319 if (!memcmp(&m[i].old_daddr, &m[j].old_daddr,
3320 sizeof(m[i].old_daddr)) &&
3321 !memcmp(&m[i].old_saddr, &m[j].old_saddr,
3322 sizeof(m[i].old_saddr)) &&
3323 m[i].proto == m[j].proto &&
3324 m[i].mode == m[j].mode &&
3325 m[i].reqid == m[j].reqid &&
3326 m[i].old_family == m[j].old_family)
3327 return -EINVAL;
3328 }
3329 }
3330
3331 return 0;
3332}
3333
b4b7c0b3 3334int xfrm_migrate(const struct xfrm_selector *sel, u8 dir, u8 type,
13c1d189 3335 struct xfrm_migrate *m, int num_migrate,
8d549c4f 3336 struct xfrm_kmaddress *k, struct net *net)
80c9abaa
SS		 3337{
3338 int i, err, nx_cur = 0, nx_new = 0;
3339 struct xfrm_policy *pol = NULL;
3340 struct xfrm_state *x, *xc;
3341 struct xfrm_state *x_cur[XFRM_MAX_DEPTH];
3342 struct xfrm_state *x_new[XFRM_MAX_DEPTH];
3343 struct xfrm_migrate *mp;
3344
3345 if ((err = xfrm_migrate_check(m, num_migrate)) < 0)
3346 goto out;
3347
3348 /* Stage 1 - find policy */
8d549c4f 3349 if ((pol = xfrm_migrate_policy_find(sel, dir, type, net)) == NULL) {
80c9abaa
SS		 3350 err = -ENOENT;
3351 goto out;
3352 }
3353
3354 /* Stage 2 - find and update state(s) */
3355 for (i = 0, mp = m; i < num_migrate; i++, mp++) {
283bc9f3 3356 if ((x = xfrm_migrate_state_find(mp, net))) {
80c9abaa
SS		 3357 x_cur[nx_cur] = x;
3358 nx_cur++;
3359 if ((xc = xfrm_state_migrate(x, mp))) {
3360 x_new[nx_new] = xc;
3361 nx_new++;
3362 } else {
3363 err = -ENODATA;
3364 goto restore_state;
3365 }
3366 }
3367 }
3368
3369 /* Stage 3 - update policy */
3370 if ((err = xfrm_policy_migrate(pol, m, num_migrate)) < 0)
3371 goto restore_state;
3372
3373 /* Stage 4 - delete old state(s) */
3374 if (nx_cur) {
3375 xfrm_states_put(x_cur, nx_cur);
3376 xfrm_states_delete(x_cur, nx_cur);
3377 }
3378
3379 /* Stage 5 - announce */
13c1d189 3380 km_migrate(sel, dir, type, m, num_migrate, k);
80c9abaa
SS		 3381
3382 xfrm_pol_put(pol);
3383
3384 return 0;
3385out:
3386 return err;
3387
3388restore_state:
3389 if (pol)
3390 xfrm_pol_put(pol);
3391 if (nx_cur)
3392 xfrm_states_put(x_cur, nx_cur);
3393 if (nx_new)
3394 xfrm_states_delete(x_new, nx_new);
3395
3396 return err;
3397}
e610e679 3398EXPORT_SYMBOL(xfrm_migrate);
80c9abaa 3399#endif
ubuntu-bionic-kernel mirror