examples/ipsec-secgw/ipsec.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2016-2017 Intel Corporation
   3  */
   4 #include <sys/types.h>
   5 #include <netinet/in.h>
   6 #include <netinet/ip.h>
   7
   8 #include <rte_branch_prediction.h>
   9 #include <rte_log.h>
  10 #include <rte_crypto.h>
  11 #include <rte_security.h>
  12 #include <rte_cryptodev.h>
  13 #include <rte_ethdev.h>
  14 #include <rte_mbuf.h>
  15 #include <rte_hash.h>
  16
  17 #include "ipsec.h"
  18 #include "esp.h"
  19
  20 static inline void
  21 set_ipsec_conf(struct ipsec_sa *sa, struct rte_security_ipsec_xform *ipsec)
  22 {
  23         if (ipsec->mode == RTE_SECURITY_IPSEC_SA_MODE_TUNNEL) {
  24                 struct rte_security_ipsec_tunnel_param *tunnel =
  25                                 &ipsec->tunnel;
  26                 if (IS_IP4_TUNNEL(sa->flags)) {
  27                         tunnel->type =
  28                                 RTE_SECURITY_IPSEC_TUNNEL_IPV4;
  29                         tunnel->ipv4.ttl = IPDEFTTL;
  30
  31                         memcpy((uint8_t *)&tunnel->ipv4.src_ip,
  32                                 (uint8_t *)&sa->src.ip.ip4, 4);
  33
  34                         memcpy((uint8_t *)&tunnel->ipv4.dst_ip,
  35                                 (uint8_t *)&sa->dst.ip.ip4, 4);
  36                 } else if (IS_IP6_TUNNEL(sa->flags)) {
  37                         tunnel->type =
  38                                 RTE_SECURITY_IPSEC_TUNNEL_IPV6;
  39                         tunnel->ipv6.hlimit = IPDEFTTL;
  40                         tunnel->ipv6.dscp = 0;
  41                         tunnel->ipv6.flabel = 0;
  42
  43                         memcpy((uint8_t *)&tunnel->ipv6.src_addr,
  44                                 (uint8_t *)&sa->src.ip.ip6.ip6_b, 16);
  45
  46                         memcpy((uint8_t *)&tunnel->ipv6.dst_addr,
  47                                 (uint8_t *)&sa->dst.ip.ip6.ip6_b, 16);
  48                 }
  49                 /* TODO support for Transport */
  50         }
  51         ipsec->esn_soft_limit = IPSEC_OFFLOAD_ESN_SOFTLIMIT;
  52 }
  53
  54 int
  55 create_lookaside_session(struct ipsec_ctx *ipsec_ctx, struct ipsec_sa *sa)
  56 {
  57         struct rte_cryptodev_info cdev_info;
  58         unsigned long cdev_id_qp = 0;
  59         int32_t ret = 0;
  60         struct cdev_key key = { 0 };
  61
  62         key.lcore_id = (uint8_t)rte_lcore_id();
  63
  64         key.cipher_algo = (uint8_t)sa->cipher_algo;
  65         key.auth_algo = (uint8_t)sa->auth_algo;
  66         key.aead_algo = (uint8_t)sa->aead_algo;
  67
  68         ret = rte_hash_lookup_data(ipsec_ctx->cdev_map, &key,
  69                         (void **)&cdev_id_qp);
  70         if (ret < 0) {
  71                 RTE_LOG(ERR, IPSEC,
  72                                 "No cryptodev: core %u, cipher_algo %u, "
  73                                 "auth_algo %u, aead_algo %u\n",
  74                                 key.lcore_id,
  75                                 key.cipher_algo,
  76                                 key.auth_algo,
  77                                 key.aead_algo);
  78                 return -1;
  79         }
  80
  81         RTE_LOG_DP(DEBUG, IPSEC, "Create session for SA spi %u on cryptodev "
  82                         "%u qp %u\n", sa->spi,
  83                         ipsec_ctx->tbl[cdev_id_qp].id,
  84                         ipsec_ctx->tbl[cdev_id_qp].qp);
  85
  86         if (sa->type != RTE_SECURITY_ACTION_TYPE_NONE) {
  87                 struct rte_security_session_conf sess_conf = {
  88                         .action_type = sa->type,
  89                         .protocol = RTE_SECURITY_PROTOCOL_IPSEC,
  90                         {.ipsec = {
  91                                 .spi = sa->spi,
  92                                 .salt = sa->salt,
  93                                 .options = { 0 },
  94                                 .direction = sa->direction,
  95                                 .proto = RTE_SECURITY_IPSEC_SA_PROTO_ESP,
  96                                 .mode = (IS_TUNNEL(sa->flags)) ?
  97                                         RTE_SECURITY_IPSEC_SA_MODE_TUNNEL :
  98                                         RTE_SECURITY_IPSEC_SA_MODE_TRANSPORT,
  99                         } },
 100                         .crypto_xform = sa->xforms,
 101                         .userdata = NULL,
 102
 103                 };
 104
 105                 if (sa->type == RTE_SECURITY_ACTION_TYPE_LOOKASIDE_PROTOCOL) {
 106                         struct rte_security_ctx *ctx = (struct rte_security_ctx *)
 107                                                         rte_cryptodev_get_sec_ctx(
 108                                                         ipsec_ctx->tbl[cdev_id_qp].id);
 109
 110                         /* Set IPsec parameters in conf */
 111                         set_ipsec_conf(sa, &(sess_conf.ipsec));
 112
 113                         sa->sec_session = rte_security_session_create(ctx,
 114                                         &sess_conf, ipsec_ctx->session_priv_pool);
 115                         if (sa->sec_session == NULL) {
 116                                 RTE_LOG(ERR, IPSEC,
 117                                 "SEC Session init failed: err: %d\n", ret);
 118                                 return -1;
 119                         }
 120                 } else {
 121                         RTE_LOG(ERR, IPSEC, "Inline not supported\n");
 122                         return -1;
 123                 }
 124         } else {
 125                 sa->crypto_session = rte_cryptodev_sym_session_create(
 126                                 ipsec_ctx->session_pool);
 127                 rte_cryptodev_sym_session_init(ipsec_ctx->tbl[cdev_id_qp].id,
 128                                 sa->crypto_session, sa->xforms,
 129                                 ipsec_ctx->session_priv_pool);
 130
 131                 rte_cryptodev_info_get(ipsec_ctx->tbl[cdev_id_qp].id,
 132                                 &cdev_info);
 133         }
 134
 135         sa->cdev_id_qp = cdev_id_qp;
 136
 137         return 0;
 138 }
 139
 140 int
 141 create_inline_session(struct socket_ctx *skt_ctx, struct ipsec_sa *sa)
 142 {
 143         int32_t ret = 0;
 144         struct rte_security_ctx *sec_ctx;
 145         struct rte_security_session_conf sess_conf = {
 146                 .action_type = sa->type,
 147                 .protocol = RTE_SECURITY_PROTOCOL_IPSEC,
 148                 {.ipsec = {
 149                         .spi = sa->spi,
 150                         .salt = sa->salt,
 151                         .options = { 0 },
 152                         .direction = sa->direction,
 153                         .proto = RTE_SECURITY_IPSEC_SA_PROTO_ESP,
 154                         .mode = (sa->flags == IP4_TUNNEL ||
 155                                         sa->flags == IP6_TUNNEL) ?
 156                                         RTE_SECURITY_IPSEC_SA_MODE_TUNNEL :
 157                                         RTE_SECURITY_IPSEC_SA_MODE_TRANSPORT,
 158                 } },
 159                 .crypto_xform = sa->xforms,
 160                 .userdata = NULL,
 161         };
 162
 163         RTE_LOG_DP(DEBUG, IPSEC, "Create session for SA spi %u on port %u\n",
 164                 sa->spi, sa->portid);
 165
 166         if (sa->type == RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO) {
 167                 struct rte_flow_error err;
 168                 const struct rte_security_capability *sec_cap;
 169                 int ret = 0;
 170
 171                 sec_ctx = (struct rte_security_ctx *)
 172                                         rte_eth_dev_get_sec_ctx(
 173                                         sa->portid);
 174                 if (sec_ctx == NULL) {
 175                         RTE_LOG(ERR, IPSEC,
 176                                 " rte_eth_dev_get_sec_ctx failed\n");
 177                         return -1;
 178                 }
 179
 180                 sa->sec_session = rte_security_session_create(sec_ctx,
 181                                 &sess_conf, skt_ctx->session_pool);
 182                 if (sa->sec_session == NULL) {
 183                         RTE_LOG(ERR, IPSEC,
 184                                 "SEC Session init failed: err: %d\n", ret);
 185                         return -1;
 186                 }
 187
 188                 sec_cap = rte_security_capabilities_get(sec_ctx);
 189
 190                 /* iterate until ESP tunnel*/
 191                 while (sec_cap->action != RTE_SECURITY_ACTION_TYPE_NONE) {
 192                         if (sec_cap->action == sa->type &&
 193                             sec_cap->protocol ==
 194                                 RTE_SECURITY_PROTOCOL_IPSEC &&
 195                             sec_cap->ipsec.mode ==
 196                                 RTE_SECURITY_IPSEC_SA_MODE_TUNNEL &&
 197                             sec_cap->ipsec.direction == sa->direction)
 198                                 break;
 199                         sec_cap++;
 200                 }
 201
 202                 if (sec_cap->action == RTE_SECURITY_ACTION_TYPE_NONE) {
 203                         RTE_LOG(ERR, IPSEC,
 204                                 "No suitable security capability found\n");
 205                         return -1;
 206                 }
 207
 208                 sa->ol_flags = sec_cap->ol_flags;
 209                 sa->security_ctx = sec_ctx;
 210                 sa->pattern[0].type = RTE_FLOW_ITEM_TYPE_ETH;
 211
 212                 if (IS_IP6(sa->flags)) {
 213                         sa->pattern[1].mask = &rte_flow_item_ipv6_mask;
 214                         sa->pattern[1].type = RTE_FLOW_ITEM_TYPE_IPV6;
 215                         sa->pattern[1].spec = &sa->ipv6_spec;
 216
 217                         memcpy(sa->ipv6_spec.hdr.dst_addr,
 218                                 sa->dst.ip.ip6.ip6_b, 16);
 219                         memcpy(sa->ipv6_spec.hdr.src_addr,
 220                                sa->src.ip.ip6.ip6_b, 16);
 221                 } else if (IS_IP4(sa->flags)) {
 222                         sa->pattern[1].mask = &rte_flow_item_ipv4_mask;
 223                         sa->pattern[1].type = RTE_FLOW_ITEM_TYPE_IPV4;
 224                         sa->pattern[1].spec = &sa->ipv4_spec;
 225
 226                         sa->ipv4_spec.hdr.dst_addr = sa->dst.ip.ip4;
 227                         sa->ipv4_spec.hdr.src_addr = sa->src.ip.ip4;
 228                 }
 229
 230                 sa->pattern[2].type = RTE_FLOW_ITEM_TYPE_ESP;
 231                 sa->pattern[2].spec = &sa->esp_spec;
 232                 sa->pattern[2].mask = &rte_flow_item_esp_mask;
 233                 sa->esp_spec.hdr.spi = rte_cpu_to_be_32(sa->spi);
 234
 235                 sa->pattern[3].type = RTE_FLOW_ITEM_TYPE_END;
 236
 237                 sa->action[0].type = RTE_FLOW_ACTION_TYPE_SECURITY;
 238                 sa->action[0].conf = sa->sec_session;
 239
 240                 sa->action[1].type = RTE_FLOW_ACTION_TYPE_END;
 241
 242                 sa->attr.egress = (sa->direction ==
 243                                 RTE_SECURITY_IPSEC_SA_DIR_EGRESS);
 244                 sa->attr.ingress = (sa->direction ==
 245                                 RTE_SECURITY_IPSEC_SA_DIR_INGRESS);
 246                 if (sa->attr.ingress) {
 247                         uint8_t rss_key[40];
 248                         struct rte_eth_rss_conf rss_conf = {
 249                                 .rss_key = rss_key,
 250                                 .rss_key_len = 40,
 251                         };
 252                         struct rte_eth_dev_info dev_info;
 253                         uint16_t queue[RTE_MAX_QUEUES_PER_PORT];
 254                         struct rte_flow_action_rss action_rss;
 255                         unsigned int i;
 256                         unsigned int j;
 257
 258                         rte_eth_dev_info_get(sa->portid, &dev_info);
 259                         sa->action[2].type = RTE_FLOW_ACTION_TYPE_END;
 260                         /* Try RSS. */
 261                         sa->action[1].type = RTE_FLOW_ACTION_TYPE_RSS;
 262                         sa->action[1].conf = &action_rss;
 263                         ret = rte_eth_dev_rss_hash_conf_get(sa->portid,
 264                                         &rss_conf);
 265                         if (ret != 0) {
 266                                 RTE_LOG(ERR, IPSEC,
 267                                         "rte_eth_dev_rss_hash_conf_get:ret=%d\n",
 268                                         ret);
 269                                 return -1;
 270                         }
 271                         for (i = 0, j = 0; i < dev_info.nb_rx_queues; ++i)
 272                                 queue[j++] = i;
 273
 274                         action_rss = (struct rte_flow_action_rss){
 275                                         .types = rss_conf.rss_hf,
 276                                         .key_len = rss_conf.rss_key_len,
 277                                         .queue_num = j,
 278                                         .key = rss_key,
 279                                         .queue = queue,
 280                         };
 281                         ret = rte_flow_validate(sa->portid, &sa->attr,
 282                                                 sa->pattern, sa->action,
 283                                                 &err);
 284                         if (!ret)
 285                                 goto flow_create;
 286                         /* Try Queue. */
 287                         sa->action[1].type = RTE_FLOW_ACTION_TYPE_QUEUE;
 288                         sa->action[1].conf =
 289                                 &(struct rte_flow_action_queue){
 290                                 .index = 0,
 291                         };
 292                         ret = rte_flow_validate(sa->portid, &sa->attr,
 293                                                 sa->pattern, sa->action,
 294                                                 &err);
 295                         /* Try End. */
 296                         sa->action[1].type = RTE_FLOW_ACTION_TYPE_END;
 297                         sa->action[1].conf = NULL;
 298                         ret = rte_flow_validate(sa->portid, &sa->attr,
 299                                                 sa->pattern, sa->action,
 300                                                 &err);
 301                         if (ret)
 302                                 goto flow_create_failure;
 303                 } else if (sa->attr.egress &&
 304                            (sa->ol_flags &
 305                                     RTE_SECURITY_TX_HW_TRAILER_OFFLOAD)) {
 306                         sa->action[1].type =
 307                                         RTE_FLOW_ACTION_TYPE_PASSTHRU;
 308                         sa->action[2].type =
 309                                         RTE_FLOW_ACTION_TYPE_END;
 310                 }
 311 flow_create:
 312                 sa->flow = rte_flow_create(sa->portid,
 313                                 &sa->attr, sa->pattern, sa->action, &err);
 314                 if (sa->flow == NULL) {
 315 flow_create_failure:
 316                         RTE_LOG(ERR, IPSEC,
 317                                 "Failed to create ipsec flow msg: %s\n",
 318                                 err.message);
 319                         return -1;
 320                 }
 321         } else if (sa->type ==  RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL) {
 322                 const struct rte_security_capability *sec_cap;
 323
 324                 sec_ctx = (struct rte_security_ctx *)
 325                                 rte_eth_dev_get_sec_ctx(sa->portid);
 326
 327                 if (sec_ctx == NULL) {
 328                         RTE_LOG(ERR, IPSEC,
 329                                 "Ethernet device doesn't have security features registered\n");
 330                         return -1;
 331                 }
 332
 333                 /* Set IPsec parameters in conf */
 334                 set_ipsec_conf(sa, &(sess_conf.ipsec));
 335
 336                 /* Save SA as userdata for the security session. When
 337                  * the packet is received, this userdata will be
 338                  * retrieved using the metadata from the packet.
 339                  *
 340                  * The PMD is expected to set similar metadata for other
 341                  * operations, like rte_eth_event, which are tied to
 342                  * security session. In such cases, the userdata could
 343                  * be obtained to uniquely identify the security
 344                  * parameters denoted.
 345                  */
 346
 347                 sess_conf.userdata = (void *) sa;
 348
 349                 sa->sec_session = rte_security_session_create(sec_ctx,
 350                                         &sess_conf, skt_ctx->session_pool);
 351                 if (sa->sec_session == NULL) {
 352                         RTE_LOG(ERR, IPSEC,
 353                                 "SEC Session init failed: err: %d\n", ret);
 354                         return -1;
 355                 }
 356
 357                 sec_cap = rte_security_capabilities_get(sec_ctx);
 358                 if (sec_cap == NULL) {
 359                         RTE_LOG(ERR, IPSEC,
 360                                 "No capabilities registered\n");
 361                         return -1;
 362                 }
 363
 364                 /* iterate until ESP tunnel*/
 365                 while (sec_cap->action !=
 366                                 RTE_SECURITY_ACTION_TYPE_NONE) {
 367                         if (sec_cap->action == sa->type &&
 368                             sec_cap->protocol ==
 369                                 RTE_SECURITY_PROTOCOL_IPSEC &&
 370                             sec_cap->ipsec.mode ==
 371                                 sess_conf.ipsec.mode &&
 372                             sec_cap->ipsec.direction == sa->direction)
 373                                 break;
 374                         sec_cap++;
 375                 }
 376
 377                 if (sec_cap->action == RTE_SECURITY_ACTION_TYPE_NONE) {
 378                         RTE_LOG(ERR, IPSEC,
 379                                 "No suitable security capability found\n");
 380                         return -1;
 381                 }
 382
 383                 sa->ol_flags = sec_cap->ol_flags;
 384                 sa->security_ctx = sec_ctx;
 385         }
 386         sa->cdev_id_qp = 0;
 387
 388         return 0;
 389 }
 390
 391 /*
 392  * queue crypto-ops into PMD queue.
 393  */
 394 void
 395 enqueue_cop_burst(struct cdev_qp *cqp)
 396 {
 397         uint32_t i, len, ret;
 398
 399         len = cqp->len;
 400         ret = rte_cryptodev_enqueue_burst(cqp->id, cqp->qp, cqp->buf, len);
 401         if (ret < len) {
 402                 RTE_LOG_DP(DEBUG, IPSEC, "Cryptodev %u queue %u:"
 403                         " enqueued %u crypto ops out of %u\n",
 404                         cqp->id, cqp->qp, ret, len);
 405                         /* drop packets that we fail to enqueue */
 406                         for (i = ret; i < len; i++)
 407                                 rte_pktmbuf_free(cqp->buf[i]->sym->m_src);
 408         }
 409         cqp->in_flight += ret;
 410         cqp->len = 0;
 411 }
 412
 413 static inline void
 414 enqueue_cop(struct cdev_qp *cqp, struct rte_crypto_op *cop)
 415 {
 416         cqp->buf[cqp->len++] = cop;
 417
 418         if (cqp->len == MAX_PKT_BURST)
 419                 enqueue_cop_burst(cqp);
 420 }
 421
 422 static inline void
 423 ipsec_enqueue(ipsec_xform_fn xform_func, struct ipsec_ctx *ipsec_ctx,
 424                 struct rte_mbuf *pkts[], struct ipsec_sa *sas[],
 425                 uint16_t nb_pkts)
 426 {
 427         int32_t ret = 0, i;
 428         struct ipsec_mbuf_metadata *priv;
 429         struct rte_crypto_sym_op *sym_cop;
 430         struct ipsec_sa *sa;
 431
 432         for (i = 0; i < nb_pkts; i++) {
 433                 if (unlikely(sas[i] == NULL)) {
 434                         rte_pktmbuf_free(pkts[i]);
 435                         continue;
 436                 }
 437
 438                 rte_prefetch0(sas[i]);
 439                 rte_prefetch0(pkts[i]);
 440
 441                 priv = get_priv(pkts[i]);
 442                 sa = sas[i];
 443                 priv->sa = sa;
 444
 445                 switch (sa->type) {
 446                 case RTE_SECURITY_ACTION_TYPE_LOOKASIDE_PROTOCOL:
 447                         priv->cop.type = RTE_CRYPTO_OP_TYPE_SYMMETRIC;
 448                         priv->cop.status = RTE_CRYPTO_OP_STATUS_NOT_PROCESSED;
 449
 450                         rte_prefetch0(&priv->sym_cop);
 451
 452                         if ((unlikely(sa->sec_session == NULL)) &&
 453                                 create_lookaside_session(ipsec_ctx, sa)) {
 454                                 rte_pktmbuf_free(pkts[i]);
 455                                 continue;
 456                         }
 457
 458                         sym_cop = get_sym_cop(&priv->cop);
 459                         sym_cop->m_src = pkts[i];
 460
 461                         rte_security_attach_session(&priv->cop,
 462                                         sa->sec_session);
 463                         break;
 464                 case RTE_SECURITY_ACTION_TYPE_NONE:
 465
 466                         priv->cop.type = RTE_CRYPTO_OP_TYPE_SYMMETRIC;
 467                         priv->cop.status = RTE_CRYPTO_OP_STATUS_NOT_PROCESSED;
 468
 469                         rte_prefetch0(&priv->sym_cop);
 470
 471                         if ((unlikely(sa->crypto_session == NULL)) &&
 472                                 create_lookaside_session(ipsec_ctx, sa)) {
 473                                 rte_pktmbuf_free(pkts[i]);
 474                                 continue;
 475                         }
 476
 477                         rte_crypto_op_attach_sym_session(&priv->cop,
 478                                         sa->crypto_session);
 479
 480                         ret = xform_func(pkts[i], sa, &priv->cop);
 481                         if (unlikely(ret)) {
 482                                 rte_pktmbuf_free(pkts[i]);
 483                                 continue;
 484                         }
 485                         break;
 486                 case RTE_SECURITY_ACTION_TYPE_INLINE_PROTOCOL:
 487                         RTE_ASSERT(sa->sec_session != NULL);
 488                         ipsec_ctx->ol_pkts[ipsec_ctx->ol_pkts_cnt++] = pkts[i];
 489                         if (sa->ol_flags & RTE_SECURITY_TX_OLOAD_NEED_MDATA)
 490                                 rte_security_set_pkt_metadata(
 491                                                 sa->security_ctx,
 492                                                 sa->sec_session, pkts[i], NULL);
 493                         continue;
 494                 case RTE_SECURITY_ACTION_TYPE_INLINE_CRYPTO:
 495                         RTE_ASSERT(sa->sec_session != NULL);
 496                         priv->cop.type = RTE_CRYPTO_OP_TYPE_SYMMETRIC;
 497                         priv->cop.status = RTE_CRYPTO_OP_STATUS_NOT_PROCESSED;
 498
 499                         rte_prefetch0(&priv->sym_cop);
 500                         rte_security_attach_session(&priv->cop,
 501                                         sa->sec_session);
 502
 503                         ret = xform_func(pkts[i], sa, &priv->cop);
 504                         if (unlikely(ret)) {
 505                                 rte_pktmbuf_free(pkts[i]);
 506                                 continue;
 507                         }
 508
 509                         ipsec_ctx->ol_pkts[ipsec_ctx->ol_pkts_cnt++] = pkts[i];
 510                         if (sa->ol_flags & RTE_SECURITY_TX_OLOAD_NEED_MDATA)
 511                                 rte_security_set_pkt_metadata(
 512                                                 sa->security_ctx,
 513                                                 sa->sec_session, pkts[i], NULL);
 514                         continue;
 515                 }
 516
 517                 RTE_ASSERT(sa->cdev_id_qp < ipsec_ctx->nb_qps);
 518                 enqueue_cop(&ipsec_ctx->tbl[sa->cdev_id_qp], &priv->cop);
 519         }
 520 }
 521
 522 static inline int32_t
 523 ipsec_inline_dequeue(ipsec_xform_fn xform_func, struct ipsec_ctx *ipsec_ctx,
 524               struct rte_mbuf *pkts[], uint16_t max_pkts)
 525 {
 526         int32_t nb_pkts, ret;
 527         struct ipsec_mbuf_metadata *priv;
 528         struct ipsec_sa *sa;
 529         struct rte_mbuf *pkt;
 530
 531         nb_pkts = 0;
 532         while (ipsec_ctx->ol_pkts_cnt > 0 && nb_pkts < max_pkts) {
 533                 pkt = ipsec_ctx->ol_pkts[--ipsec_ctx->ol_pkts_cnt];
 534                 rte_prefetch0(pkt);
 535                 priv = get_priv(pkt);
 536                 sa = priv->sa;
 537                 ret = xform_func(pkt, sa, &priv->cop);
 538                 if (unlikely(ret)) {
 539                         rte_pktmbuf_free(pkt);
 540                         continue;
 541                 }
 542                 pkts[nb_pkts++] = pkt;
 543         }
 544
 545         return nb_pkts;
 546 }
 547
 548 static inline int
 549 ipsec_dequeue(ipsec_xform_fn xform_func, struct ipsec_ctx *ipsec_ctx,
 550               struct rte_mbuf *pkts[], uint16_t max_pkts)
 551 {
 552         int32_t nb_pkts = 0, ret = 0, i, j, nb_cops;
 553         struct ipsec_mbuf_metadata *priv;
 554         struct rte_crypto_op *cops[max_pkts];
 555         struct ipsec_sa *sa;
 556         struct rte_mbuf *pkt;
 557
 558         for (i = 0; i < ipsec_ctx->nb_qps && nb_pkts < max_pkts; i++) {
 559                 struct cdev_qp *cqp;
 560
 561                 cqp = &ipsec_ctx->tbl[ipsec_ctx->last_qp++];
 562                 if (ipsec_ctx->last_qp == ipsec_ctx->nb_qps)
 563                         ipsec_ctx->last_qp %= ipsec_ctx->nb_qps;
 564
 565                 if (cqp->in_flight == 0)
 566                         continue;
 567
 568                 nb_cops = rte_cryptodev_dequeue_burst(cqp->id, cqp->qp,
 569                                 cops, max_pkts - nb_pkts);
 570
 571                 cqp->in_flight -= nb_cops;
 572
 573                 for (j = 0; j < nb_cops; j++) {
 574                         pkt = cops[j]->sym->m_src;
 575                         rte_prefetch0(pkt);
 576
 577                         priv = get_priv(pkt);
 578                         sa = priv->sa;
 579
 580                         RTE_ASSERT(sa != NULL);
 581
 582                         if (sa->type == RTE_SECURITY_ACTION_TYPE_NONE) {
 583                                 ret = xform_func(pkt, sa, cops[j]);
 584                                 if (unlikely(ret)) {
 585                                         rte_pktmbuf_free(pkt);
 586                                         continue;
 587                                 }
 588                         } else if (sa->type ==
 589                                 RTE_SECURITY_ACTION_TYPE_LOOKASIDE_PROTOCOL) {
 590                                 if (cops[j]->status) {
 591                                         rte_pktmbuf_free(pkt);
 592                                         continue;
 593                                 }
 594                         }
 595                         pkts[nb_pkts++] = pkt;
 596                 }
 597         }
 598
 599         /* return packets */
 600         return nb_pkts;
 601 }
 602
 603 uint16_t
 604 ipsec_inbound(struct ipsec_ctx *ctx, struct rte_mbuf *pkts[],
 605                 uint16_t nb_pkts, uint16_t len)
 606 {
 607         struct ipsec_sa *sas[nb_pkts];
 608
 609         inbound_sa_lookup(ctx->sa_ctx, pkts, sas, nb_pkts);
 610
 611         ipsec_enqueue(esp_inbound, ctx, pkts, sas, nb_pkts);
 612
 613         return ipsec_inline_dequeue(esp_inbound_post, ctx, pkts, len);
 614 }
 615
 616 uint16_t
 617 ipsec_inbound_cqp_dequeue(struct ipsec_ctx *ctx, struct rte_mbuf *pkts[],
 618                 uint16_t len)
 619 {
 620         return ipsec_dequeue(esp_inbound_post, ctx, pkts, len);
 621 }
 622
 623 uint16_t
 624 ipsec_outbound(struct ipsec_ctx *ctx, struct rte_mbuf *pkts[],
 625                 uint32_t sa_idx[], uint16_t nb_pkts, uint16_t len)
 626 {
 627         struct ipsec_sa *sas[nb_pkts];
 628
 629         outbound_sa_lookup(ctx->sa_ctx, sa_idx, sas, nb_pkts);
 630
 631         ipsec_enqueue(esp_outbound, ctx, pkts, sas, nb_pkts);
 632
 633         return ipsec_inline_dequeue(esp_outbound_post, ctx, pkts, len);
 634 }
 635
 636 uint16_t
 637 ipsec_outbound_cqp_dequeue(struct ipsec_ctx *ctx, struct rte_mbuf *pkts[],
 638                 uint16_t len)
 639 {
 640         return ipsec_dequeue(esp_outbound_post, ctx, pkts, len);
 641 }