src/plugins/dpdk/cryptodev/cryptodev_op_data_path.c

   1
   2 /*
   3  *------------------------------------------------------------------
   4  * Copyright (c) 2019 - 2021 Intel and/or its affiliates.
   5  * Licensed under the Apache License, Version 2.0 (the "License");
   6  * you may not use this file except in compliance with the License.
   7  * You may obtain a copy of the License at:
   8  *
   9  *     http://www.apache.org/licenses/LICENSE-2.0
  10  *
  11  * Unless required by applicable law or agreed to in writing, software
  12  * distributed under the License is distributed on an "AS IS" BASIS,
  13  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  14  * See the License for the specific language governing permissions and
  15  * limitations under the License.
  16  *------------------------------------------------------------------
  17  */
  18
  19 #include <vlib/vlib.h>
  20 #include <vnet/crypto/crypto.h>
  21
  22 #include <dpdk/buffer.h>
  23 #include <dpdk/device/dpdk.h>
  24 #include <dpdk/device/dpdk_priv.h>
  25 #undef always_inline
  26 #include <rte_bus_vdev.h>
  27 #include <rte_cryptodev.h>
  28 #include <rte_crypto_sym.h>
  29 #include <rte_crypto.h>
  30 #include <rte_ring_peek_zc.h>
  31 #include <rte_config.h>
  32
  33 #include "cryptodev.h"
  34
  35 #if CLIB_DEBUG > 0
  36 #define always_inline static inline
  37 #else
  38 #define always_inline static inline __attribute__ ((__always_inline__))
  39 #endif
  40
  41 #define CRYPTODEV_AAD_OFFSET (offsetof (cryptodev_op_t, aad))
  42
  43 #define foreach_vnet_crypto_status_conversion                                 \
  44   _ (SUCCESS, COMPLETED)                                                      \
  45   _ (NOT_PROCESSED, WORK_IN_PROGRESS)                                         \
  46   _ (AUTH_FAILED, FAIL_BAD_HMAC)                                              \
  47   _ (INVALID_SESSION, FAIL_ENGINE_ERR)                                        \
  48   _ (INVALID_ARGS, FAIL_ENGINE_ERR)                                           \
  49   _ (ERROR, FAIL_ENGINE_ERR)
  50
  51 static const vnet_crypto_op_status_t cryptodev_status_conversion[] = {
  52 #define _(a, b) VNET_CRYPTO_OP_STATUS_##b,
  53   foreach_vnet_crypto_status_conversion
  54 #undef _
  55 };
  56
  57 static_always_inline rte_iova_t
  58 cryptodev_get_iova (clib_pmalloc_main_t *pm, enum rte_iova_mode mode,
  59                     void *data)
  60 {
  61   u64 index;
  62   if (mode == RTE_IOVA_VA)
  63     return (rte_iova_t) pointer_to_uword (data);
  64
  65   index = clib_pmalloc_get_page_index (pm, data);
  66   return pointer_to_uword (data) - pm->lookup_table[index];
  67 }
  68
  69 static_always_inline void
  70 cryptodev_validate_mbuf (struct rte_mbuf *mb, vlib_buffer_t *b)
  71 {
  72   /* on vnet side vlib_buffer current_length is updated by cipher padding and
  73    * icv_sh. mbuf needs to be sync with these changes */
  74   u16 data_len = b->current_length +
  75                  (b->data + b->current_data - rte_pktmbuf_mtod (mb, u8 *));
  76
  77   /* for input nodes that are not dpdk-input, it is possible the mbuf
  78    * was updated before as one of the chained mbufs. Setting nb_segs
  79    * to 1 here to prevent the cryptodev PMD to access potentially
  80    * invalid m_src->next pointers.
  81    */
  82   mb->nb_segs = 1;
  83   mb->pkt_len = mb->data_len = data_len;
  84 }
  85
  86 static_always_inline void
  87 cryptodev_validate_mbuf_chain (vlib_main_t *vm, struct rte_mbuf *mb,
  88                                vlib_buffer_t *b)
  89 {
  90   struct rte_mbuf *first_mb = mb, *last_mb = mb; /**< last mbuf */
  91   /* when input node is not dpdk, mbuf data len is not initialized, for
  92    * single buffer it is not a problem since the data length is written
  93    * into cryptodev operation. For chained buffer a reference data length
  94    * has to be computed through vlib_buffer.
  95    *
  96    * even when input node is dpdk, it is possible chained vlib_buffers
  97    * are updated (either added or removed a buffer) but not not mbuf fields.
  98    * we have to re-link every mbuf in the chain.
  99    */
 100   u16 data_len = b->current_length +
 101                  (b->data + b->current_data - rte_pktmbuf_mtod (mb, u8 *));
 102
 103   first_mb->nb_segs = 1;
 104   first_mb->pkt_len = first_mb->data_len = data_len;
 105
 106   while (b->flags & VLIB_BUFFER_NEXT_PRESENT)
 107     {
 108       b = vlib_get_buffer (vm, b->next_buffer);
 109       mb = rte_mbuf_from_vlib_buffer (b);
 110       if (PREDICT_FALSE ((b->flags & VLIB_BUFFER_EXT_HDR_VALID) == 0))
 111         rte_pktmbuf_reset (mb);
 112       last_mb->next = mb;
 113       last_mb = mb;
 114       mb->data_len = b->current_length;
 115       mb->pkt_len = b->current_length;
 116       mb->data_off = VLIB_BUFFER_PRE_DATA_SIZE + b->current_data;
 117       first_mb->nb_segs++;
 118       if (PREDICT_FALSE (b->ref_count > 1))
 119         mb->pool =
 120           dpdk_no_cache_mempool_by_buffer_pool_index[b->buffer_pool_index];
 121     }
 122 }
 123
 124 static_always_inline void
 125 crypto_op_init (struct rte_mempool *mempool,
 126                 void *_arg __attribute__ ((unused)), void *_obj,
 127                 unsigned i __attribute__ ((unused)))
 128 {
 129   struct rte_crypto_op *op = _obj;
 130
 131   op->sess_type = RTE_CRYPTO_OP_WITH_SESSION;
 132   op->type = RTE_CRYPTO_OP_TYPE_SYMMETRIC;
 133   op->status = RTE_CRYPTO_OP_STATUS_NOT_PROCESSED;
 134   op->phys_addr = rte_mempool_virt2iova (_obj);
 135   op->mempool = mempool;
 136 }
 137
 138 static_always_inline int
 139 cryptodev_frame_linked_algs_enqueue (vlib_main_t *vm,
 140                                      vnet_crypto_async_frame_t *frame,
 141                                      cryptodev_op_type_t op_type)
 142 {
 143   cryptodev_main_t *cmt = &cryptodev_main;
 144   cryptodev_engine_thread_t *cet = cmt->per_thread_data + vm->thread_index;
 145   cryptodev_cache_ring_t *ring = &cet->cache_ring;
 146   ERROR_ASSERT (frame != 0);
 147   ERROR_ASSERT (frame->n_elts > 0);
 148   cryptodev_cache_ring_elt_t *ring_elt =
 149     cryptodev_cache_ring_push (ring, frame);
 150
 151   if (PREDICT_FALSE (ring_elt == NULL))
 152     return -1;
 153
 154   ring_elt->aad_len = 1;
 155   ring_elt->op_type = (u8) op_type;
 156   return 0;
 157 }
 158
 159 static_always_inline void
 160 cryptodev_frame_linked_algs_enqueue_internal (vlib_main_t *vm,
 161                                               vnet_crypto_async_frame_t *frame,
 162                                               cryptodev_op_type_t op_type)
 163 {
 164   cryptodev_main_t *cmt = &cryptodev_main;
 165   clib_pmalloc_main_t *pm = vm->physmem_main.pmalloc_main;
 166   cryptodev_engine_thread_t *cet = cmt->per_thread_data + vm->thread_index;
 167   cryptodev_cache_ring_t *ring = &cet->cache_ring;
 168   u16 *const enq = &ring->enq_head;
 169   vnet_crypto_async_frame_elt_t *fe;
 170   cryptodev_session_t *sess = 0;
 171   cryptodev_op_t *cops[CRYPTODE_ENQ_MAX] = {};
 172   cryptodev_op_t **cop = cops;
 173   u32 *bi = 0;
 174   u32 n_enqueue, n_elts;
 175   u32 last_key_index = ~0;
 176   u32 max_to_enq;
 177
 178   if (PREDICT_FALSE (frame == 0 || frame->n_elts == 0))
 179     return;
 180
 181   max_to_enq = clib_min (CRYPTODE_ENQ_MAX,
 182                          frame->n_elts - ring->frames[*enq].enq_elts_head);
 183
 184   if (cet->inflight + max_to_enq > CRYPTODEV_MAX_INFLIGHT)
 185     return;
 186
 187   n_elts = max_to_enq;
 188
 189   if (PREDICT_FALSE (
 190         rte_mempool_get_bulk (cet->cop_pool, (void **) cops, n_elts) < 0))
 191     {
 192       cryptodev_mark_frame_fill_err (
 193         frame, ring->frames[*enq].frame_elts_errs_mask,
 194         ring->frames[*enq].enq_elts_head, max_to_enq,
 195         VNET_CRYPTO_OP_STATUS_FAIL_ENGINE_ERR);
 196       ring->frames[*enq].enq_elts_head += max_to_enq;
 197       ring->frames[*enq].deq_elts_tail += max_to_enq;
 198       cryptodev_cache_ring_update_enq_head (ring, frame);
 199       return;
 200     }
 201
 202   fe = frame->elts + ring->frames[*enq].enq_elts_head;
 203   bi = frame->buffer_indices + ring->frames[*enq].enq_elts_head;
 204
 205   while (n_elts)
 206     {
 207       vlib_buffer_t *b = vlib_get_buffer (vm, bi[0]);
 208       struct rte_crypto_sym_op *sop = &cop[0]->sop;
 209       i16 crypto_offset = fe->crypto_start_offset;
 210       i16 integ_offset = fe->integ_start_offset;
 211       u32 offset_diff = crypto_offset - integ_offset;
 212
 213       if (n_elts > 2)
 214         {
 215           CLIB_PREFETCH (cop[1], sizeof (*cop[1]), STORE);
 216           CLIB_PREFETCH (cop[2], sizeof (*cop[2]), STORE);
 217           clib_prefetch_load (&fe[1]);
 218           clib_prefetch_load (&fe[2]);
 219         }
 220       if (last_key_index != fe->key_index)
 221         {
 222           cryptodev_key_t *key = vec_elt_at_index (cmt->keys, fe->key_index);
 223           last_key_index = fe->key_index;
 224
 225           if (key->keys[vm->numa_node][op_type] == 0)
 226             {
 227               if (PREDICT_FALSE (
 228                     cryptodev_session_create (vm, last_key_index, 0) < 0))
 229                 {
 230                   cryptodev_mark_frame_fill_err (
 231                     frame, ring->frames[*enq].frame_elts_errs_mask,
 232                     ring->frames[*enq].enq_elts_head, max_to_enq,
 233                     VNET_CRYPTO_OP_STATUS_FAIL_ENGINE_ERR);
 234                   goto error_exit;
 235                 }
 236             }
 237           sess = key->keys[vm->numa_node][op_type];
 238         }
 239
 240       sop->m_src = rte_mbuf_from_vlib_buffer (b);
 241       sop->m_src->data_off = VLIB_BUFFER_PRE_DATA_SIZE;
 242       sop->m_dst = 0;
 243       /* mbuf prepend happens in the tx, but vlib_buffer happens in the nodes,
 244        * so we have to manually adjust mbuf data_off here so cryptodev can
 245        * correctly compute the data pointer. The prepend here will be later
 246        * rewritten by tx. */
 247       if (PREDICT_TRUE (fe->integ_start_offset < 0))
 248         {
 249           sop->m_src->data_off += fe->integ_start_offset;
 250           integ_offset = 0;
 251           crypto_offset = offset_diff;
 252         }
 253       sop->session = sess;
 254       sop->cipher.data.offset = crypto_offset;
 255       sop->cipher.data.length = fe->crypto_total_length;
 256       sop->auth.data.offset = integ_offset;
 257       sop->auth.data.length = fe->crypto_total_length + fe->integ_length_adj;
 258       sop->auth.digest.data = fe->digest;
 259       sop->auth.digest.phys_addr =
 260         cryptodev_get_iova (pm, cmt->iova_mode, fe->digest);
 261       if (PREDICT_FALSE (fe->flags & VNET_CRYPTO_OP_FLAG_CHAINED_BUFFERS))
 262         cryptodev_validate_mbuf_chain (vm, sop->m_src, b);
 263       else
 264         cryptodev_validate_mbuf (sop->m_src, b);
 265
 266       clib_memcpy_fast (cop[0]->iv, fe->iv, 16);
 267       ring->frames[*enq].enq_elts_head++;
 268       cop++;
 269       bi++;
 270       fe++;
 271       n_elts--;
 272     }
 273
 274   n_enqueue =
 275     rte_cryptodev_enqueue_burst (cet->cryptodev_id, cet->cryptodev_q,
 276                                  (struct rte_crypto_op **) cops, max_to_enq);
 277   ERROR_ASSERT (n_enqueue == max_to_enq);
 278   cet->inflight += max_to_enq;
 279   cryptodev_cache_ring_update_enq_head (ring, frame);
 280   return;
 281
 282 error_exit:
 283   ring->frames[*enq].enq_elts_head += max_to_enq;
 284   ring->frames[*enq].deq_elts_tail += max_to_enq;
 285   cryptodev_cache_ring_update_enq_head (ring, frame);
 286   rte_mempool_put_bulk (cet->cop_pool, (void **) cops, max_to_enq);
 287 }
 288
 289 static_always_inline int
 290 cryptodev_frame_aead_enqueue (vlib_main_t *vm,
 291                               vnet_crypto_async_frame_t *frame,
 292                               cryptodev_op_type_t op_type, u8 aad_len)
 293 {
 294   cryptodev_main_t *cmt = &cryptodev_main;
 295   cryptodev_engine_thread_t *cet = cmt->per_thread_data + vm->thread_index;
 296   cryptodev_cache_ring_t *ring = &cet->cache_ring;
 297   ERROR_ASSERT (frame != 0);
 298   ERROR_ASSERT (frame->n_elts > 0);
 299   cryptodev_cache_ring_elt_t *ring_elt =
 300     cryptodev_cache_ring_push (ring, frame);
 301
 302   if (PREDICT_FALSE (ring_elt == NULL))
 303     return -1;
 304
 305   ring_elt->aad_len = aad_len;
 306   ring_elt->op_type = (u8) op_type;
 307   return 0;
 308 }
 309
 310 static_always_inline int
 311 cryptodev_aead_enqueue_internal (vlib_main_t *vm,
 312                                  vnet_crypto_async_frame_t *frame,
 313                                  cryptodev_op_type_t op_type, u8 aad_len)
 314 {
 315   cryptodev_main_t *cmt = &cryptodev_main;
 316   cryptodev_engine_thread_t *cet = cmt->per_thread_data + vm->thread_index;
 317   cryptodev_cache_ring_t *ring = &cet->cache_ring;
 318   u16 *const enq = &ring->enq_head;
 319   clib_pmalloc_main_t *pm = vm->physmem_main.pmalloc_main;
 320   vnet_crypto_async_frame_elt_t *fe;
 321   cryptodev_session_t *sess = 0;
 322   cryptodev_op_t *cops[CRYPTODE_ENQ_MAX] = {};
 323   cryptodev_op_t **cop = cops;
 324   u32 *bi = 0;
 325   u32 n_enqueue = 0, n_elts;
 326   u32 last_key_index = ~0;
 327   u16 left_to_enq = frame->n_elts - ring->frames[*enq].enq_elts_head;
 328   const u16 max_to_enq = clib_min (CRYPTODE_ENQ_MAX, left_to_enq);
 329
 330   if (PREDICT_FALSE (frame == 0 || frame->n_elts == 0))
 331     return -1;
 332
 333   if (cet->inflight + max_to_enq > CRYPTODEV_MAX_INFLIGHT)
 334     return -1;
 335
 336   n_elts = max_to_enq;
 337
 338   if (PREDICT_FALSE (
 339         rte_mempool_get_bulk (cet->cop_pool, (void **) cops, n_elts) < 0))
 340     {
 341       cryptodev_mark_frame_fill_err (
 342         frame, ring->frames[*enq].frame_elts_errs_mask,
 343         ring->frames[*enq].enq_elts_head, max_to_enq,
 344         VNET_CRYPTO_OP_STATUS_FAIL_ENGINE_ERR);
 345       ring->frames[*enq].enq_elts_head += max_to_enq;
 346       ring->frames[*enq].deq_elts_tail += max_to_enq;
 347       cryptodev_cache_ring_update_enq_head (ring, frame);
 348       return -1;
 349     }
 350
 351   fe = frame->elts + ring->frames[*enq].enq_elts_head;
 352   bi = frame->buffer_indices + ring->frames[*enq].enq_elts_head;
 353
 354   while (n_elts)
 355     {
 356       vlib_buffer_t *b = vlib_get_buffer (vm, bi[0]);
 357       struct rte_crypto_sym_op *sop = &cop[0]->sop;
 358       u16 crypto_offset = fe->crypto_start_offset;
 359
 360       if (n_elts > 2)
 361         {
 362           CLIB_PREFETCH (cop[1], sizeof (*cop[1]), STORE);
 363           CLIB_PREFETCH (cop[2], sizeof (*cop[2]), STORE);
 364           clib_prefetch_load (&fe[1]);
 365           clib_prefetch_load (&fe[2]);
 366         }
 367       if (last_key_index != fe->key_index)
 368         {
 369           cryptodev_key_t *key = vec_elt_at_index (cmt->keys, fe->key_index);
 370
 371           last_key_index = fe->key_index;
 372           if (key->keys[vm->numa_node][op_type] == 0)
 373             {
 374               if (PREDICT_FALSE (cryptodev_session_create (vm, last_key_index,
 375                                                            aad_len) < 0))
 376                 {
 377                   cryptodev_mark_frame_fill_err (
 378                     frame, ring->frames[*enq].frame_elts_errs_mask,
 379                     ring->frames[*enq].enq_elts_head, max_to_enq,
 380                     VNET_CRYPTO_OP_STATUS_FAIL_ENGINE_ERR);
 381                   goto error_exit;
 382                 }
 383             }
 384           else if (PREDICT_FALSE (
 385 #if RTE_VERSION >= RTE_VERSION_NUM(22, 11, 0, 0)
 386                      rte_cryptodev_sym_session_opaque_data_get (
 387                        key->keys[vm->numa_node][op_type]) != (u64) aad_len
 388 #else
 389                      key->keys[vm->numa_node][op_type]->opaque_data != aad_len
 390 #endif
 391                      ))
 392             {
 393               cryptodev_sess_handler (vm, VNET_CRYPTO_KEY_OP_DEL,
 394                                       fe->key_index, aad_len);
 395               if (PREDICT_FALSE (cryptodev_session_create (vm, last_key_index,
 396                                                            aad_len) < 0))
 397                 {
 398                   cryptodev_mark_frame_fill_err (
 399                     frame, ring->frames[*enq].frame_elts_errs_mask,
 400                     ring->frames[*enq].enq_elts_head, max_to_enq,
 401                     VNET_CRYPTO_OP_STATUS_FAIL_ENGINE_ERR);
 402                   goto error_exit;
 403                 }
 404             }
 405
 406           sess = key->keys[vm->numa_node][op_type];
 407         }
 408
 409       sop->m_src = rte_mbuf_from_vlib_buffer (b);
 410       sop->m_src->data_off = VLIB_BUFFER_PRE_DATA_SIZE;
 411       sop->m_dst = 0;
 412       /* mbuf prepend happens in the tx, but vlib_buffer happens in the nodes,
 413        * so we have to manually adjust mbuf data_off here so cryptodev can
 414        * correctly compute the data pointer. The prepend here will be later
 415        * rewritten by tx. */
 416       if (PREDICT_FALSE (fe->crypto_start_offset < 0))
 417         {
 418           rte_pktmbuf_prepend (sop->m_src, -fe->crypto_start_offset);
 419           crypto_offset = 0;
 420         }
 421
 422       sop->session = sess;
 423       sop->aead.aad.data = cop[0]->aad;
 424       sop->aead.aad.phys_addr = cop[0]->op.phys_addr + CRYPTODEV_AAD_OFFSET;
 425       sop->aead.data.length = fe->crypto_total_length;
 426       sop->aead.data.offset = crypto_offset;
 427       sop->aead.digest.data = fe->tag;
 428       sop->aead.digest.phys_addr =
 429         cryptodev_get_iova (pm, cmt->iova_mode, fe->tag);
 430       if (PREDICT_FALSE (fe->flags & VNET_CRYPTO_OP_FLAG_CHAINED_BUFFERS))
 431         cryptodev_validate_mbuf_chain (vm, sop->m_src, b);
 432       else
 433         cryptodev_validate_mbuf (sop->m_src, b);
 434
 435       clib_memcpy_fast (cop[0]->iv, fe->iv, 12);
 436       clib_memcpy_fast (cop[0]->aad, fe->aad, aad_len);
 437
 438       cop++;
 439       bi++;
 440       fe++;
 441       n_elts--;
 442     }
 443
 444   n_enqueue =
 445     rte_cryptodev_enqueue_burst (cet->cryptodev_id, cet->cryptodev_q,
 446                                  (struct rte_crypto_op **) cops, max_to_enq);
 447   ERROR_ASSERT (n_enqueue == max_to_enq);
 448   cet->inflight += max_to_enq;
 449   ring->frames[*enq].enq_elts_head += max_to_enq;
 450   cryptodev_cache_ring_update_enq_head (ring, frame);
 451
 452   return 0;
 453
 454 error_exit:
 455   ring->frames[*enq].enq_elts_head += max_to_enq;
 456   ring->frames[*enq].deq_elts_tail += max_to_enq;
 457   cryptodev_cache_ring_update_enq_head (ring, frame);
 458   rte_mempool_put_bulk (cet->cop_pool, (void **) cops, max_to_enq);
 459
 460   return -1;
 461 }
 462
 463 static_always_inline u8
 464 cryptodev_frame_dequeue_internal (vlib_main_t *vm, u32 *nb_elts_processed,
 465                                   u32 *enqueue_thread_idx)
 466 {
 467   cryptodev_main_t *cmt = &cryptodev_main;
 468   cryptodev_engine_thread_t *cet = cmt->per_thread_data + vm->thread_index;
 469   vnet_crypto_async_frame_t *frame = NULL;
 470   cryptodev_cache_ring_t *ring = &cet->cache_ring;
 471   u16 *const deq = &ring->deq_tail;
 472   u16 n_deq, left_to_deq;
 473   u16 max_to_deq = 0;
 474   u16 inflight = cet->inflight;
 475   u8 dequeue_more = 0;
 476   cryptodev_op_t *cops[CRYPTODE_DEQ_MAX] = {};
 477   cryptodev_op_t **cop = cops;
 478   vnet_crypto_async_frame_elt_t *fe;
 479   u32 n_elts, n;
 480   u64 err0 = 0, err1 = 0, err2 = 0, err3 = 0; /* partial errors mask */
 481
 482   left_to_deq =
 483     ring->frames[*deq].f->n_elts - ring->frames[*deq].deq_elts_tail;
 484   max_to_deq = clib_min (left_to_deq, CRYPTODE_DEQ_MAX);
 485
 486   /* deq field can be used to track frame that is currently dequeued
 487    based on that you can specify the amount of elements to deq for the frame */
 488   n_deq =
 489     rte_cryptodev_dequeue_burst (cet->cryptodev_id, cet->cryptodev_q,
 490                                  (struct rte_crypto_op **) cops, max_to_deq);
 491
 492   if (n_deq == 0)
 493     return dequeue_more;
 494
 495   frame = ring->frames[*deq].f;
 496   fe = frame->elts + ring->frames[*deq].deq_elts_tail;
 497
 498   n_elts = n_deq;
 499   n = ring->frames[*deq].deq_elts_tail;
 500
 501   while (n_elts > 4)
 502     {
 503       fe[0].status = cryptodev_status_conversion[cop[0]->op.status];
 504       fe[1].status = cryptodev_status_conversion[cop[1]->op.status];
 505       fe[2].status = cryptodev_status_conversion[cop[2]->op.status];
 506       fe[3].status = cryptodev_status_conversion[cop[3]->op.status];
 507
 508       err0 |= ((u64) (fe[0].status == VNET_CRYPTO_OP_STATUS_COMPLETED)) << n;
 509       err1 |= ((u64) (fe[1].status == VNET_CRYPTO_OP_STATUS_COMPLETED))
 510               << (n + 1);
 511       err2 |= ((u64) (fe[2].status == VNET_CRYPTO_OP_STATUS_COMPLETED))
 512               << (n + 2);
 513       err3 |= ((u64) (fe[3].status == VNET_CRYPTO_OP_STATUS_COMPLETED))
 514               << (n + 3);
 515
 516       cop += 4;
 517       fe += 4;
 518       n_elts -= 4;
 519       n += 4;
 520     }
 521
 522   while (n_elts)
 523     {
 524       fe[0].status = cryptodev_status_conversion[cop[0]->op.status];
 525       err0 |= (fe[0].status == VNET_CRYPTO_OP_STATUS_COMPLETED) << n;
 526       n++;
 527       fe++;
 528       cop++;
 529       n_elts--;
 530     }
 531
 532   ring->frames[*deq].frame_elts_errs_mask |= (err0 | err1 | err2 | err3);
 533
 534   rte_mempool_put_bulk (cet->cop_pool, (void **) cops, n_deq);
 535
 536   inflight -= n_deq;
 537   ring->frames[*deq].deq_elts_tail += n_deq;
 538   if (cryptodev_cache_ring_update_deq_tail (ring, deq))
 539     {
 540       u32 fr_processed =
 541         (CRYPTODEV_CACHE_QUEUE_SIZE - ring->tail + ring->deq_tail) &
 542         CRYPTODEV_CACHE_QUEUE_MASK;
 543
 544       *nb_elts_processed = frame->n_elts;
 545       *enqueue_thread_idx = frame->enqueue_thread_index;
 546       dequeue_more = (fr_processed < CRYPTODEV_MAX_PROCESED_IN_CACHE_QUEUE);
 547     }
 548
 549   cet->inflight = inflight;
 550   return dequeue_more;
 551 }
 552
 553 static_always_inline void
 554 cryptodev_enqueue_frame (vlib_main_t *vm, cryptodev_cache_ring_elt_t *ring_elt)
 555 {
 556   cryptodev_op_type_t op_type = (cryptodev_op_type_t) ring_elt->op_type;
 557   u8 linked_or_aad_len = ring_elt->aad_len;
 558
 559   if (linked_or_aad_len == 1)
 560     cryptodev_frame_linked_algs_enqueue_internal (vm, ring_elt->f, op_type);
 561   else
 562     cryptodev_aead_enqueue_internal (vm, ring_elt->f, op_type,
 563                                      linked_or_aad_len);
 564 }
 565
 566 static_always_inline vnet_crypto_async_frame_t *
 567 cryptodev_frame_dequeue (vlib_main_t *vm, u32 *nb_elts_processed,
 568                          u32 *enqueue_thread_idx)
 569 {
 570   cryptodev_main_t *cmt = &cryptodev_main;
 571   vnet_crypto_main_t *cm = &crypto_main;
 572   cryptodev_engine_thread_t *cet = cmt->per_thread_data + vm->thread_index;
 573   cryptodev_cache_ring_t *ring = &cet->cache_ring;
 574   cryptodev_cache_ring_elt_t *ring_elt = &ring->frames[ring->tail];
 575
 576   vnet_crypto_async_frame_t *ret_frame = 0;
 577   u8 dequeue_more = 1;
 578
 579   while (cet->inflight > 0 && dequeue_more)
 580     {
 581       dequeue_more = cryptodev_frame_dequeue_internal (vm, nb_elts_processed,
 582                                                        enqueue_thread_idx);
 583     }
 584
 585   if (PREDICT_TRUE (ring->frames[ring->enq_head].f != 0))
 586     cryptodev_enqueue_frame (vm, &ring->frames[ring->enq_head]);
 587
 588   if (PREDICT_TRUE (ring_elt->f != 0))
 589     {
 590       if (ring_elt->enq_elts_head == ring_elt->deq_elts_tail)
 591         {
 592           vlib_node_set_interrupt_pending (
 593             vlib_get_main_by_index (vm->thread_index), cm->crypto_node_index);
 594           ret_frame = cryptodev_cache_ring_pop (ring);
 595           return ret_frame;
 596         }
 597     }
 598
 599   return ret_frame;
 600 }
 601 static_always_inline int
 602 cryptodev_enqueue_aead_aad_0_enc (vlib_main_t *vm,
 603                                   vnet_crypto_async_frame_t *frame)
 604 {
 605   return cryptodev_frame_aead_enqueue (vm, frame, CRYPTODEV_OP_TYPE_ENCRYPT,
 606                                        0);
 607 }
 608 static_always_inline int
 609 cryptodev_enqueue_aead_aad_8_enc (vlib_main_t *vm,
 610                                   vnet_crypto_async_frame_t *frame)
 611 {
 612   return cryptodev_frame_aead_enqueue (vm, frame, CRYPTODEV_OP_TYPE_ENCRYPT,
 613                                        8);
 614 }
 615 static_always_inline int
 616 cryptodev_enqueue_aead_aad_12_enc (vlib_main_t *vm,
 617                                    vnet_crypto_async_frame_t *frame)
 618 {
 619   return cryptodev_frame_aead_enqueue (vm, frame, CRYPTODEV_OP_TYPE_ENCRYPT,
 620                                        12);
 621 }
 622
 623 static_always_inline int
 624 cryptodev_enqueue_aead_aad_0_dec (vlib_main_t *vm,
 625                                   vnet_crypto_async_frame_t *frame)
 626 {
 627   return cryptodev_frame_aead_enqueue (vm, frame, CRYPTODEV_OP_TYPE_DECRYPT,
 628                                        0);
 629 }
 630 static_always_inline int
 631 cryptodev_enqueue_aead_aad_8_dec (vlib_main_t *vm,
 632                                   vnet_crypto_async_frame_t *frame)
 633 {
 634   return cryptodev_frame_aead_enqueue (vm, frame, CRYPTODEV_OP_TYPE_DECRYPT,
 635                                        8);
 636 }
 637 static_always_inline int
 638 cryptodev_enqueue_aead_aad_12_dec (vlib_main_t *vm,
 639                                    vnet_crypto_async_frame_t *frame)
 640 {
 641   return cryptodev_frame_aead_enqueue (vm, frame, CRYPTODEV_OP_TYPE_DECRYPT,
 642                                        12);
 643 }
 644
 645 static_always_inline int
 646 cryptodev_enqueue_linked_alg_enc (vlib_main_t *vm,
 647                                   vnet_crypto_async_frame_t *frame)
 648 {
 649   return cryptodev_frame_linked_algs_enqueue (vm, frame,
 650                                               CRYPTODEV_OP_TYPE_ENCRYPT);
 651 }
 652
 653 static_always_inline int
 654 cryptodev_enqueue_linked_alg_dec (vlib_main_t *vm,
 655                                   vnet_crypto_async_frame_t *frame)
 656 {
 657   return cryptodev_frame_linked_algs_enqueue (vm, frame,
 658                                               CRYPTODEV_OP_TYPE_DECRYPT);
 659 }
 660
 661 clib_error_t *
 662 cryptodev_register_cop_hdl (vlib_main_t *vm, u32 eidx)
 663 {
 664   cryptodev_main_t *cmt = &cryptodev_main;
 665   cryptodev_engine_thread_t *cet;
 666   struct rte_cryptodev_sym_capability_idx cap_auth_idx;
 667   struct rte_cryptodev_sym_capability_idx cap_cipher_idx;
 668   struct rte_cryptodev_sym_capability_idx cap_aead_idx;
 669   u8 *name;
 670   clib_error_t *error = 0;
 671   u32 ref_cnt = 0;
 672
 673   vec_foreach (cet, cmt->per_thread_data)
 674     {
 675       u32 thread_index = cet - cmt->per_thread_data;
 676       u32 numa = vlib_get_main_by_index (thread_index)->numa_node;
 677       name = format (0, "vpp_cop_pool_%u_%u", numa, thread_index);
 678       cet->cop_pool = rte_mempool_create (
 679         (char *) name, CRYPTODEV_NB_CRYPTO_OPS, sizeof (cryptodev_op_t), 0,
 680         sizeof (struct rte_crypto_op_pool_private), NULL, NULL, crypto_op_init,
 681         NULL, vm->numa_node, 0);
 682       vec_free (name);
 683       if (!cet->cop_pool)
 684         {
 685           error = clib_error_return (
 686             0, "Failed to create cryptodev op pool %s", name);
 687
 688           goto error_exit;
 689         }
 690     }
 691
 692 #define _(a, b, c, d, e, f, g)                                                \
 693   cap_aead_idx.type = RTE_CRYPTO_SYM_XFORM_AEAD;                              \
 694   cap_aead_idx.algo.aead = RTE_CRYPTO_##b##_##c;                              \
 695   if (cryptodev_check_cap_support (&cap_aead_idx, g, e, f))                   \
 696     {                                                                         \
 697       vnet_crypto_register_enqueue_handler (                                  \
 698         vm, eidx, VNET_CRYPTO_OP_##a##_TAG##e##_AAD##f##_ENC,                 \
 699         cryptodev_enqueue_aead_aad_##f##_enc);                                \
 700       vnet_crypto_register_enqueue_handler (                                  \
 701         vm, eidx, VNET_CRYPTO_OP_##a##_TAG##e##_AAD##f##_DEC,                 \
 702         cryptodev_enqueue_aead_aad_##f##_dec);                                \
 703       ref_cnt++;                                                              \
 704     }
 705   foreach_vnet_aead_crypto_conversion
 706 #undef _
 707
 708 #define _(a, b, c, d, e)                                                      \
 709   cap_auth_idx.type = RTE_CRYPTO_SYM_XFORM_AUTH;                              \
 710   cap_auth_idx.algo.auth = RTE_CRYPTO_AUTH_##d##_HMAC;                        \
 711   cap_cipher_idx.type = RTE_CRYPTO_SYM_XFORM_CIPHER;                          \
 712   cap_cipher_idx.algo.cipher = RTE_CRYPTO_CIPHER_##b;                         \
 713   if (cryptodev_check_cap_support (&cap_cipher_idx, c, -1, -1) &&             \
 714       cryptodev_check_cap_support (&cap_auth_idx, -1, e, -1))                 \
 715     {                                                                         \
 716       vnet_crypto_register_enqueue_handler (                                  \
 717         vm, eidx, VNET_CRYPTO_OP_##a##_##d##_TAG##e##_ENC,                    \
 718         cryptodev_enqueue_linked_alg_enc);                                    \
 719       vnet_crypto_register_enqueue_handler (                                  \
 720         vm, eidx, VNET_CRYPTO_OP_##a##_##d##_TAG##e##_DEC,                    \
 721         cryptodev_enqueue_linked_alg_dec);                                    \
 722       ref_cnt++;                                                              \
 723     }
 724     foreach_cryptodev_link_async_alg
 725 #undef _
 726
 727     if (ref_cnt)
 728       vnet_crypto_register_dequeue_handler (vm, eidx, cryptodev_frame_dequeue);
 729
 730     return 0;
 731
 732 error_exit:
 733   vec_foreach (cet, cmt->per_thread_data)
 734     {
 735       if (cet->cop_pool)
 736         rte_mempool_free (cet->cop_pool);
 737     }
 738
 739   return error;
 740 }