SAFE public projects git trees. - safe/jmp/linux-2.6/blob - net/xfrm/xfrm_user.c

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