1 /* xfrm_user.c: User interface to configure xfrm engine.
2 *
3 * Copyright (C) 2002 David S. Miller (davem@redhat.com)
4 *
5 * Changes:
6 * Mitsuru KANDA @USAGI
7 * Kazunori MIYAZAWA @USAGI
8 * Kunihiro Ishiguro <kunihiro@ipinfusion.com>
9 * IPv6 support
10 *
11 */
12
13 #include <linux/crypto.h>
14 #include <linux/module.h>
15 #include <linux/kernel.h>
16 #include <linux/types.h>
17 #include <linux/slab.h>
18 #include <linux/socket.h>
19 #include <linux/string.h>
20 #include <linux/net.h>
21 #include <linux/skbuff.h>
22 #include <linux/pfkeyv2.h>
23 #include <linux/ipsec.h>
24 #include <linux/init.h>
25 #include <linux/security.h>
26 #include <net/sock.h>
27 #include <net/xfrm.h>
28 #include <net/netlink.h>
29 #include <net/ah.h>
30 #include <asm/uaccess.h>
31 #if IS_ENABLED(CONFIG_IPV6)
32 #include <linux/in6.h>
33 #endif
34 #include <asm/unaligned.h>
35
verify_one_alg(struct nlattr ** attrs,enum xfrm_attr_type_t type)36 static int verify_one_alg(struct nlattr **attrs, enum xfrm_attr_type_t type)
37 {
38 struct nlattr *rt = attrs[type];
39 struct xfrm_algo *algp;
40
41 if (!rt)
42 return 0;
43
44 algp = nla_data(rt);
45 if (nla_len(rt) < xfrm_alg_len(algp))
46 return -EINVAL;
47
48 switch (type) {
49 case XFRMA_ALG_AUTH:
50 case XFRMA_ALG_CRYPT:
51 case XFRMA_ALG_COMP:
52 break;
53
54 default:
55 return -EINVAL;
56 }
57
58 algp->alg_name[CRYPTO_MAX_ALG_NAME - 1] = '\0';
59 return 0;
60 }
61
verify_auth_trunc(struct nlattr ** attrs)62 static int verify_auth_trunc(struct nlattr **attrs)
63 {
64 struct nlattr *rt = attrs[XFRMA_ALG_AUTH_TRUNC];
65 struct xfrm_algo_auth *algp;
66
67 if (!rt)
68 return 0;
69
70 algp = nla_data(rt);
71 if (nla_len(rt) < xfrm_alg_auth_len(algp))
72 return -EINVAL;
73
74 algp->alg_name[CRYPTO_MAX_ALG_NAME - 1] = '\0';
75 return 0;
76 }
77
verify_aead(struct nlattr ** attrs)78 static int verify_aead(struct nlattr **attrs)
79 {
80 struct nlattr *rt = attrs[XFRMA_ALG_AEAD];
81 struct xfrm_algo_aead *algp;
82
83 if (!rt)
84 return 0;
85
86 algp = nla_data(rt);
87 if (nla_len(rt) < aead_len(algp))
88 return -EINVAL;
89
90 algp->alg_name[CRYPTO_MAX_ALG_NAME - 1] = '\0';
91 return 0;
92 }
93
verify_one_addr(struct nlattr ** attrs,enum xfrm_attr_type_t type,xfrm_address_t ** addrp)94 static void verify_one_addr(struct nlattr **attrs, enum xfrm_attr_type_t type,
95 xfrm_address_t **addrp)
96 {
97 struct nlattr *rt = attrs[type];
98
99 if (rt && addrp)
100 *addrp = nla_data(rt);
101 }
102
verify_sec_ctx_len(struct nlattr ** attrs)103 static inline int verify_sec_ctx_len(struct nlattr **attrs)
104 {
105 struct nlattr *rt = attrs[XFRMA_SEC_CTX];
106 struct xfrm_user_sec_ctx *uctx;
107
108 if (!rt)
109 return 0;
110
111 uctx = nla_data(rt);
112 if (uctx->len != (sizeof(struct xfrm_user_sec_ctx) + uctx->ctx_len))
113 return -EINVAL;
114
115 return 0;
116 }
117
verify_replay(struct xfrm_usersa_info * p,struct nlattr ** attrs)118 static inline int verify_replay(struct xfrm_usersa_info *p,
119 struct nlattr **attrs)
120 {
121 struct nlattr *rt = attrs[XFRMA_REPLAY_ESN_VAL];
122 struct xfrm_replay_state_esn *rs;
123
124 if (!rt)
125 return (p->flags & XFRM_STATE_ESN) ? -EINVAL : 0;
126
127 rs = nla_data(rt);
128
129 if (rs->bmp_len > XFRMA_REPLAY_ESN_MAX / sizeof(rs->bmp[0]) / 8)
130 return -EINVAL;
131
132 if (nla_len(rt) < xfrm_replay_state_esn_len(rs) &&
133 nla_len(rt) != sizeof(*rs))
134 return -EINVAL;
135
136 /* As only ESP and AH support ESN feature. */
137 if ((p->id.proto != IPPROTO_ESP) && (p->id.proto != IPPROTO_AH))
138 return -EINVAL;
139
140 if (p->replay_window != 0)
141 return -EINVAL;
142
143 return 0;
144 }
145
verify_newsa_info(struct xfrm_usersa_info * p,struct nlattr ** attrs)146 static int verify_newsa_info(struct xfrm_usersa_info *p,
147 struct nlattr **attrs)
148 {
149 int err;
150
151 err = -EINVAL;
152 switch (p->family) {
153 case AF_INET:
154 break;
155
156 case AF_INET6:
157 #if IS_ENABLED(CONFIG_IPV6)
158 break;
159 #else
160 err = -EAFNOSUPPORT;
161 goto out;
162 #endif
163
164 default:
165 goto out;
166 }
167
168 err = -EINVAL;
169 switch (p->id.proto) {
170 case IPPROTO_AH:
171 if ((!attrs[XFRMA_ALG_AUTH] &&
172 !attrs[XFRMA_ALG_AUTH_TRUNC]) ||
173 attrs[XFRMA_ALG_AEAD] ||
174 attrs[XFRMA_ALG_CRYPT] ||
175 attrs[XFRMA_ALG_COMP] ||
176 attrs[XFRMA_TFCPAD])
177 goto out;
178 break;
179
180 case IPPROTO_ESP:
181 if (attrs[XFRMA_ALG_COMP])
182 goto out;
183 if (!attrs[XFRMA_ALG_AUTH] &&
184 !attrs[XFRMA_ALG_AUTH_TRUNC] &&
185 !attrs[XFRMA_ALG_CRYPT] &&
186 !attrs[XFRMA_ALG_AEAD])
187 goto out;
188 if ((attrs[XFRMA_ALG_AUTH] ||
189 attrs[XFRMA_ALG_AUTH_TRUNC] ||
190 attrs[XFRMA_ALG_CRYPT]) &&
191 attrs[XFRMA_ALG_AEAD])
192 goto out;
193 if (attrs[XFRMA_TFCPAD] &&
194 p->mode != XFRM_MODE_TUNNEL)
195 goto out;
196 break;
197
198 case IPPROTO_COMP:
199 if (!attrs[XFRMA_ALG_COMP] ||
200 attrs[XFRMA_ALG_AEAD] ||
201 attrs[XFRMA_ALG_AUTH] ||
202 attrs[XFRMA_ALG_AUTH_TRUNC] ||
203 attrs[XFRMA_ALG_CRYPT] ||
204 attrs[XFRMA_TFCPAD] ||
205 (ntohl(p->id.spi) >= 0x10000))
206 goto out;
207 break;
208
209 #if IS_ENABLED(CONFIG_IPV6)
210 case IPPROTO_DSTOPTS:
211 case IPPROTO_ROUTING:
212 if (attrs[XFRMA_ALG_COMP] ||
213 attrs[XFRMA_ALG_AUTH] ||
214 attrs[XFRMA_ALG_AUTH_TRUNC] ||
215 attrs[XFRMA_ALG_AEAD] ||
216 attrs[XFRMA_ALG_CRYPT] ||
217 attrs[XFRMA_ENCAP] ||
218 attrs[XFRMA_SEC_CTX] ||
219 attrs[XFRMA_TFCPAD] ||
220 !attrs[XFRMA_COADDR])
221 goto out;
222 break;
223 #endif
224
225 default:
226 goto out;
227 }
228
229 if ((err = verify_aead(attrs)))
230 goto out;
231 if ((err = verify_auth_trunc(attrs)))
232 goto out;
233 if ((err = verify_one_alg(attrs, XFRMA_ALG_AUTH)))
234 goto out;
235 if ((err = verify_one_alg(attrs, XFRMA_ALG_CRYPT)))
236 goto out;
237 if ((err = verify_one_alg(attrs, XFRMA_ALG_COMP)))
238 goto out;
239 if ((err = verify_sec_ctx_len(attrs)))
240 goto out;
241 if ((err = verify_replay(p, attrs)))
242 goto out;
243
244 err = -EINVAL;
245 switch (p->mode) {
246 case XFRM_MODE_TRANSPORT:
247 case XFRM_MODE_TUNNEL:
248 case XFRM_MODE_ROUTEOPTIMIZATION:
249 case XFRM_MODE_BEET:
250 break;
251
252 default:
253 goto out;
254 }
255
256 err = 0;
257
258 out:
259 return err;
260 }
261
attach_one_algo(struct xfrm_algo ** algpp,u8 * props,struct xfrm_algo_desc * (* get_byname)(const char *,int),struct nlattr * rta)262 static int attach_one_algo(struct xfrm_algo **algpp, u8 *props,
263 struct xfrm_algo_desc *(*get_byname)(const char *, int),
264 struct nlattr *rta)
265 {
266 struct xfrm_algo *p, *ualg;
267 struct xfrm_algo_desc *algo;
268
269 if (!rta)
270 return 0;
271
272 ualg = nla_data(rta);
273
274 algo = get_byname(ualg->alg_name, 1);
275 if (!algo)
276 return -ENOSYS;
277 *props = algo->desc.sadb_alg_id;
278
279 p = kmemdup(ualg, xfrm_alg_len(ualg), GFP_KERNEL);
280 if (!p)
281 return -ENOMEM;
282
283 strcpy(p->alg_name, algo->name);
284 *algpp = p;
285 return 0;
286 }
287
attach_crypt(struct xfrm_state * x,struct nlattr * rta)288 static int attach_crypt(struct xfrm_state *x, struct nlattr *rta)
289 {
290 struct xfrm_algo *p, *ualg;
291 struct xfrm_algo_desc *algo;
292
293 if (!rta)
294 return 0;
295
296 ualg = nla_data(rta);
297
298 algo = xfrm_ealg_get_byname(ualg->alg_name, 1);
299 if (!algo)
300 return -ENOSYS;
301 x->props.ealgo = algo->desc.sadb_alg_id;
302
303 p = kmemdup(ualg, xfrm_alg_len(ualg), GFP_KERNEL);
304 if (!p)
305 return -ENOMEM;
306
307 strcpy(p->alg_name, algo->name);
308 x->ealg = p;
309 x->geniv = algo->uinfo.encr.geniv;
310 return 0;
311 }
312
attach_auth(struct xfrm_algo_auth ** algpp,u8 * props,struct nlattr * rta)313 static int attach_auth(struct xfrm_algo_auth **algpp, u8 *props,
314 struct nlattr *rta)
315 {
316 struct xfrm_algo *ualg;
317 struct xfrm_algo_auth *p;
318 struct xfrm_algo_desc *algo;
319
320 if (!rta)
321 return 0;
322
323 ualg = nla_data(rta);
324
325 algo = xfrm_aalg_get_byname(ualg->alg_name, 1);
326 if (!algo)
327 return -ENOSYS;
328 *props = algo->desc.sadb_alg_id;
329
330 p = kmalloc(sizeof(*p) + (ualg->alg_key_len + 7) / 8, GFP_KERNEL);
331 if (!p)
332 return -ENOMEM;
333
334 strcpy(p->alg_name, algo->name);
335 p->alg_key_len = ualg->alg_key_len;
336 p->alg_trunc_len = algo->uinfo.auth.icv_truncbits;
337 memcpy(p->alg_key, ualg->alg_key, (ualg->alg_key_len + 7) / 8);
338
339 *algpp = p;
340 return 0;
341 }
342
attach_auth_trunc(struct xfrm_algo_auth ** algpp,u8 * props,struct nlattr * rta)343 static int attach_auth_trunc(struct xfrm_algo_auth **algpp, u8 *props,
344 struct nlattr *rta)
345 {
346 struct xfrm_algo_auth *p, *ualg;
347 struct xfrm_algo_desc *algo;
348
349 if (!rta)
350 return 0;
351
352 ualg = nla_data(rta);
353
354 algo = xfrm_aalg_get_byname(ualg->alg_name, 1);
355 if (!algo)
356 return -ENOSYS;
357 if (ualg->alg_trunc_len > algo->uinfo.auth.icv_fullbits)
358 return -EINVAL;
359 *props = algo->desc.sadb_alg_id;
360
361 p = kmemdup(ualg, xfrm_alg_auth_len(ualg), GFP_KERNEL);
362 if (!p)
363 return -ENOMEM;
364
365 strcpy(p->alg_name, algo->name);
366 if (!p->alg_trunc_len)
367 p->alg_trunc_len = algo->uinfo.auth.icv_truncbits;
368
369 *algpp = p;
370 return 0;
371 }
372
attach_aead(struct xfrm_state * x,struct nlattr * rta)373 static int attach_aead(struct xfrm_state *x, struct nlattr *rta)
374 {
375 struct xfrm_algo_aead *p, *ualg;
376 struct xfrm_algo_desc *algo;
377
378 if (!rta)
379 return 0;
380
381 ualg = nla_data(rta);
382
383 algo = xfrm_aead_get_byname(ualg->alg_name, ualg->alg_icv_len, 1);
384 if (!algo)
385 return -ENOSYS;
386 x->props.ealgo = algo->desc.sadb_alg_id;
387
388 p = kmemdup(ualg, aead_len(ualg), GFP_KERNEL);
389 if (!p)
390 return -ENOMEM;
391
392 strcpy(p->alg_name, algo->name);
393 x->aead = p;
394 x->geniv = algo->uinfo.aead.geniv;
395 return 0;
396 }
397
xfrm_replay_verify_len(struct xfrm_replay_state_esn * replay_esn,struct nlattr * rp)398 static inline int xfrm_replay_verify_len(struct xfrm_replay_state_esn *replay_esn,
399 struct nlattr *rp)
400 {
401 struct xfrm_replay_state_esn *up;
402 int ulen;
403
404 if (!replay_esn || !rp)
405 return 0;
406
407 up = nla_data(rp);
408 ulen = xfrm_replay_state_esn_len(up);
409
410 /* Check the overall length and the internal bitmap length to avoid
411 * potential overflow. */
412 if (nla_len(rp) < ulen ||
413 xfrm_replay_state_esn_len(replay_esn) != ulen ||
414 replay_esn->bmp_len != up->bmp_len)
415 return -EINVAL;
416
417 if (up->replay_window > up->bmp_len * sizeof(__u32) * 8)
418 return -EINVAL;
419
420 return 0;
421 }
422
xfrm_alloc_replay_state_esn(struct xfrm_replay_state_esn ** replay_esn,struct xfrm_replay_state_esn ** preplay_esn,struct nlattr * rta)423 static int xfrm_alloc_replay_state_esn(struct xfrm_replay_state_esn **replay_esn,
424 struct xfrm_replay_state_esn **preplay_esn,
425 struct nlattr *rta)
426 {
427 struct xfrm_replay_state_esn *p, *pp, *up;
428 int klen, ulen;
429
430 if (!rta)
431 return 0;
432
433 up = nla_data(rta);
434 klen = xfrm_replay_state_esn_len(up);
435 ulen = nla_len(rta) >= klen ? klen : sizeof(*up);
436
437 p = kzalloc(klen, GFP_KERNEL);
438 if (!p)
439 return -ENOMEM;
440
441 pp = kzalloc(klen, GFP_KERNEL);
442 if (!pp) {
443 kfree(p);
444 return -ENOMEM;
445 }
446
447 memcpy(p, up, ulen);
448 memcpy(pp, up, ulen);
449
450 *replay_esn = p;
451 *preplay_esn = pp;
452
453 return 0;
454 }
455
xfrm_user_sec_ctx_size(struct xfrm_sec_ctx * xfrm_ctx)456 static inline int xfrm_user_sec_ctx_size(struct xfrm_sec_ctx *xfrm_ctx)
457 {
458 int len = 0;
459
460 if (xfrm_ctx) {
461 len += sizeof(struct xfrm_user_sec_ctx);
462 len += xfrm_ctx->ctx_len;
463 }
464 return len;
465 }
466
copy_from_user_state(struct xfrm_state * x,struct xfrm_usersa_info * p)467 static void copy_from_user_state(struct xfrm_state *x, struct xfrm_usersa_info *p)
468 {
469 memcpy(&x->id, &p->id, sizeof(x->id));
470 memcpy(&x->sel, &p->sel, sizeof(x->sel));
471 memcpy(&x->lft, &p->lft, sizeof(x->lft));
472 x->props.mode = p->mode;
473 x->props.replay_window = min_t(unsigned int, p->replay_window,
474 sizeof(x->replay.bitmap) * 8);
475 x->props.reqid = p->reqid;
476 x->props.family = p->family;
477 memcpy(&x->props.saddr, &p->saddr, sizeof(x->props.saddr));
478 x->props.flags = p->flags;
479
480 if (!x->sel.family && !(p->flags & XFRM_STATE_AF_UNSPEC))
481 x->sel.family = p->family;
482 }
483
484 /*
485 * someday when pfkey also has support, we could have the code
486 * somehow made shareable and move it to xfrm_state.c - JHS
487 *
488 */
xfrm_update_ae_params(struct xfrm_state * x,struct nlattr ** attrs,int update_esn)489 static void xfrm_update_ae_params(struct xfrm_state *x, struct nlattr **attrs,
490 int update_esn)
491 {
492 struct nlattr *rp = attrs[XFRMA_REPLAY_VAL];
493 struct nlattr *re = update_esn ? attrs[XFRMA_REPLAY_ESN_VAL] : NULL;
494 struct nlattr *lt = attrs[XFRMA_LTIME_VAL];
495 struct nlattr *et = attrs[XFRMA_ETIMER_THRESH];
496 struct nlattr *rt = attrs[XFRMA_REPLAY_THRESH];
497
498 if (re) {
499 struct xfrm_replay_state_esn *replay_esn;
500 replay_esn = nla_data(re);
501 memcpy(x->replay_esn, replay_esn,
502 xfrm_replay_state_esn_len(replay_esn));
503 memcpy(x->preplay_esn, replay_esn,
504 xfrm_replay_state_esn_len(replay_esn));
505 }
506
507 if (rp) {
508 struct xfrm_replay_state *replay;
509 replay = nla_data(rp);
510 memcpy(&x->replay, replay, sizeof(*replay));
511 memcpy(&x->preplay, replay, sizeof(*replay));
512 }
513
514 if (lt) {
515 struct xfrm_lifetime_cur *ltime;
516 ltime = nla_data(lt);
517 x->curlft.bytes = ltime->bytes;
518 x->curlft.packets = ltime->packets;
519 x->curlft.add_time = ltime->add_time;
520 x->curlft.use_time = ltime->use_time;
521 }
522
523 if (et)
524 x->replay_maxage = nla_get_u32(et);
525
526 if (rt)
527 x->replay_maxdiff = nla_get_u32(rt);
528 }
529
xfrm_state_construct(struct net * net,struct xfrm_usersa_info * p,struct nlattr ** attrs,int * errp)530 static struct xfrm_state *xfrm_state_construct(struct net *net,
531 struct xfrm_usersa_info *p,
532 struct nlattr **attrs,
533 int *errp)
534 {
535 struct xfrm_state *x = xfrm_state_alloc(net);
536 int err = -ENOMEM;
537
538 if (!x)
539 goto error_no_put;
540
541 copy_from_user_state(x, p);
542
543 if (attrs[XFRMA_SA_EXTRA_FLAGS])
544 x->props.extra_flags = nla_get_u32(attrs[XFRMA_SA_EXTRA_FLAGS]);
545
546 if ((err = attach_aead(x, attrs[XFRMA_ALG_AEAD])))
547 goto error;
548 if ((err = attach_auth_trunc(&x->aalg, &x->props.aalgo,
549 attrs[XFRMA_ALG_AUTH_TRUNC])))
550 goto error;
551 if (!x->props.aalgo) {
552 if ((err = attach_auth(&x->aalg, &x->props.aalgo,
553 attrs[XFRMA_ALG_AUTH])))
554 goto error;
555 }
556 if ((err = attach_crypt(x, attrs[XFRMA_ALG_CRYPT])))
557 goto error;
558 if ((err = attach_one_algo(&x->calg, &x->props.calgo,
559 xfrm_calg_get_byname,
560 attrs[XFRMA_ALG_COMP])))
561 goto error;
562
563 if (attrs[XFRMA_ENCAP]) {
564 x->encap = kmemdup(nla_data(attrs[XFRMA_ENCAP]),
565 sizeof(*x->encap), GFP_KERNEL);
566 if (x->encap == NULL)
567 goto error;
568 }
569
570 if (attrs[XFRMA_TFCPAD])
571 x->tfcpad = nla_get_u32(attrs[XFRMA_TFCPAD]);
572
573 if (attrs[XFRMA_COADDR]) {
574 x->coaddr = kmemdup(nla_data(attrs[XFRMA_COADDR]),
575 sizeof(*x->coaddr), GFP_KERNEL);
576 if (x->coaddr == NULL)
577 goto error;
578 }
579
580 xfrm_mark_get(attrs, &x->mark);
581
582 if (attrs[XFRMA_OUTPUT_MARK])
583 x->props.output_mark = nla_get_u32(attrs[XFRMA_OUTPUT_MARK]);
584
585 err = __xfrm_init_state(x, false);
586 if (err)
587 goto error;
588
589 if (attrs[XFRMA_SEC_CTX]) {
590 err = security_xfrm_state_alloc(x,
591 nla_data(attrs[XFRMA_SEC_CTX]));
592 if (err)
593 goto error;
594 }
595
596 if ((err = xfrm_alloc_replay_state_esn(&x->replay_esn, &x->preplay_esn,
597 attrs[XFRMA_REPLAY_ESN_VAL])))
598 goto error;
599
600 x->km.seq = p->seq;
601 x->replay_maxdiff = net->xfrm.sysctl_aevent_rseqth;
602 /* sysctl_xfrm_aevent_etime is in 100ms units */
603 x->replay_maxage = (net->xfrm.sysctl_aevent_etime*HZ)/XFRM_AE_ETH_M;
604
605 if ((err = xfrm_init_replay(x)))
606 goto error;
607
608 /* override default values from above */
609 xfrm_update_ae_params(x, attrs, 0);
610
611 return x;
612
613 error:
614 x->km.state = XFRM_STATE_DEAD;
615 xfrm_state_put(x);
616 error_no_put:
617 *errp = err;
618 return NULL;
619 }
620
xfrm_add_sa(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)621 static int xfrm_add_sa(struct sk_buff *skb, struct nlmsghdr *nlh,
622 struct nlattr **attrs)
623 {
624 struct net *net = sock_net(skb->sk);
625 struct xfrm_usersa_info *p = nlmsg_data(nlh);
626 struct xfrm_state *x;
627 int err;
628 struct km_event c;
629
630 err = verify_newsa_info(p, attrs);
631 if (err)
632 return err;
633
634 x = xfrm_state_construct(net, p, attrs, &err);
635 if (!x)
636 return err;
637
638 xfrm_state_hold(x);
639 if (nlh->nlmsg_type == XFRM_MSG_NEWSA)
640 err = xfrm_state_add(x);
641 else
642 err = xfrm_state_update(x);
643
644 xfrm_audit_state_add(x, err ? 0 : 1, true);
645
646 if (err < 0) {
647 x->km.state = XFRM_STATE_DEAD;
648 __xfrm_state_put(x);
649 goto out;
650 }
651
652 c.seq = nlh->nlmsg_seq;
653 c.portid = nlh->nlmsg_pid;
654 c.event = nlh->nlmsg_type;
655
656 km_state_notify(x, &c);
657 out:
658 xfrm_state_put(x);
659 return err;
660 }
661
xfrm_user_state_lookup(struct net * net,struct xfrm_usersa_id * p,struct nlattr ** attrs,int * errp)662 static struct xfrm_state *xfrm_user_state_lookup(struct net *net,
663 struct xfrm_usersa_id *p,
664 struct nlattr **attrs,
665 int *errp)
666 {
667 struct xfrm_state *x = NULL;
668 struct xfrm_mark m;
669 int err;
670 u32 mark = xfrm_mark_get(attrs, &m);
671
672 if (xfrm_id_proto_match(p->proto, IPSEC_PROTO_ANY)) {
673 err = -ESRCH;
674 x = xfrm_state_lookup(net, mark, &p->daddr, p->spi, p->proto, p->family);
675 } else {
676 xfrm_address_t *saddr = NULL;
677
678 verify_one_addr(attrs, XFRMA_SRCADDR, &saddr);
679 if (!saddr) {
680 err = -EINVAL;
681 goto out;
682 }
683
684 err = -ESRCH;
685 x = xfrm_state_lookup_byaddr(net, mark,
686 &p->daddr, saddr,
687 p->proto, p->family);
688 }
689
690 out:
691 if (!x && errp)
692 *errp = err;
693 return x;
694 }
695
xfrm_del_sa(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)696 static int xfrm_del_sa(struct sk_buff *skb, struct nlmsghdr *nlh,
697 struct nlattr **attrs)
698 {
699 struct net *net = sock_net(skb->sk);
700 struct xfrm_state *x;
701 int err = -ESRCH;
702 struct km_event c;
703 struct xfrm_usersa_id *p = nlmsg_data(nlh);
704
705 x = xfrm_user_state_lookup(net, p, attrs, &err);
706 if (x == NULL)
707 return err;
708
709 if ((err = security_xfrm_state_delete(x)) != 0)
710 goto out;
711
712 if (xfrm_state_kern(x)) {
713 err = -EPERM;
714 goto out;
715 }
716
717 err = xfrm_state_delete(x);
718
719 if (err < 0)
720 goto out;
721
722 c.seq = nlh->nlmsg_seq;
723 c.portid = nlh->nlmsg_pid;
724 c.event = nlh->nlmsg_type;
725 km_state_notify(x, &c);
726
727 out:
728 xfrm_audit_state_delete(x, err ? 0 : 1, true);
729 xfrm_state_put(x);
730 return err;
731 }
732
copy_to_user_state(struct xfrm_state * x,struct xfrm_usersa_info * p)733 static void copy_to_user_state(struct xfrm_state *x, struct xfrm_usersa_info *p)
734 {
735 memset(p, 0, sizeof(*p));
736 memcpy(&p->id, &x->id, sizeof(p->id));
737 memcpy(&p->sel, &x->sel, sizeof(p->sel));
738 memcpy(&p->lft, &x->lft, sizeof(p->lft));
739 memcpy(&p->curlft, &x->curlft, sizeof(p->curlft));
740 put_unaligned(x->stats.replay_window, &p->stats.replay_window);
741 put_unaligned(x->stats.replay, &p->stats.replay);
742 put_unaligned(x->stats.integrity_failed, &p->stats.integrity_failed);
743 memcpy(&p->saddr, &x->props.saddr, sizeof(p->saddr));
744 p->mode = x->props.mode;
745 p->replay_window = x->props.replay_window;
746 p->reqid = x->props.reqid;
747 p->family = x->props.family;
748 p->flags = x->props.flags;
749 p->seq = x->km.seq;
750 }
751
752 struct xfrm_dump_info {
753 struct sk_buff *in_skb;
754 struct sk_buff *out_skb;
755 u32 nlmsg_seq;
756 u16 nlmsg_flags;
757 };
758
copy_sec_ctx(struct xfrm_sec_ctx * s,struct sk_buff * skb)759 static int copy_sec_ctx(struct xfrm_sec_ctx *s, struct sk_buff *skb)
760 {
761 struct xfrm_user_sec_ctx *uctx;
762 struct nlattr *attr;
763 int ctx_size = sizeof(*uctx) + s->ctx_len;
764
765 attr = nla_reserve(skb, XFRMA_SEC_CTX, ctx_size);
766 if (attr == NULL)
767 return -EMSGSIZE;
768
769 uctx = nla_data(attr);
770 uctx->exttype = XFRMA_SEC_CTX;
771 uctx->len = ctx_size;
772 uctx->ctx_doi = s->ctx_doi;
773 uctx->ctx_alg = s->ctx_alg;
774 uctx->ctx_len = s->ctx_len;
775 memcpy(uctx + 1, s->ctx_str, s->ctx_len);
776
777 return 0;
778 }
779
copy_to_user_auth(struct xfrm_algo_auth * auth,struct sk_buff * skb)780 static int copy_to_user_auth(struct xfrm_algo_auth *auth, struct sk_buff *skb)
781 {
782 struct xfrm_algo *algo;
783 struct nlattr *nla;
784
785 nla = nla_reserve(skb, XFRMA_ALG_AUTH,
786 sizeof(*algo) + (auth->alg_key_len + 7) / 8);
787 if (!nla)
788 return -EMSGSIZE;
789
790 algo = nla_data(nla);
791 strncpy(algo->alg_name, auth->alg_name, sizeof(algo->alg_name));
792 memcpy(algo->alg_key, auth->alg_key, (auth->alg_key_len + 7) / 8);
793 algo->alg_key_len = auth->alg_key_len;
794
795 return 0;
796 }
797
798 /* Don't change this without updating xfrm_sa_len! */
copy_to_user_state_extra(struct xfrm_state * x,struct xfrm_usersa_info * p,struct sk_buff * skb)799 static int copy_to_user_state_extra(struct xfrm_state *x,
800 struct xfrm_usersa_info *p,
801 struct sk_buff *skb)
802 {
803 int ret = 0;
804
805 copy_to_user_state(x, p);
806
807 if (x->props.extra_flags) {
808 ret = nla_put_u32(skb, XFRMA_SA_EXTRA_FLAGS,
809 x->props.extra_flags);
810 if (ret)
811 goto out;
812 }
813
814 if (x->coaddr) {
815 ret = nla_put(skb, XFRMA_COADDR, sizeof(*x->coaddr), x->coaddr);
816 if (ret)
817 goto out;
818 }
819 if (x->lastused) {
820 ret = nla_put_u64_64bit(skb, XFRMA_LASTUSED, x->lastused,
821 XFRMA_PAD);
822 if (ret)
823 goto out;
824 }
825 if (x->aead) {
826 ret = nla_put(skb, XFRMA_ALG_AEAD, aead_len(x->aead), x->aead);
827 if (ret)
828 goto out;
829 }
830 if (x->aalg) {
831 ret = copy_to_user_auth(x->aalg, skb);
832 if (!ret)
833 ret = nla_put(skb, XFRMA_ALG_AUTH_TRUNC,
834 xfrm_alg_auth_len(x->aalg), x->aalg);
835 if (ret)
836 goto out;
837 }
838 if (x->ealg) {
839 ret = nla_put(skb, XFRMA_ALG_CRYPT, xfrm_alg_len(x->ealg), x->ealg);
840 if (ret)
841 goto out;
842 }
843 if (x->calg) {
844 ret = nla_put(skb, XFRMA_ALG_COMP, sizeof(*(x->calg)), x->calg);
845 if (ret)
846 goto out;
847 }
848 if (x->encap) {
849 ret = nla_put(skb, XFRMA_ENCAP, sizeof(*x->encap), x->encap);
850 if (ret)
851 goto out;
852 }
853 if (x->tfcpad) {
854 ret = nla_put_u32(skb, XFRMA_TFCPAD, x->tfcpad);
855 if (ret)
856 goto out;
857 }
858 ret = xfrm_mark_put(skb, &x->mark);
859 if (ret)
860 goto out;
861 if (x->replay_esn)
862 ret = nla_put(skb, XFRMA_REPLAY_ESN_VAL,
863 xfrm_replay_state_esn_len(x->replay_esn),
864 x->replay_esn);
865 else
866 ret = nla_put(skb, XFRMA_REPLAY_VAL, sizeof(x->replay),
867 &x->replay);
868 if (ret)
869 goto out;
870 if (x->props.output_mark) {
871 ret = nla_put_u32(skb, XFRMA_OUTPUT_MARK, x->props.output_mark);
872 if (ret)
873 goto out;
874 }
875 if (x->security)
876 ret = copy_sec_ctx(x->security, skb);
877 out:
878 return ret;
879 }
880
dump_one_state(struct xfrm_state * x,int count,void * ptr)881 static int dump_one_state(struct xfrm_state *x, int count, void *ptr)
882 {
883 struct xfrm_dump_info *sp = ptr;
884 struct sk_buff *in_skb = sp->in_skb;
885 struct sk_buff *skb = sp->out_skb;
886 struct xfrm_usersa_info *p;
887 struct nlmsghdr *nlh;
888 int err;
889
890 nlh = nlmsg_put(skb, NETLINK_CB(in_skb).portid, sp->nlmsg_seq,
891 XFRM_MSG_NEWSA, sizeof(*p), sp->nlmsg_flags);
892 if (nlh == NULL)
893 return -EMSGSIZE;
894
895 p = nlmsg_data(nlh);
896
897 err = copy_to_user_state_extra(x, p, skb);
898 if (err) {
899 nlmsg_cancel(skb, nlh);
900 return err;
901 }
902 nlmsg_end(skb, nlh);
903 return 0;
904 }
905
xfrm_dump_sa_done(struct netlink_callback * cb)906 static int xfrm_dump_sa_done(struct netlink_callback *cb)
907 {
908 struct xfrm_state_walk *walk = (struct xfrm_state_walk *) &cb->args[1];
909 struct sock *sk = cb->skb->sk;
910 struct net *net = sock_net(sk);
911
912 if (cb->args[0])
913 xfrm_state_walk_done(walk, net);
914 return 0;
915 }
916
917 static const struct nla_policy xfrma_policy[XFRMA_MAX+1];
xfrm_dump_sa(struct sk_buff * skb,struct netlink_callback * cb)918 static int xfrm_dump_sa(struct sk_buff *skb, struct netlink_callback *cb)
919 {
920 struct net *net = sock_net(skb->sk);
921 struct xfrm_state_walk *walk = (struct xfrm_state_walk *) &cb->args[1];
922 struct xfrm_dump_info info;
923
924 BUILD_BUG_ON(sizeof(struct xfrm_state_walk) >
925 sizeof(cb->args) - sizeof(cb->args[0]));
926
927 info.in_skb = cb->skb;
928 info.out_skb = skb;
929 info.nlmsg_seq = cb->nlh->nlmsg_seq;
930 info.nlmsg_flags = NLM_F_MULTI;
931
932 if (!cb->args[0]) {
933 struct nlattr *attrs[XFRMA_MAX+1];
934 struct xfrm_address_filter *filter = NULL;
935 u8 proto = 0;
936 int err;
937
938 err = nlmsg_parse(cb->nlh, 0, attrs, XFRMA_MAX,
939 xfrma_policy);
940 if (err < 0)
941 return err;
942
943 if (attrs[XFRMA_ADDRESS_FILTER]) {
944 filter = kmemdup(nla_data(attrs[XFRMA_ADDRESS_FILTER]),
945 sizeof(*filter), GFP_KERNEL);
946 if (filter == NULL)
947 return -ENOMEM;
948 }
949
950 if (attrs[XFRMA_PROTO])
951 proto = nla_get_u8(attrs[XFRMA_PROTO]);
952
953 xfrm_state_walk_init(walk, proto, filter);
954 cb->args[0] = 1;
955 }
956
957 (void) xfrm_state_walk(net, walk, dump_one_state, &info);
958
959 return skb->len;
960 }
961
xfrm_state_netlink(struct sk_buff * in_skb,struct xfrm_state * x,u32 seq)962 static struct sk_buff *xfrm_state_netlink(struct sk_buff *in_skb,
963 struct xfrm_state *x, u32 seq)
964 {
965 struct xfrm_dump_info info;
966 struct sk_buff *skb;
967 int err;
968
969 skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
970 if (!skb)
971 return ERR_PTR(-ENOMEM);
972
973 info.in_skb = in_skb;
974 info.out_skb = skb;
975 info.nlmsg_seq = seq;
976 info.nlmsg_flags = 0;
977
978 err = dump_one_state(x, 0, &info);
979 if (err) {
980 kfree_skb(skb);
981 return ERR_PTR(err);
982 }
983
984 return skb;
985 }
986
987 /* A wrapper for nlmsg_multicast() checking that nlsk is still available.
988 * Must be called with RCU read lock.
989 */
xfrm_nlmsg_multicast(struct net * net,struct sk_buff * skb,u32 pid,unsigned int group)990 static inline int xfrm_nlmsg_multicast(struct net *net, struct sk_buff *skb,
991 u32 pid, unsigned int group)
992 {
993 struct sock *nlsk = rcu_dereference(net->xfrm.nlsk);
994
995 if (nlsk)
996 return nlmsg_multicast(nlsk, skb, pid, group, GFP_ATOMIC);
997 else
998 return -1;
999 }
1000
xfrm_spdinfo_msgsize(void)1001 static inline size_t xfrm_spdinfo_msgsize(void)
1002 {
1003 return NLMSG_ALIGN(4)
1004 + nla_total_size(sizeof(struct xfrmu_spdinfo))
1005 + nla_total_size(sizeof(struct xfrmu_spdhinfo))
1006 + nla_total_size(sizeof(struct xfrmu_spdhthresh))
1007 + nla_total_size(sizeof(struct xfrmu_spdhthresh));
1008 }
1009
build_spdinfo(struct sk_buff * skb,struct net * net,u32 portid,u32 seq,u32 flags)1010 static int build_spdinfo(struct sk_buff *skb, struct net *net,
1011 u32 portid, u32 seq, u32 flags)
1012 {
1013 struct xfrmk_spdinfo si;
1014 struct xfrmu_spdinfo spc;
1015 struct xfrmu_spdhinfo sph;
1016 struct xfrmu_spdhthresh spt4, spt6;
1017 struct nlmsghdr *nlh;
1018 int err;
1019 u32 *f;
1020 unsigned lseq;
1021
1022 nlh = nlmsg_put(skb, portid, seq, XFRM_MSG_NEWSPDINFO, sizeof(u32), 0);
1023 if (nlh == NULL) /* shouldn't really happen ... */
1024 return -EMSGSIZE;
1025
1026 f = nlmsg_data(nlh);
1027 *f = flags;
1028 xfrm_spd_getinfo(net, &si);
1029 spc.incnt = si.incnt;
1030 spc.outcnt = si.outcnt;
1031 spc.fwdcnt = si.fwdcnt;
1032 spc.inscnt = si.inscnt;
1033 spc.outscnt = si.outscnt;
1034 spc.fwdscnt = si.fwdscnt;
1035 sph.spdhcnt = si.spdhcnt;
1036 sph.spdhmcnt = si.spdhmcnt;
1037
1038 do {
1039 lseq = read_seqbegin(&net->xfrm.policy_hthresh.lock);
1040
1041 spt4.lbits = net->xfrm.policy_hthresh.lbits4;
1042 spt4.rbits = net->xfrm.policy_hthresh.rbits4;
1043 spt6.lbits = net->xfrm.policy_hthresh.lbits6;
1044 spt6.rbits = net->xfrm.policy_hthresh.rbits6;
1045 } while (read_seqretry(&net->xfrm.policy_hthresh.lock, lseq));
1046
1047 err = nla_put(skb, XFRMA_SPD_INFO, sizeof(spc), &spc);
1048 if (!err)
1049 err = nla_put(skb, XFRMA_SPD_HINFO, sizeof(sph), &sph);
1050 if (!err)
1051 err = nla_put(skb, XFRMA_SPD_IPV4_HTHRESH, sizeof(spt4), &spt4);
1052 if (!err)
1053 err = nla_put(skb, XFRMA_SPD_IPV6_HTHRESH, sizeof(spt6), &spt6);
1054 if (err) {
1055 nlmsg_cancel(skb, nlh);
1056 return err;
1057 }
1058
1059 nlmsg_end(skb, nlh);
1060 return 0;
1061 }
1062
xfrm_set_spdinfo(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)1063 static int xfrm_set_spdinfo(struct sk_buff *skb, struct nlmsghdr *nlh,
1064 struct nlattr **attrs)
1065 {
1066 struct net *net = sock_net(skb->sk);
1067 struct xfrmu_spdhthresh *thresh4 = NULL;
1068 struct xfrmu_spdhthresh *thresh6 = NULL;
1069
1070 /* selector prefixlen thresholds to hash policies */
1071 if (attrs[XFRMA_SPD_IPV4_HTHRESH]) {
1072 struct nlattr *rta = attrs[XFRMA_SPD_IPV4_HTHRESH];
1073
1074 if (nla_len(rta) < sizeof(*thresh4))
1075 return -EINVAL;
1076 thresh4 = nla_data(rta);
1077 if (thresh4->lbits > 32 || thresh4->rbits > 32)
1078 return -EINVAL;
1079 }
1080 if (attrs[XFRMA_SPD_IPV6_HTHRESH]) {
1081 struct nlattr *rta = attrs[XFRMA_SPD_IPV6_HTHRESH];
1082
1083 if (nla_len(rta) < sizeof(*thresh6))
1084 return -EINVAL;
1085 thresh6 = nla_data(rta);
1086 if (thresh6->lbits > 128 || thresh6->rbits > 128)
1087 return -EINVAL;
1088 }
1089
1090 if (thresh4 || thresh6) {
1091 write_seqlock(&net->xfrm.policy_hthresh.lock);
1092 if (thresh4) {
1093 net->xfrm.policy_hthresh.lbits4 = thresh4->lbits;
1094 net->xfrm.policy_hthresh.rbits4 = thresh4->rbits;
1095 }
1096 if (thresh6) {
1097 net->xfrm.policy_hthresh.lbits6 = thresh6->lbits;
1098 net->xfrm.policy_hthresh.rbits6 = thresh6->rbits;
1099 }
1100 write_sequnlock(&net->xfrm.policy_hthresh.lock);
1101
1102 xfrm_policy_hash_rebuild(net);
1103 }
1104
1105 return 0;
1106 }
1107
xfrm_get_spdinfo(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)1108 static int xfrm_get_spdinfo(struct sk_buff *skb, struct nlmsghdr *nlh,
1109 struct nlattr **attrs)
1110 {
1111 struct net *net = sock_net(skb->sk);
1112 struct sk_buff *r_skb;
1113 u32 *flags = nlmsg_data(nlh);
1114 u32 sportid = NETLINK_CB(skb).portid;
1115 u32 seq = nlh->nlmsg_seq;
1116
1117 r_skb = nlmsg_new(xfrm_spdinfo_msgsize(), GFP_ATOMIC);
1118 if (r_skb == NULL)
1119 return -ENOMEM;
1120
1121 if (build_spdinfo(r_skb, net, sportid, seq, *flags) < 0)
1122 BUG();
1123
1124 return nlmsg_unicast(net->xfrm.nlsk, r_skb, sportid);
1125 }
1126
xfrm_sadinfo_msgsize(void)1127 static inline size_t xfrm_sadinfo_msgsize(void)
1128 {
1129 return NLMSG_ALIGN(4)
1130 + nla_total_size(sizeof(struct xfrmu_sadhinfo))
1131 + nla_total_size(4); /* XFRMA_SAD_CNT */
1132 }
1133
build_sadinfo(struct sk_buff * skb,struct net * net,u32 portid,u32 seq,u32 flags)1134 static int build_sadinfo(struct sk_buff *skb, struct net *net,
1135 u32 portid, u32 seq, u32 flags)
1136 {
1137 struct xfrmk_sadinfo si;
1138 struct xfrmu_sadhinfo sh;
1139 struct nlmsghdr *nlh;
1140 int err;
1141 u32 *f;
1142
1143 nlh = nlmsg_put(skb, portid, seq, XFRM_MSG_NEWSADINFO, sizeof(u32), 0);
1144 if (nlh == NULL) /* shouldn't really happen ... */
1145 return -EMSGSIZE;
1146
1147 f = nlmsg_data(nlh);
1148 *f = flags;
1149 xfrm_sad_getinfo(net, &si);
1150
1151 sh.sadhmcnt = si.sadhmcnt;
1152 sh.sadhcnt = si.sadhcnt;
1153
1154 err = nla_put_u32(skb, XFRMA_SAD_CNT, si.sadcnt);
1155 if (!err)
1156 err = nla_put(skb, XFRMA_SAD_HINFO, sizeof(sh), &sh);
1157 if (err) {
1158 nlmsg_cancel(skb, nlh);
1159 return err;
1160 }
1161
1162 nlmsg_end(skb, nlh);
1163 return 0;
1164 }
1165
xfrm_get_sadinfo(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)1166 static int xfrm_get_sadinfo(struct sk_buff *skb, struct nlmsghdr *nlh,
1167 struct nlattr **attrs)
1168 {
1169 struct net *net = sock_net(skb->sk);
1170 struct sk_buff *r_skb;
1171 u32 *flags = nlmsg_data(nlh);
1172 u32 sportid = NETLINK_CB(skb).portid;
1173 u32 seq = nlh->nlmsg_seq;
1174
1175 r_skb = nlmsg_new(xfrm_sadinfo_msgsize(), GFP_ATOMIC);
1176 if (r_skb == NULL)
1177 return -ENOMEM;
1178
1179 if (build_sadinfo(r_skb, net, sportid, seq, *flags) < 0)
1180 BUG();
1181
1182 return nlmsg_unicast(net->xfrm.nlsk, r_skb, sportid);
1183 }
1184
xfrm_get_sa(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)1185 static int xfrm_get_sa(struct sk_buff *skb, struct nlmsghdr *nlh,
1186 struct nlattr **attrs)
1187 {
1188 struct net *net = sock_net(skb->sk);
1189 struct xfrm_usersa_id *p = nlmsg_data(nlh);
1190 struct xfrm_state *x;
1191 struct sk_buff *resp_skb;
1192 int err = -ESRCH;
1193
1194 x = xfrm_user_state_lookup(net, p, attrs, &err);
1195 if (x == NULL)
1196 goto out_noput;
1197
1198 resp_skb = xfrm_state_netlink(skb, x, nlh->nlmsg_seq);
1199 if (IS_ERR(resp_skb)) {
1200 err = PTR_ERR(resp_skb);
1201 } else {
1202 err = nlmsg_unicast(net->xfrm.nlsk, resp_skb, NETLINK_CB(skb).portid);
1203 }
1204 xfrm_state_put(x);
1205 out_noput:
1206 return err;
1207 }
1208
xfrm_alloc_userspi(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)1209 static int xfrm_alloc_userspi(struct sk_buff *skb, struct nlmsghdr *nlh,
1210 struct nlattr **attrs)
1211 {
1212 struct net *net = sock_net(skb->sk);
1213 struct xfrm_state *x;
1214 struct xfrm_userspi_info *p;
1215 struct sk_buff *resp_skb;
1216 xfrm_address_t *daddr;
1217 int family;
1218 int err;
1219 u32 mark;
1220 struct xfrm_mark m;
1221
1222 p = nlmsg_data(nlh);
1223 err = verify_spi_info(p->info.id.proto, p->min, p->max);
1224 if (err)
1225 goto out_noput;
1226
1227 family = p->info.family;
1228 daddr = &p->info.id.daddr;
1229
1230 x = NULL;
1231
1232 mark = xfrm_mark_get(attrs, &m);
1233 if (p->info.seq) {
1234 x = xfrm_find_acq_byseq(net, mark, p->info.seq);
1235 if (x && !xfrm_addr_equal(&x->id.daddr, daddr, family)) {
1236 xfrm_state_put(x);
1237 x = NULL;
1238 }
1239 }
1240
1241 if (!x)
1242 x = xfrm_find_acq(net, &m, p->info.mode, p->info.reqid,
1243 p->info.id.proto, daddr,
1244 &p->info.saddr, 1,
1245 family);
1246 err = -ENOENT;
1247 if (x == NULL)
1248 goto out_noput;
1249
1250 err = xfrm_alloc_spi(x, p->min, p->max);
1251 if (err)
1252 goto out;
1253
1254 resp_skb = xfrm_state_netlink(skb, x, nlh->nlmsg_seq);
1255 if (IS_ERR(resp_skb)) {
1256 err = PTR_ERR(resp_skb);
1257 goto out;
1258 }
1259
1260 err = nlmsg_unicast(net->xfrm.nlsk, resp_skb, NETLINK_CB(skb).portid);
1261
1262 out:
1263 xfrm_state_put(x);
1264 out_noput:
1265 return err;
1266 }
1267
verify_policy_dir(u8 dir)1268 static int verify_policy_dir(u8 dir)
1269 {
1270 switch (dir) {
1271 case XFRM_POLICY_IN:
1272 case XFRM_POLICY_OUT:
1273 case XFRM_POLICY_FWD:
1274 break;
1275
1276 default:
1277 return -EINVAL;
1278 }
1279
1280 return 0;
1281 }
1282
verify_policy_type(u8 type)1283 static int verify_policy_type(u8 type)
1284 {
1285 switch (type) {
1286 case XFRM_POLICY_TYPE_MAIN:
1287 #ifdef CONFIG_XFRM_SUB_POLICY
1288 case XFRM_POLICY_TYPE_SUB:
1289 #endif
1290 break;
1291
1292 default:
1293 return -EINVAL;
1294 }
1295
1296 return 0;
1297 }
1298
verify_newpolicy_info(struct xfrm_userpolicy_info * p)1299 static int verify_newpolicy_info(struct xfrm_userpolicy_info *p)
1300 {
1301 int ret;
1302
1303 switch (p->share) {
1304 case XFRM_SHARE_ANY:
1305 case XFRM_SHARE_SESSION:
1306 case XFRM_SHARE_USER:
1307 case XFRM_SHARE_UNIQUE:
1308 break;
1309
1310 default:
1311 return -EINVAL;
1312 }
1313
1314 switch (p->action) {
1315 case XFRM_POLICY_ALLOW:
1316 case XFRM_POLICY_BLOCK:
1317 break;
1318
1319 default:
1320 return -EINVAL;
1321 }
1322
1323 switch (p->sel.family) {
1324 case AF_INET:
1325 break;
1326
1327 case AF_INET6:
1328 #if IS_ENABLED(CONFIG_IPV6)
1329 break;
1330 #else
1331 return -EAFNOSUPPORT;
1332 #endif
1333
1334 default:
1335 return -EINVAL;
1336 }
1337
1338 ret = verify_policy_dir(p->dir);
1339 if (ret)
1340 return ret;
1341 if (p->index && ((p->index & XFRM_POLICY_MAX) != p->dir))
1342 return -EINVAL;
1343
1344 return 0;
1345 }
1346
copy_from_user_sec_ctx(struct xfrm_policy * pol,struct nlattr ** attrs)1347 static int copy_from_user_sec_ctx(struct xfrm_policy *pol, struct nlattr **attrs)
1348 {
1349 struct nlattr *rt = attrs[XFRMA_SEC_CTX];
1350 struct xfrm_user_sec_ctx *uctx;
1351
1352 if (!rt)
1353 return 0;
1354
1355 uctx = nla_data(rt);
1356 return security_xfrm_policy_alloc(&pol->security, uctx, GFP_KERNEL);
1357 }
1358
copy_templates(struct xfrm_policy * xp,struct xfrm_user_tmpl * ut,int nr)1359 static void copy_templates(struct xfrm_policy *xp, struct xfrm_user_tmpl *ut,
1360 int nr)
1361 {
1362 int i;
1363
1364 xp->xfrm_nr = nr;
1365 for (i = 0; i < nr; i++, ut++) {
1366 struct xfrm_tmpl *t = &xp->xfrm_vec[i];
1367
1368 memcpy(&t->id, &ut->id, sizeof(struct xfrm_id));
1369 memcpy(&t->saddr, &ut->saddr,
1370 sizeof(xfrm_address_t));
1371 t->reqid = ut->reqid;
1372 t->mode = ut->mode;
1373 t->share = ut->share;
1374 t->optional = ut->optional;
1375 t->aalgos = ut->aalgos;
1376 t->ealgos = ut->ealgos;
1377 t->calgos = ut->calgos;
1378 /* If all masks are ~0, then we allow all algorithms. */
1379 t->allalgs = !~(t->aalgos & t->ealgos & t->calgos);
1380 t->encap_family = ut->family;
1381 }
1382 }
1383
validate_tmpl(int nr,struct xfrm_user_tmpl * ut,u16 family)1384 static int validate_tmpl(int nr, struct xfrm_user_tmpl *ut, u16 family)
1385 {
1386 u16 prev_family;
1387 int i;
1388
1389 if (nr > XFRM_MAX_DEPTH)
1390 return -EINVAL;
1391
1392 prev_family = family;
1393
1394 for (i = 0; i < nr; i++) {
1395 /* We never validated the ut->family value, so many
1396 * applications simply leave it at zero. The check was
1397 * never made and ut->family was ignored because all
1398 * templates could be assumed to have the same family as
1399 * the policy itself. Now that we will have ipv4-in-ipv6
1400 * and ipv6-in-ipv4 tunnels, this is no longer true.
1401 */
1402 if (!ut[i].family)
1403 ut[i].family = family;
1404
1405 if ((ut[i].mode == XFRM_MODE_TRANSPORT) &&
1406 (ut[i].family != prev_family))
1407 return -EINVAL;
1408
1409 prev_family = ut[i].family;
1410
1411 switch (ut[i].family) {
1412 case AF_INET:
1413 break;
1414 #if IS_ENABLED(CONFIG_IPV6)
1415 case AF_INET6:
1416 break;
1417 #endif
1418 default:
1419 return -EINVAL;
1420 }
1421
1422 switch (ut[i].id.proto) {
1423 case IPPROTO_AH:
1424 case IPPROTO_ESP:
1425 case IPPROTO_COMP:
1426 #if IS_ENABLED(CONFIG_IPV6)
1427 case IPPROTO_ROUTING:
1428 case IPPROTO_DSTOPTS:
1429 #endif
1430 case IPSEC_PROTO_ANY:
1431 break;
1432 default:
1433 return -EINVAL;
1434 }
1435
1436 }
1437
1438 return 0;
1439 }
1440
copy_from_user_tmpl(struct xfrm_policy * pol,struct nlattr ** attrs)1441 static int copy_from_user_tmpl(struct xfrm_policy *pol, struct nlattr **attrs)
1442 {
1443 struct nlattr *rt = attrs[XFRMA_TMPL];
1444
1445 if (!rt) {
1446 pol->xfrm_nr = 0;
1447 } else {
1448 struct xfrm_user_tmpl *utmpl = nla_data(rt);
1449 int nr = nla_len(rt) / sizeof(*utmpl);
1450 int err;
1451
1452 err = validate_tmpl(nr, utmpl, pol->family);
1453 if (err)
1454 return err;
1455
1456 copy_templates(pol, utmpl, nr);
1457 }
1458 return 0;
1459 }
1460
copy_from_user_policy_type(u8 * tp,struct nlattr ** attrs)1461 static int copy_from_user_policy_type(u8 *tp, struct nlattr **attrs)
1462 {
1463 struct nlattr *rt = attrs[XFRMA_POLICY_TYPE];
1464 struct xfrm_userpolicy_type *upt;
1465 u8 type = XFRM_POLICY_TYPE_MAIN;
1466 int err;
1467
1468 if (rt) {
1469 upt = nla_data(rt);
1470 type = upt->type;
1471 }
1472
1473 err = verify_policy_type(type);
1474 if (err)
1475 return err;
1476
1477 *tp = type;
1478 return 0;
1479 }
1480
copy_from_user_policy(struct xfrm_policy * xp,struct xfrm_userpolicy_info * p)1481 static void copy_from_user_policy(struct xfrm_policy *xp, struct xfrm_userpolicy_info *p)
1482 {
1483 xp->priority = p->priority;
1484 xp->index = p->index;
1485 memcpy(&xp->selector, &p->sel, sizeof(xp->selector));
1486 memcpy(&xp->lft, &p->lft, sizeof(xp->lft));
1487 xp->action = p->action;
1488 xp->flags = p->flags;
1489 xp->family = p->sel.family;
1490 /* XXX xp->share = p->share; */
1491 }
1492
copy_to_user_policy(struct xfrm_policy * xp,struct xfrm_userpolicy_info * p,int dir)1493 static void copy_to_user_policy(struct xfrm_policy *xp, struct xfrm_userpolicy_info *p, int dir)
1494 {
1495 memset(p, 0, sizeof(*p));
1496 memcpy(&p->sel, &xp->selector, sizeof(p->sel));
1497 memcpy(&p->lft, &xp->lft, sizeof(p->lft));
1498 memcpy(&p->curlft, &xp->curlft, sizeof(p->curlft));
1499 p->priority = xp->priority;
1500 p->index = xp->index;
1501 p->sel.family = xp->family;
1502 p->dir = dir;
1503 p->action = xp->action;
1504 p->flags = xp->flags;
1505 p->share = XFRM_SHARE_ANY; /* XXX xp->share */
1506 }
1507
xfrm_policy_construct(struct net * net,struct xfrm_userpolicy_info * p,struct nlattr ** attrs,int * errp)1508 static struct xfrm_policy *xfrm_policy_construct(struct net *net, struct xfrm_userpolicy_info *p, struct nlattr **attrs, int *errp)
1509 {
1510 struct xfrm_policy *xp = xfrm_policy_alloc(net, GFP_KERNEL);
1511 int err;
1512
1513 if (!xp) {
1514 *errp = -ENOMEM;
1515 return NULL;
1516 }
1517
1518 copy_from_user_policy(xp, p);
1519
1520 err = copy_from_user_policy_type(&xp->type, attrs);
1521 if (err)
1522 goto error;
1523
1524 if (!(err = copy_from_user_tmpl(xp, attrs)))
1525 err = copy_from_user_sec_ctx(xp, attrs);
1526 if (err)
1527 goto error;
1528
1529 xfrm_mark_get(attrs, &xp->mark);
1530
1531 return xp;
1532 error:
1533 *errp = err;
1534 xp->walk.dead = 1;
1535 xfrm_policy_destroy(xp);
1536 return NULL;
1537 }
1538
xfrm_add_policy(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)1539 static int xfrm_add_policy(struct sk_buff *skb, struct nlmsghdr *nlh,
1540 struct nlattr **attrs)
1541 {
1542 struct net *net = sock_net(skb->sk);
1543 struct xfrm_userpolicy_info *p = nlmsg_data(nlh);
1544 struct xfrm_policy *xp;
1545 struct km_event c;
1546 int err;
1547 int excl;
1548
1549 err = verify_newpolicy_info(p);
1550 if (err)
1551 return err;
1552 err = verify_sec_ctx_len(attrs);
1553 if (err)
1554 return err;
1555
1556 xp = xfrm_policy_construct(net, p, attrs, &err);
1557 if (!xp)
1558 return err;
1559
1560 /* shouldn't excl be based on nlh flags??
1561 * Aha! this is anti-netlink really i.e more pfkey derived
1562 * in netlink excl is a flag and you wouldnt need
1563 * a type XFRM_MSG_UPDPOLICY - JHS */
1564 excl = nlh->nlmsg_type == XFRM_MSG_NEWPOLICY;
1565 err = xfrm_policy_insert(p->dir, xp, excl);
1566 xfrm_audit_policy_add(xp, err ? 0 : 1, true);
1567
1568 if (err) {
1569 security_xfrm_policy_free(xp->security);
1570 kfree(xp);
1571 return err;
1572 }
1573
1574 c.event = nlh->nlmsg_type;
1575 c.seq = nlh->nlmsg_seq;
1576 c.portid = nlh->nlmsg_pid;
1577 km_policy_notify(xp, p->dir, &c);
1578
1579 xfrm_pol_put(xp);
1580
1581 return 0;
1582 }
1583
copy_to_user_tmpl(struct xfrm_policy * xp,struct sk_buff * skb)1584 static int copy_to_user_tmpl(struct xfrm_policy *xp, struct sk_buff *skb)
1585 {
1586 struct xfrm_user_tmpl vec[XFRM_MAX_DEPTH];
1587 int i;
1588
1589 if (xp->xfrm_nr == 0)
1590 return 0;
1591
1592 for (i = 0; i < xp->xfrm_nr; i++) {
1593 struct xfrm_user_tmpl *up = &vec[i];
1594 struct xfrm_tmpl *kp = &xp->xfrm_vec[i];
1595
1596 memset(up, 0, sizeof(*up));
1597 memcpy(&up->id, &kp->id, sizeof(up->id));
1598 up->family = kp->encap_family;
1599 memcpy(&up->saddr, &kp->saddr, sizeof(up->saddr));
1600 up->reqid = kp->reqid;
1601 up->mode = kp->mode;
1602 up->share = kp->share;
1603 up->optional = kp->optional;
1604 up->aalgos = kp->aalgos;
1605 up->ealgos = kp->ealgos;
1606 up->calgos = kp->calgos;
1607 }
1608
1609 return nla_put(skb, XFRMA_TMPL,
1610 sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr, vec);
1611 }
1612
copy_to_user_state_sec_ctx(struct xfrm_state * x,struct sk_buff * skb)1613 static inline int copy_to_user_state_sec_ctx(struct xfrm_state *x, struct sk_buff *skb)
1614 {
1615 if (x->security) {
1616 return copy_sec_ctx(x->security, skb);
1617 }
1618 return 0;
1619 }
1620
copy_to_user_sec_ctx(struct xfrm_policy * xp,struct sk_buff * skb)1621 static inline int copy_to_user_sec_ctx(struct xfrm_policy *xp, struct sk_buff *skb)
1622 {
1623 if (xp->security)
1624 return copy_sec_ctx(xp->security, skb);
1625 return 0;
1626 }
userpolicy_type_attrsize(void)1627 static inline size_t userpolicy_type_attrsize(void)
1628 {
1629 #ifdef CONFIG_XFRM_SUB_POLICY
1630 return nla_total_size(sizeof(struct xfrm_userpolicy_type));
1631 #else
1632 return 0;
1633 #endif
1634 }
1635
1636 #ifdef CONFIG_XFRM_SUB_POLICY
copy_to_user_policy_type(u8 type,struct sk_buff * skb)1637 static int copy_to_user_policy_type(u8 type, struct sk_buff *skb)
1638 {
1639 struct xfrm_userpolicy_type upt = {
1640 .type = type,
1641 };
1642
1643 return nla_put(skb, XFRMA_POLICY_TYPE, sizeof(upt), &upt);
1644 }
1645
1646 #else
copy_to_user_policy_type(u8 type,struct sk_buff * skb)1647 static inline int copy_to_user_policy_type(u8 type, struct sk_buff *skb)
1648 {
1649 return 0;
1650 }
1651 #endif
1652
dump_one_policy(struct xfrm_policy * xp,int dir,int count,void * ptr)1653 static int dump_one_policy(struct xfrm_policy *xp, int dir, int count, void *ptr)
1654 {
1655 struct xfrm_dump_info *sp = ptr;
1656 struct xfrm_userpolicy_info *p;
1657 struct sk_buff *in_skb = sp->in_skb;
1658 struct sk_buff *skb = sp->out_skb;
1659 struct nlmsghdr *nlh;
1660 int err;
1661
1662 nlh = nlmsg_put(skb, NETLINK_CB(in_skb).portid, sp->nlmsg_seq,
1663 XFRM_MSG_NEWPOLICY, sizeof(*p), sp->nlmsg_flags);
1664 if (nlh == NULL)
1665 return -EMSGSIZE;
1666
1667 p = nlmsg_data(nlh);
1668 copy_to_user_policy(xp, p, dir);
1669 err = copy_to_user_tmpl(xp, skb);
1670 if (!err)
1671 err = copy_to_user_sec_ctx(xp, skb);
1672 if (!err)
1673 err = copy_to_user_policy_type(xp->type, skb);
1674 if (!err)
1675 err = xfrm_mark_put(skb, &xp->mark);
1676 if (err) {
1677 nlmsg_cancel(skb, nlh);
1678 return err;
1679 }
1680 nlmsg_end(skb, nlh);
1681 return 0;
1682 }
1683
xfrm_dump_policy_done(struct netlink_callback * cb)1684 static int xfrm_dump_policy_done(struct netlink_callback *cb)
1685 {
1686 struct xfrm_policy_walk *walk = (struct xfrm_policy_walk *)cb->args;
1687 struct net *net = sock_net(cb->skb->sk);
1688
1689 xfrm_policy_walk_done(walk, net);
1690 return 0;
1691 }
1692
xfrm_dump_policy_start(struct netlink_callback * cb)1693 static int xfrm_dump_policy_start(struct netlink_callback *cb)
1694 {
1695 struct xfrm_policy_walk *walk = (struct xfrm_policy_walk *)cb->args;
1696
1697 BUILD_BUG_ON(sizeof(*walk) > sizeof(cb->args));
1698
1699 xfrm_policy_walk_init(walk, XFRM_POLICY_TYPE_ANY);
1700 return 0;
1701 }
1702
xfrm_dump_policy(struct sk_buff * skb,struct netlink_callback * cb)1703 static int xfrm_dump_policy(struct sk_buff *skb, struct netlink_callback *cb)
1704 {
1705 struct net *net = sock_net(skb->sk);
1706 struct xfrm_policy_walk *walk = (struct xfrm_policy_walk *)cb->args;
1707 struct xfrm_dump_info info;
1708
1709 info.in_skb = cb->skb;
1710 info.out_skb = skb;
1711 info.nlmsg_seq = cb->nlh->nlmsg_seq;
1712 info.nlmsg_flags = NLM_F_MULTI;
1713
1714 (void) xfrm_policy_walk(net, walk, dump_one_policy, &info);
1715
1716 return skb->len;
1717 }
1718
xfrm_policy_netlink(struct sk_buff * in_skb,struct xfrm_policy * xp,int dir,u32 seq)1719 static struct sk_buff *xfrm_policy_netlink(struct sk_buff *in_skb,
1720 struct xfrm_policy *xp,
1721 int dir, u32 seq)
1722 {
1723 struct xfrm_dump_info info;
1724 struct sk_buff *skb;
1725 int err;
1726
1727 err = verify_policy_dir(dir);
1728 if (err)
1729 return ERR_PTR(err);
1730
1731 skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1732 if (!skb)
1733 return ERR_PTR(-ENOMEM);
1734
1735 info.in_skb = in_skb;
1736 info.out_skb = skb;
1737 info.nlmsg_seq = seq;
1738 info.nlmsg_flags = 0;
1739
1740 err = dump_one_policy(xp, dir, 0, &info);
1741 if (err) {
1742 kfree_skb(skb);
1743 return ERR_PTR(err);
1744 }
1745
1746 return skb;
1747 }
1748
xfrm_get_policy(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)1749 static int xfrm_get_policy(struct sk_buff *skb, struct nlmsghdr *nlh,
1750 struct nlattr **attrs)
1751 {
1752 struct net *net = sock_net(skb->sk);
1753 struct xfrm_policy *xp;
1754 struct xfrm_userpolicy_id *p;
1755 u8 type = XFRM_POLICY_TYPE_MAIN;
1756 int err;
1757 struct km_event c;
1758 int delete;
1759 struct xfrm_mark m;
1760 u32 mark = xfrm_mark_get(attrs, &m);
1761
1762 p = nlmsg_data(nlh);
1763 delete = nlh->nlmsg_type == XFRM_MSG_DELPOLICY;
1764
1765 err = copy_from_user_policy_type(&type, attrs);
1766 if (err)
1767 return err;
1768
1769 err = verify_policy_dir(p->dir);
1770 if (err)
1771 return err;
1772
1773 if (p->index)
1774 xp = xfrm_policy_byid(net, mark, type, p->dir, p->index, delete, &err);
1775 else {
1776 struct nlattr *rt = attrs[XFRMA_SEC_CTX];
1777 struct xfrm_sec_ctx *ctx;
1778
1779 err = verify_sec_ctx_len(attrs);
1780 if (err)
1781 return err;
1782
1783 ctx = NULL;
1784 if (rt) {
1785 struct xfrm_user_sec_ctx *uctx = nla_data(rt);
1786
1787 err = security_xfrm_policy_alloc(&ctx, uctx, GFP_KERNEL);
1788 if (err)
1789 return err;
1790 }
1791 xp = xfrm_policy_bysel_ctx(net, mark, type, p->dir, &p->sel,
1792 ctx, delete, &err);
1793 security_xfrm_policy_free(ctx);
1794 }
1795 if (xp == NULL)
1796 return -ENOENT;
1797
1798 if (!delete) {
1799 struct sk_buff *resp_skb;
1800
1801 resp_skb = xfrm_policy_netlink(skb, xp, p->dir, nlh->nlmsg_seq);
1802 if (IS_ERR(resp_skb)) {
1803 err = PTR_ERR(resp_skb);
1804 } else {
1805 err = nlmsg_unicast(net->xfrm.nlsk, resp_skb,
1806 NETLINK_CB(skb).portid);
1807 }
1808 } else {
1809 xfrm_audit_policy_delete(xp, err ? 0 : 1, true);
1810
1811 if (err != 0)
1812 goto out;
1813
1814 c.data.byid = p->index;
1815 c.event = nlh->nlmsg_type;
1816 c.seq = nlh->nlmsg_seq;
1817 c.portid = nlh->nlmsg_pid;
1818 km_policy_notify(xp, p->dir, &c);
1819 }
1820
1821 out:
1822 xfrm_pol_put(xp);
1823 if (delete && err == 0)
1824 xfrm_garbage_collect(net);
1825 return err;
1826 }
1827
xfrm_flush_sa(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)1828 static int xfrm_flush_sa(struct sk_buff *skb, struct nlmsghdr *nlh,
1829 struct nlattr **attrs)
1830 {
1831 struct net *net = sock_net(skb->sk);
1832 struct km_event c;
1833 struct xfrm_usersa_flush *p = nlmsg_data(nlh);
1834 int err;
1835
1836 err = xfrm_state_flush(net, p->proto, true);
1837 if (err) {
1838 if (err == -ESRCH) /* empty table */
1839 return 0;
1840 return err;
1841 }
1842 c.data.proto = p->proto;
1843 c.event = nlh->nlmsg_type;
1844 c.seq = nlh->nlmsg_seq;
1845 c.portid = nlh->nlmsg_pid;
1846 c.net = net;
1847 km_state_notify(NULL, &c);
1848
1849 return 0;
1850 }
1851
xfrm_aevent_msgsize(struct xfrm_state * x)1852 static inline size_t xfrm_aevent_msgsize(struct xfrm_state *x)
1853 {
1854 size_t replay_size = x->replay_esn ?
1855 xfrm_replay_state_esn_len(x->replay_esn) :
1856 sizeof(struct xfrm_replay_state);
1857
1858 return NLMSG_ALIGN(sizeof(struct xfrm_aevent_id))
1859 + nla_total_size(replay_size)
1860 + nla_total_size_64bit(sizeof(struct xfrm_lifetime_cur))
1861 + nla_total_size(sizeof(struct xfrm_mark))
1862 + nla_total_size(4) /* XFRM_AE_RTHR */
1863 + nla_total_size(4); /* XFRM_AE_ETHR */
1864 }
1865
build_aevent(struct sk_buff * skb,struct xfrm_state * x,const struct km_event * c)1866 static int build_aevent(struct sk_buff *skb, struct xfrm_state *x, const struct km_event *c)
1867 {
1868 struct xfrm_aevent_id *id;
1869 struct nlmsghdr *nlh;
1870 int err;
1871
1872 nlh = nlmsg_put(skb, c->portid, c->seq, XFRM_MSG_NEWAE, sizeof(*id), 0);
1873 if (nlh == NULL)
1874 return -EMSGSIZE;
1875
1876 id = nlmsg_data(nlh);
1877 memcpy(&id->sa_id.daddr, &x->id.daddr, sizeof(x->id.daddr));
1878 id->sa_id.spi = x->id.spi;
1879 id->sa_id.family = x->props.family;
1880 id->sa_id.proto = x->id.proto;
1881 memcpy(&id->saddr, &x->props.saddr, sizeof(x->props.saddr));
1882 id->reqid = x->props.reqid;
1883 id->flags = c->data.aevent;
1884
1885 if (x->replay_esn) {
1886 err = nla_put(skb, XFRMA_REPLAY_ESN_VAL,
1887 xfrm_replay_state_esn_len(x->replay_esn),
1888 x->replay_esn);
1889 } else {
1890 err = nla_put(skb, XFRMA_REPLAY_VAL, sizeof(x->replay),
1891 &x->replay);
1892 }
1893 if (err)
1894 goto out_cancel;
1895 err = nla_put_64bit(skb, XFRMA_LTIME_VAL, sizeof(x->curlft), &x->curlft,
1896 XFRMA_PAD);
1897 if (err)
1898 goto out_cancel;
1899
1900 if (id->flags & XFRM_AE_RTHR) {
1901 err = nla_put_u32(skb, XFRMA_REPLAY_THRESH, x->replay_maxdiff);
1902 if (err)
1903 goto out_cancel;
1904 }
1905 if (id->flags & XFRM_AE_ETHR) {
1906 err = nla_put_u32(skb, XFRMA_ETIMER_THRESH,
1907 x->replay_maxage * 10 / HZ);
1908 if (err)
1909 goto out_cancel;
1910 }
1911 err = xfrm_mark_put(skb, &x->mark);
1912 if (err)
1913 goto out_cancel;
1914
1915 nlmsg_end(skb, nlh);
1916 return 0;
1917
1918 out_cancel:
1919 nlmsg_cancel(skb, nlh);
1920 return err;
1921 }
1922
xfrm_get_ae(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)1923 static int xfrm_get_ae(struct sk_buff *skb, struct nlmsghdr *nlh,
1924 struct nlattr **attrs)
1925 {
1926 struct net *net = sock_net(skb->sk);
1927 struct xfrm_state *x;
1928 struct sk_buff *r_skb;
1929 int err;
1930 struct km_event c;
1931 u32 mark;
1932 struct xfrm_mark m;
1933 struct xfrm_aevent_id *p = nlmsg_data(nlh);
1934 struct xfrm_usersa_id *id = &p->sa_id;
1935
1936 mark = xfrm_mark_get(attrs, &m);
1937
1938 x = xfrm_state_lookup(net, mark, &id->daddr, id->spi, id->proto, id->family);
1939 if (x == NULL)
1940 return -ESRCH;
1941
1942 r_skb = nlmsg_new(xfrm_aevent_msgsize(x), GFP_ATOMIC);
1943 if (r_skb == NULL) {
1944 xfrm_state_put(x);
1945 return -ENOMEM;
1946 }
1947
1948 /*
1949 * XXX: is this lock really needed - none of the other
1950 * gets lock (the concern is things getting updated
1951 * while we are still reading) - jhs
1952 */
1953 spin_lock_bh(&x->lock);
1954 c.data.aevent = p->flags;
1955 c.seq = nlh->nlmsg_seq;
1956 c.portid = nlh->nlmsg_pid;
1957
1958 if (build_aevent(r_skb, x, &c) < 0)
1959 BUG();
1960 err = nlmsg_unicast(net->xfrm.nlsk, r_skb, NETLINK_CB(skb).portid);
1961 spin_unlock_bh(&x->lock);
1962 xfrm_state_put(x);
1963 return err;
1964 }
1965
xfrm_new_ae(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)1966 static int xfrm_new_ae(struct sk_buff *skb, struct nlmsghdr *nlh,
1967 struct nlattr **attrs)
1968 {
1969 struct net *net = sock_net(skb->sk);
1970 struct xfrm_state *x;
1971 struct km_event c;
1972 int err = -EINVAL;
1973 u32 mark = 0;
1974 struct xfrm_mark m;
1975 struct xfrm_aevent_id *p = nlmsg_data(nlh);
1976 struct nlattr *rp = attrs[XFRMA_REPLAY_VAL];
1977 struct nlattr *re = attrs[XFRMA_REPLAY_ESN_VAL];
1978 struct nlattr *lt = attrs[XFRMA_LTIME_VAL];
1979 struct nlattr *et = attrs[XFRMA_ETIMER_THRESH];
1980 struct nlattr *rt = attrs[XFRMA_REPLAY_THRESH];
1981
1982 if (!lt && !rp && !re && !et && !rt)
1983 return err;
1984
1985 /* pedantic mode - thou shalt sayeth replaceth */
1986 if (!(nlh->nlmsg_flags&NLM_F_REPLACE))
1987 return err;
1988
1989 mark = xfrm_mark_get(attrs, &m);
1990
1991 x = xfrm_state_lookup(net, mark, &p->sa_id.daddr, p->sa_id.spi, p->sa_id.proto, p->sa_id.family);
1992 if (x == NULL)
1993 return -ESRCH;
1994
1995 if (x->km.state != XFRM_STATE_VALID)
1996 goto out;
1997
1998 err = xfrm_replay_verify_len(x->replay_esn, re);
1999 if (err)
2000 goto out;
2001
2002 spin_lock_bh(&x->lock);
2003 xfrm_update_ae_params(x, attrs, 1);
2004 spin_unlock_bh(&x->lock);
2005
2006 c.event = nlh->nlmsg_type;
2007 c.seq = nlh->nlmsg_seq;
2008 c.portid = nlh->nlmsg_pid;
2009 c.data.aevent = XFRM_AE_CU;
2010 km_state_notify(x, &c);
2011 err = 0;
2012 out:
2013 xfrm_state_put(x);
2014 return err;
2015 }
2016
xfrm_flush_policy(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)2017 static int xfrm_flush_policy(struct sk_buff *skb, struct nlmsghdr *nlh,
2018 struct nlattr **attrs)
2019 {
2020 struct net *net = sock_net(skb->sk);
2021 struct km_event c;
2022 u8 type = XFRM_POLICY_TYPE_MAIN;
2023 int err;
2024
2025 err = copy_from_user_policy_type(&type, attrs);
2026 if (err)
2027 return err;
2028
2029 err = xfrm_policy_flush(net, type, true);
2030 if (err) {
2031 if (err == -ESRCH) /* empty table */
2032 return 0;
2033 return err;
2034 }
2035
2036 c.data.type = type;
2037 c.event = nlh->nlmsg_type;
2038 c.seq = nlh->nlmsg_seq;
2039 c.portid = nlh->nlmsg_pid;
2040 c.net = net;
2041 km_policy_notify(NULL, 0, &c);
2042 return 0;
2043 }
2044
xfrm_add_pol_expire(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)2045 static int xfrm_add_pol_expire(struct sk_buff *skb, struct nlmsghdr *nlh,
2046 struct nlattr **attrs)
2047 {
2048 struct net *net = sock_net(skb->sk);
2049 struct xfrm_policy *xp;
2050 struct xfrm_user_polexpire *up = nlmsg_data(nlh);
2051 struct xfrm_userpolicy_info *p = &up->pol;
2052 u8 type = XFRM_POLICY_TYPE_MAIN;
2053 int err = -ENOENT;
2054 struct xfrm_mark m;
2055 u32 mark = xfrm_mark_get(attrs, &m);
2056
2057 err = copy_from_user_policy_type(&type, attrs);
2058 if (err)
2059 return err;
2060
2061 err = verify_policy_dir(p->dir);
2062 if (err)
2063 return err;
2064
2065 if (p->index)
2066 xp = xfrm_policy_byid(net, mark, type, p->dir, p->index, 0, &err);
2067 else {
2068 struct nlattr *rt = attrs[XFRMA_SEC_CTX];
2069 struct xfrm_sec_ctx *ctx;
2070
2071 err = verify_sec_ctx_len(attrs);
2072 if (err)
2073 return err;
2074
2075 ctx = NULL;
2076 if (rt) {
2077 struct xfrm_user_sec_ctx *uctx = nla_data(rt);
2078
2079 err = security_xfrm_policy_alloc(&ctx, uctx, GFP_KERNEL);
2080 if (err)
2081 return err;
2082 }
2083 xp = xfrm_policy_bysel_ctx(net, mark, type, p->dir,
2084 &p->sel, ctx, 0, &err);
2085 security_xfrm_policy_free(ctx);
2086 }
2087 if (xp == NULL)
2088 return -ENOENT;
2089
2090 if (unlikely(xp->walk.dead))
2091 goto out;
2092
2093 err = 0;
2094 if (up->hard) {
2095 xfrm_policy_delete(xp, p->dir);
2096 xfrm_audit_policy_delete(xp, 1, true);
2097 }
2098 km_policy_expired(xp, p->dir, up->hard, nlh->nlmsg_pid);
2099
2100 out:
2101 xfrm_pol_put(xp);
2102 return err;
2103 }
2104
xfrm_add_sa_expire(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)2105 static int xfrm_add_sa_expire(struct sk_buff *skb, struct nlmsghdr *nlh,
2106 struct nlattr **attrs)
2107 {
2108 struct net *net = sock_net(skb->sk);
2109 struct xfrm_state *x;
2110 int err;
2111 struct xfrm_user_expire *ue = nlmsg_data(nlh);
2112 struct xfrm_usersa_info *p = &ue->state;
2113 struct xfrm_mark m;
2114 u32 mark = xfrm_mark_get(attrs, &m);
2115
2116 x = xfrm_state_lookup(net, mark, &p->id.daddr, p->id.spi, p->id.proto, p->family);
2117
2118 err = -ENOENT;
2119 if (x == NULL)
2120 return err;
2121
2122 spin_lock_bh(&x->lock);
2123 err = -EINVAL;
2124 if (x->km.state != XFRM_STATE_VALID)
2125 goto out;
2126 km_state_expired(x, ue->hard, nlh->nlmsg_pid);
2127
2128 if (ue->hard) {
2129 __xfrm_state_delete(x);
2130 xfrm_audit_state_delete(x, 1, true);
2131 }
2132 err = 0;
2133 out:
2134 spin_unlock_bh(&x->lock);
2135 xfrm_state_put(x);
2136 return err;
2137 }
2138
xfrm_add_acquire(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)2139 static int xfrm_add_acquire(struct sk_buff *skb, struct nlmsghdr *nlh,
2140 struct nlattr **attrs)
2141 {
2142 struct net *net = sock_net(skb->sk);
2143 struct xfrm_policy *xp;
2144 struct xfrm_user_tmpl *ut;
2145 int i;
2146 struct nlattr *rt = attrs[XFRMA_TMPL];
2147 struct xfrm_mark mark;
2148
2149 struct xfrm_user_acquire *ua = nlmsg_data(nlh);
2150 struct xfrm_state *x = xfrm_state_alloc(net);
2151 int err = -ENOMEM;
2152
2153 if (!x)
2154 goto nomem;
2155
2156 xfrm_mark_get(attrs, &mark);
2157
2158 err = verify_newpolicy_info(&ua->policy);
2159 if (err)
2160 goto free_state;
2161
2162 /* build an XP */
2163 xp = xfrm_policy_construct(net, &ua->policy, attrs, &err);
2164 if (!xp)
2165 goto free_state;
2166
2167 memcpy(&x->id, &ua->id, sizeof(ua->id));
2168 memcpy(&x->props.saddr, &ua->saddr, sizeof(ua->saddr));
2169 memcpy(&x->sel, &ua->sel, sizeof(ua->sel));
2170 xp->mark.m = x->mark.m = mark.m;
2171 xp->mark.v = x->mark.v = mark.v;
2172 ut = nla_data(rt);
2173 /* extract the templates and for each call km_key */
2174 for (i = 0; i < xp->xfrm_nr; i++, ut++) {
2175 struct xfrm_tmpl *t = &xp->xfrm_vec[i];
2176 memcpy(&x->id, &t->id, sizeof(x->id));
2177 x->props.mode = t->mode;
2178 x->props.reqid = t->reqid;
2179 x->props.family = ut->family;
2180 t->aalgos = ua->aalgos;
2181 t->ealgos = ua->ealgos;
2182 t->calgos = ua->calgos;
2183 err = km_query(x, t, xp);
2184
2185 }
2186
2187 kfree(x);
2188 kfree(xp);
2189
2190 return 0;
2191
2192 free_state:
2193 kfree(x);
2194 nomem:
2195 return err;
2196 }
2197
2198 #ifdef CONFIG_XFRM_MIGRATE
copy_from_user_migrate(struct xfrm_migrate * ma,struct xfrm_kmaddress * k,struct nlattr ** attrs,int * num)2199 static int copy_from_user_migrate(struct xfrm_migrate *ma,
2200 struct xfrm_kmaddress *k,
2201 struct nlattr **attrs, int *num)
2202 {
2203 struct nlattr *rt = attrs[XFRMA_MIGRATE];
2204 struct xfrm_user_migrate *um;
2205 int i, num_migrate;
2206
2207 if (k != NULL) {
2208 struct xfrm_user_kmaddress *uk;
2209
2210 uk = nla_data(attrs[XFRMA_KMADDRESS]);
2211 memcpy(&k->local, &uk->local, sizeof(k->local));
2212 memcpy(&k->remote, &uk->remote, sizeof(k->remote));
2213 k->family = uk->family;
2214 k->reserved = uk->reserved;
2215 }
2216
2217 um = nla_data(rt);
2218 num_migrate = nla_len(rt) / sizeof(*um);
2219
2220 if (num_migrate <= 0 || num_migrate > XFRM_MAX_DEPTH)
2221 return -EINVAL;
2222
2223 for (i = 0; i < num_migrate; i++, um++, ma++) {
2224 memcpy(&ma->old_daddr, &um->old_daddr, sizeof(ma->old_daddr));
2225 memcpy(&ma->old_saddr, &um->old_saddr, sizeof(ma->old_saddr));
2226 memcpy(&ma->new_daddr, &um->new_daddr, sizeof(ma->new_daddr));
2227 memcpy(&ma->new_saddr, &um->new_saddr, sizeof(ma->new_saddr));
2228
2229 ma->proto = um->proto;
2230 ma->mode = um->mode;
2231 ma->reqid = um->reqid;
2232
2233 ma->old_family = um->old_family;
2234 ma->new_family = um->new_family;
2235 }
2236
2237 *num = i;
2238 return 0;
2239 }
2240
xfrm_do_migrate(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)2241 static int xfrm_do_migrate(struct sk_buff *skb, struct nlmsghdr *nlh,
2242 struct nlattr **attrs)
2243 {
2244 struct xfrm_userpolicy_id *pi = nlmsg_data(nlh);
2245 struct xfrm_migrate m[XFRM_MAX_DEPTH];
2246 struct xfrm_kmaddress km, *kmp;
2247 u8 type;
2248 int err;
2249 int n = 0;
2250 struct net *net = sock_net(skb->sk);
2251
2252 err = verify_policy_dir(pi->dir);
2253 if (err)
2254 return err;
2255
2256 if (attrs[XFRMA_MIGRATE] == NULL)
2257 return -EINVAL;
2258
2259 kmp = attrs[XFRMA_KMADDRESS] ? &km : NULL;
2260
2261 err = copy_from_user_policy_type(&type, attrs);
2262 if (err)
2263 return err;
2264
2265 err = copy_from_user_migrate((struct xfrm_migrate *)m, kmp, attrs, &n);
2266 if (err)
2267 return err;
2268
2269 if (!n)
2270 return 0;
2271
2272 xfrm_migrate(&pi->sel, pi->dir, type, m, n, kmp, net);
2273
2274 return 0;
2275 }
2276 #else
xfrm_do_migrate(struct sk_buff * skb,struct nlmsghdr * nlh,struct nlattr ** attrs)2277 static int xfrm_do_migrate(struct sk_buff *skb, struct nlmsghdr *nlh,
2278 struct nlattr **attrs)
2279 {
2280 return -ENOPROTOOPT;
2281 }
2282 #endif
2283
2284 #ifdef CONFIG_XFRM_MIGRATE
copy_to_user_migrate(const struct xfrm_migrate * m,struct sk_buff * skb)2285 static int copy_to_user_migrate(const struct xfrm_migrate *m, struct sk_buff *skb)
2286 {
2287 struct xfrm_user_migrate um;
2288
2289 memset(&um, 0, sizeof(um));
2290 um.proto = m->proto;
2291 um.mode = m->mode;
2292 um.reqid = m->reqid;
2293 um.old_family = m->old_family;
2294 memcpy(&um.old_daddr, &m->old_daddr, sizeof(um.old_daddr));
2295 memcpy(&um.old_saddr, &m->old_saddr, sizeof(um.old_saddr));
2296 um.new_family = m->new_family;
2297 memcpy(&um.new_daddr, &m->new_daddr, sizeof(um.new_daddr));
2298 memcpy(&um.new_saddr, &m->new_saddr, sizeof(um.new_saddr));
2299
2300 return nla_put(skb, XFRMA_MIGRATE, sizeof(um), &um);
2301 }
2302
copy_to_user_kmaddress(const struct xfrm_kmaddress * k,struct sk_buff * skb)2303 static int copy_to_user_kmaddress(const struct xfrm_kmaddress *k, struct sk_buff *skb)
2304 {
2305 struct xfrm_user_kmaddress uk;
2306
2307 memset(&uk, 0, sizeof(uk));
2308 uk.family = k->family;
2309 uk.reserved = k->reserved;
2310 memcpy(&uk.local, &k->local, sizeof(uk.local));
2311 memcpy(&uk.remote, &k->remote, sizeof(uk.remote));
2312
2313 return nla_put(skb, XFRMA_KMADDRESS, sizeof(uk), &uk);
2314 }
2315
xfrm_migrate_msgsize(int num_migrate,int with_kma)2316 static inline size_t xfrm_migrate_msgsize(int num_migrate, int with_kma)
2317 {
2318 return NLMSG_ALIGN(sizeof(struct xfrm_userpolicy_id))
2319 + (with_kma ? nla_total_size(sizeof(struct xfrm_kmaddress)) : 0)
2320 + nla_total_size(sizeof(struct xfrm_user_migrate) * num_migrate)
2321 + userpolicy_type_attrsize();
2322 }
2323
build_migrate(struct sk_buff * skb,const struct xfrm_migrate * m,int num_migrate,const struct xfrm_kmaddress * k,const struct xfrm_selector * sel,u8 dir,u8 type)2324 static int build_migrate(struct sk_buff *skb, const struct xfrm_migrate *m,
2325 int num_migrate, const struct xfrm_kmaddress *k,
2326 const struct xfrm_selector *sel, u8 dir, u8 type)
2327 {
2328 const struct xfrm_migrate *mp;
2329 struct xfrm_userpolicy_id *pol_id;
2330 struct nlmsghdr *nlh;
2331 int i, err;
2332
2333 nlh = nlmsg_put(skb, 0, 0, XFRM_MSG_MIGRATE, sizeof(*pol_id), 0);
2334 if (nlh == NULL)
2335 return -EMSGSIZE;
2336
2337 pol_id = nlmsg_data(nlh);
2338 /* copy data from selector, dir, and type to the pol_id */
2339 memset(pol_id, 0, sizeof(*pol_id));
2340 memcpy(&pol_id->sel, sel, sizeof(pol_id->sel));
2341 pol_id->dir = dir;
2342
2343 if (k != NULL) {
2344 err = copy_to_user_kmaddress(k, skb);
2345 if (err)
2346 goto out_cancel;
2347 }
2348 err = copy_to_user_policy_type(type, skb);
2349 if (err)
2350 goto out_cancel;
2351 for (i = 0, mp = m ; i < num_migrate; i++, mp++) {
2352 err = copy_to_user_migrate(mp, skb);
2353 if (err)
2354 goto out_cancel;
2355 }
2356
2357 nlmsg_end(skb, nlh);
2358 return 0;
2359
2360 out_cancel:
2361 nlmsg_cancel(skb, nlh);
2362 return err;
2363 }
2364
xfrm_send_migrate(const struct xfrm_selector * sel,u8 dir,u8 type,const struct xfrm_migrate * m,int num_migrate,const struct xfrm_kmaddress * k)2365 static int xfrm_send_migrate(const struct xfrm_selector *sel, u8 dir, u8 type,
2366 const struct xfrm_migrate *m, int num_migrate,
2367 const struct xfrm_kmaddress *k)
2368 {
2369 struct net *net = &init_net;
2370 struct sk_buff *skb;
2371 int err;
2372
2373 err = verify_policy_dir(dir);
2374 if (err)
2375 return err;
2376
2377 skb = nlmsg_new(xfrm_migrate_msgsize(num_migrate, !!k), GFP_ATOMIC);
2378 if (skb == NULL)
2379 return -ENOMEM;
2380
2381 /* build migrate */
2382 if (build_migrate(skb, m, num_migrate, k, sel, dir, type) < 0)
2383 BUG();
2384
2385 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_MIGRATE);
2386 }
2387 #else
xfrm_send_migrate(const struct xfrm_selector * sel,u8 dir,u8 type,const struct xfrm_migrate * m,int num_migrate,const struct xfrm_kmaddress * k)2388 static int xfrm_send_migrate(const struct xfrm_selector *sel, u8 dir, u8 type,
2389 const struct xfrm_migrate *m, int num_migrate,
2390 const struct xfrm_kmaddress *k)
2391 {
2392 return -ENOPROTOOPT;
2393 }
2394 #endif
2395
2396 #define XMSGSIZE(type) sizeof(struct type)
2397
2398 static const int xfrm_msg_min[XFRM_NR_MSGTYPES] = {
2399 [XFRM_MSG_NEWSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_info),
2400 [XFRM_MSG_DELSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_id),
2401 [XFRM_MSG_GETSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_id),
2402 [XFRM_MSG_NEWPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_info),
2403 [XFRM_MSG_DELPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_id),
2404 [XFRM_MSG_GETPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_id),
2405 [XFRM_MSG_ALLOCSPI - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userspi_info),
2406 [XFRM_MSG_ACQUIRE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_user_acquire),
2407 [XFRM_MSG_EXPIRE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_user_expire),
2408 [XFRM_MSG_UPDPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_info),
2409 [XFRM_MSG_UPDSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_info),
2410 [XFRM_MSG_POLEXPIRE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_user_polexpire),
2411 [XFRM_MSG_FLUSHSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_flush),
2412 [XFRM_MSG_FLUSHPOLICY - XFRM_MSG_BASE] = 0,
2413 [XFRM_MSG_NEWAE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_aevent_id),
2414 [XFRM_MSG_GETAE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_aevent_id),
2415 [XFRM_MSG_REPORT - XFRM_MSG_BASE] = XMSGSIZE(xfrm_user_report),
2416 [XFRM_MSG_MIGRATE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_id),
2417 [XFRM_MSG_GETSADINFO - XFRM_MSG_BASE] = sizeof(u32),
2418 [XFRM_MSG_NEWSPDINFO - XFRM_MSG_BASE] = sizeof(u32),
2419 [XFRM_MSG_GETSPDINFO - XFRM_MSG_BASE] = sizeof(u32),
2420 };
2421
2422 #undef XMSGSIZE
2423
2424 static const struct nla_policy xfrma_policy[XFRMA_MAX+1] = {
2425 [XFRMA_SA] = { .len = sizeof(struct xfrm_usersa_info)},
2426 [XFRMA_POLICY] = { .len = sizeof(struct xfrm_userpolicy_info)},
2427 [XFRMA_LASTUSED] = { .type = NLA_U64},
2428 [XFRMA_ALG_AUTH_TRUNC] = { .len = sizeof(struct xfrm_algo_auth)},
2429 [XFRMA_ALG_AEAD] = { .len = sizeof(struct xfrm_algo_aead) },
2430 [XFRMA_ALG_AUTH] = { .len = sizeof(struct xfrm_algo) },
2431 [XFRMA_ALG_CRYPT] = { .len = sizeof(struct xfrm_algo) },
2432 [XFRMA_ALG_COMP] = { .len = sizeof(struct xfrm_algo) },
2433 [XFRMA_ENCAP] = { .len = sizeof(struct xfrm_encap_tmpl) },
2434 [XFRMA_TMPL] = { .len = sizeof(struct xfrm_user_tmpl) },
2435 [XFRMA_SEC_CTX] = { .len = sizeof(struct xfrm_sec_ctx) },
2436 [XFRMA_LTIME_VAL] = { .len = sizeof(struct xfrm_lifetime_cur) },
2437 [XFRMA_REPLAY_VAL] = { .len = sizeof(struct xfrm_replay_state) },
2438 [XFRMA_REPLAY_THRESH] = { .type = NLA_U32 },
2439 [XFRMA_ETIMER_THRESH] = { .type = NLA_U32 },
2440 [XFRMA_SRCADDR] = { .len = sizeof(xfrm_address_t) },
2441 [XFRMA_COADDR] = { .len = sizeof(xfrm_address_t) },
2442 [XFRMA_POLICY_TYPE] = { .len = sizeof(struct xfrm_userpolicy_type)},
2443 [XFRMA_MIGRATE] = { .len = sizeof(struct xfrm_user_migrate) },
2444 [XFRMA_KMADDRESS] = { .len = sizeof(struct xfrm_user_kmaddress) },
2445 [XFRMA_MARK] = { .len = sizeof(struct xfrm_mark) },
2446 [XFRMA_TFCPAD] = { .type = NLA_U32 },
2447 [XFRMA_REPLAY_ESN_VAL] = { .len = sizeof(struct xfrm_replay_state_esn) },
2448 [XFRMA_SA_EXTRA_FLAGS] = { .type = NLA_U32 },
2449 [XFRMA_PROTO] = { .type = NLA_U8 },
2450 [XFRMA_ADDRESS_FILTER] = { .len = sizeof(struct xfrm_address_filter) },
2451 [XFRMA_OUTPUT_MARK] = { .len = NLA_U32 },
2452 };
2453
2454 static const struct nla_policy xfrma_spd_policy[XFRMA_SPD_MAX+1] = {
2455 [XFRMA_SPD_IPV4_HTHRESH] = { .len = sizeof(struct xfrmu_spdhthresh) },
2456 [XFRMA_SPD_IPV6_HTHRESH] = { .len = sizeof(struct xfrmu_spdhthresh) },
2457 };
2458
2459 static const struct xfrm_link {
2460 int (*doit)(struct sk_buff *, struct nlmsghdr *, struct nlattr **);
2461 int (*start)(struct netlink_callback *);
2462 int (*dump)(struct sk_buff *, struct netlink_callback *);
2463 int (*done)(struct netlink_callback *);
2464 const struct nla_policy *nla_pol;
2465 int nla_max;
2466 } xfrm_dispatch[XFRM_NR_MSGTYPES] = {
2467 [XFRM_MSG_NEWSA - XFRM_MSG_BASE] = { .doit = xfrm_add_sa },
2468 [XFRM_MSG_DELSA - XFRM_MSG_BASE] = { .doit = xfrm_del_sa },
2469 [XFRM_MSG_GETSA - XFRM_MSG_BASE] = { .doit = xfrm_get_sa,
2470 .dump = xfrm_dump_sa,
2471 .done = xfrm_dump_sa_done },
2472 [XFRM_MSG_NEWPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_add_policy },
2473 [XFRM_MSG_DELPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_get_policy },
2474 [XFRM_MSG_GETPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_get_policy,
2475 .start = xfrm_dump_policy_start,
2476 .dump = xfrm_dump_policy,
2477 .done = xfrm_dump_policy_done },
2478 [XFRM_MSG_ALLOCSPI - XFRM_MSG_BASE] = { .doit = xfrm_alloc_userspi },
2479 [XFRM_MSG_ACQUIRE - XFRM_MSG_BASE] = { .doit = xfrm_add_acquire },
2480 [XFRM_MSG_EXPIRE - XFRM_MSG_BASE] = { .doit = xfrm_add_sa_expire },
2481 [XFRM_MSG_UPDPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_add_policy },
2482 [XFRM_MSG_UPDSA - XFRM_MSG_BASE] = { .doit = xfrm_add_sa },
2483 [XFRM_MSG_POLEXPIRE - XFRM_MSG_BASE] = { .doit = xfrm_add_pol_expire},
2484 [XFRM_MSG_FLUSHSA - XFRM_MSG_BASE] = { .doit = xfrm_flush_sa },
2485 [XFRM_MSG_FLUSHPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_flush_policy },
2486 [XFRM_MSG_NEWAE - XFRM_MSG_BASE] = { .doit = xfrm_new_ae },
2487 [XFRM_MSG_GETAE - XFRM_MSG_BASE] = { .doit = xfrm_get_ae },
2488 [XFRM_MSG_MIGRATE - XFRM_MSG_BASE] = { .doit = xfrm_do_migrate },
2489 [XFRM_MSG_GETSADINFO - XFRM_MSG_BASE] = { .doit = xfrm_get_sadinfo },
2490 [XFRM_MSG_NEWSPDINFO - XFRM_MSG_BASE] = { .doit = xfrm_set_spdinfo,
2491 .nla_pol = xfrma_spd_policy,
2492 .nla_max = XFRMA_SPD_MAX },
2493 [XFRM_MSG_GETSPDINFO - XFRM_MSG_BASE] = { .doit = xfrm_get_spdinfo },
2494 };
2495
xfrm_user_rcv_msg(struct sk_buff * skb,struct nlmsghdr * nlh)2496 static int xfrm_user_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh)
2497 {
2498 struct net *net = sock_net(skb->sk);
2499 struct nlattr *attrs[XFRMA_MAX+1];
2500 const struct xfrm_link *link;
2501 int type, err;
2502
2503 #ifdef CONFIG_COMPAT
2504 if (in_compat_syscall())
2505 return -EOPNOTSUPP;
2506 #endif
2507
2508 type = nlh->nlmsg_type;
2509 if (type > XFRM_MSG_MAX)
2510 return -EINVAL;
2511
2512 type -= XFRM_MSG_BASE;
2513 link = &xfrm_dispatch[type];
2514
2515 /* All operations require privileges, even GET */
2516 if (!netlink_net_capable(skb, CAP_NET_ADMIN))
2517 return -EPERM;
2518
2519 if ((type == (XFRM_MSG_GETSA - XFRM_MSG_BASE) ||
2520 type == (XFRM_MSG_GETPOLICY - XFRM_MSG_BASE)) &&
2521 (nlh->nlmsg_flags & NLM_F_DUMP)) {
2522 if (link->dump == NULL)
2523 return -EINVAL;
2524
2525 {
2526 struct netlink_dump_control c = {
2527 .start = link->start,
2528 .dump = link->dump,
2529 .done = link->done,
2530 };
2531 return netlink_dump_start(net->xfrm.nlsk, skb, nlh, &c);
2532 }
2533 }
2534
2535 err = nlmsg_parse(nlh, xfrm_msg_min[type], attrs,
2536 link->nla_max ? : XFRMA_MAX,
2537 link->nla_pol ? : xfrma_policy);
2538 if (err < 0)
2539 return err;
2540
2541 if (link->doit == NULL)
2542 return -EINVAL;
2543
2544 return link->doit(skb, nlh, attrs);
2545 }
2546
xfrm_netlink_rcv(struct sk_buff * skb)2547 static void xfrm_netlink_rcv(struct sk_buff *skb)
2548 {
2549 struct net *net = sock_net(skb->sk);
2550
2551 mutex_lock(&net->xfrm.xfrm_cfg_mutex);
2552 netlink_rcv_skb(skb, &xfrm_user_rcv_msg);
2553 mutex_unlock(&net->xfrm.xfrm_cfg_mutex);
2554 }
2555
xfrm_expire_msgsize(void)2556 static inline size_t xfrm_expire_msgsize(void)
2557 {
2558 return NLMSG_ALIGN(sizeof(struct xfrm_user_expire))
2559 + nla_total_size(sizeof(struct xfrm_mark));
2560 }
2561
build_expire(struct sk_buff * skb,struct xfrm_state * x,const struct km_event * c)2562 static int build_expire(struct sk_buff *skb, struct xfrm_state *x, const struct km_event *c)
2563 {
2564 struct xfrm_user_expire *ue;
2565 struct nlmsghdr *nlh;
2566 int err;
2567
2568 nlh = nlmsg_put(skb, c->portid, 0, XFRM_MSG_EXPIRE, sizeof(*ue), 0);
2569 if (nlh == NULL)
2570 return -EMSGSIZE;
2571
2572 ue = nlmsg_data(nlh);
2573 copy_to_user_state(x, &ue->state);
2574 ue->hard = (c->data.hard != 0) ? 1 : 0;
2575
2576 err = xfrm_mark_put(skb, &x->mark);
2577 if (err)
2578 return err;
2579
2580 nlmsg_end(skb, nlh);
2581 return 0;
2582 }
2583
xfrm_exp_state_notify(struct xfrm_state * x,const struct km_event * c)2584 static int xfrm_exp_state_notify(struct xfrm_state *x, const struct km_event *c)
2585 {
2586 struct net *net = xs_net(x);
2587 struct sk_buff *skb;
2588
2589 skb = nlmsg_new(xfrm_expire_msgsize(), GFP_ATOMIC);
2590 if (skb == NULL)
2591 return -ENOMEM;
2592
2593 if (build_expire(skb, x, c) < 0) {
2594 kfree_skb(skb);
2595 return -EMSGSIZE;
2596 }
2597
2598 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_EXPIRE);
2599 }
2600
xfrm_aevent_state_notify(struct xfrm_state * x,const struct km_event * c)2601 static int xfrm_aevent_state_notify(struct xfrm_state *x, const struct km_event *c)
2602 {
2603 struct net *net = xs_net(x);
2604 struct sk_buff *skb;
2605
2606 skb = nlmsg_new(xfrm_aevent_msgsize(x), GFP_ATOMIC);
2607 if (skb == NULL)
2608 return -ENOMEM;
2609
2610 if (build_aevent(skb, x, c) < 0)
2611 BUG();
2612
2613 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_AEVENTS);
2614 }
2615
xfrm_notify_sa_flush(const struct km_event * c)2616 static int xfrm_notify_sa_flush(const struct km_event *c)
2617 {
2618 struct net *net = c->net;
2619 struct xfrm_usersa_flush *p;
2620 struct nlmsghdr *nlh;
2621 struct sk_buff *skb;
2622 int len = NLMSG_ALIGN(sizeof(struct xfrm_usersa_flush));
2623
2624 skb = nlmsg_new(len, GFP_ATOMIC);
2625 if (skb == NULL)
2626 return -ENOMEM;
2627
2628 nlh = nlmsg_put(skb, c->portid, c->seq, XFRM_MSG_FLUSHSA, sizeof(*p), 0);
2629 if (nlh == NULL) {
2630 kfree_skb(skb);
2631 return -EMSGSIZE;
2632 }
2633
2634 p = nlmsg_data(nlh);
2635 p->proto = c->data.proto;
2636
2637 nlmsg_end(skb, nlh);
2638
2639 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_SA);
2640 }
2641
xfrm_sa_len(struct xfrm_state * x)2642 static inline size_t xfrm_sa_len(struct xfrm_state *x)
2643 {
2644 size_t l = 0;
2645 if (x->aead)
2646 l += nla_total_size(aead_len(x->aead));
2647 if (x->aalg) {
2648 l += nla_total_size(sizeof(struct xfrm_algo) +
2649 (x->aalg->alg_key_len + 7) / 8);
2650 l += nla_total_size(xfrm_alg_auth_len(x->aalg));
2651 }
2652 if (x->ealg)
2653 l += nla_total_size(xfrm_alg_len(x->ealg));
2654 if (x->calg)
2655 l += nla_total_size(sizeof(*x->calg));
2656 if (x->encap)
2657 l += nla_total_size(sizeof(*x->encap));
2658 if (x->tfcpad)
2659 l += nla_total_size(sizeof(x->tfcpad));
2660 if (x->replay_esn)
2661 l += nla_total_size(xfrm_replay_state_esn_len(x->replay_esn));
2662 else
2663 l += nla_total_size(sizeof(struct xfrm_replay_state));
2664 if (x->security)
2665 l += nla_total_size(sizeof(struct xfrm_user_sec_ctx) +
2666 x->security->ctx_len);
2667 if (x->coaddr)
2668 l += nla_total_size(sizeof(*x->coaddr));
2669 if (x->props.extra_flags)
2670 l += nla_total_size(sizeof(x->props.extra_flags));
2671 if (x->props.output_mark)
2672 l += nla_total_size(sizeof(x->props.output_mark));
2673
2674 /* Must count x->lastused as it may become non-zero behind our back. */
2675 l += nla_total_size_64bit(sizeof(u64));
2676
2677 return l;
2678 }
2679
xfrm_notify_sa(struct xfrm_state * x,const struct km_event * c)2680 static int xfrm_notify_sa(struct xfrm_state *x, const struct km_event *c)
2681 {
2682 struct net *net = xs_net(x);
2683 struct xfrm_usersa_info *p;
2684 struct xfrm_usersa_id *id;
2685 struct nlmsghdr *nlh;
2686 struct sk_buff *skb;
2687 int len = xfrm_sa_len(x);
2688 int headlen, err;
2689
2690 headlen = sizeof(*p);
2691 if (c->event == XFRM_MSG_DELSA) {
2692 len += nla_total_size(headlen);
2693 headlen = sizeof(*id);
2694 len += nla_total_size(sizeof(struct xfrm_mark));
2695 }
2696 len += NLMSG_ALIGN(headlen);
2697
2698 skb = nlmsg_new(len, GFP_ATOMIC);
2699 if (skb == NULL)
2700 return -ENOMEM;
2701
2702 nlh = nlmsg_put(skb, c->portid, c->seq, c->event, headlen, 0);
2703 err = -EMSGSIZE;
2704 if (nlh == NULL)
2705 goto out_free_skb;
2706
2707 p = nlmsg_data(nlh);
2708 if (c->event == XFRM_MSG_DELSA) {
2709 struct nlattr *attr;
2710
2711 id = nlmsg_data(nlh);
2712 memcpy(&id->daddr, &x->id.daddr, sizeof(id->daddr));
2713 id->spi = x->id.spi;
2714 id->family = x->props.family;
2715 id->proto = x->id.proto;
2716
2717 attr = nla_reserve(skb, XFRMA_SA, sizeof(*p));
2718 err = -EMSGSIZE;
2719 if (attr == NULL)
2720 goto out_free_skb;
2721
2722 p = nla_data(attr);
2723 }
2724 err = copy_to_user_state_extra(x, p, skb);
2725 if (err)
2726 goto out_free_skb;
2727
2728 nlmsg_end(skb, nlh);
2729
2730 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_SA);
2731
2732 out_free_skb:
2733 kfree_skb(skb);
2734 return err;
2735 }
2736
xfrm_send_state_notify(struct xfrm_state * x,const struct km_event * c)2737 static int xfrm_send_state_notify(struct xfrm_state *x, const struct km_event *c)
2738 {
2739
2740 switch (c->event) {
2741 case XFRM_MSG_EXPIRE:
2742 return xfrm_exp_state_notify(x, c);
2743 case XFRM_MSG_NEWAE:
2744 return xfrm_aevent_state_notify(x, c);
2745 case XFRM_MSG_DELSA:
2746 case XFRM_MSG_UPDSA:
2747 case XFRM_MSG_NEWSA:
2748 return xfrm_notify_sa(x, c);
2749 case XFRM_MSG_FLUSHSA:
2750 return xfrm_notify_sa_flush(c);
2751 default:
2752 printk(KERN_NOTICE "xfrm_user: Unknown SA event %d\n",
2753 c->event);
2754 break;
2755 }
2756
2757 return 0;
2758
2759 }
2760
xfrm_acquire_msgsize(struct xfrm_state * x,struct xfrm_policy * xp)2761 static inline size_t xfrm_acquire_msgsize(struct xfrm_state *x,
2762 struct xfrm_policy *xp)
2763 {
2764 return NLMSG_ALIGN(sizeof(struct xfrm_user_acquire))
2765 + nla_total_size(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr)
2766 + nla_total_size(sizeof(struct xfrm_mark))
2767 + nla_total_size(xfrm_user_sec_ctx_size(x->security))
2768 + userpolicy_type_attrsize();
2769 }
2770
build_acquire(struct sk_buff * skb,struct xfrm_state * x,struct xfrm_tmpl * xt,struct xfrm_policy * xp)2771 static int build_acquire(struct sk_buff *skb, struct xfrm_state *x,
2772 struct xfrm_tmpl *xt, struct xfrm_policy *xp)
2773 {
2774 __u32 seq = xfrm_get_acqseq();
2775 struct xfrm_user_acquire *ua;
2776 struct nlmsghdr *nlh;
2777 int err;
2778
2779 nlh = nlmsg_put(skb, 0, 0, XFRM_MSG_ACQUIRE, sizeof(*ua), 0);
2780 if (nlh == NULL)
2781 return -EMSGSIZE;
2782
2783 ua = nlmsg_data(nlh);
2784 memcpy(&ua->id, &x->id, sizeof(ua->id));
2785 memcpy(&ua->saddr, &x->props.saddr, sizeof(ua->saddr));
2786 memcpy(&ua->sel, &x->sel, sizeof(ua->sel));
2787 copy_to_user_policy(xp, &ua->policy, XFRM_POLICY_OUT);
2788 ua->aalgos = xt->aalgos;
2789 ua->ealgos = xt->ealgos;
2790 ua->calgos = xt->calgos;
2791 ua->seq = x->km.seq = seq;
2792
2793 err = copy_to_user_tmpl(xp, skb);
2794 if (!err)
2795 err = copy_to_user_state_sec_ctx(x, skb);
2796 if (!err)
2797 err = copy_to_user_policy_type(xp->type, skb);
2798 if (!err)
2799 err = xfrm_mark_put(skb, &xp->mark);
2800 if (err) {
2801 nlmsg_cancel(skb, nlh);
2802 return err;
2803 }
2804
2805 nlmsg_end(skb, nlh);
2806 return 0;
2807 }
2808
xfrm_send_acquire(struct xfrm_state * x,struct xfrm_tmpl * xt,struct xfrm_policy * xp)2809 static int xfrm_send_acquire(struct xfrm_state *x, struct xfrm_tmpl *xt,
2810 struct xfrm_policy *xp)
2811 {
2812 struct net *net = xs_net(x);
2813 struct sk_buff *skb;
2814
2815 skb = nlmsg_new(xfrm_acquire_msgsize(x, xp), GFP_ATOMIC);
2816 if (skb == NULL)
2817 return -ENOMEM;
2818
2819 if (build_acquire(skb, x, xt, xp) < 0)
2820 BUG();
2821
2822 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_ACQUIRE);
2823 }
2824
2825 /* User gives us xfrm_user_policy_info followed by an array of 0
2826 * or more templates.
2827 */
xfrm_compile_policy(struct sock * sk,int opt,u8 * data,int len,int * dir)2828 static struct xfrm_policy *xfrm_compile_policy(struct sock *sk, int opt,
2829 u8 *data, int len, int *dir)
2830 {
2831 struct net *net = sock_net(sk);
2832 struct xfrm_userpolicy_info *p = (struct xfrm_userpolicy_info *)data;
2833 struct xfrm_user_tmpl *ut = (struct xfrm_user_tmpl *) (p + 1);
2834 struct xfrm_policy *xp;
2835 int nr;
2836
2837 switch (sk->sk_family) {
2838 case AF_INET:
2839 if (opt != IP_XFRM_POLICY) {
2840 *dir = -EOPNOTSUPP;
2841 return NULL;
2842 }
2843 break;
2844 #if IS_ENABLED(CONFIG_IPV6)
2845 case AF_INET6:
2846 if (opt != IPV6_XFRM_POLICY) {
2847 *dir = -EOPNOTSUPP;
2848 return NULL;
2849 }
2850 break;
2851 #endif
2852 default:
2853 *dir = -EINVAL;
2854 return NULL;
2855 }
2856
2857 *dir = -EINVAL;
2858
2859 if (len < sizeof(*p) ||
2860 verify_newpolicy_info(p))
2861 return NULL;
2862
2863 nr = ((len - sizeof(*p)) / sizeof(*ut));
2864 if (validate_tmpl(nr, ut, p->sel.family))
2865 return NULL;
2866
2867 if (p->dir > XFRM_POLICY_OUT)
2868 return NULL;
2869
2870 xp = xfrm_policy_alloc(net, GFP_ATOMIC);
2871 if (xp == NULL) {
2872 *dir = -ENOBUFS;
2873 return NULL;
2874 }
2875
2876 copy_from_user_policy(xp, p);
2877 xp->type = XFRM_POLICY_TYPE_MAIN;
2878 copy_templates(xp, ut, nr);
2879
2880 *dir = p->dir;
2881
2882 return xp;
2883 }
2884
xfrm_polexpire_msgsize(struct xfrm_policy * xp)2885 static inline size_t xfrm_polexpire_msgsize(struct xfrm_policy *xp)
2886 {
2887 return NLMSG_ALIGN(sizeof(struct xfrm_user_polexpire))
2888 + nla_total_size(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr)
2889 + nla_total_size(xfrm_user_sec_ctx_size(xp->security))
2890 + nla_total_size(sizeof(struct xfrm_mark))
2891 + userpolicy_type_attrsize();
2892 }
2893
build_polexpire(struct sk_buff * skb,struct xfrm_policy * xp,int dir,const struct km_event * c)2894 static int build_polexpire(struct sk_buff *skb, struct xfrm_policy *xp,
2895 int dir, const struct km_event *c)
2896 {
2897 struct xfrm_user_polexpire *upe;
2898 int hard = c->data.hard;
2899 struct nlmsghdr *nlh;
2900 int err;
2901
2902 nlh = nlmsg_put(skb, c->portid, 0, XFRM_MSG_POLEXPIRE, sizeof(*upe), 0);
2903 if (nlh == NULL)
2904 return -EMSGSIZE;
2905
2906 upe = nlmsg_data(nlh);
2907 copy_to_user_policy(xp, &upe->pol, dir);
2908 err = copy_to_user_tmpl(xp, skb);
2909 if (!err)
2910 err = copy_to_user_sec_ctx(xp, skb);
2911 if (!err)
2912 err = copy_to_user_policy_type(xp->type, skb);
2913 if (!err)
2914 err = xfrm_mark_put(skb, &xp->mark);
2915 if (err) {
2916 nlmsg_cancel(skb, nlh);
2917 return err;
2918 }
2919 upe->hard = !!hard;
2920
2921 nlmsg_end(skb, nlh);
2922 return 0;
2923 }
2924
xfrm_exp_policy_notify(struct xfrm_policy * xp,int dir,const struct km_event * c)2925 static int xfrm_exp_policy_notify(struct xfrm_policy *xp, int dir, const struct km_event *c)
2926 {
2927 struct net *net = xp_net(xp);
2928 struct sk_buff *skb;
2929
2930 skb = nlmsg_new(xfrm_polexpire_msgsize(xp), GFP_ATOMIC);
2931 if (skb == NULL)
2932 return -ENOMEM;
2933
2934 if (build_polexpire(skb, xp, dir, c) < 0)
2935 BUG();
2936
2937 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_EXPIRE);
2938 }
2939
xfrm_notify_policy(struct xfrm_policy * xp,int dir,const struct km_event * c)2940 static int xfrm_notify_policy(struct xfrm_policy *xp, int dir, const struct km_event *c)
2941 {
2942 int len = nla_total_size(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
2943 struct net *net = xp_net(xp);
2944 struct xfrm_userpolicy_info *p;
2945 struct xfrm_userpolicy_id *id;
2946 struct nlmsghdr *nlh;
2947 struct sk_buff *skb;
2948 int headlen, err;
2949
2950 headlen = sizeof(*p);
2951 if (c->event == XFRM_MSG_DELPOLICY) {
2952 len += nla_total_size(headlen);
2953 headlen = sizeof(*id);
2954 }
2955 len += userpolicy_type_attrsize();
2956 len += nla_total_size(sizeof(struct xfrm_mark));
2957 len += NLMSG_ALIGN(headlen);
2958
2959 skb = nlmsg_new(len, GFP_ATOMIC);
2960 if (skb == NULL)
2961 return -ENOMEM;
2962
2963 nlh = nlmsg_put(skb, c->portid, c->seq, c->event, headlen, 0);
2964 err = -EMSGSIZE;
2965 if (nlh == NULL)
2966 goto out_free_skb;
2967
2968 p = nlmsg_data(nlh);
2969 if (c->event == XFRM_MSG_DELPOLICY) {
2970 struct nlattr *attr;
2971
2972 id = nlmsg_data(nlh);
2973 memset(id, 0, sizeof(*id));
2974 id->dir = dir;
2975 if (c->data.byid)
2976 id->index = xp->index;
2977 else
2978 memcpy(&id->sel, &xp->selector, sizeof(id->sel));
2979
2980 attr = nla_reserve(skb, XFRMA_POLICY, sizeof(*p));
2981 err = -EMSGSIZE;
2982 if (attr == NULL)
2983 goto out_free_skb;
2984
2985 p = nla_data(attr);
2986 }
2987
2988 copy_to_user_policy(xp, p, dir);
2989 err = copy_to_user_tmpl(xp, skb);
2990 if (!err)
2991 err = copy_to_user_policy_type(xp->type, skb);
2992 if (!err)
2993 err = xfrm_mark_put(skb, &xp->mark);
2994 if (err)
2995 goto out_free_skb;
2996
2997 nlmsg_end(skb, nlh);
2998
2999 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_POLICY);
3000
3001 out_free_skb:
3002 kfree_skb(skb);
3003 return err;
3004 }
3005
xfrm_notify_policy_flush(const struct km_event * c)3006 static int xfrm_notify_policy_flush(const struct km_event *c)
3007 {
3008 struct net *net = c->net;
3009 struct nlmsghdr *nlh;
3010 struct sk_buff *skb;
3011 int err;
3012
3013 skb = nlmsg_new(userpolicy_type_attrsize(), GFP_ATOMIC);
3014 if (skb == NULL)
3015 return -ENOMEM;
3016
3017 nlh = nlmsg_put(skb, c->portid, c->seq, XFRM_MSG_FLUSHPOLICY, 0, 0);
3018 err = -EMSGSIZE;
3019 if (nlh == NULL)
3020 goto out_free_skb;
3021 err = copy_to_user_policy_type(c->data.type, skb);
3022 if (err)
3023 goto out_free_skb;
3024
3025 nlmsg_end(skb, nlh);
3026
3027 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_POLICY);
3028
3029 out_free_skb:
3030 kfree_skb(skb);
3031 return err;
3032 }
3033
xfrm_send_policy_notify(struct xfrm_policy * xp,int dir,const struct km_event * c)3034 static int xfrm_send_policy_notify(struct xfrm_policy *xp, int dir, const struct km_event *c)
3035 {
3036 int err;
3037
3038 err = verify_policy_dir(dir);
3039 if (err)
3040 return err;
3041
3042 switch (c->event) {
3043 case XFRM_MSG_NEWPOLICY:
3044 case XFRM_MSG_UPDPOLICY:
3045 case XFRM_MSG_DELPOLICY:
3046 return xfrm_notify_policy(xp, dir, c);
3047 case XFRM_MSG_FLUSHPOLICY:
3048 return xfrm_notify_policy_flush(c);
3049 case XFRM_MSG_POLEXPIRE:
3050 return xfrm_exp_policy_notify(xp, dir, c);
3051 default:
3052 printk(KERN_NOTICE "xfrm_user: Unknown Policy event %d\n",
3053 c->event);
3054 }
3055
3056 return 0;
3057
3058 }
3059
xfrm_report_msgsize(void)3060 static inline size_t xfrm_report_msgsize(void)
3061 {
3062 return NLMSG_ALIGN(sizeof(struct xfrm_user_report));
3063 }
3064
build_report(struct sk_buff * skb,u8 proto,struct xfrm_selector * sel,xfrm_address_t * addr)3065 static int build_report(struct sk_buff *skb, u8 proto,
3066 struct xfrm_selector *sel, xfrm_address_t *addr)
3067 {
3068 struct xfrm_user_report *ur;
3069 struct nlmsghdr *nlh;
3070
3071 nlh = nlmsg_put(skb, 0, 0, XFRM_MSG_REPORT, sizeof(*ur), 0);
3072 if (nlh == NULL)
3073 return -EMSGSIZE;
3074
3075 ur = nlmsg_data(nlh);
3076 ur->proto = proto;
3077 memcpy(&ur->sel, sel, sizeof(ur->sel));
3078
3079 if (addr) {
3080 int err = nla_put(skb, XFRMA_COADDR, sizeof(*addr), addr);
3081 if (err) {
3082 nlmsg_cancel(skb, nlh);
3083 return err;
3084 }
3085 }
3086 nlmsg_end(skb, nlh);
3087 return 0;
3088 }
3089
xfrm_send_report(struct net * net,u8 proto,struct xfrm_selector * sel,xfrm_address_t * addr)3090 static int xfrm_send_report(struct net *net, u8 proto,
3091 struct xfrm_selector *sel, xfrm_address_t *addr)
3092 {
3093 struct sk_buff *skb;
3094
3095 skb = nlmsg_new(xfrm_report_msgsize(), GFP_ATOMIC);
3096 if (skb == NULL)
3097 return -ENOMEM;
3098
3099 if (build_report(skb, proto, sel, addr) < 0)
3100 BUG();
3101
3102 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_REPORT);
3103 }
3104
xfrm_mapping_msgsize(void)3105 static inline size_t xfrm_mapping_msgsize(void)
3106 {
3107 return NLMSG_ALIGN(sizeof(struct xfrm_user_mapping));
3108 }
3109
build_mapping(struct sk_buff * skb,struct xfrm_state * x,xfrm_address_t * new_saddr,__be16 new_sport)3110 static int build_mapping(struct sk_buff *skb, struct xfrm_state *x,
3111 xfrm_address_t *new_saddr, __be16 new_sport)
3112 {
3113 struct xfrm_user_mapping *um;
3114 struct nlmsghdr *nlh;
3115
3116 nlh = nlmsg_put(skb, 0, 0, XFRM_MSG_MAPPING, sizeof(*um), 0);
3117 if (nlh == NULL)
3118 return -EMSGSIZE;
3119
3120 um = nlmsg_data(nlh);
3121
3122 memcpy(&um->id.daddr, &x->id.daddr, sizeof(um->id.daddr));
3123 um->id.spi = x->id.spi;
3124 um->id.family = x->props.family;
3125 um->id.proto = x->id.proto;
3126 memcpy(&um->new_saddr, new_saddr, sizeof(um->new_saddr));
3127 memcpy(&um->old_saddr, &x->props.saddr, sizeof(um->old_saddr));
3128 um->new_sport = new_sport;
3129 um->old_sport = x->encap->encap_sport;
3130 um->reqid = x->props.reqid;
3131
3132 nlmsg_end(skb, nlh);
3133 return 0;
3134 }
3135
xfrm_send_mapping(struct xfrm_state * x,xfrm_address_t * ipaddr,__be16 sport)3136 static int xfrm_send_mapping(struct xfrm_state *x, xfrm_address_t *ipaddr,
3137 __be16 sport)
3138 {
3139 struct net *net = xs_net(x);
3140 struct sk_buff *skb;
3141
3142 if (x->id.proto != IPPROTO_ESP)
3143 return -EINVAL;
3144
3145 if (!x->encap)
3146 return -EINVAL;
3147
3148 skb = nlmsg_new(xfrm_mapping_msgsize(), GFP_ATOMIC);
3149 if (skb == NULL)
3150 return -ENOMEM;
3151
3152 if (build_mapping(skb, x, ipaddr, sport) < 0)
3153 BUG();
3154
3155 return xfrm_nlmsg_multicast(net, skb, 0, XFRMNLGRP_MAPPING);
3156 }
3157
xfrm_is_alive(const struct km_event * c)3158 static bool xfrm_is_alive(const struct km_event *c)
3159 {
3160 return (bool)xfrm_acquire_is_on(c->net);
3161 }
3162
3163 static struct xfrm_mgr netlink_mgr = {
3164 .id = "netlink",
3165 .notify = xfrm_send_state_notify,
3166 .acquire = xfrm_send_acquire,
3167 .compile_policy = xfrm_compile_policy,
3168 .notify_policy = xfrm_send_policy_notify,
3169 .report = xfrm_send_report,
3170 .migrate = xfrm_send_migrate,
3171 .new_mapping = xfrm_send_mapping,
3172 .is_alive = xfrm_is_alive,
3173 };
3174
xfrm_user_net_init(struct net * net)3175 static int __net_init xfrm_user_net_init(struct net *net)
3176 {
3177 struct sock *nlsk;
3178 struct netlink_kernel_cfg cfg = {
3179 .groups = XFRMNLGRP_MAX,
3180 .input = xfrm_netlink_rcv,
3181 };
3182
3183 nlsk = netlink_kernel_create(net, NETLINK_XFRM, &cfg);
3184 if (nlsk == NULL)
3185 return -ENOMEM;
3186 net->xfrm.nlsk_stash = nlsk; /* Don't set to NULL */
3187 rcu_assign_pointer(net->xfrm.nlsk, nlsk);
3188 return 0;
3189 }
3190
xfrm_user_net_exit(struct list_head * net_exit_list)3191 static void __net_exit xfrm_user_net_exit(struct list_head *net_exit_list)
3192 {
3193 struct net *net;
3194 list_for_each_entry(net, net_exit_list, exit_list)
3195 RCU_INIT_POINTER(net->xfrm.nlsk, NULL);
3196 synchronize_net();
3197 list_for_each_entry(net, net_exit_list, exit_list)
3198 netlink_kernel_release(net->xfrm.nlsk_stash);
3199 }
3200
3201 static struct pernet_operations xfrm_user_net_ops = {
3202 .init = xfrm_user_net_init,
3203 .exit_batch = xfrm_user_net_exit,
3204 };
3205
xfrm_user_init(void)3206 static int __init xfrm_user_init(void)
3207 {
3208 int rv;
3209
3210 printk(KERN_INFO "Initializing XFRM netlink socket\n");
3211
3212 rv = register_pernet_subsys(&xfrm_user_net_ops);
3213 if (rv < 0)
3214 return rv;
3215 rv = xfrm_register_km(&netlink_mgr);
3216 if (rv < 0)
3217 unregister_pernet_subsys(&xfrm_user_net_ops);
3218 return rv;
3219 }
3220
xfrm_user_exit(void)3221 static void __exit xfrm_user_exit(void)
3222 {
3223 xfrm_unregister_km(&netlink_mgr);
3224 unregister_pernet_subsys(&xfrm_user_net_ops);
3225 }
3226
3227 module_init(xfrm_user_init);
3228 module_exit(xfrm_user_exit);
3229 MODULE_LICENSE("GPL");
3230 MODULE_ALIAS_NET_PF_PROTO(PF_NETLINK, NETLINK_XFRM);
3231
3232