ip/ipxfrm.c

   1 /* $USAGI: $ */
   2
   3 /*
   4  * Copyright (C)2004 USAGI/WIDE Project
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, see <http://www.gnu.org/licenses>.
  18  */
  19 /*
  20  * based on ip.c, iproute.c
  21  */
  22 /*
  23  * Authors:
  24  *      Masahide NAKAMURA @USAGI
  25  */
  26
  27 #include <alloca.h>
  28 #include <stdio.h>
  29 #include <stdlib.h>
  30 #include <string.h>
  31 #include <sys/types.h>
  32 #include <sys/socket.h>
  33 #include <time.h>
  34 #include <netdb.h>
  35 #include <linux/netlink.h>
  36 #include <linux/rtnetlink.h>
  37
  38 #include "utils.h"
  39 #include "xfrm.h"
  40 #include "ip_common.h"
  41
  42 #define STRBUF_SIZE     (128)
  43 #define STRBUF_CAT(buf, str) \
  44         do { \
  45                 int rest = sizeof(buf) - 1 - strlen(buf); \
  46                 if (rest > 0) { \
  47                         int len = strlen(str); \
  48                         if (len > rest) \
  49                                 len = rest; \
  50                         strncat(buf, str, len); \
  51                         buf[sizeof(buf) - 1] = '\0'; \
  52                 } \
  53         } while(0);
  54
  55 struct xfrm_filter filter;
  56
  57 static void usage(void) __attribute__((noreturn));
  58
  59 static void usage(void)
  60 {
  61         fprintf(stderr,
  62                 "Usage: ip xfrm XFRM-OBJECT { COMMAND | help }\n"
  63                 "where  XFRM-OBJECT := state | policy | monitor\n");
  64         exit(-1);
  65 }
  66
  67 /* This is based on utils.c(inet_addr_match) */
  68 int xfrm_addr_match(xfrm_address_t *x1, xfrm_address_t *x2, int bits)
  69 {
  70         __u32 *a1 = (__u32 *)x1;
  71         __u32 *a2 = (__u32 *)x2;
  72         int words = bits >> 0x05;
  73
  74         bits &= 0x1f;
  75
  76         if (words)
  77                 if (memcmp(a1, a2, words << 2))
  78                         return -1;
  79
  80         if (bits) {
  81                 __u32 w1, w2;
  82                 __u32 mask;
  83
  84                 w1 = a1[words];
  85                 w2 = a2[words];
  86
  87                 mask = htonl((0xffffffff) << (0x20 - bits));
  88
  89                 if ((w1 ^ w2) & mask)
  90                         return 1;
  91         }
  92
  93         return 0;
  94 }
  95
  96 int xfrm_xfrmproto_is_ipsec(__u8 proto)
  97 {
  98         return (proto ==  IPPROTO_ESP ||
  99                 proto ==  IPPROTO_AH  ||
 100                 proto ==  IPPROTO_COMP);
 101 }
 102
 103 int xfrm_xfrmproto_is_ro(__u8 proto)
 104 {
 105         return (proto ==  IPPROTO_ROUTING ||
 106                 proto ==  IPPROTO_DSTOPTS);
 107 }
 108
 109 struct typeent {
 110         const char *t_name;
 111         int t_type;
 112 };
 113
 114 static const struct typeent xfrmproto_types[]= {
 115         { "esp", IPPROTO_ESP }, { "ah", IPPROTO_AH }, { "comp", IPPROTO_COMP },
 116         { "route2", IPPROTO_ROUTING }, { "hao", IPPROTO_DSTOPTS },
 117         { "ipsec-any", IPSEC_PROTO_ANY },
 118         { NULL, -1 }
 119 };
 120
 121 int xfrm_xfrmproto_getbyname(char *name)
 122 {
 123         int i;
 124
 125         for (i = 0; ; i++) {
 126                 const struct typeent *t = &xfrmproto_types[i];
 127                 if (!t->t_name || t->t_type == -1)
 128                         break;
 129
 130                 if (strcmp(t->t_name, name) == 0)
 131                         return t->t_type;
 132         }
 133
 134         return -1;
 135 }
 136
 137 const char *strxf_xfrmproto(__u8 proto)
 138 {
 139         static char str[16];
 140         int i;
 141
 142         for (i = 0; ; i++) {
 143                 const struct typeent *t = &xfrmproto_types[i];
 144                 if (!t->t_name || t->t_type == -1)
 145                         break;
 146
 147                 if (t->t_type == proto)
 148                         return t->t_name;
 149         }
 150
 151         sprintf(str, "%u", proto);
 152         return str;
 153 }
 154
 155 static const struct typeent algo_types[]= {
 156         { "enc", XFRMA_ALG_CRYPT }, { "auth", XFRMA_ALG_AUTH },
 157         { "comp", XFRMA_ALG_COMP }, { "aead", XFRMA_ALG_AEAD },
 158         { "auth-trunc", XFRMA_ALG_AUTH_TRUNC },
 159         { NULL, -1 }
 160 };
 161
 162 int xfrm_algotype_getbyname(char *name)
 163 {
 164         int i;
 165
 166         for (i = 0; ; i++) {
 167                 const struct typeent *t = &algo_types[i];
 168                 if (!t->t_name || t->t_type == -1)
 169                         break;
 170
 171                 if (strcmp(t->t_name, name) == 0)
 172                         return t->t_type;
 173         }
 174
 175         return -1;
 176 }
 177
 178 const char *strxf_algotype(int type)
 179 {
 180         static char str[32];
 181         int i;
 182
 183         for (i = 0; ; i++) {
 184                 const struct typeent *t = &algo_types[i];
 185                 if (!t->t_name || t->t_type == -1)
 186                         break;
 187
 188                 if (t->t_type == type)
 189                         return t->t_name;
 190         }
 191
 192         sprintf(str, "%d", type);
 193         return str;
 194 }
 195
 196 const char *strxf_mask8(__u8 mask)
 197 {
 198         static char str[16];
 199         const int sn = sizeof(mask) * 8 - 1;
 200         __u8 b;
 201         int i = 0;
 202
 203         for (b = (1 << sn); b > 0; b >>= 1)
 204                 str[i++] = ((b & mask) ? '1' : '0');
 205         str[i] = '\0';
 206
 207         return str;
 208 }
 209
 210 const char *strxf_mask32(__u32 mask)
 211 {
 212         static char str[16];
 213
 214         sprintf(str, "%.8x", mask);
 215
 216         return str;
 217 }
 218
 219 const char *strxf_share(__u8 share)
 220 {
 221         static char str[32];
 222
 223         switch (share) {
 224         case XFRM_SHARE_ANY:
 225                 strcpy(str, "any");
 226                 break;
 227         case XFRM_SHARE_SESSION:
 228                 strcpy(str, "session");
 229                 break;
 230         case XFRM_SHARE_USER:
 231                 strcpy(str, "user");
 232                 break;
 233         case XFRM_SHARE_UNIQUE:
 234                 strcpy(str, "unique");
 235                 break;
 236         default:
 237                 sprintf(str, "%u", share);
 238                 break;
 239         }
 240
 241         return str;
 242 }
 243
 244 const char *strxf_proto(__u8 proto)
 245 {
 246         static char buf[32];
 247         struct protoent *pp;
 248         const char *p;
 249
 250         pp = getprotobynumber(proto);
 251         if (pp)
 252                 p = pp->p_name;
 253         else {
 254                 sprintf(buf, "%u", proto);
 255                 p = buf;
 256         }
 257
 258         return p;
 259 }
 260
 261 const char *strxf_ptype(__u8 ptype)
 262 {
 263         static char str[16];
 264
 265         switch (ptype) {
 266         case XFRM_POLICY_TYPE_MAIN:
 267                 strcpy(str, "main");
 268                 break;
 269         case XFRM_POLICY_TYPE_SUB:
 270                 strcpy(str, "sub");
 271                 break;
 272         default:
 273                 sprintf(str, "%u", ptype);
 274                 break;
 275         }
 276
 277         return str;
 278 }
 279
 280 void xfrm_id_info_print(xfrm_address_t *saddr, struct xfrm_id *id,
 281                         __u8 mode, __u32 reqid, __u16 family, int force_spi,
 282                         FILE *fp, const char *prefix, const char *title)
 283 {
 284         char abuf[256];
 285
 286         if (title)
 287                 fputs(title, fp);
 288
 289         memset(abuf, '\0', sizeof(abuf));
 290         fprintf(fp, "src %s ", rt_addr_n2a(family, sizeof(*saddr),
 291                                            saddr, abuf, sizeof(abuf)));
 292         memset(abuf, '\0', sizeof(abuf));
 293         fprintf(fp, "dst %s", rt_addr_n2a(family, sizeof(id->daddr),
 294                                           &id->daddr, abuf, sizeof(abuf)));
 295         fprintf(fp, "%s", _SL_);
 296
 297         if (prefix)
 298                 fputs(prefix, fp);
 299         fprintf(fp, "\t");
 300
 301         fprintf(fp, "proto %s ", strxf_xfrmproto(id->proto));
 302
 303         if (show_stats > 0 || force_spi || id->spi) {
 304                 __u32 spi = ntohl(id->spi);
 305                 fprintf(fp, "spi 0x%08x", spi);
 306                 if (show_stats > 0)
 307                         fprintf(fp, "(%u)", spi);
 308                 fprintf(fp, " ");
 309         }
 310
 311         fprintf(fp, "reqid %u", reqid);
 312         if (show_stats > 0)
 313                 fprintf(fp, "(0x%08x)", reqid);
 314         fprintf(fp, " ");
 315
 316         fprintf(fp, "mode ");
 317         switch (mode) {
 318         case XFRM_MODE_TRANSPORT:
 319                 fprintf(fp, "transport");
 320                 break;
 321         case XFRM_MODE_TUNNEL:
 322                 fprintf(fp, "tunnel");
 323                 break;
 324         case XFRM_MODE_ROUTEOPTIMIZATION:
 325                 fprintf(fp, "ro");
 326                 break;
 327         case XFRM_MODE_IN_TRIGGER:
 328                 fprintf(fp, "in_trigger");
 329                 break;
 330         case XFRM_MODE_BEET:
 331                 fprintf(fp, "beet");
 332                 break;
 333         default:
 334                 fprintf(fp, "%u", mode);
 335                 break;
 336         }
 337         fprintf(fp, "%s", _SL_);
 338 }
 339
 340 static const char *strxf_limit(__u64 limit)
 341 {
 342         static char str[32];
 343         if (limit == XFRM_INF)
 344                 strcpy(str, "(INF)");
 345         else
 346                 sprintf(str, "%llu", (unsigned long long) limit);
 347
 348         return str;
 349 }
 350
 351 void xfrm_stats_print(struct xfrm_stats *s, FILE *fp, const char *prefix)
 352 {
 353         if (prefix)
 354                 fputs(prefix, fp);
 355         fprintf(fp, "stats:%s", _SL_);
 356
 357         if (prefix)
 358                 fputs(prefix, fp);
 359         fprintf(fp, "  replay-window %u replay %u failed %u%s",
 360                 s->replay_window, s->replay, s->integrity_failed, _SL_);
 361 }
 362
 363 static const char *strxf_time(__u64 time)
 364 {
 365         static char str[32];
 366
 367         if (time == 0)
 368                 strcpy(str, "-");
 369         else {
 370                 time_t t;
 371                 struct tm *tp;
 372
 373                 /* XXX: treat time in the same manner of kernel's
 374                  * net/xfrm/xfrm_{user,state}.c
 375                  */
 376                 t = (long)time;
 377                 tp = localtime(&t);
 378
 379                 strftime(str, sizeof(str), "%Y-%m-%d %T", tp);
 380         }
 381
 382         return str;
 383 }
 384
 385 void xfrm_lifetime_print(struct xfrm_lifetime_cfg *cfg,
 386                          struct xfrm_lifetime_cur *cur,
 387                          FILE *fp, const char *prefix)
 388 {
 389         if (cfg) {
 390                 if (prefix)
 391                         fputs(prefix, fp);
 392                 fprintf(fp, "lifetime config:%s",_SL_);
 393
 394                 if (prefix)
 395                         fputs(prefix, fp);
 396                 fprintf(fp, "  limit: soft %s(bytes),",
 397                         strxf_limit(cfg->soft_byte_limit));
 398                 fprintf(fp, " hard %s(bytes)%s",
 399                         strxf_limit(cfg->hard_byte_limit), _SL_);
 400
 401                 if (prefix)
 402                         fputs(prefix, fp);
 403                 fprintf(fp, "  limit: soft %s(packets),",
 404                         strxf_limit(cfg->soft_packet_limit));
 405                 fprintf(fp, " hard %s(packets)%s",
 406                         strxf_limit(cfg->hard_packet_limit), _SL_);
 407
 408                 if (prefix)
 409                         fputs(prefix, fp);
 410                 fprintf(fp, "  expire add: soft %llu(sec), hard %llu(sec)%s",
 411                         (unsigned long long) cfg->soft_add_expires_seconds,
 412                         (unsigned long long) cfg->hard_add_expires_seconds,
 413                         _SL_);
 414
 415                 if (prefix)
 416                         fputs(prefix, fp);
 417                 fprintf(fp, "  expire use: soft %llu(sec), hard %llu(sec)%s",
 418                         (unsigned long long) cfg->soft_use_expires_seconds,
 419                         (unsigned long long) cfg->hard_use_expires_seconds,
 420                         _SL_);
 421         }
 422         if (cur) {
 423                 if (prefix)
 424                         fputs(prefix, fp);
 425                 fprintf(fp, "lifetime current:%s", _SL_);
 426
 427                 if (prefix)
 428                         fputs(prefix, fp);
 429                 fprintf(fp, "  %llu(bytes), %llu(packets)%s",
 430                         (unsigned long long) cur->bytes,
 431                         (unsigned long long) cur->packets,
 432                          _SL_);
 433
 434                 if (prefix)
 435                         fputs(prefix, fp);
 436                 fprintf(fp, "  add %s ", strxf_time(cur->add_time));
 437                 fprintf(fp, "use %s%s", strxf_time(cur->use_time), _SL_);
 438         }
 439 }
 440
 441 void xfrm_selector_print(struct xfrm_selector *sel, __u16 family,
 442                          FILE *fp, const char *prefix)
 443 {
 444         char abuf[256];
 445         __u16 f;
 446
 447         f = sel->family;
 448         if (f == AF_UNSPEC)
 449                 f = family;
 450         if (f == AF_UNSPEC)
 451                 f = preferred_family;
 452
 453         if (prefix)
 454                 fputs(prefix, fp);
 455
 456         memset(abuf, '\0', sizeof(abuf));
 457         fprintf(fp, "src %s/%u ",
 458                 rt_addr_n2a(f, sizeof(sel->saddr), &sel->saddr,
 459                             abuf, sizeof(abuf)),
 460                 sel->prefixlen_s);
 461
 462         memset(abuf, '\0', sizeof(abuf));
 463         fprintf(fp, "dst %s/%u ",
 464                 rt_addr_n2a(f, sizeof(sel->daddr), &sel->daddr,
 465                             abuf, sizeof(abuf)),
 466                 sel->prefixlen_d);
 467
 468         if (sel->proto)
 469                 fprintf(fp, "proto %s ", strxf_proto(sel->proto));
 470         switch (sel->proto) {
 471         case IPPROTO_TCP:
 472         case IPPROTO_UDP:
 473         case IPPROTO_SCTP:
 474         case IPPROTO_DCCP:
 475         default: /* XXX */
 476                 if (sel->sport_mask)
 477                         fprintf(fp, "sport %u ", ntohs(sel->sport));
 478                 if (sel->dport_mask)
 479                         fprintf(fp, "dport %u ", ntohs(sel->dport));
 480                 break;
 481         case IPPROTO_ICMP:
 482         case IPPROTO_ICMPV6:
 483                 /* type/code is stored at sport/dport in selector */
 484                 if (sel->sport_mask)
 485                         fprintf(fp, "type %u ", ntohs(sel->sport));
 486                 if (sel->dport_mask)
 487                         fprintf(fp, "code %u ", ntohs(sel->dport));
 488                 break;
 489         case IPPROTO_GRE:
 490                 if (sel->sport_mask || sel->dport_mask)
 491                         fprintf(fp, "key %u ",
 492                                 (((__u32)ntohs(sel->sport)) << 16) +
 493                                 ntohs(sel->dport));
 494                 break;
 495         case IPPROTO_MH:
 496                 if (sel->sport_mask)
 497                         fprintf(fp, "type %u ", ntohs(sel->sport));
 498                 if (sel->dport_mask) {
 499                         if (show_stats > 0)
 500                                 fprintf(fp, "(dport) 0x%.4x ", sel->dport);
 501                 }
 502                 break;
 503         }
 504
 505         if (sel->ifindex > 0)
 506                 fprintf(fp, "dev %s ", ll_index_to_name(sel->ifindex));
 507
 508         if (show_stats > 0)
 509                 fprintf(fp, "uid %u", sel->user);
 510
 511         fprintf(fp, "%s", _SL_);
 512 }
 513
 514 static void __xfrm_algo_print(struct xfrm_algo *algo, int type, int len,
 515                               FILE *fp, const char *prefix, int newline)
 516 {
 517         int keylen;
 518         int i;
 519
 520         if (prefix)
 521                 fputs(prefix, fp);
 522
 523         fprintf(fp, "%s ", strxf_algotype(type));
 524
 525         if (len < sizeof(*algo)) {
 526                 fprintf(fp, "(ERROR truncated)");
 527                 goto fin;
 528         }
 529         len -= sizeof(*algo);
 530
 531         fprintf(fp, "%s ", algo->alg_name);
 532
 533         keylen = algo->alg_key_len / 8;
 534         if (len < keylen) {
 535                 fprintf(fp, "(ERROR truncated)");
 536                 goto fin;
 537         }
 538
 539         if (keylen > 0) {
 540                 fprintf(fp, "0x");
 541                 for (i = 0; i < keylen; i ++)
 542                         fprintf(fp, "%.2x", (unsigned char)algo->alg_key[i]);
 543
 544                 if (show_stats > 0)
 545                         fprintf(fp, " (%d bits)", algo->alg_key_len);
 546         }
 547
 548  fin:
 549         if (newline)
 550                 fprintf(fp, "%s", _SL_);
 551 }
 552
 553 static inline void xfrm_algo_print(struct xfrm_algo *algo, int type, int len,
 554                                    FILE *fp, const char *prefix)
 555 {
 556         return __xfrm_algo_print(algo, type, len, fp, prefix, 1);
 557 }
 558
 559 static void xfrm_aead_print(struct xfrm_algo_aead *algo, int len,
 560                             FILE *fp, const char *prefix)
 561 {
 562         struct xfrm_algo *base_algo = alloca(sizeof(*base_algo) + algo->alg_key_len / 8);
 563
 564         memcpy(base_algo->alg_name, algo->alg_name, sizeof(base_algo->alg_name));
 565         base_algo->alg_key_len = algo->alg_key_len;
 566         memcpy(base_algo->alg_key, algo->alg_key, algo->alg_key_len / 8);
 567
 568         __xfrm_algo_print(base_algo, XFRMA_ALG_AEAD, len, fp, prefix, 0);
 569
 570         fprintf(fp, " %d", algo->alg_icv_len);
 571
 572         fprintf(fp, "%s", _SL_);
 573 }
 574
 575 static void xfrm_auth_trunc_print(struct xfrm_algo_auth *algo, int len,
 576                                   FILE *fp, const char *prefix)
 577 {
 578         struct xfrm_algo *base_algo = alloca(sizeof(*base_algo) + algo->alg_key_len / 8);
 579
 580         memcpy(base_algo->alg_name, algo->alg_name, sizeof(base_algo->alg_name));
 581         base_algo->alg_key_len = algo->alg_key_len;
 582         memcpy(base_algo->alg_key, algo->alg_key, algo->alg_key_len / 8);
 583
 584         __xfrm_algo_print(base_algo, XFRMA_ALG_AUTH_TRUNC, len, fp, prefix, 0);
 585
 586         fprintf(fp, " %d", algo->alg_trunc_len);
 587
 588         fprintf(fp, "%s", _SL_);
 589 }
 590
 591 static void xfrm_tmpl_print(struct xfrm_user_tmpl *tmpls, int len,
 592                             FILE *fp, const char *prefix)
 593 {
 594         int ntmpls = len / sizeof(struct xfrm_user_tmpl);
 595         int i;
 596
 597         if (ntmpls <= 0) {
 598                 if (prefix)
 599                         fputs(prefix, fp);
 600                 fprintf(fp, "(ERROR \"tmpl\" truncated)");
 601                 fprintf(fp, "%s", _SL_);
 602                 return;
 603         }
 604
 605         for (i = 0; i < ntmpls; i++) {
 606                 struct xfrm_user_tmpl *tmpl = &tmpls[i];
 607
 608                 if (prefix)
 609                         fputs(prefix, fp);
 610
 611                 xfrm_id_info_print(&tmpl->saddr, &tmpl->id, tmpl->mode,
 612                                    tmpl->reqid, tmpl->family, 0, fp, prefix, "tmpl ");
 613
 614                 if (show_stats > 0 || tmpl->optional) {
 615                         if (prefix)
 616                                 fputs(prefix, fp);
 617                         fprintf(fp, "\t");
 618                         switch (tmpl->optional) {
 619                         case 0:
 620                                 if (show_stats > 0)
 621                                         fprintf(fp, "level required ");
 622                                 break;
 623                         case 1:
 624                                 fprintf(fp, "level use ");
 625                                 break;
 626                         default:
 627                                 fprintf(fp, "level %u ", tmpl->optional);
 628                                 break;
 629                         }
 630
 631                         if (show_stats > 0)
 632                                 fprintf(fp, "share %s ", strxf_share(tmpl->share));
 633
 634                         fprintf(fp, "%s", _SL_);
 635                 }
 636
 637                 if (show_stats > 0) {
 638                         if (prefix)
 639                                 fputs(prefix, fp);
 640                         fprintf(fp, "\t");
 641                         fprintf(fp, "%s-mask %s ",
 642                                 strxf_algotype(XFRMA_ALG_CRYPT),
 643                                 strxf_mask32(tmpl->ealgos));
 644                         fprintf(fp, "%s-mask %s ",
 645                                 strxf_algotype(XFRMA_ALG_AUTH),
 646                                 strxf_mask32(tmpl->aalgos));
 647                         fprintf(fp, "%s-mask %s",
 648                                 strxf_algotype(XFRMA_ALG_COMP),
 649                                 strxf_mask32(tmpl->calgos));
 650
 651                         fprintf(fp, "%s", _SL_);
 652                 }
 653         }
 654 }
 655
 656 int xfrm_parse_mark(struct xfrm_mark *mark, int *argcp, char ***argvp)
 657 {
 658         int argc = *argcp;
 659         char **argv = *argvp;
 660
 661         NEXT_ARG();
 662         if (get_u32(&mark->v, *argv, 0)) {
 663                 invarg("MARK value is invalid\n", *argv);
 664         }
 665         if (argc > 1)
 666                 NEXT_ARG();
 667         else { /* last entry on parse line */
 668                 mark->m = 0xffffffff;
 669                 goto done;
 670         }
 671
 672         if (strcmp(*argv, "mask") == 0) {
 673                 NEXT_ARG();
 674                 if (get_u32(&mark->m, *argv, 0)) {
 675                         invarg("MASK value is invalid\n", *argv);
 676                 }
 677         } else {
 678                 mark->m = 0xffffffff;
 679                 PREV_ARG();
 680         }
 681
 682 done:
 683         *argcp = argc;
 684         *argvp = argv;
 685
 686         return 0;
 687 }
 688
 689 void xfrm_xfrma_print(struct rtattr *tb[], __u16 family,
 690                       FILE *fp, const char *prefix)
 691 {
 692         if (tb[XFRMA_MARK]) {
 693                 struct rtattr *rta = tb[XFRMA_MARK];
 694                 struct xfrm_mark *m = (struct xfrm_mark *) RTA_DATA(rta);
 695                 fprintf(fp, "\tmark %#x/%#x", m->v, m->m);
 696                 fprintf(fp, "%s", _SL_);
 697         }
 698
 699         if (tb[XFRMA_ALG_AUTH] && !tb[XFRMA_ALG_AUTH_TRUNC]) {
 700                 struct rtattr *rta = tb[XFRMA_ALG_AUTH];
 701                 xfrm_algo_print((struct xfrm_algo *) RTA_DATA(rta),
 702                                 XFRMA_ALG_AUTH, RTA_PAYLOAD(rta), fp, prefix);
 703         }
 704
 705         if (tb[XFRMA_ALG_AUTH_TRUNC]) {
 706                 struct rtattr *rta = tb[XFRMA_ALG_AUTH_TRUNC];
 707                 xfrm_auth_trunc_print((struct xfrm_algo_auth *) RTA_DATA(rta),
 708                                       RTA_PAYLOAD(rta), fp, prefix);
 709         }
 710
 711         if (tb[XFRMA_ALG_AEAD]) {
 712                 struct rtattr *rta = tb[XFRMA_ALG_AEAD];
 713                 xfrm_aead_print((struct xfrm_algo_aead *)RTA_DATA(rta),
 714                                 RTA_PAYLOAD(rta), fp, prefix);
 715         }
 716
 717         if (tb[XFRMA_ALG_CRYPT]) {
 718                 struct rtattr *rta = tb[XFRMA_ALG_CRYPT];
 719                 xfrm_algo_print((struct xfrm_algo *) RTA_DATA(rta),
 720                                 XFRMA_ALG_CRYPT, RTA_PAYLOAD(rta), fp, prefix);
 721         }
 722
 723         if (tb[XFRMA_ALG_COMP]) {
 724                 struct rtattr *rta = tb[XFRMA_ALG_COMP];
 725                 xfrm_algo_print((struct xfrm_algo *) RTA_DATA(rta),
 726                                 XFRMA_ALG_COMP, RTA_PAYLOAD(rta), fp, prefix);
 727         }
 728
 729         if (tb[XFRMA_ENCAP]) {
 730                 struct xfrm_encap_tmpl *e;
 731                 char abuf[256];
 732
 733                 if (prefix)
 734                         fputs(prefix, fp);
 735                 fprintf(fp, "encap ");
 736
 737                 if (RTA_PAYLOAD(tb[XFRMA_ENCAP]) < sizeof(*e)) {
 738                         fprintf(fp, "(ERROR truncated)");
 739                         fprintf(fp, "%s", _SL_);
 740                         return;
 741                 }
 742                 e = (struct xfrm_encap_tmpl *) RTA_DATA(tb[XFRMA_ENCAP]);
 743
 744                 fprintf(fp, "type ");
 745                 switch (e->encap_type) {
 746                 case 1:
 747                         fprintf(fp, "espinudp-nonike ");
 748                         break;
 749                 case 2:
 750                         fprintf(fp, "espinudp ");
 751                         break;
 752                 default:
 753                         fprintf(fp, "%u ", e->encap_type);
 754                         break;
 755                 }
 756                 fprintf(fp, "sport %u ", ntohs(e->encap_sport));
 757                 fprintf(fp, "dport %u ", ntohs(e->encap_dport));
 758
 759                 memset(abuf, '\0', sizeof(abuf));
 760                 fprintf(fp, "addr %s",
 761                         rt_addr_n2a(family, sizeof(e->encap_oa), &e->encap_oa,
 762                                     abuf, sizeof(abuf)));
 763                 fprintf(fp, "%s", _SL_);
 764         }
 765
 766         if (tb[XFRMA_TMPL]) {
 767                 struct rtattr *rta = tb[XFRMA_TMPL];
 768                 xfrm_tmpl_print((struct xfrm_user_tmpl *) RTA_DATA(rta),
 769                                 RTA_PAYLOAD(rta), fp, prefix);
 770         }
 771
 772         if (tb[XFRMA_COADDR]) {
 773                 char abuf[256];
 774                 xfrm_address_t *coa;
 775
 776                 if (prefix)
 777                         fputs(prefix, fp);
 778                 fprintf(fp, "coa ");
 779
 780                 coa = (xfrm_address_t *)RTA_DATA(tb[XFRMA_COADDR]);
 781
 782                 if (RTA_PAYLOAD(tb[XFRMA_COADDR]) < sizeof(*coa)) {
 783                         fprintf(fp, "(ERROR truncated)");
 784                         fprintf(fp, "%s", _SL_);
 785                         return;
 786                 }
 787
 788                 memset(abuf, '\0', sizeof(abuf));
 789                 fprintf(fp, "%s",
 790                         rt_addr_n2a(family, sizeof(*coa), coa,
 791                                     abuf, sizeof(abuf)));
 792                 fprintf(fp, "%s", _SL_);
 793         }
 794
 795         if (tb[XFRMA_LASTUSED]) {
 796                 __u64 lastused;
 797
 798                 if (prefix)
 799                         fputs(prefix, fp);
 800                 fprintf(fp, "lastused ");
 801
 802                 if (RTA_PAYLOAD(tb[XFRMA_LASTUSED]) < sizeof(lastused)) {
 803                         fprintf(fp, "(ERROR truncated)");
 804                         fprintf(fp, "%s", _SL_);
 805                         return;
 806                 }
 807
 808                 lastused = rta_getattr_u64(tb[XFRMA_LASTUSED]);
 809
 810                 fprintf(fp, "%s", strxf_time(lastused));
 811                 fprintf(fp, "%s", _SL_);
 812         }
 813
 814         if (tb[XFRMA_REPLAY_VAL]) {
 815                 struct xfrm_replay_state *replay;
 816
 817                 if (prefix)
 818                         fputs(prefix, fp);
 819                 fprintf(fp, "anti-replay context: ");
 820
 821                 if (RTA_PAYLOAD(tb[XFRMA_REPLAY_VAL]) < sizeof(*replay)) {
 822                         fprintf(fp, "(ERROR truncated)");
 823                         fprintf(fp, "%s", _SL_);
 824                         return;
 825                 }
 826
 827                 replay = (struct xfrm_replay_state *)RTA_DATA(tb[XFRMA_REPLAY_VAL]);
 828                 fprintf(fp, "seq 0x%x, oseq 0x%x, bitmap 0x%08x",
 829                         replay->seq, replay->oseq, replay->bitmap);
 830                 fprintf(fp, "%s", _SL_);
 831         }
 832
 833         if (tb[XFRMA_REPLAY_ESN_VAL]) {
 834                 struct xfrm_replay_state_esn *replay;
 835                 unsigned int i, j;
 836
 837                 if (prefix)
 838                         fputs(prefix, fp);
 839                 fprintf(fp, "anti-replay esn context:");
 840
 841                 if (RTA_PAYLOAD(tb[XFRMA_REPLAY_ESN_VAL]) < sizeof(*replay)) {
 842                         fprintf(fp, "(ERROR truncated)");
 843                         fprintf(fp, "%s", _SL_);
 844                         return;
 845                 }
 846                 fprintf(fp, "%s", _SL_);
 847
 848                 replay = (struct xfrm_replay_state_esn *)RTA_DATA(tb[XFRMA_REPLAY_ESN_VAL]);
 849                 if (prefix)
 850                         fputs(prefix, fp);
 851                 fprintf(fp, " seq-hi 0x%x, seq 0x%x, oseq-hi 0x%0x, oseq 0x%0x",
 852                         replay->seq_hi, replay->seq, replay->oseq_hi,
 853                         replay->oseq);
 854                 fprintf(fp, "%s", _SL_);
 855                 if (prefix)
 856                         fputs(prefix, fp);
 857                 fprintf(fp, " replay_window %u, bitmap-length %u",
 858                         replay->replay_window, replay->bmp_len);
 859                 for (i = replay->bmp_len, j = 0; i; i--) {
 860                         if (j++ % 8 == 0) {
 861                                 fprintf(fp, "%s", _SL_);
 862                                 if (prefix)
 863                                         fputs(prefix, fp);
 864                                 fprintf(fp, " ");
 865                         }
 866                         fprintf(fp, "%08x ", replay->bmp[i - 1]);
 867                 }
 868                 fprintf(fp, "%s", _SL_);
 869         }
 870 }
 871
 872 static int xfrm_selector_iszero(struct xfrm_selector *s)
 873 {
 874         struct xfrm_selector s0;
 875
 876         memset(&s0, 0, sizeof(s0));
 877
 878         return (memcmp(&s0, s, sizeof(s0)) == 0);
 879 }
 880
 881 void xfrm_state_info_print(struct xfrm_usersa_info *xsinfo,
 882                             struct rtattr *tb[], FILE *fp, const char *prefix,
 883                             const char *title)
 884 {
 885         char buf[STRBUF_SIZE];
 886         int force_spi = xfrm_xfrmproto_is_ipsec(xsinfo->id.proto);
 887
 888         memset(buf, '\0', sizeof(buf));
 889
 890         xfrm_id_info_print(&xsinfo->saddr, &xsinfo->id, xsinfo->mode,
 891                            xsinfo->reqid, xsinfo->family, force_spi, fp,
 892                            prefix, title);
 893
 894         if (prefix)
 895                 STRBUF_CAT(buf, prefix);
 896         STRBUF_CAT(buf, "\t");
 897
 898         fputs(buf, fp);
 899         fprintf(fp, "replay-window %u ", xsinfo->replay_window);
 900         if (show_stats > 0)
 901                 fprintf(fp, "seq 0x%08u ", xsinfo->seq);
 902         if (show_stats > 0 || xsinfo->flags) {
 903                 __u8 flags = xsinfo->flags;
 904
 905                 fprintf(fp, "flag ");
 906                 XFRM_FLAG_PRINT(fp, flags, XFRM_STATE_NOECN, "noecn");
 907                 XFRM_FLAG_PRINT(fp, flags, XFRM_STATE_DECAP_DSCP, "decap-dscp");
 908                 XFRM_FLAG_PRINT(fp, flags, XFRM_STATE_NOPMTUDISC, "nopmtudisc");
 909                 XFRM_FLAG_PRINT(fp, flags, XFRM_STATE_WILDRECV, "wildrecv");
 910                 XFRM_FLAG_PRINT(fp, flags, XFRM_STATE_ICMP, "icmp");
 911                 XFRM_FLAG_PRINT(fp, flags, XFRM_STATE_AF_UNSPEC, "af-unspec");
 912                 XFRM_FLAG_PRINT(fp, flags, XFRM_STATE_ALIGN4, "align4");
 913                 XFRM_FLAG_PRINT(fp, flags, XFRM_STATE_ESN, "esn");
 914                 if (flags)
 915                         fprintf(fp, "%x", flags);
 916         }
 917         if (show_stats > 0 && tb[XFRMA_SA_EXTRA_FLAGS]) {
 918                 __u32 extra_flags = *(__u32 *)RTA_DATA(tb[XFRMA_SA_EXTRA_FLAGS]);
 919
 920                 fprintf(fp, "extra_flag ");
 921                 XFRM_FLAG_PRINT(fp, extra_flags,
 922                                 XFRM_SA_XFLAG_DONT_ENCAP_DSCP,
 923                                 "dont-encap-dscp");
 924                 if (extra_flags)
 925                         fprintf(fp, "%x", extra_flags);
 926         }
 927         if (show_stats > 0)
 928                 fprintf(fp, " (0x%s)", strxf_mask8(xsinfo->flags));
 929         fprintf(fp, "%s", _SL_);
 930
 931         xfrm_xfrma_print(tb, xsinfo->family, fp, buf);
 932
 933         if (!xfrm_selector_iszero(&xsinfo->sel)) {
 934                 char sbuf[STRBUF_SIZE];
 935
 936                 memcpy(sbuf, buf, sizeof(sbuf));
 937                 STRBUF_CAT(sbuf, "sel ");
 938
 939                 xfrm_selector_print(&xsinfo->sel, xsinfo->family, fp, sbuf);
 940         }
 941
 942         if (show_stats > 0) {
 943                 xfrm_lifetime_print(&xsinfo->lft, &xsinfo->curlft, fp, buf);
 944                 xfrm_stats_print(&xsinfo->stats, fp, buf);
 945         }
 946
 947         if (tb[XFRMA_SEC_CTX]) {
 948                 struct xfrm_user_sec_ctx *sctx;
 949
 950                 fprintf(fp, "\tsecurity context ");
 951
 952                 if (RTA_PAYLOAD(tb[XFRMA_SEC_CTX]) < sizeof(*sctx))
 953                         fprintf(fp, "(ERROR truncated)");
 954
 955                 sctx = (struct xfrm_user_sec_ctx *)RTA_DATA(tb[XFRMA_SEC_CTX]);
 956
 957                 fprintf(fp, "%s %s", (char *)(sctx + 1), _SL_);
 958         }
 959
 960 }
 961
 962 void xfrm_policy_info_print(struct xfrm_userpolicy_info *xpinfo,
 963                             struct rtattr *tb[], FILE *fp, const char *prefix,
 964                             const char *title)
 965 {
 966         char buf[STRBUF_SIZE];
 967
 968         memset(buf, '\0', sizeof(buf));
 969
 970         xfrm_selector_print(&xpinfo->sel, preferred_family, fp, title);
 971
 972         if (tb[XFRMA_SEC_CTX]) {
 973                 struct xfrm_user_sec_ctx *sctx;
 974
 975                 fprintf(fp, "\tsecurity context ");
 976
 977                 if (RTA_PAYLOAD(tb[XFRMA_SEC_CTX]) < sizeof(*sctx))
 978                         fprintf(fp, "(ERROR truncated)");
 979
 980                 sctx = (struct xfrm_user_sec_ctx *)RTA_DATA(tb[XFRMA_SEC_CTX]);
 981
 982                 fprintf(fp, "%s ", (char *)(sctx + 1));
 983                 fprintf(fp, "%s", _SL_);
 984         }
 985
 986         if (prefix)
 987                 STRBUF_CAT(buf, prefix);
 988         STRBUF_CAT(buf, "\t");
 989
 990         fputs(buf, fp);
 991         if (xpinfo->dir >= XFRM_POLICY_MAX) {
 992                 xpinfo->dir -= XFRM_POLICY_MAX;
 993                 fprintf(fp, "socket ");
 994         } else
 995                 fprintf(fp, "dir ");
 996
 997         switch (xpinfo->dir) {
 998         case XFRM_POLICY_IN:
 999                 fprintf(fp, "in");
1000                 break;
1001         case XFRM_POLICY_OUT:
1002                 fprintf(fp, "out");
1003                 break;
1004         case XFRM_POLICY_FWD:
1005                 fprintf(fp, "fwd");
1006                 break;
1007         default:
1008                 fprintf(fp, "%u", xpinfo->dir);
1009                 break;
1010         }
1011         fprintf(fp, " ");
1012
1013         switch (xpinfo->action) {
1014         case XFRM_POLICY_ALLOW:
1015                 if (show_stats > 0)
1016                         fprintf(fp, "action allow ");
1017                 break;
1018         case XFRM_POLICY_BLOCK:
1019                 fprintf(fp, "action block ");
1020                 break;
1021         default:
1022                 fprintf(fp, "action %u ", xpinfo->action);
1023                 break;
1024         }
1025
1026         if (show_stats)
1027                 fprintf(fp, "index %u ", xpinfo->index);
1028         fprintf(fp, "priority %u ", xpinfo->priority);
1029
1030         if (tb[XFRMA_POLICY_TYPE]) {
1031                 struct xfrm_userpolicy_type *upt;
1032
1033                 fprintf(fp, "ptype ");
1034
1035                 if (RTA_PAYLOAD(tb[XFRMA_POLICY_TYPE]) < sizeof(*upt))
1036                         fprintf(fp, "(ERROR truncated)");
1037
1038                 upt = (struct xfrm_userpolicy_type *)RTA_DATA(tb[XFRMA_POLICY_TYPE]);
1039                 fprintf(fp, "%s ", strxf_ptype(upt->type));
1040         }
1041
1042         if (show_stats > 0)
1043                 fprintf(fp, "share %s ", strxf_share(xpinfo->share));
1044
1045         if (show_stats > 0 || xpinfo->flags) {
1046                 __u8 flags = xpinfo->flags;
1047
1048                 fprintf(fp, "flag ");
1049                 XFRM_FLAG_PRINT(fp, flags, XFRM_POLICY_LOCALOK, "localok");
1050                 XFRM_FLAG_PRINT(fp, flags, XFRM_POLICY_ICMP, "icmp");
1051                 if (flags)
1052                         fprintf(fp, "%x", flags);
1053         }
1054         if (show_stats > 0)
1055                 fprintf(fp, " (0x%s)", strxf_mask8(xpinfo->flags));
1056         fprintf(fp, "%s", _SL_);
1057
1058         if (show_stats > 0)
1059                 xfrm_lifetime_print(&xpinfo->lft, &xpinfo->curlft, fp, buf);
1060
1061         xfrm_xfrma_print(tb, xpinfo->sel.family, fp, buf);
1062 }
1063
1064 int xfrm_id_parse(xfrm_address_t *saddr, struct xfrm_id *id, __u16 *family,
1065                   int loose, int *argcp, char ***argvp)
1066 {
1067         int argc = *argcp;
1068         char **argv = *argvp;
1069         inet_prefix dst;
1070         inet_prefix src;
1071
1072         memset(&dst, 0, sizeof(dst));
1073         memset(&src, 0, sizeof(src));
1074
1075         while (1) {
1076                 if (strcmp(*argv, "src") == 0) {
1077                         NEXT_ARG();
1078
1079                         get_prefix(&src, *argv, preferred_family);
1080                         if (src.family == AF_UNSPEC)
1081                                 invarg("value after \"src\" has an unrecognized address family", *argv);
1082                         if (family)
1083                                 *family = src.family;
1084
1085                         memcpy(saddr, &src.data, sizeof(*saddr));
1086
1087                         filter.id_src_mask = src.bitlen;
1088
1089                 } else if (strcmp(*argv, "dst") == 0) {
1090                         NEXT_ARG();
1091
1092                         get_prefix(&dst, *argv, preferred_family);
1093                         if (dst.family == AF_UNSPEC)
1094                                 invarg("value after \"dst\" has an unrecognized address family", *argv);
1095                         if (family)
1096                                 *family = dst.family;
1097
1098                         memcpy(&id->daddr, &dst.data, sizeof(id->daddr));
1099
1100                         filter.id_dst_mask = dst.bitlen;
1101
1102                 } else if (strcmp(*argv, "proto") == 0) {
1103                         int ret;
1104
1105                         NEXT_ARG();
1106
1107                         ret = xfrm_xfrmproto_getbyname(*argv);
1108                         if (ret < 0)
1109                                 invarg("XFRM-PROTO value is invalid", *argv);
1110
1111                         id->proto = (__u8)ret;
1112
1113                         filter.id_proto_mask = XFRM_FILTER_MASK_FULL;
1114
1115                 } else if (strcmp(*argv, "spi") == 0) {
1116                         __u32 spi;
1117
1118                         NEXT_ARG();
1119                         if (get_u32(&spi, *argv, 0))
1120                                 invarg("SPI value is invalid", *argv);
1121
1122                         spi = htonl(spi);
1123                         id->spi = spi;
1124
1125                         filter.id_spi_mask = XFRM_FILTER_MASK_FULL;
1126
1127                 } else {
1128                         PREV_ARG(); /* back track */
1129                         break;
1130                 }
1131
1132                 if (!NEXT_ARG_OK())
1133                         break;
1134                 NEXT_ARG();
1135         }
1136
1137         if (src.family && dst.family && (src.family != dst.family))
1138                 invarg("the same address family is required between values after \"src\" and \"dst\"", *argv);
1139
1140         if (id->spi && id->proto) {
1141                 if (xfrm_xfrmproto_is_ro(id->proto)) {
1142                         fprintf(stderr, "\"spi\" is invalid with XFRM-PROTO value \"%s\"\n",
1143                                 strxf_xfrmproto(id->proto));
1144                         exit(1);
1145                 } else if (id->proto == IPPROTO_COMP && ntohl(id->spi) >= 0x10000) {
1146                         fprintf(stderr, "SPI value is too large with XFRM-PROTO value \"%s\"\n",
1147                                 strxf_xfrmproto(id->proto));
1148                         exit(1);
1149                 }
1150         }
1151
1152         if (loose == 0 && id->proto == 0)
1153                 missarg("XFRM-PROTO");
1154         if (argc == *argcp)
1155                 missarg("ID");
1156
1157         *argcp = argc;
1158         *argvp = argv;
1159
1160         return 0;
1161 }
1162
1163 int xfrm_mode_parse(__u8 *mode, int *argcp, char ***argvp)
1164 {
1165         int argc = *argcp;
1166         char **argv = *argvp;
1167
1168         if (matches(*argv, "transport") == 0)
1169                 *mode = XFRM_MODE_TRANSPORT;
1170         else if (matches(*argv, "tunnel") == 0)
1171                 *mode = XFRM_MODE_TUNNEL;
1172         else if (matches(*argv, "ro") == 0)
1173                 *mode = XFRM_MODE_ROUTEOPTIMIZATION;
1174         else if (matches(*argv, "in_trigger") == 0)
1175                 *mode = XFRM_MODE_IN_TRIGGER;
1176         else if (matches(*argv, "beet") == 0)
1177                 *mode = XFRM_MODE_BEET;
1178         else
1179                 invarg("MODE value is invalid", *argv);
1180
1181         *argcp = argc;
1182         *argvp = argv;
1183
1184         return 0;
1185 }
1186
1187 int xfrm_encap_type_parse(__u16 *type, int *argcp, char ***argvp)
1188 {
1189         int argc = *argcp;
1190         char **argv = *argvp;
1191
1192         if (strcmp(*argv, "espinudp-nonike") == 0)
1193                 *type = 1;
1194         else if (strcmp(*argv, "espinudp") == 0)
1195                 *type = 2;
1196         else
1197                 invarg("ENCAP-TYPE value is invalid", *argv);
1198
1199         *argcp = argc;
1200         *argvp = argv;
1201
1202         return 0;
1203 }
1204
1205 /* NOTE: reqid is used by host-byte order */
1206 int xfrm_reqid_parse(__u32 *reqid, int *argcp, char ***argvp)
1207 {
1208         int argc = *argcp;
1209         char **argv = *argvp;
1210
1211         if (get_u32(reqid, *argv, 0))
1212                 invarg("REQID value is invalid", *argv);
1213
1214         *argcp = argc;
1215         *argvp = argv;
1216
1217         return 0;
1218 }
1219
1220 static int xfrm_selector_upspec_parse(struct xfrm_selector *sel,
1221                                       int *argcp, char ***argvp)
1222 {
1223         int argc = *argcp;
1224         char **argv = *argvp;
1225         char *sportp = NULL;
1226         char *dportp = NULL;
1227         char *typep = NULL;
1228         char *codep = NULL;
1229         char *grekey = NULL;
1230
1231         while (1) {
1232                 if (strcmp(*argv, "proto") == 0) {
1233                         __u8 upspec;
1234
1235                         NEXT_ARG();
1236
1237                         if (strcmp(*argv, "any") == 0)
1238                                 upspec = 0;
1239                         else {
1240                                 struct protoent *pp;
1241                                 pp = getprotobyname(*argv);
1242                                 if (pp)
1243                                         upspec = pp->p_proto;
1244                                 else {
1245                                         if (get_u8(&upspec, *argv, 0))
1246                                                 invarg("PROTO value is invalid", *argv);
1247                                 }
1248                         }
1249                         sel->proto = upspec;
1250
1251                         filter.upspec_proto_mask = XFRM_FILTER_MASK_FULL;
1252
1253                 } else if (strcmp(*argv, "sport") == 0) {
1254                         sportp = *argv;
1255
1256                         NEXT_ARG();
1257
1258                         if (get_u16(&sel->sport, *argv, 0))
1259                                 invarg("value after \"sport\" is invalid", *argv);
1260                         sel->sport = htons(sel->sport);
1261                         if (sel->sport)
1262                                 sel->sport_mask = ~((__u16)0);
1263
1264                         filter.upspec_sport_mask = XFRM_FILTER_MASK_FULL;
1265
1266                 } else if (strcmp(*argv, "dport") == 0) {
1267                         dportp = *argv;
1268
1269                         NEXT_ARG();
1270
1271                         if (get_u16(&sel->dport, *argv, 0))
1272                                 invarg("value after \"dport\" is invalid", *argv);
1273                         sel->dport = htons(sel->dport);
1274                         if (sel->dport)
1275                                 sel->dport_mask = ~((__u16)0);
1276
1277                         filter.upspec_dport_mask = XFRM_FILTER_MASK_FULL;
1278
1279                 } else if (strcmp(*argv, "type") == 0) {
1280                         typep = *argv;
1281
1282                         NEXT_ARG();
1283
1284                         if (get_u16(&sel->sport, *argv, 0) ||
1285                             (sel->sport & ~((__u16)0xff)))
1286                                 invarg("value after \"type\" is invalid", *argv);
1287                         sel->sport = htons(sel->sport);
1288                         sel->sport_mask = ~((__u16)0);
1289
1290                         filter.upspec_sport_mask = XFRM_FILTER_MASK_FULL;
1291
1292
1293                 } else if (strcmp(*argv, "code") == 0) {
1294                         codep = *argv;
1295
1296                         NEXT_ARG();
1297
1298                         if (get_u16(&sel->dport, *argv, 0) ||
1299                             (sel->dport & ~((__u16)0xff)))
1300                                 invarg("value after \"code\" is invalid", *argv);
1301                         sel->dport = htons(sel->dport);
1302                         sel->dport_mask = ~((__u16)0);
1303
1304                         filter.upspec_dport_mask = XFRM_FILTER_MASK_FULL;
1305
1306                 } else if (strcmp(*argv, "key") == 0) {
1307                         unsigned uval;
1308
1309                         grekey = *argv;
1310
1311                         NEXT_ARG();
1312
1313                         if (strchr(*argv, '.'))
1314                                 uval = htonl(get_addr32(*argv));
1315                         else {
1316                                 if (get_unsigned(&uval, *argv, 0)<0) {
1317                                         fprintf(stderr, "value after \"key\" is invalid\n");
1318                                         exit(-1);
1319                                 }
1320                         }
1321
1322                         sel->sport = htons(uval >> 16);
1323                         sel->dport = htons(uval & 0xffff);
1324                         sel->sport_mask = ~((__u16)0);
1325                         sel->dport_mask = ~((__u16)0);
1326
1327                         filter.upspec_dport_mask = XFRM_FILTER_MASK_FULL;
1328
1329                 } else {
1330                         PREV_ARG(); /* back track */
1331                         break;
1332                 }
1333
1334                 if (!NEXT_ARG_OK())
1335                         break;
1336                 NEXT_ARG();
1337         }
1338         if (argc == *argcp)
1339                 missarg("UPSPEC");
1340         if (sportp || dportp) {
1341                 switch (sel->proto) {
1342                 case IPPROTO_TCP:
1343                 case IPPROTO_UDP:
1344                 case IPPROTO_SCTP:
1345                 case IPPROTO_DCCP:
1346                 case IPPROTO_IP: /* to allow shared SA for different protocols */
1347                         break;
1348                 default:
1349                         fprintf(stderr, "\"sport\" and \"dport\" are invalid with PROTO value \"%s\"\n", strxf_proto(sel->proto));
1350                         exit(1);
1351                 }
1352         }
1353         if (typep || codep) {
1354                 switch (sel->proto) {
1355                 case IPPROTO_ICMP:
1356                 case IPPROTO_ICMPV6:
1357                 case IPPROTO_MH:
1358                         break;
1359                 default:
1360                         fprintf(stderr, "\"type\" and \"code\" are invalid with PROTO value \"%s\"\n", strxf_proto(sel->proto));
1361                         exit(1);
1362                 }
1363         }
1364         if (grekey) {
1365                 switch (sel->proto) {
1366                 case IPPROTO_GRE:
1367                         break;
1368                 default:
1369                         fprintf(stderr, "\"key\" is invalid with PROTO value \"%s\"\n", strxf_proto(sel->proto));
1370                         exit(1);
1371                 }
1372         }
1373
1374         *argcp = argc;
1375         *argvp = argv;
1376
1377         return 0;
1378 }
1379
1380 int xfrm_selector_parse(struct xfrm_selector *sel, int *argcp, char ***argvp)
1381 {
1382         int argc = *argcp;
1383         char **argv = *argvp;
1384         inet_prefix dst;
1385         inet_prefix src;
1386         char *upspecp = NULL;
1387
1388         memset(&dst, 0, sizeof(dst));
1389         memset(&src, 0, sizeof(src));
1390
1391         while (1) {
1392                 if (strcmp(*argv, "src") == 0) {
1393                         NEXT_ARG();
1394
1395                         get_prefix(&src, *argv, preferred_family);
1396                         if (src.family == AF_UNSPEC)
1397                                 invarg("value after \"src\" has an unrecognized address family", *argv);
1398                         sel->family = src.family;
1399
1400                         memcpy(&sel->saddr, &src.data, sizeof(sel->saddr));
1401                         sel->prefixlen_s = src.bitlen;
1402
1403                         filter.sel_src_mask = src.bitlen;
1404
1405                 } else if (strcmp(*argv, "dst") == 0) {
1406                         NEXT_ARG();
1407
1408                         get_prefix(&dst, *argv, preferred_family);
1409                         if (dst.family == AF_UNSPEC)
1410                                 invarg("value after \"dst\" has an unrecognized address family", *argv);
1411                         sel->family = dst.family;
1412
1413                         memcpy(&sel->daddr, &dst.data, sizeof(sel->daddr));
1414                         sel->prefixlen_d = dst.bitlen;
1415
1416                         filter.sel_dst_mask = dst.bitlen;
1417
1418                 } else if (strcmp(*argv, "dev") == 0) {
1419                         int ifindex;
1420
1421                         NEXT_ARG();
1422
1423                         if (strcmp(*argv, "none") == 0)
1424                                 ifindex = 0;
1425                         else {
1426                                 ifindex = ll_name_to_index(*argv);
1427                                 if (ifindex <= 0)
1428                                         invarg("DEV value is invalid", *argv);
1429                         }
1430                         sel->ifindex = ifindex;
1431
1432                         filter.sel_dev_mask = XFRM_FILTER_MASK_FULL;
1433
1434                 } else {
1435                         if (upspecp) {
1436                                 PREV_ARG(); /* back track */
1437                                 break;
1438                         } else {
1439                                 upspecp = *argv;
1440                                 xfrm_selector_upspec_parse(sel, &argc, &argv);
1441                         }
1442                 }
1443
1444                 if (!NEXT_ARG_OK())
1445                         break;
1446
1447                 NEXT_ARG();
1448         }
1449
1450         if (src.family && dst.family && (src.family != dst.family))
1451                 invarg("the same address family is required between values after \"src\" and \"dst\"", *argv);
1452
1453         if (argc == *argcp)
1454                 missarg("SELECTOR");
1455
1456         *argcp = argc;
1457         *argvp = argv;
1458
1459         return 0;
1460 }
1461
1462 int xfrm_lifetime_cfg_parse(struct xfrm_lifetime_cfg *lft,
1463                             int *argcp, char ***argvp)
1464 {
1465         int argc = *argcp;
1466         char **argv = *argvp;
1467         int ret;
1468
1469         if (strcmp(*argv, "time-soft") == 0) {
1470                 NEXT_ARG();
1471                 ret = get_u64(&lft->soft_add_expires_seconds, *argv, 0);
1472                 if (ret)
1473                         invarg("value after \"time-soft\" is invalid", *argv);
1474         } else if (strcmp(*argv, "time-hard") == 0) {
1475                 NEXT_ARG();
1476                 ret = get_u64(&lft->hard_add_expires_seconds, *argv, 0);
1477                 if (ret)
1478                         invarg("value after \"time-hard\" is invalid", *argv);
1479         } else if (strcmp(*argv, "time-use-soft") == 0) {
1480                 NEXT_ARG();
1481                 ret = get_u64(&lft->soft_use_expires_seconds, *argv, 0);
1482                 if (ret)
1483                         invarg("value after \"time-use-soft\" is invalid", *argv);
1484         } else if (strcmp(*argv, "time-use-hard") == 0) {
1485                 NEXT_ARG();
1486                 ret = get_u64(&lft->hard_use_expires_seconds, *argv, 0);
1487                 if (ret)
1488                         invarg("value after \"time-use-hard\" is invalid", *argv);
1489         } else if (strcmp(*argv, "byte-soft") == 0) {
1490                 NEXT_ARG();
1491                 ret = get_u64(&lft->soft_byte_limit, *argv, 0);
1492                 if (ret)
1493                         invarg("value after \"byte-soft\" is invalid", *argv);
1494         } else if (strcmp(*argv, "byte-hard") == 0) {
1495                 NEXT_ARG();
1496                 ret = get_u64(&lft->hard_byte_limit, *argv, 0);
1497                 if (ret)
1498                         invarg("value after \"byte-hard\" is invalid", *argv);
1499         } else if (strcmp(*argv, "packet-soft") == 0) {
1500                 NEXT_ARG();
1501                 ret = get_u64(&lft->soft_packet_limit, *argv, 0);
1502                 if (ret)
1503                         invarg("value after \"packet-soft\" is invalid", *argv);
1504         } else if (strcmp(*argv, "packet-hard") == 0) {
1505                 NEXT_ARG();
1506                 ret = get_u64(&lft->hard_packet_limit, *argv, 0);
1507                 if (ret)
1508                         invarg("value after \"packet-hard\" is invalid", *argv);
1509         } else
1510                 invarg("LIMIT value is invalid", *argv);
1511
1512         *argcp = argc;
1513         *argvp = argv;
1514
1515         return 0;
1516 }
1517
1518 int do_xfrm(int argc, char **argv)
1519 {
1520         memset(&filter, 0, sizeof(filter));
1521
1522         if (argc < 1)
1523                 usage();
1524
1525         if (matches(*argv, "state") == 0 ||
1526             matches(*argv, "sa") == 0)
1527                 return do_xfrm_state(argc-1, argv+1);
1528         else if (matches(*argv, "policy") == 0)
1529                 return do_xfrm_policy(argc-1, argv+1);
1530         else if (matches(*argv, "monitor") == 0)
1531                 return do_xfrm_monitor(argc-1, argv+1);
1532         else if (matches(*argv, "help") == 0) {
1533                 usage();
1534                 fprintf(stderr, "xfrm Object \"%s\" is unknown.\n", *argv);
1535                 exit(-1);
1536         }
1537         usage();
1538 }