projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
[IPSEC]: Sync series - user
[linux-2.6-block.git] / net / xfrm / xfrm_user.c
CommitLineData
1da177e4
LT		 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
df71837d 10 *
1da177e4
LT		 11 */
12
13#include <linux/module.h>
14#include <linux/kernel.h>
15#include <linux/types.h>
16#include <linux/slab.h>
17#include <linux/socket.h>
18#include <linux/string.h>
19#include <linux/net.h>
20#include <linux/skbuff.h>
1da177e4
LT		 21#include <linux/rtnetlink.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>
88fc2c84 28#include <net/netlink.h>
1da177e4
LT		 29#include <asm/uaccess.h>
30
f8cd5488 31struct sock *xfrm_nl;
1da177e4
LT		 32
33static int verify_one_alg(struct rtattr **xfrma, enum xfrm_attr_type_t type)
34{
35 struct rtattr *rt = xfrma[type - 1];
36 struct xfrm_algo *algp;
31c26852 37 int len;
1da177e4
LT		 38
39 if (!rt)
40 return 0;
41
31c26852
HX		 42 len = (rt->rta_len - sizeof(*rt)) - sizeof(*algp);
43 if (len < 0)
1da177e4
LT		 44 return -EINVAL;
45
46 algp = RTA_DATA(rt);
31c26852
HX		 47
48 len -= (algp->alg_key_len + 7U) / 8;
49 if (len < 0)
50 return -EINVAL;
51
1da177e4
LT		 52 switch (type) {
53 case XFRMA_ALG_AUTH:
54 if (!algp->alg_key_len &&
55 strcmp(algp->alg_name, "digest_null") != 0)
56 return -EINVAL;
57 break;
58
59 case XFRMA_ALG_CRYPT:
60 if (!algp->alg_key_len &&
61 strcmp(algp->alg_name, "cipher_null") != 0)
62 return -EINVAL;
63 break;
64
65 case XFRMA_ALG_COMP:
66 /* Zero length keys are legal. */
67 break;
68
69 default:
70 return -EINVAL;
71 };
72
73 algp->alg_name[CRYPTO_MAX_ALG_NAME - 1] = '\0';
74 return 0;
75}
76
77static int verify_encap_tmpl(struct rtattr **xfrma)
78{
79 struct rtattr *rt = xfrma[XFRMA_ENCAP - 1];
80 struct xfrm_encap_tmpl *encap;
81
82 if (!rt)
83 return 0;
84
85 if ((rt->rta_len - sizeof(*rt)) < sizeof(*encap))
86 return -EINVAL;
87
88 return 0;
89}
90
df71837d
TJ		 91
92static inline int verify_sec_ctx_len(struct rtattr **xfrma)
93{
94 struct rtattr *rt = xfrma[XFRMA_SEC_CTX - 1];
95 struct xfrm_user_sec_ctx *uctx;
96 int len = 0;
97
98 if (!rt)
99 return 0;
100
101 if (rt->rta_len < sizeof(*uctx))
102 return -EINVAL;
103
104 uctx = RTA_DATA(rt);
105
106 if (uctx->ctx_len > PAGE_SIZE)
107 return -EINVAL;
108
109 len += sizeof(struct xfrm_user_sec_ctx);
110 len += uctx->ctx_len;
111
112 if (uctx->len != len)
113 return -EINVAL;
114
115 return 0;
116}
117
118
1da177e4
LT		 119static int verify_newsa_info(struct xfrm_usersa_info *p,
120 struct rtattr **xfrma)
121{
122 int err;
123
124 err = -EINVAL;
125 switch (p->family) {
126 case AF_INET:
127 break;
128
129 case AF_INET6:
130#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
131 break;
132#else
133 err = -EAFNOSUPPORT;
134 goto out;
135#endif
136
137 default:
138 goto out;
139 };
140
141 err = -EINVAL;
142 switch (p->id.proto) {
143 case IPPROTO_AH:
144 if (!xfrma[XFRMA_ALG_AUTH-1] ||
145 xfrma[XFRMA_ALG_CRYPT-1] ||
146 xfrma[XFRMA_ALG_COMP-1])
147 goto out;
148 break;
149
150 case IPPROTO_ESP:
151 if ((!xfrma[XFRMA_ALG_AUTH-1] &&
152 !xfrma[XFRMA_ALG_CRYPT-1]) ||
153 xfrma[XFRMA_ALG_COMP-1])
154 goto out;
155 break;
156
157 case IPPROTO_COMP:
158 if (!xfrma[XFRMA_ALG_COMP-1] ||
159 xfrma[XFRMA_ALG_AUTH-1] ||
160 xfrma[XFRMA_ALG_CRYPT-1])
161 goto out;
162 break;
163
164 default:
165 goto out;
166 };
167
168 if ((err = verify_one_alg(xfrma, XFRMA_ALG_AUTH)))
169 goto out;
170 if ((err = verify_one_alg(xfrma, XFRMA_ALG_CRYPT)))
171 goto out;
172 if ((err = verify_one_alg(xfrma, XFRMA_ALG_COMP)))
173 goto out;
174 if ((err = verify_encap_tmpl(xfrma)))
175 goto out;
df71837d
TJ		 176 if ((err = verify_sec_ctx_len(xfrma)))
177 goto out;
1da177e4
LT		 178
179 err = -EINVAL;
180 switch (p->mode) {
181 case 0:
182 case 1:
183 break;
184
185 default:
186 goto out;
187 };
188
189 err = 0;
190
191out:
192 return err;
193}
194
195static int attach_one_algo(struct xfrm_algo **algpp, u8 *props,
196 struct xfrm_algo_desc *(*get_byname)(char *, int),
197 struct rtattr *u_arg)
198{
199 struct rtattr *rta = u_arg;
200 struct xfrm_algo *p, *ualg;
201 struct xfrm_algo_desc *algo;
b9e9dead 202 int len;
1da177e4
LT		 203
204 if (!rta)
205 return 0;
206
207 ualg = RTA_DATA(rta);
208
209 algo = get_byname(ualg->alg_name, 1);
210 if (!algo)
211 return -ENOSYS;
212 *props = algo->desc.sadb_alg_id;
213
b9e9dead
HX		 214 len = sizeof(*ualg) + (ualg->alg_key_len + 7U) / 8;
215 p = kmalloc(len, GFP_KERNEL);
1da177e4
LT		 216 if (!p)
217 return -ENOMEM;
218
b9e9dead 219 memcpy(p, ualg, len);
1da177e4
LT		 220 *algpp = p;
221 return 0;
222}
223
224static int attach_encap_tmpl(struct xfrm_encap_tmpl **encapp, struct rtattr *u_arg)
225{
226 struct rtattr *rta = u_arg;
227 struct xfrm_encap_tmpl *p, *uencap;
228
229 if (!rta)
230 return 0;
231
232 uencap = RTA_DATA(rta);
233 p = kmalloc(sizeof(*p), GFP_KERNEL);
234 if (!p)
235 return -ENOMEM;
236
237 memcpy(p, uencap, sizeof(*p));
238 *encapp = p;
239 return 0;
240}
241
df71837d
TJ		 242
243static inline int xfrm_user_sec_ctx_size(struct xfrm_policy *xp)
244{
245 struct xfrm_sec_ctx *xfrm_ctx = xp->security;
246 int len = 0;
247
248 if (xfrm_ctx) {
249 len += sizeof(struct xfrm_user_sec_ctx);
250 len += xfrm_ctx->ctx_len;
251 }
252 return len;
253}
254
255static int attach_sec_ctx(struct xfrm_state *x, struct rtattr *u_arg)
256{
257 struct xfrm_user_sec_ctx *uctx;
258
259 if (!u_arg)
260 return 0;
261
262 uctx = RTA_DATA(u_arg);
263 return security_xfrm_state_alloc(x, uctx);
264}
265
1da177e4
LT		 266static void copy_from_user_state(struct xfrm_state *x, struct xfrm_usersa_info *p)
267{
268 memcpy(&x->id, &p->id, sizeof(x->id));
269 memcpy(&x->sel, &p->sel, sizeof(x->sel));
270 memcpy(&x->lft, &p->lft, sizeof(x->lft));
271 x->props.mode = p->mode;
272 x->props.replay_window = p->replay_window;
273 x->props.reqid = p->reqid;
274 x->props.family = p->family;
275 x->props.saddr = p->saddr;
276 x->props.flags = p->flags;
277}
278
d51d081d
JHS		 279/*
280 * someday when pfkey also has support, we could have the code
281 * somehow made shareable and move it to xfrm_state.c - JHS
282 *
283*/
284static int xfrm_update_ae_params(struct xfrm_state *x, struct rtattr **xfrma)
285{
286 int err = - EINVAL;
287 struct rtattr *rp = xfrma[XFRMA_REPLAY_VAL-1];
288 struct rtattr *lt = xfrma[XFRMA_LTIME_VAL-1];
289 struct rtattr *et = xfrma[XFRMA_ETIMER_THRESH-1];
290 struct rtattr *rt = xfrma[XFRMA_REPLAY_THRESH-1];
291
292 if (rp) {
293 struct xfrm_replay_state *replay;
294 if (RTA_PAYLOAD(rp) < sizeof(*replay))
295 goto error;
296 replay = RTA_DATA(rp);
297 memcpy(&x->replay, replay, sizeof(*replay));
298 memcpy(&x->preplay, replay, sizeof(*replay));
299 }
300
301 if (lt) {
302 struct xfrm_lifetime_cur *ltime;
303 if (RTA_PAYLOAD(lt) < sizeof(*ltime))
304 goto error;
305 ltime = RTA_DATA(lt);
306 x->curlft.bytes = ltime->bytes;
307 x->curlft.packets = ltime->packets;
308 x->curlft.add_time = ltime->add_time;
309 x->curlft.use_time = ltime->use_time;
310 }
311
312 if (et) {
313 if (RTA_PAYLOAD(et) < sizeof(u32))
314 goto error;
315 x->replay_maxage = *(u32*)RTA_DATA(et);
316 }
317
318 if (rt) {
319 if (RTA_PAYLOAD(rt) < sizeof(u32))
320 goto error;
321 x->replay_maxdiff = *(u32*)RTA_DATA(rt);
322 }
323
324 return 0;
325error:
326 return err;
327}
328
1da177e4
LT		 329static struct xfrm_state *xfrm_state_construct(struct xfrm_usersa_info *p,
330 struct rtattr **xfrma,
331 int *errp)
332{
333 struct xfrm_state *x = xfrm_state_alloc();
334 int err = -ENOMEM;
335
336 if (!x)
337 goto error_no_put;
338
339 copy_from_user_state(x, p);
340
341 if ((err = attach_one_algo(&x->aalg, &x->props.aalgo,
342 xfrm_aalg_get_byname,
343 xfrma[XFRMA_ALG_AUTH-1])))
344 goto error;
345 if ((err = attach_one_algo(&x->ealg, &x->props.ealgo,
346 xfrm_ealg_get_byname,
347 xfrma[XFRMA_ALG_CRYPT-1])))
348 goto error;
349 if ((err = attach_one_algo(&x->calg, &x->props.calgo,
350 xfrm_calg_get_byname,
351 xfrma[XFRMA_ALG_COMP-1])))
352 goto error;
353 if ((err = attach_encap_tmpl(&x->encap, xfrma[XFRMA_ENCAP-1])))
354 goto error;
355
72cb6962 356 err = xfrm_init_state(x);
1da177e4
LT		 357 if (err)
358 goto error;
359
df71837d
TJ		 360 if ((err = attach_sec_ctx(x, xfrma[XFRMA_SEC_CTX-1])))
361 goto error;
362
1da177e4 363 x->km.seq = p->seq;
d51d081d
JHS		 364 x->replay_maxdiff = sysctl_xfrm_aevent_rseqth;
365 /* sysctl_xfrm_aevent_etime is in 100ms units */
366 x->replay_maxage = (sysctl_xfrm_aevent_etime*HZ)/XFRM_AE_ETH_M;
367 x->preplay.bitmap = 0;
368 x->preplay.seq = x->replay.seq+x->replay_maxdiff;
369 x->preplay.oseq = x->replay.oseq +x->replay_maxdiff;
370
371 /* override default values from above */
372
373 err = xfrm_update_ae_params(x, (struct rtattr **)xfrma);
374 if (err < 0)
375 goto error;
1da177e4
LT		 376
377 return x;
378
379error:
380 x->km.state = XFRM_STATE_DEAD;
381 xfrm_state_put(x);
382error_no_put:
383 *errp = err;
384 return NULL;
385}
386
387static int xfrm_add_sa(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
388{
389 struct xfrm_usersa_info *p = NLMSG_DATA(nlh);
390 struct xfrm_state *x;
391 int err;
26b15dad 392 struct km_event c;
1da177e4 393
df71837d 394 err = verify_newsa_info(p, (struct rtattr **)xfrma);
1da177e4
LT		 395 if (err)
396 return err;
397
df71837d 398 x = xfrm_state_construct(p, (struct rtattr **)xfrma, &err);
1da177e4
LT		 399 if (!x)
400 return err;
401
26b15dad 402 xfrm_state_hold(x);
1da177e4
LT		 403 if (nlh->nlmsg_type == XFRM_MSG_NEWSA)
404 err = xfrm_state_add(x);
405 else
406 err = xfrm_state_update(x);
407
408 if (err < 0) {
409 x->km.state = XFRM_STATE_DEAD;
21380b81 410 __xfrm_state_put(x);
7d6dfe1f 411 goto out;
1da177e4
LT		 412 }
413
26b15dad
JHS		 414 c.seq = nlh->nlmsg_seq;
415 c.pid = nlh->nlmsg_pid;
f60f6b8f 416 c.event = nlh->nlmsg_type;
26b15dad
JHS		 417
418 km_state_notify(x, &c);
7d6dfe1f 419out:
26b15dad 420 xfrm_state_put(x);
1da177e4
LT		 421 return err;
422}
423
424static int xfrm_del_sa(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
425{
426 struct xfrm_state *x;
26b15dad
JHS		 427 int err;
428 struct km_event c;
1da177e4
LT		 429 struct xfrm_usersa_id *p = NLMSG_DATA(nlh);
430
431 x = xfrm_state_lookup(&p->daddr, p->spi, p->proto, p->family);
432 if (x == NULL)
433 return -ESRCH;
434
435 if (xfrm_state_kern(x)) {
436 xfrm_state_put(x);
437 return -EPERM;
438 }
439
26b15dad
JHS		 440 err = xfrm_state_delete(x);
441 if (err < 0) {
442 xfrm_state_put(x);
443 return err;
444 }
445
446 c.seq = nlh->nlmsg_seq;
447 c.pid = nlh->nlmsg_pid;
f60f6b8f 448 c.event = nlh->nlmsg_type;
26b15dad 449 km_state_notify(x, &c);
1da177e4
LT		 450 xfrm_state_put(x);
451
26b15dad 452 return err;
1da177e4
LT		 453}
454
455static void copy_to_user_state(struct xfrm_state *x, struct xfrm_usersa_info *p)
456{
457 memcpy(&p->id, &x->id, sizeof(p->id));
458 memcpy(&p->sel, &x->sel, sizeof(p->sel));
459 memcpy(&p->lft, &x->lft, sizeof(p->lft));
460 memcpy(&p->curlft, &x->curlft, sizeof(p->curlft));
461 memcpy(&p->stats, &x->stats, sizeof(p->stats));
462 p->saddr = x->props.saddr;
463 p->mode = x->props.mode;
464 p->replay_window = x->props.replay_window;
465 p->reqid = x->props.reqid;
466 p->family = x->props.family;
467 p->flags = x->props.flags;
468 p->seq = x->km.seq;
469}
470
471struct xfrm_dump_info {
472 struct sk_buff *in_skb;
473 struct sk_buff *out_skb;
474 u32 nlmsg_seq;
475 u16 nlmsg_flags;
476 int start_idx;
477 int this_idx;
478};
479
480static int dump_one_state(struct xfrm_state *x, int count, void *ptr)
481{
482 struct xfrm_dump_info *sp = ptr;
483 struct sk_buff *in_skb = sp->in_skb;
484 struct sk_buff *skb = sp->out_skb;
485 struct xfrm_usersa_info *p;
486 struct nlmsghdr *nlh;
487 unsigned char *b = skb->tail;
488
489 if (sp->this_idx < sp->start_idx)
490 goto out;
491
492 nlh = NLMSG_PUT(skb, NETLINK_CB(in_skb).pid,
493 sp->nlmsg_seq,
494 XFRM_MSG_NEWSA, sizeof(*p));
495 nlh->nlmsg_flags = sp->nlmsg_flags;
496
497 p = NLMSG_DATA(nlh);
498 copy_to_user_state(x, p);
499
500 if (x->aalg)
501 RTA_PUT(skb, XFRMA_ALG_AUTH,
502 sizeof(*(x->aalg))+(x->aalg->alg_key_len+7)/8, x->aalg);
503 if (x->ealg)
504 RTA_PUT(skb, XFRMA_ALG_CRYPT,
505 sizeof(*(x->ealg))+(x->ealg->alg_key_len+7)/8, x->ealg);
506 if (x->calg)
507 RTA_PUT(skb, XFRMA_ALG_COMP, sizeof(*(x->calg)), x->calg);
508
509 if (x->encap)
510 RTA_PUT(skb, XFRMA_ENCAP, sizeof(*x->encap), x->encap);
511
df71837d
TJ		 512 if (x->security) {
513 int ctx_size = sizeof(struct xfrm_sec_ctx) +
514 x->security->ctx_len;
515 struct rtattr *rt = __RTA_PUT(skb, XFRMA_SEC_CTX, ctx_size);
516 struct xfrm_user_sec_ctx *uctx = RTA_DATA(rt);
517
518 uctx->exttype = XFRMA_SEC_CTX;
519 uctx->len = ctx_size;
520 uctx->ctx_doi = x->security->ctx_doi;
521 uctx->ctx_alg = x->security->ctx_alg;
522 uctx->ctx_len = x->security->ctx_len;
523 memcpy(uctx + 1, x->security->ctx_str, x->security->ctx_len);
524 }
1da177e4
LT		 525 nlh->nlmsg_len = skb->tail - b;
526out:
527 sp->this_idx++;
528 return 0;
529
530nlmsg_failure:
531rtattr_failure:
532 skb_trim(skb, b - skb->data);
533 return -1;
534}
535
536static int xfrm_dump_sa(struct sk_buff *skb, struct netlink_callback *cb)
537{
538 struct xfrm_dump_info info;
539
540 info.in_skb = cb->skb;
541 info.out_skb = skb;
542 info.nlmsg_seq = cb->nlh->nlmsg_seq;
543 info.nlmsg_flags = NLM_F_MULTI;
544 info.this_idx = 0;
545 info.start_idx = cb->args[0];
546 (void) xfrm_state_walk(IPSEC_PROTO_ANY, dump_one_state, &info);
547 cb->args[0] = info.this_idx;
548
549 return skb->len;
550}
551
552static struct sk_buff *xfrm_state_netlink(struct sk_buff *in_skb,
553 struct xfrm_state *x, u32 seq)
554{
555 struct xfrm_dump_info info;
556 struct sk_buff *skb;
557
558 skb = alloc_skb(NLMSG_GOODSIZE, GFP_ATOMIC);
559 if (!skb)
560 return ERR_PTR(-ENOMEM);
561
562 NETLINK_CB(skb).dst_pid = NETLINK_CB(in_skb).pid;
563 info.in_skb = in_skb;
564 info.out_skb = skb;
565 info.nlmsg_seq = seq;
566 info.nlmsg_flags = 0;
567 info.this_idx = info.start_idx = 0;
568
569 if (dump_one_state(x, 0, &info)) {
570 kfree_skb(skb);
571 return NULL;
572 }
573
574 return skb;
575}
576
577static int xfrm_get_sa(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
578{
579 struct xfrm_usersa_id *p = NLMSG_DATA(nlh);
580 struct xfrm_state *x;
581 struct sk_buff *resp_skb;
582 int err;
583
584 x = xfrm_state_lookup(&p->daddr, p->spi, p->proto, p->family);
585 err = -ESRCH;
586 if (x == NULL)
587 goto out_noput;
588
589 resp_skb = xfrm_state_netlink(skb, x, nlh->nlmsg_seq);
590 if (IS_ERR(resp_skb)) {
591 err = PTR_ERR(resp_skb);
592 } else {
593 err = netlink_unicast(xfrm_nl, resp_skb,
594 NETLINK_CB(skb).pid, MSG_DONTWAIT);
595 }
596 xfrm_state_put(x);
597out_noput:
598 return err;
599}
600
601static int verify_userspi_info(struct xfrm_userspi_info *p)
602{
603 switch (p->info.id.proto) {
604 case IPPROTO_AH:
605 case IPPROTO_ESP:
606 break;
607
608 case IPPROTO_COMP:
609 /* IPCOMP spi is 16-bits. */
610 if (p->max >= 0x10000)
611 return -EINVAL;
612 break;
613
614 default:
615 return -EINVAL;
616 };
617
618 if (p->min > p->max)
619 return -EINVAL;
620
621 return 0;
622}
623
624static int xfrm_alloc_userspi(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
625{
626 struct xfrm_state *x;
627 struct xfrm_userspi_info *p;
628 struct sk_buff *resp_skb;
629 xfrm_address_t *daddr;
630 int family;
631 int err;
632
633 p = NLMSG_DATA(nlh);
634 err = verify_userspi_info(p);
635 if (err)
636 goto out_noput;
637
638 family = p->info.family;
639 daddr = &p->info.id.daddr;
640
641 x = NULL;
642 if (p->info.seq) {
643 x = xfrm_find_acq_byseq(p->info.seq);
644 if (x && xfrm_addr_cmp(&x->id.daddr, daddr, family)) {
645 xfrm_state_put(x);
646 x = NULL;
647 }
648 }
649
650 if (!x)
651 x = xfrm_find_acq(p->info.mode, p->info.reqid,
652 p->info.id.proto, daddr,
653 &p->info.saddr, 1,
654 family);
655 err = -ENOENT;
656 if (x == NULL)
657 goto out_noput;
658
659 resp_skb = ERR_PTR(-ENOENT);
660
661 spin_lock_bh(&x->lock);
662 if (x->km.state != XFRM_STATE_DEAD) {
663 xfrm_alloc_spi(x, htonl(p->min), htonl(p->max));
664 if (x->id.spi)
665 resp_skb = xfrm_state_netlink(skb, x, nlh->nlmsg_seq);
666 }
667 spin_unlock_bh(&x->lock);
668
669 if (IS_ERR(resp_skb)) {
670 err = PTR_ERR(resp_skb);
671 goto out;
672 }
673
674 err = netlink_unicast(xfrm_nl, resp_skb,
675 NETLINK_CB(skb).pid, MSG_DONTWAIT);
676
677out:
678 xfrm_state_put(x);
679out_noput:
680 return err;
681}
682
683static int verify_policy_dir(__u8 dir)
684{
685 switch (dir) {
686 case XFRM_POLICY_IN:
687 case XFRM_POLICY_OUT:
688 case XFRM_POLICY_FWD:
689 break;
690
691 default:
692 return -EINVAL;
693 };
694
695 return 0;
696}
697
698static int verify_newpolicy_info(struct xfrm_userpolicy_info *p)
699{
700 switch (p->share) {
701 case XFRM_SHARE_ANY:
702 case XFRM_SHARE_SESSION:
703 case XFRM_SHARE_USER:
704 case XFRM_SHARE_UNIQUE:
705 break;
706
707 default:
708 return -EINVAL;
709 };
710
711 switch (p->action) {
712 case XFRM_POLICY_ALLOW:
713 case XFRM_POLICY_BLOCK:
714 break;
715
716 default:
717 return -EINVAL;
718 };
719
720 switch (p->sel.family) {
721 case AF_INET:
722 break;
723
724 case AF_INET6:
725#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
726 break;
727#else
728 return -EAFNOSUPPORT;
729#endif
730
731 default:
732 return -EINVAL;
733 };
734
735 return verify_policy_dir(p->dir);
736}
737
df71837d
TJ		 738static int copy_from_user_sec_ctx(struct xfrm_policy *pol, struct rtattr **xfrma)
739{
740 struct rtattr *rt = xfrma[XFRMA_SEC_CTX-1];
741 struct xfrm_user_sec_ctx *uctx;
742
743 if (!rt)
744 return 0;
745
746 uctx = RTA_DATA(rt);
747 return security_xfrm_policy_alloc(pol, uctx);
748}
749
1da177e4
LT		 750static void copy_templates(struct xfrm_policy *xp, struct xfrm_user_tmpl *ut,
751 int nr)
752{
753 int i;
754
755 xp->xfrm_nr = nr;
756 for (i = 0; i < nr; i++, ut++) {
757 struct xfrm_tmpl *t = &xp->xfrm_vec[i];
758
759 memcpy(&t->id, &ut->id, sizeof(struct xfrm_id));
760 memcpy(&t->saddr, &ut->saddr,
761 sizeof(xfrm_address_t));
762 t->reqid = ut->reqid;
763 t->mode = ut->mode;
764 t->share = ut->share;
765 t->optional = ut->optional;
766 t->aalgos = ut->aalgos;
767 t->ealgos = ut->ealgos;
768 t->calgos = ut->calgos;
769 }
770}
771
772static int copy_from_user_tmpl(struct xfrm_policy *pol, struct rtattr **xfrma)
773{
774 struct rtattr *rt = xfrma[XFRMA_TMPL-1];
775 struct xfrm_user_tmpl *utmpl;
776 int nr;
777
778 if (!rt) {
779 pol->xfrm_nr = 0;
780 } else {
781 nr = (rt->rta_len - sizeof(*rt)) / sizeof(*utmpl);
782
783 if (nr > XFRM_MAX_DEPTH)
784 return -EINVAL;
785
786 copy_templates(pol, RTA_DATA(rt), nr);
787 }
788 return 0;
789}
790
791static void copy_from_user_policy(struct xfrm_policy *xp, struct xfrm_userpolicy_info *p)
792{
793 xp->priority = p->priority;
794 xp->index = p->index;
795 memcpy(&xp->selector, &p->sel, sizeof(xp->selector));
796 memcpy(&xp->lft, &p->lft, sizeof(xp->lft));
797 xp->action = p->action;
798 xp->flags = p->flags;
799 xp->family = p->sel.family;
800 /* XXX xp->share = p->share; */
801}
802
803static void copy_to_user_policy(struct xfrm_policy *xp, struct xfrm_userpolicy_info *p, int dir)
804{
805 memcpy(&p->sel, &xp->selector, sizeof(p->sel));
806 memcpy(&p->lft, &xp->lft, sizeof(p->lft));
807 memcpy(&p->curlft, &xp->curlft, sizeof(p->curlft));
808 p->priority = xp->priority;
809 p->index = xp->index;
810 p->sel.family = xp->family;
811 p->dir = dir;
812 p->action = xp->action;
813 p->flags = xp->flags;
814 p->share = XFRM_SHARE_ANY; /* XXX xp->share */
815}
816
817static struct xfrm_policy *xfrm_policy_construct(struct xfrm_userpolicy_info *p, struct rtattr **xfrma, int *errp)
818{
819 struct xfrm_policy *xp = xfrm_policy_alloc(GFP_KERNEL);
820 int err;
821
822 if (!xp) {
823 *errp = -ENOMEM;
824 return NULL;
825 }
826
827 copy_from_user_policy(xp, p);
df71837d
TJ		 828
829 if (!(err = copy_from_user_tmpl(xp, xfrma)))
830 err = copy_from_user_sec_ctx(xp, xfrma);
831
1da177e4
LT		 832 if (err) {
833 *errp = err;
834 kfree(xp);
835 xp = NULL;
836 }
837
838 return xp;
839}
840
841static int xfrm_add_policy(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
842{
843 struct xfrm_userpolicy_info *p = NLMSG_DATA(nlh);
844 struct xfrm_policy *xp;
26b15dad 845 struct km_event c;
1da177e4
LT		 846 int err;
847 int excl;
848
849 err = verify_newpolicy_info(p);
df71837d
TJ		 850 if (err)
851 return err;
852 err = verify_sec_ctx_len((struct rtattr **)xfrma);
1da177e4
LT		 853 if (err)
854 return err;
855
df71837d 856 xp = xfrm_policy_construct(p, (struct rtattr **)xfrma, &err);
1da177e4
LT		 857 if (!xp)
858 return err;
859
26b15dad
JHS		 860 /* shouldnt excl be based on nlh flags??
861 * Aha! this is anti-netlink really i.e more pfkey derived
862 * in netlink excl is a flag and you wouldnt need
863 * a type XFRM_MSG_UPDPOLICY - JHS */
1da177e4
LT		 864 excl = nlh->nlmsg_type == XFRM_MSG_NEWPOLICY;
865 err = xfrm_policy_insert(p->dir, xp, excl);
866 if (err) {
5f8ac64b 867 security_xfrm_policy_free(xp);
1da177e4
LT		 868 kfree(xp);
869 return err;
870 }
871
f60f6b8f 872 c.event = nlh->nlmsg_type;
26b15dad
JHS		 873 c.seq = nlh->nlmsg_seq;
874 c.pid = nlh->nlmsg_pid;
875 km_policy_notify(xp, p->dir, &c);
876
1da177e4
LT		 877 xfrm_pol_put(xp);
878
879 return 0;
880}
881
882static int copy_to_user_tmpl(struct xfrm_policy *xp, struct sk_buff *skb)
883{
884 struct xfrm_user_tmpl vec[XFRM_MAX_DEPTH];
885 int i;
886
887 if (xp->xfrm_nr == 0)
888 return 0;
889
890 for (i = 0; i < xp->xfrm_nr; i++) {
891 struct xfrm_user_tmpl *up = &vec[i];
892 struct xfrm_tmpl *kp = &xp->xfrm_vec[i];
893
894 memcpy(&up->id, &kp->id, sizeof(up->id));
895 up->family = xp->family;
896 memcpy(&up->saddr, &kp->saddr, sizeof(up->saddr));
897 up->reqid = kp->reqid;
898 up->mode = kp->mode;
899 up->share = kp->share;
900 up->optional = kp->optional;
901 up->aalgos = kp->aalgos;
902 up->ealgos = kp->ealgos;
903 up->calgos = kp->calgos;
904 }
905 RTA_PUT(skb, XFRMA_TMPL,
906 (sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr),
907 vec);
908
909 return 0;
910
911rtattr_failure:
912 return -1;
913}
914
df71837d
TJ		 915static int copy_to_user_sec_ctx(struct xfrm_policy *xp, struct sk_buff *skb)
916{
917 if (xp->security) {
918 int ctx_size = sizeof(struct xfrm_sec_ctx) +
919 xp->security->ctx_len;
920 struct rtattr *rt = __RTA_PUT(skb, XFRMA_SEC_CTX, ctx_size);
921 struct xfrm_user_sec_ctx *uctx = RTA_DATA(rt);
922
923 uctx->exttype = XFRMA_SEC_CTX;
924 uctx->len = ctx_size;
925 uctx->ctx_doi = xp->security->ctx_doi;
926 uctx->ctx_alg = xp->security->ctx_alg;
927 uctx->ctx_len = xp->security->ctx_len;
928 memcpy(uctx + 1, xp->security->ctx_str, xp->security->ctx_len);
929 }
930 return 0;
931
932 rtattr_failure:
933 return -1;
934}
935
1da177e4
LT		 936static int dump_one_policy(struct xfrm_policy *xp, int dir, int count, void *ptr)
937{
938 struct xfrm_dump_info *sp = ptr;
939 struct xfrm_userpolicy_info *p;
940 struct sk_buff *in_skb = sp->in_skb;
941 struct sk_buff *skb = sp->out_skb;
942 struct nlmsghdr *nlh;
943 unsigned char *b = skb->tail;
944
945 if (sp->this_idx < sp->start_idx)
946 goto out;
947
948 nlh = NLMSG_PUT(skb, NETLINK_CB(in_skb).pid,
949 sp->nlmsg_seq,
950 XFRM_MSG_NEWPOLICY, sizeof(*p));
951 p = NLMSG_DATA(nlh);
952 nlh->nlmsg_flags = sp->nlmsg_flags;
953
954 copy_to_user_policy(xp, p, dir);
955 if (copy_to_user_tmpl(xp, skb) < 0)
956 goto nlmsg_failure;
df71837d
TJ		 957 if (copy_to_user_sec_ctx(xp, skb))
958 goto nlmsg_failure;
1da177e4
LT		 959
960 nlh->nlmsg_len = skb->tail - b;
961out:
962 sp->this_idx++;
963 return 0;
964
965nlmsg_failure:
966 skb_trim(skb, b - skb->data);
967 return -1;
968}
969
970static int xfrm_dump_policy(struct sk_buff *skb, struct netlink_callback *cb)
971{
972 struct xfrm_dump_info info;
973
974 info.in_skb = cb->skb;
975 info.out_skb = skb;
976 info.nlmsg_seq = cb->nlh->nlmsg_seq;
977 info.nlmsg_flags = NLM_F_MULTI;
978 info.this_idx = 0;
979 info.start_idx = cb->args[0];
980 (void) xfrm_policy_walk(dump_one_policy, &info);
981 cb->args[0] = info.this_idx;
982
983 return skb->len;
984}
985
986static struct sk_buff *xfrm_policy_netlink(struct sk_buff *in_skb,
987 struct xfrm_policy *xp,
988 int dir, u32 seq)
989{
990 struct xfrm_dump_info info;
991 struct sk_buff *skb;
992
993 skb = alloc_skb(NLMSG_GOODSIZE, GFP_KERNEL);
994 if (!skb)
995 return ERR_PTR(-ENOMEM);
996
997 NETLINK_CB(skb).dst_pid = NETLINK_CB(in_skb).pid;
998 info.in_skb = in_skb;
999 info.out_skb = skb;
1000 info.nlmsg_seq = seq;
1001 info.nlmsg_flags = 0;
1002 info.this_idx = info.start_idx = 0;
1003
1004 if (dump_one_policy(xp, dir, 0, &info) < 0) {
1005 kfree_skb(skb);
1006 return NULL;
1007 }
1008
1009 return skb;
1010}
1011
1012static int xfrm_get_policy(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
1013{
1014 struct xfrm_policy *xp;
1015 struct xfrm_userpolicy_id *p;
1016 int err;
26b15dad 1017 struct km_event c;
1da177e4
LT		 1018 int delete;
1019
1020 p = NLMSG_DATA(nlh);
1021 delete = nlh->nlmsg_type == XFRM_MSG_DELPOLICY;
1022
1023 err = verify_policy_dir(p->dir);
1024 if (err)
1025 return err;
1026
1027 if (p->index)
1028 xp = xfrm_policy_byid(p->dir, p->index, delete);
df71837d
TJ		 1029 else {
1030 struct rtattr **rtattrs = (struct rtattr **)xfrma;
1031 struct rtattr *rt = rtattrs[XFRMA_SEC_CTX-1];
1032 struct xfrm_policy tmp;
1033
1034 err = verify_sec_ctx_len(rtattrs);
1035 if (err)
1036 return err;
1037
1038 memset(&tmp, 0, sizeof(struct xfrm_policy));
1039 if (rt) {
1040 struct xfrm_user_sec_ctx *uctx = RTA_DATA(rt);
1041
1042 if ((err = security_xfrm_policy_alloc(&tmp, uctx)))
1043 return err;
1044 }
1045 xp = xfrm_policy_bysel_ctx(p->dir, &p->sel, tmp.security, delete);
1046 security_xfrm_policy_free(&tmp);
1047 }
1da177e4
LT		 1048 if (xp == NULL)
1049 return -ENOENT;
1050
1051 if (!delete) {
1052 struct sk_buff *resp_skb;
1053
1054 resp_skb = xfrm_policy_netlink(skb, xp, p->dir, nlh->nlmsg_seq);
1055 if (IS_ERR(resp_skb)) {
1056 err = PTR_ERR(resp_skb);
1057 } else {
1058 err = netlink_unicast(xfrm_nl, resp_skb,
1059 NETLINK_CB(skb).pid,
1060 MSG_DONTWAIT);
1061 }
26b15dad 1062 } else {
e7443892 1063 c.data.byid = p->index;
f60f6b8f 1064 c.event = nlh->nlmsg_type;
26b15dad
JHS		 1065 c.seq = nlh->nlmsg_seq;
1066 c.pid = nlh->nlmsg_pid;
1067 km_policy_notify(xp, p->dir, &c);
1da177e4
LT		 1068 }
1069
1070 xfrm_pol_put(xp);
1071
1072 return err;
1073}
1074
1075static int xfrm_flush_sa(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
1076{
26b15dad 1077 struct km_event c;
1da177e4
LT		 1078 struct xfrm_usersa_flush *p = NLMSG_DATA(nlh);
1079
1080 xfrm_state_flush(p->proto);
bf08867f 1081 c.data.proto = p->proto;
f60f6b8f 1082 c.event = nlh->nlmsg_type;
26b15dad
JHS		 1083 c.seq = nlh->nlmsg_seq;
1084 c.pid = nlh->nlmsg_pid;
1085 km_state_notify(NULL, &c);
1086
1da177e4
LT		 1087 return 0;
1088}
1089
d51d081d
JHS		 1090
1091static int build_aevent(struct sk_buff *skb, struct xfrm_state *x, struct km_event *c)
1092{
1093 struct xfrm_aevent_id *id;
1094 struct nlmsghdr *nlh;
1095 struct xfrm_lifetime_cur ltime;
1096 unsigned char *b = skb->tail;
1097
1098 nlh = NLMSG_PUT(skb, c->pid, c->seq, XFRM_MSG_NEWAE, sizeof(*id));
1099 id = NLMSG_DATA(nlh);
1100 nlh->nlmsg_flags = 0;
1101
1102 id->sa_id.daddr = x->id.daddr;
1103 id->sa_id.spi = x->id.spi;
1104 id->sa_id.family = x->props.family;
1105 id->sa_id.proto = x->id.proto;
1106 id->flags = c->data.aevent;
1107
1108 RTA_PUT(skb, XFRMA_REPLAY_VAL, sizeof(x->replay), &x->replay);
1109
1110 ltime.bytes = x->curlft.bytes;
1111 ltime.packets = x->curlft.packets;
1112 ltime.add_time = x->curlft.add_time;
1113 ltime.use_time = x->curlft.use_time;
1114
1115 RTA_PUT(skb, XFRMA_LTIME_VAL, sizeof(struct xfrm_lifetime_cur), &ltime);
1116
1117 if (id->flags&XFRM_AE_RTHR) {
1118 RTA_PUT(skb,XFRMA_REPLAY_THRESH,sizeof(u32),&x->replay_maxdiff);
1119 }
1120
1121 if (id->flags&XFRM_AE_ETHR) {
1122 u32 etimer = x->replay_maxage*10/HZ;
1123 RTA_PUT(skb,XFRMA_ETIMER_THRESH,sizeof(u32),&etimer);
1124 }
1125
1126 nlh->nlmsg_len = skb->tail - b;
1127 return skb->len;
1128
1129rtattr_failure:
1130nlmsg_failure:
1131 skb_trim(skb, b - skb->data);
1132 return -1;
1133}
1134
1135static int xfrm_get_ae(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
1136{
1137 struct xfrm_state *x;
1138 struct sk_buff *r_skb;
1139 int err;
1140 struct km_event c;
1141 struct xfrm_aevent_id *p = NLMSG_DATA(nlh);
1142 int len = NLMSG_LENGTH(sizeof(struct xfrm_aevent_id));
1143 struct xfrm_usersa_id *id = &p->sa_id;
1144
1145 len += RTA_SPACE(sizeof(struct xfrm_replay_state));
1146 len += RTA_SPACE(sizeof(struct xfrm_lifetime_cur));
1147
1148 if (p->flags&XFRM_AE_RTHR)
1149 len+=RTA_SPACE(sizeof(u32));
1150
1151 if (p->flags&XFRM_AE_ETHR)
1152 len+=RTA_SPACE(sizeof(u32));
1153
1154 r_skb = alloc_skb(len, GFP_ATOMIC);
1155 if (r_skb == NULL)
1156 return -ENOMEM;
1157
1158 x = xfrm_state_lookup(&id->daddr, id->spi, id->proto, id->family);
1159 if (x == NULL) {
1160 kfree(r_skb);
1161 return -ESRCH;
1162 }
1163
1164 /*
1165 * XXX: is this lock really needed - none of the other
1166 * gets lock (the concern is things getting updated
1167 * while we are still reading) - jhs
1168 */
1169 spin_lock_bh(&x->lock);
1170 c.data.aevent = p->flags;
1171 c.seq = nlh->nlmsg_seq;
1172 c.pid = nlh->nlmsg_pid;
1173
1174 if (build_aevent(r_skb, x, &c) < 0)
1175 BUG();
1176 err = netlink_unicast(xfrm_nl, r_skb,
1177 NETLINK_CB(skb).pid, MSG_DONTWAIT);
1178 spin_unlock_bh(&x->lock);
1179 xfrm_state_put(x);
1180 return err;
1181}
1182
1183static int xfrm_new_ae(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
1184{
1185 struct xfrm_state *x;
1186 struct km_event c;
1187 int err = - EINVAL;
1188 struct xfrm_aevent_id *p = NLMSG_DATA(nlh);
1189 struct rtattr *rp = xfrma[XFRMA_REPLAY_VAL-1];
1190 struct rtattr *lt = xfrma[XFRMA_LTIME_VAL-1];
1191
1192 if (!lt && !rp)
1193 return err;
1194
1195 /* pedantic mode - thou shalt sayeth replaceth */
1196 if (!(nlh->nlmsg_flags&NLM_F_REPLACE))
1197 return err;
1198
1199 x = xfrm_state_lookup(&p->sa_id.daddr, p->sa_id.spi, p->sa_id.proto, p->sa_id.family);
1200 if (x == NULL)
1201 return -ESRCH;
1202
1203 if (x->km.state != XFRM_STATE_VALID)
1204 goto out;
1205
1206 spin_lock_bh(&x->lock);
1207 err = xfrm_update_ae_params(x,(struct rtattr **)xfrma);
1208 spin_unlock_bh(&x->lock);
1209 if (err < 0)
1210 goto out;
1211
1212 c.event = nlh->nlmsg_type;
1213 c.seq = nlh->nlmsg_seq;
1214 c.pid = nlh->nlmsg_pid;
1215 c.data.aevent = XFRM_AE_CU;
1216 km_state_notify(x, &c);
1217 err = 0;
1218out:
1219 xfrm_state_put(x);
1220 return err;
1221}
1222
1da177e4
LT		 1223static int xfrm_flush_policy(struct sk_buff *skb, struct nlmsghdr *nlh, void **xfrma)
1224{
26b15dad
JHS		 1225 struct km_event c;
1226
1da177e4 1227 xfrm_policy_flush();
f60f6b8f 1228 c.event = nlh->nlmsg_type;
26b15dad
JHS		 1229 c.seq = nlh->nlmsg_seq;
1230 c.pid = nlh->nlmsg_pid;
1231 km_policy_notify(NULL, 0, &c);
1da177e4
LT		 1232 return 0;
1233}
1234
d51d081d 1235
492b558b
TG		 1236#define XMSGSIZE(type) NLMSG_LENGTH(sizeof(struct type))
1237
1238static const int xfrm_msg_min[XFRM_NR_MSGTYPES] = {
1239 [XFRM_MSG_NEWSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_info),
1240 [XFRM_MSG_DELSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_id),
1241 [XFRM_MSG_GETSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_id),
1242 [XFRM_MSG_NEWPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_info),
1243 [XFRM_MSG_DELPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_id),
1244 [XFRM_MSG_GETPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_id),
1245 [XFRM_MSG_ALLOCSPI - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userspi_info),
492b558b
TG		 1246 [XFRM_MSG_UPDPOLICY - XFRM_MSG_BASE] = XMSGSIZE(xfrm_userpolicy_info),
1247 [XFRM_MSG_UPDSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_info),
492b558b
TG		 1248 [XFRM_MSG_FLUSHSA - XFRM_MSG_BASE] = XMSGSIZE(xfrm_usersa_flush),
1249 [XFRM_MSG_FLUSHPOLICY - XFRM_MSG_BASE] = NLMSG_LENGTH(0),
d51d081d
JHS		 1250 [XFRM_MSG_NEWAE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_aevent_id),
1251 [XFRM_MSG_GETAE - XFRM_MSG_BASE] = XMSGSIZE(xfrm_aevent_id),
1da177e4
LT		 1252};
1253
492b558b
TG		 1254#undef XMSGSIZE
1255
1da177e4
LT		 1256static struct xfrm_link {
1257 int (*doit)(struct sk_buff *, struct nlmsghdr *, void **);
1258 int (*dump)(struct sk_buff *, struct netlink_callback *);
492b558b
TG		 1259} xfrm_dispatch[XFRM_NR_MSGTYPES] = {
1260 [XFRM_MSG_NEWSA - XFRM_MSG_BASE] = { .doit = xfrm_add_sa },
1261 [XFRM_MSG_DELSA - XFRM_MSG_BASE] = { .doit = xfrm_del_sa },
1262 [XFRM_MSG_GETSA - XFRM_MSG_BASE] = { .doit = xfrm_get_sa,
1263 .dump = xfrm_dump_sa },
1264 [XFRM_MSG_NEWPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_add_policy },
1265 [XFRM_MSG_DELPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_get_policy },
1266 [XFRM_MSG_GETPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_get_policy,
1267 .dump = xfrm_dump_policy },
1268 [XFRM_MSG_ALLOCSPI - XFRM_MSG_BASE] = { .doit = xfrm_alloc_userspi },
1269 [XFRM_MSG_UPDPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_add_policy },
1270 [XFRM_MSG_UPDSA - XFRM_MSG_BASE] = { .doit = xfrm_add_sa },
1271 [XFRM_MSG_FLUSHSA - XFRM_MSG_BASE] = { .doit = xfrm_flush_sa },
1272 [XFRM_MSG_FLUSHPOLICY - XFRM_MSG_BASE] = { .doit = xfrm_flush_policy },
d51d081d
JHS		 1273 [XFRM_MSG_NEWAE - XFRM_MSG_BASE] = { .doit = xfrm_new_ae },
1274 [XFRM_MSG_GETAE - XFRM_MSG_BASE] = { .doit = xfrm_get_ae },
1da177e4
LT		 1275};
1276
1da177e4
LT		 1277static int xfrm_user_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh, int *errp)
1278{
1279 struct rtattr *xfrma[XFRMA_MAX];
1280 struct xfrm_link *link;
1281 int type, min_len;
1282
1283 if (!(nlh->nlmsg_flags & NLM_F_REQUEST))
1284 return 0;
1285
1286 type = nlh->nlmsg_type;
1287
1288 /* A control message: ignore them */
1289 if (type < XFRM_MSG_BASE)
1290 return 0;
1291
1292 /* Unknown message: reply with EINVAL */
1293 if (type > XFRM_MSG_MAX)
1294 goto err_einval;
1295
1296 type -= XFRM_MSG_BASE;
1297 link = &xfrm_dispatch[type];
1298
1299 /* All operations require privileges, even GET */
1300 if (security_netlink_recv(skb)) {
1301 *errp = -EPERM;
1302 return -1;
1303 }
1304
492b558b
TG		 1305 if ((type == (XFRM_MSG_GETSA - XFRM_MSG_BASE) ||
1306 type == (XFRM_MSG_GETPOLICY - XFRM_MSG_BASE)) &&
1307 (nlh->nlmsg_flags & NLM_F_DUMP)) {
1da177e4
LT		 1308 if (link->dump == NULL)
1309 goto err_einval;
1310
1311 if ((*errp = netlink_dump_start(xfrm_nl, skb, nlh,
a8f74b22 1312 link->dump, NULL)) != 0) {
1da177e4
LT		 1313 return -1;
1314 }
88fc2c84
TG		 1315
1316 netlink_queue_skip(nlh, skb);
1da177e4
LT		 1317 return -1;
1318 }
1319
1320 memset(xfrma, 0, sizeof(xfrma));
1321
1322 if (nlh->nlmsg_len < (min_len = xfrm_msg_min[type]))
1323 goto err_einval;
1324
1325 if (nlh->nlmsg_len > min_len) {
1326 int attrlen = nlh->nlmsg_len - NLMSG_ALIGN(min_len);
1327 struct rtattr *attr = (void *) nlh + NLMSG_ALIGN(min_len);
1328
1329 while (RTA_OK(attr, attrlen)) {
1330 unsigned short flavor = attr->rta_type;
1331 if (flavor) {
1332 if (flavor > XFRMA_MAX)
1333 goto err_einval;
1334 xfrma[flavor - 1] = attr;
1335 }
1336 attr = RTA_NEXT(attr, attrlen);
1337 }
1338 }
1339
1340 if (link->doit == NULL)
1341 goto err_einval;
1342 *errp = link->doit(skb, nlh, (void **) &xfrma);
1343
1344 return *errp;
1345
1346err_einval:
1347 *errp = -EINVAL;
1348 return -1;
1349}
1350
1da177e4
LT		 1351static void xfrm_netlink_rcv(struct sock *sk, int len)
1352{
88fc2c84 1353 unsigned int qlen = 0;
2a0a6ebe 1354
1da177e4 1355 do {
1da177e4 1356 down(&xfrm_cfg_sem);
88fc2c84 1357 netlink_run_queue(sk, &qlen, &xfrm_user_rcv_msg);
1da177e4
LT		 1358 up(&xfrm_cfg_sem);
1359
2a0a6ebe 1360 } while (qlen);
1da177e4
LT		 1361}
1362
d51d081d 1363static int build_expire(struct sk_buff *skb, struct xfrm_state *x, struct km_event *c)
1da177e4
LT		 1364{
1365 struct xfrm_user_expire *ue;
1366 struct nlmsghdr *nlh;
1367 unsigned char *b = skb->tail;
1368
d51d081d 1369 nlh = NLMSG_PUT(skb, c->pid, 0, XFRM_MSG_EXPIRE,
1da177e4
LT		 1370 sizeof(*ue));
1371 ue = NLMSG_DATA(nlh);
1372 nlh->nlmsg_flags = 0;
1373
1374 copy_to_user_state(x, &ue->state);
d51d081d 1375 ue->hard = (c->data.hard != 0) ? 1 : 0;
1da177e4
LT		 1376
1377 nlh->nlmsg_len = skb->tail - b;
1378 return skb->len;
1379
1380nlmsg_failure:
1381 skb_trim(skb, b - skb->data);
1382 return -1;
1383}
1384
26b15dad 1385static int xfrm_exp_state_notify(struct xfrm_state *x, struct km_event *c)
1da177e4
LT		 1386{
1387 struct sk_buff *skb;
ee57eef9 1388 int len = NLMSG_LENGTH(sizeof(struct xfrm_user_expire));
1da177e4 1389
ee57eef9 1390 skb = alloc_skb(len, GFP_ATOMIC);
1da177e4
LT		 1391 if (skb == NULL)
1392 return -ENOMEM;
1393
d51d081d 1394 if (build_expire(skb, x, c) < 0)
1da177e4
LT		 1395 BUG();
1396
ac6d439d
PM		 1397 NETLINK_CB(skb).dst_group = XFRMNLGRP_EXPIRE;
1398 return netlink_broadcast(xfrm_nl, skb, 0, XFRMNLGRP_EXPIRE, GFP_ATOMIC);
1da177e4
LT		 1399}
1400
d51d081d
JHS		 1401static int xfrm_aevent_state_notify(struct xfrm_state *x, struct km_event *c)
1402{
1403 struct sk_buff *skb;
1404 int len = NLMSG_LENGTH(sizeof(struct xfrm_aevent_id));
1405
1406 len += RTA_SPACE(sizeof(struct xfrm_replay_state));
1407 len += RTA_SPACE(sizeof(struct xfrm_lifetime_cur));
1408 skb = alloc_skb(len, GFP_ATOMIC);
1409 if (skb == NULL)
1410 return -ENOMEM;
1411
1412 if (build_aevent(skb, x, c) < 0)
1413 BUG();
1414
1415 NETLINK_CB(skb).dst_group = XFRMNLGRP_AEVENTS;
1416 return netlink_broadcast(xfrm_nl, skb, 0, XFRMNLGRP_AEVENTS, GFP_ATOMIC);
1417}
1418
26b15dad
JHS		 1419static int xfrm_notify_sa_flush(struct km_event *c)
1420{
1421 struct xfrm_usersa_flush *p;
1422 struct nlmsghdr *nlh;
1423 struct sk_buff *skb;
1424 unsigned char *b;
1425 int len = NLMSG_LENGTH(sizeof(struct xfrm_usersa_flush));
1426
1427 skb = alloc_skb(len, GFP_ATOMIC);
1428 if (skb == NULL)
1429 return -ENOMEM;
1430 b = skb->tail;
1431
1432 nlh = NLMSG_PUT(skb, c->pid, c->seq,
1433 XFRM_MSG_FLUSHSA, sizeof(*p));
1434 nlh->nlmsg_flags = 0;
1435
1436 p = NLMSG_DATA(nlh);
bf08867f 1437 p->proto = c->data.proto;
26b15dad
JHS		 1438
1439 nlh->nlmsg_len = skb->tail - b;
1440
ac6d439d
PM		 1441 NETLINK_CB(skb).dst_group = XFRMNLGRP_SA;
1442 return netlink_broadcast(xfrm_nl, skb, 0, XFRMNLGRP_SA, GFP_ATOMIC);
26b15dad
JHS		 1443
1444nlmsg_failure:
1445 kfree_skb(skb);
1446 return -1;
1447}
1448
1449static int inline xfrm_sa_len(struct xfrm_state *x)
1450{
0603eac0 1451 int l = 0;
26b15dad
JHS		 1452 if (x->aalg)
1453 l += RTA_SPACE(sizeof(*x->aalg) + (x->aalg->alg_key_len+7)/8);
1454 if (x->ealg)
1455 l += RTA_SPACE(sizeof(*x->ealg) + (x->ealg->alg_key_len+7)/8);
1456 if (x->calg)
1457 l += RTA_SPACE(sizeof(*x->calg));
1458 if (x->encap)
1459 l += RTA_SPACE(sizeof(*x->encap));
1460
1461 return l;
1462}
1463
1464static int xfrm_notify_sa(struct xfrm_state *x, struct km_event *c)
1465{
1466 struct xfrm_usersa_info *p;
0603eac0 1467 struct xfrm_usersa_id *id;
26b15dad
JHS		 1468 struct nlmsghdr *nlh;
1469 struct sk_buff *skb;
26b15dad
JHS		 1470 unsigned char *b;
1471 int len = xfrm_sa_len(x);
0603eac0
HX		 1472 int headlen;
1473
1474 headlen = sizeof(*p);
1475 if (c->event == XFRM_MSG_DELSA) {
1476 len += RTA_SPACE(headlen);
1477 headlen = sizeof(*id);
1478 }
1479 len += NLMSG_SPACE(headlen);
26b15dad
JHS		 1480
1481 skb = alloc_skb(len, GFP_ATOMIC);
1482 if (skb == NULL)
1483 return -ENOMEM;
1484 b = skb->tail;
1485
0603eac0 1486 nlh = NLMSG_PUT(skb, c->pid, c->seq, c->event, headlen);
26b15dad
JHS		 1487 nlh->nlmsg_flags = 0;
1488
1489 p = NLMSG_DATA(nlh);
0603eac0
HX		 1490 if (c->event == XFRM_MSG_DELSA) {
1491 id = NLMSG_DATA(nlh);
1492 memcpy(&id->daddr, &x->id.daddr, sizeof(id->daddr));
1493 id->spi = x->id.spi;
1494 id->family = x->props.family;
1495 id->proto = x->id.proto;
1496
1497 p = RTA_DATA(__RTA_PUT(skb, XFRMA_SA, sizeof(*p)));
1498 }
1499
26b15dad
JHS		 1500 copy_to_user_state(x, p);
1501
1502 if (x->aalg)
1503 RTA_PUT(skb, XFRMA_ALG_AUTH,
1504 sizeof(*(x->aalg))+(x->aalg->alg_key_len+7)/8, x->aalg);
1505 if (x->ealg)
1506 RTA_PUT(skb, XFRMA_ALG_CRYPT,
1507 sizeof(*(x->ealg))+(x->ealg->alg_key_len+7)/8, x->ealg);
1508 if (x->calg)
1509 RTA_PUT(skb, XFRMA_ALG_COMP, sizeof(*(x->calg)), x->calg);
1510
1511 if (x->encap)
1512 RTA_PUT(skb, XFRMA_ENCAP, sizeof(*x->encap), x->encap);
1513
1514 nlh->nlmsg_len = skb->tail - b;
1515
ac6d439d
PM		 1516 NETLINK_CB(skb).dst_group = XFRMNLGRP_SA;
1517 return netlink_broadcast(xfrm_nl, skb, 0, XFRMNLGRP_SA, GFP_ATOMIC);
26b15dad
JHS		 1518
1519nlmsg_failure:
1520rtattr_failure:
1521 kfree_skb(skb);
1522 return -1;
1523}
1524
1525static int xfrm_send_state_notify(struct xfrm_state *x, struct km_event *c)
1526{
1527
1528 switch (c->event) {
f60f6b8f 1529 case XFRM_MSG_EXPIRE:
26b15dad 1530 return xfrm_exp_state_notify(x, c);
d51d081d
JHS		 1531 case XFRM_MSG_NEWAE:
1532 return xfrm_aevent_state_notify(x, c);
f60f6b8f
HX		 1533 case XFRM_MSG_DELSA:
1534 case XFRM_MSG_UPDSA:
1535 case XFRM_MSG_NEWSA:
26b15dad 1536 return xfrm_notify_sa(x, c);
f60f6b8f 1537 case XFRM_MSG_FLUSHSA:
26b15dad
JHS		 1538 return xfrm_notify_sa_flush(c);
1539 default:
1540 printk("xfrm_user: Unknown SA event %d\n", c->event);
1541 break;
1542 }
1543
1544 return 0;
1545
1546}
1547
1da177e4
LT		 1548static int build_acquire(struct sk_buff *skb, struct xfrm_state *x,
1549 struct xfrm_tmpl *xt, struct xfrm_policy *xp,
1550 int dir)
1551{
1552 struct xfrm_user_acquire *ua;
1553 struct nlmsghdr *nlh;
1554 unsigned char *b = skb->tail;
1555 __u32 seq = xfrm_get_acqseq();
1556
1557 nlh = NLMSG_PUT(skb, 0, 0, XFRM_MSG_ACQUIRE,
1558 sizeof(*ua));
1559 ua = NLMSG_DATA(nlh);
1560 nlh->nlmsg_flags = 0;
1561
1562 memcpy(&ua->id, &x->id, sizeof(ua->id));
1563 memcpy(&ua->saddr, &x->props.saddr, sizeof(ua->saddr));
1564 memcpy(&ua->sel, &x->sel, sizeof(ua->sel));
1565 copy_to_user_policy(xp, &ua->policy, dir);
1566 ua->aalgos = xt->aalgos;
1567 ua->ealgos = xt->ealgos;
1568 ua->calgos = xt->calgos;
1569 ua->seq = x->km.seq = seq;
1570
1571 if (copy_to_user_tmpl(xp, skb) < 0)
1572 goto nlmsg_failure;
df71837d
TJ		 1573 if (copy_to_user_sec_ctx(xp, skb))
1574 goto nlmsg_failure;
1da177e4
LT		 1575
1576 nlh->nlmsg_len = skb->tail - b;
1577 return skb->len;
1578
1579nlmsg_failure:
1580 skb_trim(skb, b - skb->data);
1581 return -1;
1582}
1583
1584static int xfrm_send_acquire(struct xfrm_state *x, struct xfrm_tmpl *xt,
1585 struct xfrm_policy *xp, int dir)
1586{
1587 struct sk_buff *skb;
1588 size_t len;
1589
1590 len = RTA_SPACE(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
1591 len += NLMSG_SPACE(sizeof(struct xfrm_user_acquire));
df71837d 1592 len += RTA_SPACE(xfrm_user_sec_ctx_size(xp));
1da177e4
LT		 1593 skb = alloc_skb(len, GFP_ATOMIC);
1594 if (skb == NULL)
1595 return -ENOMEM;
1596
1597 if (build_acquire(skb, x, xt, xp, dir) < 0)
1598 BUG();
1599
ac6d439d
PM		 1600 NETLINK_CB(skb).dst_group = XFRMNLGRP_ACQUIRE;
1601 return netlink_broadcast(xfrm_nl, skb, 0, XFRMNLGRP_ACQUIRE, GFP_ATOMIC);
1da177e4
LT		 1602}
1603
1604/* User gives us xfrm_user_policy_info followed by an array of 0
1605 * or more templates.
1606 */
1607static struct xfrm_policy *xfrm_compile_policy(u16 family, int opt,
1608 u8 *data, int len, int *dir)
1609{
1610 struct xfrm_userpolicy_info *p = (struct xfrm_userpolicy_info *)data;
1611 struct xfrm_user_tmpl *ut = (struct xfrm_user_tmpl *) (p + 1);
1612 struct xfrm_policy *xp;
1613 int nr;
1614
1615 switch (family) {
1616 case AF_INET:
1617 if (opt != IP_XFRM_POLICY) {
1618 *dir = -EOPNOTSUPP;
1619 return NULL;
1620 }
1621 break;
1622#if defined(CONFIG_IPV6) || defined(CONFIG_IPV6_MODULE)
1623 case AF_INET6:
1624 if (opt != IPV6_XFRM_POLICY) {
1625 *dir = -EOPNOTSUPP;
1626 return NULL;
1627 }
1628 break;
1629#endif
1630 default:
1631 *dir = -EINVAL;
1632 return NULL;
1633 }
1634
1635 *dir = -EINVAL;
1636
1637 if (len < sizeof(*p) ||
1638 verify_newpolicy_info(p))
1639 return NULL;
1640
1641 nr = ((len - sizeof(*p)) / sizeof(*ut));
1642 if (nr > XFRM_MAX_DEPTH)
1643 return NULL;
1644
a4f1bac6
HX		 1645 if (p->dir > XFRM_POLICY_OUT)
1646 return NULL;
1647
1da177e4
LT		 1648 xp = xfrm_policy_alloc(GFP_KERNEL);
1649 if (xp == NULL) {
1650 *dir = -ENOBUFS;
1651 return NULL;
1652 }
1653
1654 copy_from_user_policy(xp, p);
1655 copy_templates(xp, ut, nr);
1656
1657 *dir = p->dir;
1658
1659 return xp;
1660}
1661
1662static int build_polexpire(struct sk_buff *skb, struct xfrm_policy *xp,
d51d081d 1663 int dir, struct km_event *c)
1da177e4
LT		 1664{
1665 struct xfrm_user_polexpire *upe;
1666 struct nlmsghdr *nlh;
d51d081d 1667 int hard = c->data.hard;
1da177e4
LT		 1668 unsigned char *b = skb->tail;
1669
d51d081d 1670 nlh = NLMSG_PUT(skb, c->pid, 0, XFRM_MSG_POLEXPIRE, sizeof(*upe));
1da177e4
LT		 1671 upe = NLMSG_DATA(nlh);
1672 nlh->nlmsg_flags = 0;
1673
1674 copy_to_user_policy(xp, &upe->pol, dir);
1675 if (copy_to_user_tmpl(xp, skb) < 0)
1676 goto nlmsg_failure;
df71837d
TJ		 1677 if (copy_to_user_sec_ctx(xp, skb))
1678 goto nlmsg_failure;
1da177e4
LT		 1679 upe->hard = !!hard;
1680
1681 nlh->nlmsg_len = skb->tail - b;
1682 return skb->len;
1683
1684nlmsg_failure:
1685 skb_trim(skb, b - skb->data);
1686 return -1;
1687}
1688
26b15dad 1689static int xfrm_exp_policy_notify(struct xfrm_policy *xp, int dir, struct km_event *c)
1da177e4
LT		 1690{
1691 struct sk_buff *skb;
1692 size_t len;
1693
1694 len = RTA_SPACE(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
1695 len += NLMSG_SPACE(sizeof(struct xfrm_user_polexpire));
df71837d 1696 len += RTA_SPACE(xfrm_user_sec_ctx_size(xp));
1da177e4
LT		 1697 skb = alloc_skb(len, GFP_ATOMIC);
1698 if (skb == NULL)
1699 return -ENOMEM;
1700
d51d081d 1701 if (build_polexpire(skb, xp, dir, c) < 0)
1da177e4
LT		 1702 BUG();
1703
ac6d439d
PM		 1704 NETLINK_CB(skb).dst_group = XFRMNLGRP_EXPIRE;
1705 return netlink_broadcast(xfrm_nl, skb, 0, XFRMNLGRP_EXPIRE, GFP_ATOMIC);
1da177e4
LT		 1706}
1707
26b15dad
JHS		 1708static int xfrm_notify_policy(struct xfrm_policy *xp, int dir, struct km_event *c)
1709{
1710 struct xfrm_userpolicy_info *p;
0603eac0 1711 struct xfrm_userpolicy_id *id;
26b15dad
JHS		 1712 struct nlmsghdr *nlh;
1713 struct sk_buff *skb;
26b15dad
JHS		 1714 unsigned char *b;
1715 int len = RTA_SPACE(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
0603eac0
HX		 1716 int headlen;
1717
1718 headlen = sizeof(*p);
1719 if (c->event == XFRM_MSG_DELPOLICY) {
1720 len += RTA_SPACE(headlen);
1721 headlen = sizeof(*id);
1722 }
1723 len += NLMSG_SPACE(headlen);
26b15dad
JHS		 1724
1725 skb = alloc_skb(len, GFP_ATOMIC);
1726 if (skb == NULL)
1727 return -ENOMEM;
1728 b = skb->tail;
1729
0603eac0 1730 nlh = NLMSG_PUT(skb, c->pid, c->seq, c->event, headlen);
26b15dad
JHS		 1731
1732 p = NLMSG_DATA(nlh);
0603eac0
HX		 1733 if (c->event == XFRM_MSG_DELPOLICY) {
1734 id = NLMSG_DATA(nlh);
1735 memset(id, 0, sizeof(*id));
1736 id->dir = dir;
1737 if (c->data.byid)
1738 id->index = xp->index;
1739 else
1740 memcpy(&id->sel, &xp->selector, sizeof(id->sel));
1741
1742 p = RTA_DATA(__RTA_PUT(skb, XFRMA_POLICY, sizeof(*p)));
1743 }
26b15dad
JHS		 1744
1745 nlh->nlmsg_flags = 0;
1746
1747 copy_to_user_policy(xp, p, dir);
1748 if (copy_to_user_tmpl(xp, skb) < 0)
1749 goto nlmsg_failure;
1750
1751 nlh->nlmsg_len = skb->tail - b;
1752
ac6d439d
PM		 1753 NETLINK_CB(skb).dst_group = XFRMNLGRP_POLICY;
1754 return netlink_broadcast(xfrm_nl, skb, 0, XFRMNLGRP_POLICY, GFP_ATOMIC);
26b15dad
JHS		 1755
1756nlmsg_failure:
0603eac0 1757rtattr_failure:
26b15dad
JHS		 1758 kfree_skb(skb);
1759 return -1;
1760}
1761
1762static int xfrm_notify_policy_flush(struct km_event *c)
1763{
1764 struct nlmsghdr *nlh;
1765 struct sk_buff *skb;
1766 unsigned char *b;
1767 int len = NLMSG_LENGTH(0);
1768
1769 skb = alloc_skb(len, GFP_ATOMIC);
1770 if (skb == NULL)
1771 return -ENOMEM;
1772 b = skb->tail;
1773
1774
1775 nlh = NLMSG_PUT(skb, c->pid, c->seq, XFRM_MSG_FLUSHPOLICY, 0);
1776
1777 nlh->nlmsg_len = skb->tail - b;
1778
ac6d439d
PM		 1779 NETLINK_CB(skb).dst_group = XFRMNLGRP_POLICY;
1780 return netlink_broadcast(xfrm_nl, skb, 0, XFRMNLGRP_POLICY, GFP_ATOMIC);
26b15dad
JHS		 1781
1782nlmsg_failure:
1783 kfree_skb(skb);
1784 return -1;
1785}
1786
1787static int xfrm_send_policy_notify(struct xfrm_policy *xp, int dir, struct km_event *c)
1788{
1789
1790 switch (c->event) {
f60f6b8f
HX		 1791 case XFRM_MSG_NEWPOLICY:
1792 case XFRM_MSG_UPDPOLICY:
1793 case XFRM_MSG_DELPOLICY:
26b15dad 1794 return xfrm_notify_policy(xp, dir, c);
f60f6b8f 1795 case XFRM_MSG_FLUSHPOLICY:
26b15dad 1796 return xfrm_notify_policy_flush(c);
f60f6b8f 1797 case XFRM_MSG_POLEXPIRE:
26b15dad
JHS		 1798 return xfrm_exp_policy_notify(xp, dir, c);
1799 default:
1800 printk("xfrm_user: Unknown Policy event %d\n", c->event);
1801 }
1802
1803 return 0;
1804
1805}
1806
1da177e4
LT		 1807static struct xfrm_mgr netlink_mgr = {
1808 .id = "netlink",
1809 .notify = xfrm_send_state_notify,
1810 .acquire = xfrm_send_acquire,
1811 .compile_policy = xfrm_compile_policy,
1812 .notify_policy = xfrm_send_policy_notify,
1813};
1814
1815static int __init xfrm_user_init(void)
1816{
1817 printk(KERN_INFO "Initializing IPsec netlink socket\n");
1818
06628607
PM		 1819 xfrm_nl = netlink_kernel_create(NETLINK_XFRM, XFRMNLGRP_MAX,
1820 xfrm_netlink_rcv, THIS_MODULE);
1da177e4
LT		 1821 if (xfrm_nl == NULL)
1822 return -ENOMEM;
1823
1824 xfrm_register_km(&netlink_mgr);
1825
1826 return 0;
1827}
1828
1829static void __exit xfrm_user_exit(void)
1830{
1831 xfrm_unregister_km(&netlink_mgr);
1832 sock_release(xfrm_nl->sk_socket);
1833}
1834
1835module_init(xfrm_user_init);
1836module_exit(xfrm_user_exit);
1837MODULE_LICENSE("GPL");
4fdb3bb7 1838MODULE_ALIAS_NET_PF_PROTO(PF_NETLINK, NETLINK_XFRM);
f8cd5488
JHS		 1839EXPORT_SYMBOL(xfrm_nl);
1840
Linux 6.x block layer and io_uring tree(s)