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