examples/ipsec-secgw/sa.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2016-2017 Intel Corporation
   3  */
   4
   5 /*
   6  * Security Associations
   7  */
   8 #include <sys/types.h>
   9 #include <netinet/in.h>
  10 #include <netinet/ip.h>
  11 #include <netinet/ip6.h>
  12
  13 #include <rte_memzone.h>
  14 #include <rte_crypto.h>
  15 #include <rte_security.h>
  16 #include <rte_cryptodev.h>
  17 #include <rte_byteorder.h>
  18 #include <rte_errno.h>
  19 #include <rte_ip.h>
  20 #include <rte_random.h>
  21 #include <rte_ethdev.h>
  22 #include <rte_malloc.h>
  23
  24 #include "ipsec.h"
  25 #include "esp.h"
  26 #include "parser.h"
  27 #include "sad.h"
  28
  29 #define IPDEFTTL 64
  30
  31 #define IP4_FULL_MASK (sizeof(((struct ip_addr *)NULL)->ip.ip4) * CHAR_BIT)
  32
  33 #define IP6_FULL_MASK (sizeof(((struct ip_addr *)NULL)->ip.ip6.ip6) * CHAR_BIT)
  34
  35 #define MBUF_NO_SEC_OFFLOAD(m) ((m->ol_flags & PKT_RX_SEC_OFFLOAD) == 0)
  36
  37 struct supported_cipher_algo {
  38         const char *keyword;
  39         enum rte_crypto_cipher_algorithm algo;
  40         uint16_t iv_len;
  41         uint16_t block_size;
  42         uint16_t key_len;
  43 };
  44
  45 struct supported_auth_algo {
  46         const char *keyword;
  47         enum rte_crypto_auth_algorithm algo;
  48         uint16_t digest_len;
  49         uint16_t key_len;
  50         uint8_t key_not_req;
  51 };
  52
  53 struct supported_aead_algo {
  54         const char *keyword;
  55         enum rte_crypto_aead_algorithm algo;
  56         uint16_t iv_len;
  57         uint16_t block_size;
  58         uint16_t digest_len;
  59         uint16_t key_len;
  60         uint8_t aad_len;
  61 };
  62
  63
  64 const struct supported_cipher_algo cipher_algos[] = {
  65         {
  66                 .keyword = "null",
  67                 .algo = RTE_CRYPTO_CIPHER_NULL,
  68                 .iv_len = 0,
  69                 .block_size = 4,
  70                 .key_len = 0
  71         },
  72         {
  73                 .keyword = "aes-128-cbc",
  74                 .algo = RTE_CRYPTO_CIPHER_AES_CBC,
  75                 .iv_len = 16,
  76                 .block_size = 16,
  77                 .key_len = 16
  78         },
  79         {
  80                 .keyword = "aes-256-cbc",
  81                 .algo = RTE_CRYPTO_CIPHER_AES_CBC,
  82                 .iv_len = 16,
  83                 .block_size = 16,
  84                 .key_len = 32
  85         },
  86         {
  87                 .keyword = "aes-128-ctr",
  88                 .algo = RTE_CRYPTO_CIPHER_AES_CTR,
  89                 .iv_len = 8,
  90                 .block_size = 4,
  91                 .key_len = 20
  92         },
  93         {
  94                 .keyword = "3des-cbc",
  95                 .algo = RTE_CRYPTO_CIPHER_3DES_CBC,
  96                 .iv_len = 8,
  97                 .block_size = 8,
  98                 .key_len = 24
  99         }
 100 };
 101
 102 const struct supported_auth_algo auth_algos[] = {
 103         {
 104                 .keyword = "null",
 105                 .algo = RTE_CRYPTO_AUTH_NULL,
 106                 .digest_len = 0,
 107                 .key_len = 0,
 108                 .key_not_req = 1
 109         },
 110         {
 111                 .keyword = "sha1-hmac",
 112                 .algo = RTE_CRYPTO_AUTH_SHA1_HMAC,
 113                 .digest_len = 12,
 114                 .key_len = 20
 115         },
 116         {
 117                 .keyword = "sha256-hmac",
 118                 .algo = RTE_CRYPTO_AUTH_SHA256_HMAC,
 119                 .digest_len = 16,
 120                 .key_len = 32
 121         }
 122 };
 123
 124 const struct supported_aead_algo aead_algos[] = {
 125         {
 126                 .keyword = "aes-128-gcm",
 127                 .algo = RTE_CRYPTO_AEAD_AES_GCM,
 128                 .iv_len = 8,
 129                 .block_size = 4,
 130                 .key_len = 20,
 131                 .digest_len = 16,
 132                 .aad_len = 8,
 133         }
 134 };
 135
 136 #define SA_INIT_NB      128
 137
 138 static struct ipsec_sa *sa_out;
 139 static uint32_t sa_out_sz;
 140 static uint32_t nb_sa_out;
 141 static struct ipsec_sa_cnt sa_out_cnt;
 142
 143 static struct ipsec_sa *sa_in;
 144 static uint32_t sa_in_sz;
 145 static uint32_t nb_sa_in;
 146 static struct ipsec_sa_cnt sa_in_cnt;
 147
 148 static const struct supported_cipher_algo *
 149 find_match_cipher_algo(const char *cipher_keyword)
 150 {
 151         size_t i;
 152
 153         for (i = 0; i < RTE_DIM(cipher_algos); i++) {
 154                 const struct supported_cipher_algo *algo =
 155                         &cipher_algos[i];
 156
 157                 if (strcmp(cipher_keyword, algo->keyword) == 0)
 158                         return algo;
 159         }
 160
 161         return NULL;
 162 }
 163
 164 static const struct supported_auth_algo *
 165 find_match_auth_algo(const char *auth_keyword)
 166 {
 167         size_t i;
 168
 169         for (i = 0; i < RTE_DIM(auth_algos); i++) {
 170                 const struct supported_auth_algo *algo =
 171                         &auth_algos[i];
 172
 173                 if (strcmp(auth_keyword, algo->keyword) == 0)
 174                         return algo;
 175         }
 176
 177         return NULL;
 178 }
 179
 180 static const struct supported_aead_algo *
 181 find_match_aead_algo(const char *aead_keyword)
 182 {
 183         size_t i;
 184
 185         for (i = 0; i < RTE_DIM(aead_algos); i++) {
 186                 const struct supported_aead_algo *algo =
 187                         &aead_algos[i];
 188
 189                 if (strcmp(aead_keyword, algo->keyword) == 0)
 190                         return algo;
 191         }
 192
 193         return NULL;
 194 }
 195
 196 /** parse_key_string
 197  *  parse x:x:x:x.... hex number key string into uint8_t *key
 198  *  return:
 199  *  > 0: number of bytes parsed
 200  *  0:   failed
 201  */
 202 static uint32_t
 203 parse_key_string(const char *key_str, uint8_t *key)
 204 {
 205         const char *pt_start = key_str, *pt_end = key_str;
 206         uint32_t nb_bytes = 0;
 207
 208         while (pt_end != NULL) {
 209                 char sub_str[3] = {0};
 210
 211                 pt_end = strchr(pt_start, ':');
 212
 213                 if (pt_end == NULL) {
 214                         if (strlen(pt_start) > 2)
 215                                 return 0;
 216                         strncpy(sub_str, pt_start, 2);
 217                 } else {
 218                         if (pt_end - pt_start > 2)
 219                                 return 0;
 220
 221                         strncpy(sub_str, pt_start, pt_end - pt_start);
 222                         pt_start = pt_end + 1;
 223                 }
 224
 225                 key[nb_bytes++] = strtol(sub_str, NULL, 16);
 226         }
 227
 228         return nb_bytes;
 229 }
 230
 231 static int
 232 extend_sa_arr(struct ipsec_sa **sa_tbl, uint32_t cur_cnt, uint32_t *cur_sz)
 233 {
 234         if (*sa_tbl == NULL) {
 235                 *sa_tbl = calloc(SA_INIT_NB, sizeof(struct ipsec_sa));
 236                 if (*sa_tbl == NULL)
 237                         return -1;
 238                 *cur_sz = SA_INIT_NB;
 239                 return 0;
 240         }
 241
 242         if (cur_cnt >= *cur_sz) {
 243                 *sa_tbl = realloc(*sa_tbl,
 244                         *cur_sz * sizeof(struct ipsec_sa) * 2);
 245                 if (*sa_tbl == NULL)
 246                         return -1;
 247                 /* clean reallocated extra space */
 248                 memset(&(*sa_tbl)[*cur_sz], 0,
 249                         *cur_sz * sizeof(struct ipsec_sa));
 250                 *cur_sz *= 2;
 251         }
 252
 253         return 0;
 254 }
 255
 256 void
 257 parse_sa_tokens(char **tokens, uint32_t n_tokens,
 258         struct parse_status *status)
 259 {
 260         struct ipsec_sa *rule = NULL;
 261         struct rte_ipsec_session *ips;
 262         uint32_t ti; /*token index*/
 263         uint32_t *ri /*rule index*/;
 264         struct ipsec_sa_cnt *sa_cnt;
 265         uint32_t cipher_algo_p = 0;
 266         uint32_t auth_algo_p = 0;
 267         uint32_t aead_algo_p = 0;
 268         uint32_t src_p = 0;
 269         uint32_t dst_p = 0;
 270         uint32_t mode_p = 0;
 271         uint32_t type_p = 0;
 272         uint32_t portid_p = 0;
 273         uint32_t fallback_p = 0;
 274
 275         if (strcmp(tokens[0], "in") == 0) {
 276                 ri = &nb_sa_in;
 277                 sa_cnt = &sa_in_cnt;
 278                 if (extend_sa_arr(&sa_in, nb_sa_in, &sa_in_sz) < 0)
 279                         return;
 280                 rule = &sa_in[*ri];
 281                 rule->direction = RTE_SECURITY_IPSEC_SA_DIR_INGRESS;
 282         } else {
 283                 ri = &nb_sa_out;
 284                 sa_cnt = &sa_out_cnt;
 285                 if (extend_sa_arr(&sa_out, nb_sa_out, &sa_out_sz) < 0)
 286                         return;
 287                 rule = &sa_out[*ri];
 288                 rule->direction = RTE_SECURITY_IPSEC_SA_DIR_EGRESS;
 289         }
 290
 291         /* spi number */
 292         APP_CHECK_TOKEN_IS_NUM(tokens, 1, status);
 293         if (status->status < 0)
 294                 return;
 295         if (atoi(tokens[1]) == INVALID_SPI)
 296                 return;
 297         rule->spi = atoi(tokens[1]);
 298         ips = ipsec_get_primary_session(rule);
 299
 300         for (ti = 2; ti < n_tokens; ti++) {
 301                 if (strcmp(tokens[ti], "mode") == 0) {
 302                         APP_CHECK_PRESENCE(mode_p, tokens[ti], status);
 303                         if (status->status < 0)
 304                                 return;
 305
 306                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 307                         if (status->status < 0)
 308                                 return;
 309
 310                         if (strcmp(tokens[ti], "ipv4-tunnel") == 0) {
 311                                 sa_cnt->nb_v4++;
 312                                 rule->flags = IP4_TUNNEL;
 313                         } else if (strcmp(tokens[ti], "ipv6-tunnel") == 0) {
 314                                 sa_cnt->nb_v6++;
 315                                 rule->flags = IP6_TUNNEL;
 316                         } else if (strcmp(tokens[ti], "transport") == 0) {
 317                                 sa_cnt->nb_v4++;
 318                                 sa_cnt->nb_v6++;
 319                                 rule->flags = TRANSPORT;
 320                         } else {
 321                                 APP_CHECK(0, status, "unrecognized "
 322                                         "input \"%s\"", tokens[ti]);
 323                                 return;
 324                         }
 325
 326                         mode_p = 1;
 327                         continue;
 328                 }
 329
 330                 if (strcmp(tokens[ti], "cipher_algo") == 0) {
 331                         const struct supported_cipher_algo *algo;
 332                         uint32_t key_len;
 333
 334                         APP_CHECK_PRESENCE(cipher_algo_p, tokens[ti],
 335                                 status);
 336                         if (status->status < 0)
 337                                 return;
 338
 339                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 340                         if (status->status < 0)
 341                                 return;
 342
 343                         algo = find_match_cipher_algo(tokens[ti]);
 344
 345                         APP_CHECK(algo != NULL, status, "unrecognized "
 346                                 "input \"%s\"", tokens[ti]);
 347
 348                         if (status->status < 0)
 349                                 return;
 350
 351                         rule->cipher_algo = algo->algo;
 352                         rule->block_size = algo->block_size;
 353                         rule->iv_len = algo->iv_len;
 354                         rule->cipher_key_len = algo->key_len;
 355
 356                         /* for NULL algorithm, no cipher key required */
 357                         if (rule->cipher_algo == RTE_CRYPTO_CIPHER_NULL) {
 358                                 cipher_algo_p = 1;
 359                                 continue;
 360                         }
 361
 362                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 363                         if (status->status < 0)
 364                                 return;
 365
 366                         APP_CHECK(strcmp(tokens[ti], "cipher_key") == 0,
 367                                 status, "unrecognized input \"%s\", "
 368                                 "expect \"cipher_key\"", tokens[ti]);
 369                         if (status->status < 0)
 370                                 return;
 371
 372                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 373                         if (status->status < 0)
 374                                 return;
 375
 376                         key_len = parse_key_string(tokens[ti],
 377                                 rule->cipher_key);
 378                         APP_CHECK(key_len == rule->cipher_key_len, status,
 379                                 "unrecognized input \"%s\"", tokens[ti]);
 380                         if (status->status < 0)
 381                                 return;
 382
 383                         if (algo->algo == RTE_CRYPTO_CIPHER_AES_CBC ||
 384                                 algo->algo == RTE_CRYPTO_CIPHER_3DES_CBC)
 385                                 rule->salt = (uint32_t)rte_rand();
 386
 387                         if (algo->algo == RTE_CRYPTO_CIPHER_AES_CTR) {
 388                                 key_len -= 4;
 389                                 rule->cipher_key_len = key_len;
 390                                 memcpy(&rule->salt,
 391                                         &rule->cipher_key[key_len], 4);
 392                         }
 393
 394                         cipher_algo_p = 1;
 395                         continue;
 396                 }
 397
 398                 if (strcmp(tokens[ti], "auth_algo") == 0) {
 399                         const struct supported_auth_algo *algo;
 400                         uint32_t key_len;
 401
 402                         APP_CHECK_PRESENCE(auth_algo_p, tokens[ti],
 403                                 status);
 404                         if (status->status < 0)
 405                                 return;
 406
 407                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 408                         if (status->status < 0)
 409                                 return;
 410
 411                         algo = find_match_auth_algo(tokens[ti]);
 412                         APP_CHECK(algo != NULL, status, "unrecognized "
 413                                 "input \"%s\"", tokens[ti]);
 414
 415                         if (status->status < 0)
 416                                 return;
 417
 418                         rule->auth_algo = algo->algo;
 419                         rule->auth_key_len = algo->key_len;
 420                         rule->digest_len = algo->digest_len;
 421
 422                         /* NULL algorithm and combined algos do not
 423                          * require auth key
 424                          */
 425                         if (algo->key_not_req) {
 426                                 auth_algo_p = 1;
 427                                 continue;
 428                         }
 429
 430                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 431                         if (status->status < 0)
 432                                 return;
 433
 434                         APP_CHECK(strcmp(tokens[ti], "auth_key") == 0,
 435                                 status, "unrecognized input \"%s\", "
 436                                 "expect \"auth_key\"", tokens[ti]);
 437                         if (status->status < 0)
 438                                 return;
 439
 440                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 441                         if (status->status < 0)
 442                                 return;
 443
 444                         key_len = parse_key_string(tokens[ti],
 445                                 rule->auth_key);
 446                         APP_CHECK(key_len == rule->auth_key_len, status,
 447                                 "unrecognized input \"%s\"", tokens[ti]);
 448                         if (status->status < 0)
 449                                 return;
 450
 451                         auth_algo_p = 1;
 452                         continue;
 453                 }
 454
 455                 if (strcmp(tokens[ti], "aead_algo") == 0) {
 456                         const struct supported_aead_algo *algo;
 457                         uint32_t key_len;
 458
 459                         APP_CHECK_PRESENCE(aead_algo_p, tokens[ti],
 460                                 status);
 461                         if (status->status < 0)
 462                                 return;
 463
 464                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 465                         if (status->status < 0)
 466                                 return;
 467
 468                         algo = find_match_aead_algo(tokens[ti]);
 469
 470                         APP_CHECK(algo != NULL, status, "unrecognized "
 471                                 "input \"%s\"", tokens[ti]);
 472
 473                         if (status->status < 0)
 474                                 return;
 475
 476                         rule->aead_algo = algo->algo;
 477                         rule->cipher_key_len = algo->key_len;
 478                         rule->digest_len = algo->digest_len;
 479                         rule->aad_len = algo->aad_len;
 480                         rule->block_size = algo->block_size;
 481                         rule->iv_len = algo->iv_len;
 482
 483                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 484                         if (status->status < 0)
 485                                 return;
 486
 487                         APP_CHECK(strcmp(tokens[ti], "aead_key") == 0,
 488                                 status, "unrecognized input \"%s\", "
 489                                 "expect \"aead_key\"", tokens[ti]);
 490                         if (status->status < 0)
 491                                 return;
 492
 493                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 494                         if (status->status < 0)
 495                                 return;
 496
 497                         key_len = parse_key_string(tokens[ti],
 498                                 rule->cipher_key);
 499                         APP_CHECK(key_len == rule->cipher_key_len, status,
 500                                 "unrecognized input \"%s\"", tokens[ti]);
 501                         if (status->status < 0)
 502                                 return;
 503
 504                         key_len -= 4;
 505                         rule->cipher_key_len = key_len;
 506                         memcpy(&rule->salt,
 507                                 &rule->cipher_key[key_len], 4);
 508
 509                         aead_algo_p = 1;
 510                         continue;
 511                 }
 512
 513                 if (strcmp(tokens[ti], "src") == 0) {
 514                         APP_CHECK_PRESENCE(src_p, tokens[ti], status);
 515                         if (status->status < 0)
 516                                 return;
 517
 518                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 519                         if (status->status < 0)
 520                                 return;
 521
 522                         if (IS_IP4_TUNNEL(rule->flags)) {
 523                                 struct in_addr ip;
 524
 525                                 APP_CHECK(parse_ipv4_addr(tokens[ti],
 526                                         &ip, NULL) == 0, status,
 527                                         "unrecognized input \"%s\", "
 528                                         "expect valid ipv4 addr",
 529                                         tokens[ti]);
 530                                 if (status->status < 0)
 531                                         return;
 532                                 rule->src.ip.ip4 = rte_bswap32(
 533                                         (uint32_t)ip.s_addr);
 534                         } else if (IS_IP6_TUNNEL(rule->flags)) {
 535                                 struct in6_addr ip;
 536
 537                                 APP_CHECK(parse_ipv6_addr(tokens[ti], &ip,
 538                                         NULL) == 0, status,
 539                                         "unrecognized input \"%s\", "
 540                                         "expect valid ipv6 addr",
 541                                         tokens[ti]);
 542                                 if (status->status < 0)
 543                                         return;
 544                                 memcpy(rule->src.ip.ip6.ip6_b,
 545                                         ip.s6_addr, 16);
 546                         } else if (IS_TRANSPORT(rule->flags)) {
 547                                 APP_CHECK(0, status, "unrecognized input "
 548                                         "\"%s\"", tokens[ti]);
 549                                 return;
 550                         }
 551
 552                         src_p = 1;
 553                         continue;
 554                 }
 555
 556                 if (strcmp(tokens[ti], "dst") == 0) {
 557                         APP_CHECK_PRESENCE(dst_p, tokens[ti], status);
 558                         if (status->status < 0)
 559                                 return;
 560
 561                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 562                         if (status->status < 0)
 563                                 return;
 564
 565                         if (IS_IP4_TUNNEL(rule->flags)) {
 566                                 struct in_addr ip;
 567
 568                                 APP_CHECK(parse_ipv4_addr(tokens[ti],
 569                                         &ip, NULL) == 0, status,
 570                                         "unrecognized input \"%s\", "
 571                                         "expect valid ipv4 addr",
 572                                         tokens[ti]);
 573                                 if (status->status < 0)
 574                                         return;
 575                                 rule->dst.ip.ip4 = rte_bswap32(
 576                                         (uint32_t)ip.s_addr);
 577                         } else if (IS_IP6_TUNNEL(rule->flags)) {
 578                                 struct in6_addr ip;
 579
 580                                 APP_CHECK(parse_ipv6_addr(tokens[ti], &ip,
 581                                         NULL) == 0, status,
 582                                         "unrecognized input \"%s\", "
 583                                         "expect valid ipv6 addr",
 584                                         tokens[ti]);
 585                                 if (status->status < 0)
 586                                         return;
 587                                 memcpy(rule->dst.ip.ip6.ip6_b, ip.s6_addr, 16);
 588                         } else if (IS_TRANSPORT(rule->flags)) {
 589                                 APP_CHECK(0, status, "unrecognized "
 590                                         "input \"%s\"", tokens[ti]);
 591                                 return;
 592                         }
 593
 594                         dst_p = 1;
 595                         continue;
 596                 }
 597
 598                 if (strcmp(tokens[ti], "type") == 0) {
 599                         APP_CHECK_PRESENCE(type_p, tokens[ti], status);
 600                         if (status->status < 0)
 601                                 return;
 602
 603                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 604                         if (status->status < 0)
 605                                 return;
 606
 607                         if (strcmp(tokens[ti], "inline-crypto-offload") == 0)
 608                                 ips->type =
 609                                         RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO;
 610                         else if (strcmp(tokens[ti],
 611                                         "inline-protocol-offload") == 0)
 612                                 ips->type =
 613                                 RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL;
 614                         else if (strcmp(tokens[ti],
 615                                         "lookaside-protocol-offload") == 0)
 616                                 ips->type =
 617                                 RTE_SECURITY_ACTION_TYPE_LOOKASIDE_PROTOCOL;
 618                         else if (strcmp(tokens[ti], "no-offload") == 0)
 619                                 ips->type = RTE_SECURITY_ACTION_TYPE_NONE;
 620                         else {
 621                                 APP_CHECK(0, status, "Invalid input \"%s\"",
 622                                                 tokens[ti]);
 623                                 return;
 624                         }
 625
 626                         type_p = 1;
 627                         continue;
 628                 }
 629
 630                 if (strcmp(tokens[ti], "port_id") == 0) {
 631                         APP_CHECK_PRESENCE(portid_p, tokens[ti], status);
 632                         if (status->status < 0)
 633                                 return;
 634                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 635                         if (status->status < 0)
 636                                 return;
 637                         rule->portid = atoi(tokens[ti]);
 638                         if (status->status < 0)
 639                                 return;
 640                         portid_p = 1;
 641                         continue;
 642                 }
 643
 644                 if (strcmp(tokens[ti], "fallback") == 0) {
 645                         struct rte_ipsec_session *fb;
 646
 647                         APP_CHECK(app_sa_prm.enable, status, "Fallback session "
 648                                 "not allowed for legacy mode.");
 649                         if (status->status < 0)
 650                                 return;
 651                         APP_CHECK(ips->type ==
 652                                 RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO, status,
 653                                 "Fallback session allowed if primary session "
 654                                 "is of type inline-crypto-offload only.");
 655                         if (status->status < 0)
 656                                 return;
 657                         APP_CHECK(rule->direction ==
 658                                 RTE_SECURITY_IPSEC_SA_DIR_INGRESS, status,
 659                                 "Fallback session not allowed for egress "
 660                                 "rule");
 661                         if (status->status < 0)
 662                                 return;
 663                         APP_CHECK_PRESENCE(fallback_p, tokens[ti], status);
 664                         if (status->status < 0)
 665                                 return;
 666                         INCREMENT_TOKEN_INDEX(ti, n_tokens, status);
 667                         if (status->status < 0)
 668                                 return;
 669                         fb = ipsec_get_fallback_session(rule);
 670                         if (strcmp(tokens[ti], "lookaside-none") == 0) {
 671                                 fb->type = RTE_SECURITY_ACTION_TYPE_NONE;
 672                         } else {
 673                                 APP_CHECK(0, status, "unrecognized fallback "
 674                                         "type %s.", tokens[ti]);
 675                                 return;
 676                         }
 677
 678                         rule->fallback_sessions = 1;
 679                         fallback_p = 1;
 680                         continue;
 681                 }
 682
 683                 /* unrecognizeable input */
 684                 APP_CHECK(0, status, "unrecognized input \"%s\"",
 685                         tokens[ti]);
 686                 return;
 687         }
 688
 689         if (aead_algo_p) {
 690                 APP_CHECK(cipher_algo_p == 0, status,
 691                                 "AEAD used, no need for cipher options");
 692                 if (status->status < 0)
 693                         return;
 694
 695                 APP_CHECK(auth_algo_p == 0, status,
 696                                 "AEAD used, no need for auth options");
 697                 if (status->status < 0)
 698                         return;
 699         } else {
 700                 APP_CHECK(cipher_algo_p == 1, status, "missing cipher or AEAD options");
 701                 if (status->status < 0)
 702                         return;
 703
 704                 APP_CHECK(auth_algo_p == 1, status, "missing auth or AEAD options");
 705                 if (status->status < 0)
 706                         return;
 707         }
 708
 709         APP_CHECK(mode_p == 1, status, "missing mode option");
 710         if (status->status < 0)
 711                 return;
 712
 713         if ((ips->type != RTE_SECURITY_ACTION_TYPE_NONE) && (portid_p == 0))
 714                 printf("Missing portid option, falling back to non-offload\n");
 715
 716         if (!type_p || !portid_p) {
 717                 ips->type = RTE_SECURITY_ACTION_TYPE_NONE;
 718                 rule->portid = -1;
 719         }
 720
 721         *ri = *ri + 1;
 722 }
 723
 724 static void
 725 print_one_sa_rule(const struct ipsec_sa *sa, int inbound)
 726 {
 727         uint32_t i;
 728         uint8_t a, b, c, d;
 729         const struct rte_ipsec_session *ips;
 730         const struct rte_ipsec_session *fallback_ips;
 731
 732         printf("\tspi_%s(%3u):", inbound?"in":"out", sa->spi);
 733
 734         for (i = 0; i < RTE_DIM(cipher_algos); i++) {
 735                 if (cipher_algos[i].algo == sa->cipher_algo &&
 736                                 cipher_algos[i].key_len == sa->cipher_key_len) {
 737                         printf("%s ", cipher_algos[i].keyword);
 738                         break;
 739                 }
 740         }
 741
 742         for (i = 0; i < RTE_DIM(auth_algos); i++) {
 743                 if (auth_algos[i].algo == sa->auth_algo) {
 744                         printf("%s ", auth_algos[i].keyword);
 745                         break;
 746                 }
 747         }
 748
 749         for (i = 0; i < RTE_DIM(aead_algos); i++) {
 750                 if (aead_algos[i].algo == sa->aead_algo) {
 751                         printf("%s ", aead_algos[i].keyword);
 752                         break;
 753                 }
 754         }
 755
 756         printf("mode:");
 757
 758         switch (WITHOUT_TRANSPORT_VERSION(sa->flags)) {
 759         case IP4_TUNNEL:
 760                 printf("IP4Tunnel ");
 761                 uint32_t_to_char(sa->src.ip.ip4, &a, &b, &c, &d);
 762                 printf("%hhu.%hhu.%hhu.%hhu ", d, c, b, a);
 763                 uint32_t_to_char(sa->dst.ip.ip4, &a, &b, &c, &d);
 764                 printf("%hhu.%hhu.%hhu.%hhu", d, c, b, a);
 765                 break;
 766         case IP6_TUNNEL:
 767                 printf("IP6Tunnel ");
 768                 for (i = 0; i < 16; i++) {
 769                         if (i % 2 && i != 15)
 770                                 printf("%.2x:", sa->src.ip.ip6.ip6_b[i]);
 771                         else
 772                                 printf("%.2x", sa->src.ip.ip6.ip6_b[i]);
 773                 }
 774                 printf(" ");
 775                 for (i = 0; i < 16; i++) {
 776                         if (i % 2 && i != 15)
 777                                 printf("%.2x:", sa->dst.ip.ip6.ip6_b[i]);
 778                         else
 779                                 printf("%.2x", sa->dst.ip.ip6.ip6_b[i]);
 780                 }
 781                 break;
 782         case TRANSPORT:
 783                 printf("Transport ");
 784                 break;
 785         }
 786
 787         ips = &sa->sessions[IPSEC_SESSION_PRIMARY];
 788         printf(" type:");
 789         switch (ips->type) {
 790         case RTE_SECURITY_ACTION_TYPE_NONE:
 791                 printf("no-offload ");
 792                 break;
 793         case RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO:
 794                 printf("inline-crypto-offload ");
 795                 break;
 796         case RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL:
 797                 printf("inline-protocol-offload ");
 798                 break;
 799         case RTE_SECURITY_ACTION_TYPE_LOOKASIDE_PROTOCOL:
 800                 printf("lookaside-protocol-offload ");
 801                 break;
 802         }
 803
 804         fallback_ips = &sa->sessions[IPSEC_SESSION_FALLBACK];
 805         if (fallback_ips != NULL && sa->fallback_sessions > 0) {
 806                 printf("inline fallback: ");
 807                 if (fallback_ips->type == RTE_SECURITY_ACTION_TYPE_NONE)
 808                         printf("lookaside-none");
 809                 else
 810                         printf("invalid");
 811         }
 812         printf("\n");
 813 }
 814
 815 struct ipsec_xf {
 816         struct rte_crypto_sym_xform a;
 817         struct rte_crypto_sym_xform b;
 818 };
 819
 820 struct sa_ctx {
 821         void *satbl; /* pointer to array of rte_ipsec_sa objects*/
 822         struct ipsec_sad sad;
 823         struct ipsec_xf *xf;
 824         uint32_t nb_sa;
 825         struct ipsec_sa sa[];
 826 };
 827
 828 static struct sa_ctx *
 829 sa_create(const char *name, int32_t socket_id, uint32_t nb_sa)
 830 {
 831         char s[PATH_MAX];
 832         struct sa_ctx *sa_ctx;
 833         uint32_t mz_size;
 834         const struct rte_memzone *mz;
 835
 836         snprintf(s, sizeof(s), "%s_%u", name, socket_id);
 837
 838         /* Create SA context */
 839         printf("Creating SA context with %u maximum entries on socket %d\n",
 840                         nb_sa, socket_id);
 841
 842         mz_size = sizeof(struct ipsec_xf) * nb_sa;
 843         mz = rte_memzone_reserve(s, mz_size, socket_id,
 844                         RTE_MEMZONE_1GB | RTE_MEMZONE_SIZE_HINT_ONLY);
 845         if (mz == NULL) {
 846                 printf("Failed to allocate SA XFORM memory\n");
 847                 rte_errno = ENOMEM;
 848                 return NULL;
 849         }
 850
 851         sa_ctx = rte_malloc(NULL, sizeof(struct sa_ctx) +
 852                 sizeof(struct ipsec_sa) * nb_sa, RTE_CACHE_LINE_SIZE);
 853
 854         if (sa_ctx == NULL) {
 855                 printf("Failed to allocate SA CTX memory\n");
 856                 rte_errno = ENOMEM;
 857                 rte_memzone_free(mz);
 858                 return NULL;
 859         }
 860
 861         sa_ctx->xf = (struct ipsec_xf *)mz->addr;
 862         sa_ctx->nb_sa = nb_sa;
 863
 864         return sa_ctx;
 865 }
 866
 867 static int
 868 check_eth_dev_caps(uint16_t portid, uint32_t inbound)
 869 {
 870         struct rte_eth_dev_info dev_info;
 871         int retval;
 872
 873         retval = rte_eth_dev_info_get(portid, &dev_info);
 874         if (retval != 0) {
 875                 RTE_LOG(ERR, IPSEC,
 876                         "Error during getting device (port %u) info: %s\n",
 877                         portid, strerror(-retval));
 878
 879                 return retval;
 880         }
 881
 882         if (inbound) {
 883                 if ((dev_info.rx_offload_capa &
 884                                 DEV_RX_OFFLOAD_SECURITY) == 0) {
 885                         RTE_LOG(WARNING, PORT,
 886                                 "hardware RX IPSec offload is not supported\n");
 887                         return -EINVAL;
 888                 }
 889
 890         } else { /* outbound */
 891                 if ((dev_info.tx_offload_capa &
 892                                 DEV_TX_OFFLOAD_SECURITY) == 0) {
 893                         RTE_LOG(WARNING, PORT,
 894                                 "hardware TX IPSec offload is not supported\n");
 895                         return -EINVAL;
 896                 }
 897         }
 898         return 0;
 899 }
 900
 901 /*
 902  * Helper function, tries to determine next_proto for SPI
 903  * by searching though SP rules.
 904  */
 905 static int
 906 get_spi_proto(uint32_t spi, enum rte_security_ipsec_sa_direction dir,
 907                 struct ip_addr ip_addr[2], uint32_t mask[2])
 908 {
 909         int32_t rc4, rc6;
 910
 911         rc4 = sp4_spi_present(spi, dir == RTE_SECURITY_IPSEC_SA_DIR_INGRESS,
 912                                 ip_addr, mask);
 913         rc6 = sp6_spi_present(spi, dir == RTE_SECURITY_IPSEC_SA_DIR_INGRESS,
 914                                 ip_addr, mask);
 915
 916         if (rc4 >= 0) {
 917                 if (rc6 >= 0) {
 918                         RTE_LOG(ERR, IPSEC,
 919                                 "%s: SPI %u used simultaeously by "
 920                                 "IPv4(%d) and IPv6 (%d) SP rules\n",
 921                                 __func__, spi, rc4, rc6);
 922                         return -EINVAL;
 923                 } else
 924                         return IPPROTO_IPIP;
 925         } else if (rc6 < 0) {
 926                 RTE_LOG(ERR, IPSEC,
 927                         "%s: SPI %u is not used by any SP rule\n",
 928                         __func__, spi);
 929                 return -EINVAL;
 930         } else
 931                 return IPPROTO_IPV6;
 932 }
 933
 934 /*
 935  * Helper function for getting source and destination IP addresses
 936  * from SP. Needed for inline crypto transport mode, as addresses are not
 937  * provided in config file for that mode. It checks if SP for current SA exists,
 938  * and based on what type of protocol is returned, it stores appropriate
 939  * addresses got from SP into SA.
 940  */
 941 static int
 942 sa_add_address_inline_crypto(struct ipsec_sa *sa)
 943 {
 944         int protocol;
 945         struct ip_addr ip_addr[2];
 946         uint32_t mask[2];
 947
 948         protocol = get_spi_proto(sa->spi, sa->direction, ip_addr, mask);
 949         if (protocol < 0)
 950                 return protocol;
 951         else if (protocol == IPPROTO_IPIP) {
 952                 sa->flags |= IP4_TRANSPORT;
 953                 if (mask[0] == IP4_FULL_MASK &&
 954                                 mask[1] == IP4_FULL_MASK &&
 955                                 ip_addr[0].ip.ip4 != 0 &&
 956                                 ip_addr[1].ip.ip4 != 0) {
 957
 958                         sa->src.ip.ip4 = ip_addr[0].ip.ip4;
 959                         sa->dst.ip.ip4 = ip_addr[1].ip.ip4;
 960                 } else {
 961                         RTE_LOG(ERR, IPSEC,
 962                         "%s: No valid address or mask entry in"
 963                         " IPv4 SP rule for SPI %u\n",
 964                         __func__, sa->spi);
 965                         return -EINVAL;
 966                 }
 967         } else if (protocol == IPPROTO_IPV6) {
 968                 sa->flags |= IP6_TRANSPORT;
 969                 if (mask[0] == IP6_FULL_MASK &&
 970                                 mask[1] == IP6_FULL_MASK &&
 971                                 (ip_addr[0].ip.ip6.ip6[0] != 0 ||
 972                                 ip_addr[0].ip.ip6.ip6[1] != 0) &&
 973                                 (ip_addr[1].ip.ip6.ip6[0] != 0 ||
 974                                 ip_addr[1].ip.ip6.ip6[1] != 0)) {
 975
 976                         sa->src.ip.ip6 = ip_addr[0].ip.ip6;
 977                         sa->dst.ip.ip6 = ip_addr[1].ip.ip6;
 978                 } else {
 979                         RTE_LOG(ERR, IPSEC,
 980                         "%s: No valid address or mask entry in"
 981                         " IPv6 SP rule for SPI %u\n",
 982                         __func__, sa->spi);
 983                         return -EINVAL;
 984                 }
 985         }
 986         return 0;
 987 }
 988
 989 static int
 990 sa_add_rules(struct sa_ctx *sa_ctx, const struct ipsec_sa entries[],
 991                 uint32_t nb_entries, uint32_t inbound,
 992                 struct socket_ctx *skt_ctx)
 993 {
 994         struct ipsec_sa *sa;
 995         uint32_t i, idx;
 996         uint16_t iv_length, aad_length;
 997         int inline_status;
 998         int32_t rc;
 999         struct rte_ipsec_session *ips;
1000
1001         /* for ESN upper 32 bits of SQN also need to be part of AAD */
1002         aad_length = (app_sa_prm.enable_esn != 0) ? sizeof(uint32_t) : 0;
1003
1004         for (i = 0; i < nb_entries; i++) {
1005                 idx = i;
1006                 sa = &sa_ctx->sa[idx];
1007                 if (sa->spi != 0) {
1008                         printf("Index %u already in use by SPI %u\n",
1009                                         idx, sa->spi);
1010                         return -EINVAL;
1011                 }
1012                 *sa = entries[i];
1013
1014                 if (inbound) {
1015                         rc = ipsec_sad_add(&sa_ctx->sad, sa);
1016                         if (rc != 0)
1017                                 return rc;
1018                 }
1019
1020                 sa->seq = 0;
1021                 ips = ipsec_get_primary_session(sa);
1022
1023                 if (ips->type == RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL ||
1024                         ips->type == RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO) {
1025                         if (check_eth_dev_caps(sa->portid, inbound))
1026                                 return -EINVAL;
1027                 }
1028
1029
1030                 switch (WITHOUT_TRANSPORT_VERSION(sa->flags)) {
1031                 case IP4_TUNNEL:
1032                         sa->src.ip.ip4 = rte_cpu_to_be_32(sa->src.ip.ip4);
1033                         sa->dst.ip.ip4 = rte_cpu_to_be_32(sa->dst.ip.ip4);
1034                         break;
1035                 case TRANSPORT:
1036                         if (ips->type ==
1037                                 RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO) {
1038                                 inline_status =
1039                                         sa_add_address_inline_crypto(sa);
1040                                 if (inline_status < 0)
1041                                         return inline_status;
1042                         }
1043                         break;
1044                 }
1045
1046                 if (sa->aead_algo == RTE_CRYPTO_AEAD_AES_GCM) {
1047                         struct rte_ipsec_session *ips;
1048                         iv_length = 12;
1049
1050                         sa_ctx->xf[idx].a.type = RTE_CRYPTO_SYM_XFORM_AEAD;
1051                         sa_ctx->xf[idx].a.aead.algo = sa->aead_algo;
1052                         sa_ctx->xf[idx].a.aead.key.data = sa->cipher_key;
1053                         sa_ctx->xf[idx].a.aead.key.length =
1054                                 sa->cipher_key_len;
1055                         sa_ctx->xf[idx].a.aead.op = (inbound == 1) ?
1056                                 RTE_CRYPTO_AEAD_OP_DECRYPT :
1057                                 RTE_CRYPTO_AEAD_OP_ENCRYPT;
1058                         sa_ctx->xf[idx].a.next = NULL;
1059                         sa_ctx->xf[idx].a.aead.iv.offset = IV_OFFSET;
1060                         sa_ctx->xf[idx].a.aead.iv.length = iv_length;
1061                         sa_ctx->xf[idx].a.aead.aad_length =
1062                                 sa->aad_len + aad_length;
1063                         sa_ctx->xf[idx].a.aead.digest_length =
1064                                 sa->digest_len;
1065
1066                         sa->xforms = &sa_ctx->xf[idx].a;
1067
1068                         ips = ipsec_get_primary_session(sa);
1069                         if (ips->type ==
1070                                 RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL ||
1071                                 ips->type ==
1072                                 RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO) {
1073                                 rc = create_inline_session(skt_ctx, sa, ips);
1074                                 if (rc != 0) {
1075                                         RTE_LOG(ERR, IPSEC_ESP,
1076                                                 "create_inline_session() failed\n");
1077                                         return -EINVAL;
1078                                 }
1079                         }
1080                         print_one_sa_rule(sa, inbound);
1081                 } else {
1082                         switch (sa->cipher_algo) {
1083                         case RTE_CRYPTO_CIPHER_NULL:
1084                         case RTE_CRYPTO_CIPHER_3DES_CBC:
1085                         case RTE_CRYPTO_CIPHER_AES_CBC:
1086                                 iv_length = sa->iv_len;
1087                                 break;
1088                         case RTE_CRYPTO_CIPHER_AES_CTR:
1089                                 iv_length = 16;
1090                                 break;
1091                         default:
1092                                 RTE_LOG(ERR, IPSEC_ESP,
1093                                                 "unsupported cipher algorithm %u\n",
1094                                                 sa->cipher_algo);
1095                                 return -EINVAL;
1096                         }
1097
1098                         if (inbound) {
1099                                 sa_ctx->xf[idx].b.type = RTE_CRYPTO_SYM_XFORM_CIPHER;
1100                                 sa_ctx->xf[idx].b.cipher.algo = sa->cipher_algo;
1101                                 sa_ctx->xf[idx].b.cipher.key.data = sa->cipher_key;
1102                                 sa_ctx->xf[idx].b.cipher.key.length =
1103                                         sa->cipher_key_len;
1104                                 sa_ctx->xf[idx].b.cipher.op =
1105                                         RTE_CRYPTO_CIPHER_OP_DECRYPT;
1106                                 sa_ctx->xf[idx].b.next = NULL;
1107                                 sa_ctx->xf[idx].b.cipher.iv.offset = IV_OFFSET;
1108                                 sa_ctx->xf[idx].b.cipher.iv.length = iv_length;
1109
1110                                 sa_ctx->xf[idx].a.type = RTE_CRYPTO_SYM_XFORM_AUTH;
1111                                 sa_ctx->xf[idx].a.auth.algo = sa->auth_algo;
1112                                 sa_ctx->xf[idx].a.auth.key.data = sa->auth_key;
1113                                 sa_ctx->xf[idx].a.auth.key.length =
1114                                         sa->auth_key_len;
1115                                 sa_ctx->xf[idx].a.auth.digest_length =
1116                                         sa->digest_len;
1117                                 sa_ctx->xf[idx].a.auth.op =
1118                                         RTE_CRYPTO_AUTH_OP_VERIFY;
1119                         } else { /* outbound */
1120                                 sa_ctx->xf[idx].a.type = RTE_CRYPTO_SYM_XFORM_CIPHER;
1121                                 sa_ctx->xf[idx].a.cipher.algo = sa->cipher_algo;
1122                                 sa_ctx->xf[idx].a.cipher.key.data = sa->cipher_key;
1123                                 sa_ctx->xf[idx].a.cipher.key.length =
1124                                         sa->cipher_key_len;
1125                                 sa_ctx->xf[idx].a.cipher.op =
1126                                         RTE_CRYPTO_CIPHER_OP_ENCRYPT;
1127                                 sa_ctx->xf[idx].a.next = NULL;
1128                                 sa_ctx->xf[idx].a.cipher.iv.offset = IV_OFFSET;
1129                                 sa_ctx->xf[idx].a.cipher.iv.length = iv_length;
1130
1131                                 sa_ctx->xf[idx].b.type = RTE_CRYPTO_SYM_XFORM_AUTH;
1132                                 sa_ctx->xf[idx].b.auth.algo = sa->auth_algo;
1133                                 sa_ctx->xf[idx].b.auth.key.data = sa->auth_key;
1134                                 sa_ctx->xf[idx].b.auth.key.length =
1135                                         sa->auth_key_len;
1136                                 sa_ctx->xf[idx].b.auth.digest_length =
1137                                         sa->digest_len;
1138                                 sa_ctx->xf[idx].b.auth.op =
1139                                         RTE_CRYPTO_AUTH_OP_GENERATE;
1140                         }
1141
1142                         sa_ctx->xf[idx].a.next = &sa_ctx->xf[idx].b;
1143                         sa_ctx->xf[idx].b.next = NULL;
1144                         sa->xforms = &sa_ctx->xf[idx].a;
1145
1146                         print_one_sa_rule(sa, inbound);
1147                 }
1148         }
1149
1150         return 0;
1151 }
1152
1153 static inline int
1154 sa_out_add_rules(struct sa_ctx *sa_ctx, const struct ipsec_sa entries[],
1155                 uint32_t nb_entries, struct socket_ctx *skt_ctx)
1156 {
1157         return sa_add_rules(sa_ctx, entries, nb_entries, 0, skt_ctx);
1158 }
1159
1160 static inline int
1161 sa_in_add_rules(struct sa_ctx *sa_ctx, const struct ipsec_sa entries[],
1162                 uint32_t nb_entries, struct socket_ctx *skt_ctx)
1163 {
1164         return sa_add_rules(sa_ctx, entries, nb_entries, 1, skt_ctx);
1165 }
1166
1167 /*
1168  * helper function, fills parameters that are identical for all SAs
1169  */
1170 static void
1171 fill_ipsec_app_sa_prm(struct rte_ipsec_sa_prm *prm,
1172         const struct app_sa_prm *app_prm)
1173 {
1174         memset(prm, 0, sizeof(*prm));
1175
1176         prm->flags = app_prm->flags;
1177         prm->ipsec_xform.options.esn = app_prm->enable_esn;
1178         prm->ipsec_xform.replay_win_sz = app_prm->window_size;
1179 }
1180
1181 static int
1182 fill_ipsec_sa_prm(struct rte_ipsec_sa_prm *prm, const struct ipsec_sa *ss,
1183         const struct rte_ipv4_hdr *v4, struct rte_ipv6_hdr *v6)
1184 {
1185         int32_t rc;
1186
1187         /*
1188          * Try to get SPI next proto by searching that SPI in SPD.
1189          * probably not the optimal way, but there seems nothing
1190          * better right now.
1191          */
1192         rc = get_spi_proto(ss->spi, ss->direction, NULL, NULL);
1193         if (rc < 0)
1194                 return rc;
1195
1196         fill_ipsec_app_sa_prm(prm, &app_sa_prm);
1197         prm->userdata = (uintptr_t)ss;
1198
1199         /* setup ipsec xform */
1200         prm->ipsec_xform.spi = ss->spi;
1201         prm->ipsec_xform.salt = ss->salt;
1202         prm->ipsec_xform.direction = ss->direction;
1203         prm->ipsec_xform.proto = RTE_SECURITY_IPSEC_SA_PROTO_ESP;
1204         prm->ipsec_xform.mode = (IS_TRANSPORT(ss->flags)) ?
1205                 RTE_SECURITY_IPSEC_SA_MODE_TRANSPORT :
1206                 RTE_SECURITY_IPSEC_SA_MODE_TUNNEL;
1207         prm->ipsec_xform.options.ecn = 1;
1208         prm->ipsec_xform.options.copy_dscp = 1;
1209
1210         if (IS_IP4_TUNNEL(ss->flags)) {
1211                 prm->ipsec_xform.tunnel.type = RTE_SECURITY_IPSEC_TUNNEL_IPV4;
1212                 prm->tun.hdr_len = sizeof(*v4);
1213                 prm->tun.next_proto = rc;
1214                 prm->tun.hdr = v4;
1215         } else if (IS_IP6_TUNNEL(ss->flags)) {
1216                 prm->ipsec_xform.tunnel.type = RTE_SECURITY_IPSEC_TUNNEL_IPV6;
1217                 prm->tun.hdr_len = sizeof(*v6);
1218                 prm->tun.next_proto = rc;
1219                 prm->tun.hdr = v6;
1220         } else {
1221                 /* transport mode */
1222                 prm->trs.proto = rc;
1223         }
1224
1225         /* setup crypto section */
1226         prm->crypto_xform = ss->xforms;
1227         return 0;
1228 }
1229
1230 static int
1231 fill_ipsec_session(struct rte_ipsec_session *ss, struct rte_ipsec_sa *sa)
1232 {
1233         int32_t rc = 0;
1234
1235         ss->sa = sa;
1236
1237         if (ss->type == RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO ||
1238                 ss->type == RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL) {
1239                 if (ss->security.ses != NULL) {
1240                         rc = rte_ipsec_session_prepare(ss);
1241                         if (rc != 0)
1242                                 memset(ss, 0, sizeof(*ss));
1243                 }
1244         }
1245
1246         return rc;
1247 }
1248
1249 /*
1250  * Initialise related rte_ipsec_sa object.
1251  */
1252 static int
1253 ipsec_sa_init(struct ipsec_sa *lsa, struct rte_ipsec_sa *sa, uint32_t sa_size)
1254 {
1255         int rc;
1256         struct rte_ipsec_sa_prm prm;
1257         struct rte_ipsec_session *ips;
1258         struct rte_ipv4_hdr v4  = {
1259                 .version_ihl = IPVERSION << 4 |
1260                         sizeof(v4) / RTE_IPV4_IHL_MULTIPLIER,
1261                 .time_to_live = IPDEFTTL,
1262                 .next_proto_id = IPPROTO_ESP,
1263                 .src_addr = lsa->src.ip.ip4,
1264                 .dst_addr = lsa->dst.ip.ip4,
1265         };
1266         struct rte_ipv6_hdr v6 = {
1267                 .vtc_flow = htonl(IP6_VERSION << 28),
1268                 .proto = IPPROTO_ESP,
1269         };
1270
1271         if (IS_IP6_TUNNEL(lsa->flags)) {
1272                 memcpy(v6.src_addr, lsa->src.ip.ip6.ip6_b, sizeof(v6.src_addr));
1273                 memcpy(v6.dst_addr, lsa->dst.ip.ip6.ip6_b, sizeof(v6.dst_addr));
1274         }
1275
1276         rc = fill_ipsec_sa_prm(&prm, lsa, &v4, &v6);
1277         if (rc == 0)
1278                 rc = rte_ipsec_sa_init(sa, &prm, sa_size);
1279         if (rc < 0)
1280                 return rc;
1281
1282         /* init primary processing session */
1283         ips = ipsec_get_primary_session(lsa);
1284         rc = fill_ipsec_session(ips, sa);
1285         if (rc != 0)
1286                 return rc;
1287
1288         /* init inline fallback processing session */
1289         if (lsa->fallback_sessions == 1)
1290                 rc = fill_ipsec_session(ipsec_get_fallback_session(lsa), sa);
1291
1292         return rc;
1293 }
1294
1295 /*
1296  * Allocate space and init rte_ipsec_sa strcutures,
1297  * one per session.
1298  */
1299 static int
1300 ipsec_satbl_init(struct sa_ctx *ctx, uint32_t nb_ent, int32_t socket)
1301 {
1302         int32_t rc, sz;
1303         uint32_t i, idx;
1304         size_t tsz;
1305         struct rte_ipsec_sa *sa;
1306         struct ipsec_sa *lsa;
1307         struct rte_ipsec_sa_prm prm;
1308
1309         /* determine SA size */
1310         idx = 0;
1311         fill_ipsec_sa_prm(&prm, ctx->sa + idx, NULL, NULL);
1312         sz = rte_ipsec_sa_size(&prm);
1313         if (sz < 0) {
1314                 RTE_LOG(ERR, IPSEC, "%s(%p, %u, %d): "
1315                         "failed to determine SA size, error code: %d\n",
1316                         __func__, ctx, nb_ent, socket, sz);
1317                 return sz;
1318         }
1319
1320         tsz = sz * nb_ent;
1321
1322         ctx->satbl = rte_zmalloc_socket(NULL, tsz, RTE_CACHE_LINE_SIZE, socket);
1323         if (ctx->satbl == NULL) {
1324                 RTE_LOG(ERR, IPSEC,
1325                         "%s(%p, %u, %d): failed to allocate %zu bytes\n",
1326                         __func__,  ctx, nb_ent, socket, tsz);
1327                 return -ENOMEM;
1328         }
1329
1330         rc = 0;
1331         for (i = 0; i != nb_ent && rc == 0; i++) {
1332
1333                 idx = i;
1334
1335                 sa = (struct rte_ipsec_sa *)((uintptr_t)ctx->satbl + sz * i);
1336                 lsa = ctx->sa + idx;
1337
1338                 rc = ipsec_sa_init(lsa, sa, sz);
1339         }
1340
1341         return rc;
1342 }
1343
1344 static int
1345 sa_cmp(const void *p, const void *q)
1346 {
1347         uint32_t spi1 = ((const struct ipsec_sa *)p)->spi;
1348         uint32_t spi2 = ((const struct ipsec_sa *)q)->spi;
1349
1350         return (int)(spi1 - spi2);
1351 }
1352
1353 /*
1354  * Walk through all SA rules to find an SA with given SPI
1355  */
1356 int
1357 sa_spi_present(struct sa_ctx *sa_ctx, uint32_t spi, int inbound)
1358 {
1359         uint32_t num;
1360         struct ipsec_sa *sa;
1361         struct ipsec_sa tmpl;
1362         const struct ipsec_sa *sar;
1363
1364         sar = sa_ctx->sa;
1365         if (inbound != 0)
1366                 num = nb_sa_in;
1367         else
1368                 num = nb_sa_out;
1369
1370         tmpl.spi = spi;
1371
1372         sa = bsearch(&tmpl, sar, num, sizeof(struct ipsec_sa), sa_cmp);
1373         if (sa != NULL)
1374                 return RTE_PTR_DIFF(sa, sar) / sizeof(struct ipsec_sa);
1375
1376         return -ENOENT;
1377 }
1378
1379 void
1380 sa_init(struct socket_ctx *ctx, int32_t socket_id)
1381 {
1382         int32_t rc;
1383         const char *name;
1384
1385         if (ctx == NULL)
1386                 rte_exit(EXIT_FAILURE, "NULL context.\n");
1387
1388         if (ctx->sa_in != NULL)
1389                 rte_exit(EXIT_FAILURE, "Inbound SA DB for socket %u already "
1390                                 "initialized\n", socket_id);
1391
1392         if (ctx->sa_out != NULL)
1393                 rte_exit(EXIT_FAILURE, "Outbound SA DB for socket %u already "
1394                                 "initialized\n", socket_id);
1395
1396         if (nb_sa_in > 0) {
1397                 name = "sa_in";
1398                 ctx->sa_in = sa_create(name, socket_id, nb_sa_in);
1399                 if (ctx->sa_in == NULL)
1400                         rte_exit(EXIT_FAILURE, "Error [%d] creating SA "
1401                                 "context %s in socket %d\n", rte_errno,
1402                                 name, socket_id);
1403
1404                 rc = ipsec_sad_create(name, &ctx->sa_in->sad, socket_id,
1405                                 &sa_in_cnt);
1406                 if (rc != 0)
1407                         rte_exit(EXIT_FAILURE, "failed to init SAD\n");
1408
1409                 sa_in_add_rules(ctx->sa_in, sa_in, nb_sa_in, ctx);
1410
1411                 if (app_sa_prm.enable != 0) {
1412                         rc = ipsec_satbl_init(ctx->sa_in, nb_sa_in,
1413                                 socket_id);
1414                         if (rc != 0)
1415                                 rte_exit(EXIT_FAILURE,
1416                                         "failed to init inbound SAs\n");
1417                 }
1418         } else
1419                 RTE_LOG(WARNING, IPSEC, "No SA Inbound rule specified\n");
1420
1421         if (nb_sa_out > 0) {
1422                 name = "sa_out";
1423                 ctx->sa_out = sa_create(name, socket_id, nb_sa_out);
1424                 if (ctx->sa_out == NULL)
1425                         rte_exit(EXIT_FAILURE, "Error [%d] creating SA "
1426                                 "context %s in socket %d\n", rte_errno,
1427                                 name, socket_id);
1428
1429                 sa_out_add_rules(ctx->sa_out, sa_out, nb_sa_out, ctx);
1430
1431                 if (app_sa_prm.enable != 0) {
1432                         rc = ipsec_satbl_init(ctx->sa_out, nb_sa_out,
1433                                 socket_id);
1434                         if (rc != 0)
1435                                 rte_exit(EXIT_FAILURE,
1436                                         "failed to init outbound SAs\n");
1437                 }
1438         } else
1439                 RTE_LOG(WARNING, IPSEC, "No SA Outbound rule "
1440                         "specified\n");
1441 }
1442
1443 int
1444 inbound_sa_check(struct sa_ctx *sa_ctx, struct rte_mbuf *m, uint32_t sa_idx)
1445 {
1446         struct ipsec_mbuf_metadata *priv;
1447         struct ipsec_sa *sa;
1448
1449         priv = get_priv(m);
1450         sa = priv->sa;
1451         if (sa != NULL)
1452                 return (sa_ctx->sa[sa_idx].spi == sa->spi);
1453
1454         RTE_LOG(ERR, IPSEC, "SA not saved in private data\n");
1455         return 0;
1456 }
1457
1458 void
1459 inbound_sa_lookup(struct sa_ctx *sa_ctx, struct rte_mbuf *pkts[],
1460                 void *sa_arr[], uint16_t nb_pkts)
1461 {
1462         uint32_t i;
1463         struct ip *ip;
1464         uint32_t *src4_addr;
1465         uint8_t *src6_addr;
1466         void *result_sa;
1467         struct ipsec_sa *sa;
1468
1469         sad_lookup(&sa_ctx->sad, pkts, sa_arr, nb_pkts);
1470
1471         /*
1472          * Mark need for inline offload fallback on the LSB of SA pointer.
1473          * Thanks to packet grouping mechanism which ipsec_process is using
1474          * packets marked for fallback processing will form separate group.
1475          *
1476          * Because it is not safe to use SA pointer it is casted to generic
1477          * pointer to prevent from unintentional use. Use ipsec_mask_saptr
1478          * to get valid struct pointer.
1479          */
1480         for (i = 0; i < nb_pkts; i++) {
1481                 if (sa_arr[i] == NULL)
1482                         continue;
1483
1484                 result_sa = sa = sa_arr[i];
1485                 if (MBUF_NO_SEC_OFFLOAD(pkts[i]) &&
1486                         sa->fallback_sessions > 0) {
1487                         uintptr_t intsa = (uintptr_t)sa;
1488                         intsa |= IPSEC_SA_OFFLOAD_FALLBACK_FLAG;
1489                         result_sa = (void *)intsa;
1490                 }
1491
1492                 ip = rte_pktmbuf_mtod(pkts[i], struct ip *);
1493                 switch (WITHOUT_TRANSPORT_VERSION(sa->flags)) {
1494                 case IP4_TUNNEL:
1495                         src4_addr = RTE_PTR_ADD(ip,
1496                                 offsetof(struct ip, ip_src));
1497                         if ((ip->ip_v == IPVERSION) &&
1498                                         (sa->src.ip.ip4 == *src4_addr) &&
1499                                         (sa->dst.ip.ip4 == *(src4_addr + 1)))
1500                                 sa_arr[i] = result_sa;
1501                         else
1502                                 sa_arr[i] = NULL;
1503                         break;
1504                 case IP6_TUNNEL:
1505                         src6_addr = RTE_PTR_ADD(ip,
1506                                 offsetof(struct ip6_hdr, ip6_src));
1507                         if ((ip->ip_v == IP6_VERSION) &&
1508                                 !memcmp(&sa->src.ip.ip6.ip6, src6_addr, 16) &&
1509                                 !memcmp(&sa->dst.ip.ip6.ip6, src6_addr + 16, 16))
1510                                 sa_arr[i] = result_sa;
1511                         else
1512                                 sa_arr[i] = NULL;
1513                         break;
1514                 case TRANSPORT:
1515                         sa_arr[i] = result_sa;
1516                 }
1517         }
1518 }
1519
1520 void
1521 outbound_sa_lookup(struct sa_ctx *sa_ctx, uint32_t sa_idx[],
1522                 void *sa[], uint16_t nb_pkts)
1523 {
1524         uint32_t i;
1525
1526         for (i = 0; i < nb_pkts; i++)
1527                 sa[i] = &sa_ctx->sa[sa_idx[i]];
1528 }
1529
1530 /*
1531  * Select HW offloads to be used.
1532  */
1533 int
1534 sa_check_offloads(uint16_t port_id, uint64_t *rx_offloads,
1535                 uint64_t *tx_offloads)
1536 {
1537         struct ipsec_sa *rule;
1538         uint32_t idx_sa;
1539         enum rte_security_session_action_type rule_type;
1540
1541         *rx_offloads = 0;
1542         *tx_offloads = 0;
1543
1544         /* Check for inbound rules that use offloads and use this port */
1545         for (idx_sa = 0; idx_sa < nb_sa_in; idx_sa++) {
1546                 rule = &sa_in[idx_sa];
1547                 rule_type = ipsec_get_action_type(rule);
1548                 if ((rule_type == RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO ||
1549                                 rule_type ==
1550                                 RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL)
1551                                 && rule->portid == port_id)
1552                         *rx_offloads |= DEV_RX_OFFLOAD_SECURITY;
1553         }
1554
1555         /* Check for outbound rules that use offloads and use this port */
1556         for (idx_sa = 0; idx_sa < nb_sa_out; idx_sa++) {
1557                 rule = &sa_out[idx_sa];
1558                 rule_type = ipsec_get_action_type(rule);
1559                 if ((rule_type == RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO ||
1560                                 rule_type ==
1561                                 RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL)
1562                                 && rule->portid == port_id)
1563                         *tx_offloads |= DEV_TX_OFFLOAD_SECURITY;
1564         }
1565         return 0;
1566 }
1567
1568 void
1569 sa_sort_arr(void)
1570 {
1571         qsort(sa_in, nb_sa_in, sizeof(struct ipsec_sa), sa_cmp);
1572         qsort(sa_out, nb_sa_out, sizeof(struct ipsec_sa), sa_cmp);
1573 }