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