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