drivers/crypto/dpaa2_sec/dpaa2_sec_dpseci.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  *
   3  *   Copyright (c) 2016 Freescale Semiconductor, Inc. All rights reserved.
   4  *   Copyright 2016 NXP
   5  *
   6  */
   7
   8 #include <time.h>
   9 #include <net/if.h>
  10
  11 #include <rte_mbuf.h>
  12 #include <rte_cryptodev.h>
  13 #include <rte_security_driver.h>
  14 #include <rte_malloc.h>
  15 #include <rte_memcpy.h>
  16 #include <rte_string_fns.h>
  17 #include <rte_cycles.h>
  18 #include <rte_kvargs.h>
  19 #include <rte_dev.h>
  20 #include <rte_cryptodev_pmd.h>
  21 #include <rte_common.h>
  22 #include <rte_fslmc.h>
  23 #include <fslmc_vfio.h>
  24 #include <dpaa2_hw_pvt.h>
  25 #include <dpaa2_hw_dpio.h>
  26 #include <dpaa2_hw_mempool.h>
  27 #include <fsl_dpseci.h>
  28 #include <fsl_mc_sys.h>
  29
  30 #include "dpaa2_sec_priv.h"
  31 #include "dpaa2_sec_logs.h"
  32
  33 /* Required types */
  34 typedef uint64_t        dma_addr_t;
  35
  36 /* RTA header files */
  37 #include <hw/desc/ipsec.h>
  38 #include <hw/desc/algo.h>
  39
  40 /* Minimum job descriptor consists of a oneword job descriptor HEADER and
  41  * a pointer to the shared descriptor
  42  */
  43 #define MIN_JOB_DESC_SIZE       (CAAM_CMD_SZ + CAAM_PTR_SZ)
  44 #define FSL_VENDOR_ID           0x1957
  45 #define FSL_DEVICE_ID           0x410
  46 #define FSL_SUBSYSTEM_SEC       1
  47 #define FSL_MC_DPSECI_DEVID     3
  48
  49 #define NO_PREFETCH 0
  50 /* FLE_POOL_NUM_BUFS is set as per the ipsec-secgw application */
  51 #define FLE_POOL_NUM_BUFS       32000
  52 #define FLE_POOL_BUF_SIZE       256
  53 #define FLE_POOL_CACHE_SIZE     512
  54 #define FLE_SG_MEM_SIZE         2048
  55 #define SEC_FLC_DHR_OUTBOUND    -114
  56 #define SEC_FLC_DHR_INBOUND     0
  57
  58 enum rta_sec_era rta_sec_era = RTA_SEC_ERA_8;
  59
  60 static uint8_t cryptodev_driver_id;
  61
  62 int dpaa2_logtype_sec;
  63
  64 static inline int
  65 build_proto_fd(dpaa2_sec_session *sess,
  66                struct rte_crypto_op *op,
  67                struct qbman_fd *fd, uint16_t bpid)
  68 {
  69         struct rte_crypto_sym_op *sym_op = op->sym;
  70         struct ctxt_priv *priv = sess->ctxt;
  71         struct sec_flow_context *flc;
  72         struct rte_mbuf *mbuf = sym_op->m_src;
  73
  74         if (likely(bpid < MAX_BPID))
  75                 DPAA2_SET_FD_BPID(fd, bpid);
  76         else
  77                 DPAA2_SET_FD_IVP(fd);
  78
  79         /* Save the shared descriptor */
  80         flc = &priv->flc_desc[0].flc;
  81
  82         DPAA2_SET_FD_ADDR(fd, DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
  83         DPAA2_SET_FD_OFFSET(fd, sym_op->m_src->data_off);
  84         DPAA2_SET_FD_LEN(fd, sym_op->m_src->pkt_len);
  85         DPAA2_SET_FD_FLC(fd, (ptrdiff_t)flc);
  86
  87         /* save physical address of mbuf */
  88         op->sym->aead.digest.phys_addr = mbuf->buf_iova;
  89         mbuf->buf_iova = (size_t)op;
  90
  91         return 0;
  92 }
  93
  94 static inline int
  95 build_authenc_gcm_sg_fd(dpaa2_sec_session *sess,
  96                  struct rte_crypto_op *op,
  97                  struct qbman_fd *fd, __rte_unused uint16_t bpid)
  98 {
  99         struct rte_crypto_sym_op *sym_op = op->sym;
 100         struct ctxt_priv *priv = sess->ctxt;
 101         struct qbman_fle *fle, *sge, *ip_fle, *op_fle;
 102         struct sec_flow_context *flc;
 103         uint32_t auth_only_len = sess->ext_params.aead_ctxt.auth_only_len;
 104         int icv_len = sess->digest_length;
 105         uint8_t *old_icv;
 106         struct rte_mbuf *mbuf;
 107         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 108                         sess->iv.offset);
 109
 110         PMD_INIT_FUNC_TRACE();
 111
 112         if (sym_op->m_dst)
 113                 mbuf = sym_op->m_dst;
 114         else
 115                 mbuf = sym_op->m_src;
 116
 117         /* first FLE entry used to store mbuf and session ctxt */
 118         fle = (struct qbman_fle *)rte_malloc(NULL, FLE_SG_MEM_SIZE,
 119                         RTE_CACHE_LINE_SIZE);
 120         if (unlikely(!fle)) {
 121                 DPAA2_SEC_ERR("GCM SG: Memory alloc failed for SGE");
 122                 return -1;
 123         }
 124         memset(fle, 0, FLE_SG_MEM_SIZE);
 125         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 126         DPAA2_FLE_SAVE_CTXT(fle, (size_t)priv);
 127
 128         op_fle = fle + 1;
 129         ip_fle = fle + 2;
 130         sge = fle + 3;
 131
 132         /* Save the shared descriptor */
 133         flc = &priv->flc_desc[0].flc;
 134
 135         /* Configure FD as a FRAME LIST */
 136         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(op_fle));
 137         DPAA2_SET_FD_COMPOUND_FMT(fd);
 138         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 139
 140         DPAA2_SEC_DP_DEBUG("GCM SG: auth_off: 0x%x/length %d, digest-len=%d\n"
 141                    "iv-len=%d data_off: 0x%x\n",
 142                    sym_op->aead.data.offset,
 143                    sym_op->aead.data.length,
 144                    sess->digest_length,
 145                    sess->iv.length,
 146                    sym_op->m_src->data_off);
 147
 148         /* Configure Output FLE with Scatter/Gather Entry */
 149         DPAA2_SET_FLE_SG_EXT(op_fle);
 150         DPAA2_SET_FLE_ADDR(op_fle, DPAA2_VADDR_TO_IOVA(sge));
 151
 152         if (auth_only_len)
 153                 DPAA2_SET_FLE_INTERNAL_JD(op_fle, auth_only_len);
 154
 155         op_fle->length = (sess->dir == DIR_ENC) ?
 156                         (sym_op->aead.data.length + icv_len + auth_only_len) :
 157                         sym_op->aead.data.length + auth_only_len;
 158
 159         /* Configure Output SGE for Encap/Decap */
 160         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 161         DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off + sym_op->aead.data.offset -
 162                                                                 auth_only_len);
 163         sge->length = mbuf->data_len - sym_op->aead.data.offset + auth_only_len;
 164
 165         mbuf = mbuf->next;
 166         /* o/p segs */
 167         while (mbuf) {
 168                 sge++;
 169                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 170                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 171                 sge->length = mbuf->data_len;
 172                 mbuf = mbuf->next;
 173         }
 174         sge->length -= icv_len;
 175
 176         if (sess->dir == DIR_ENC) {
 177                 sge++;
 178                 DPAA2_SET_FLE_ADDR(sge,
 179                                 DPAA2_VADDR_TO_IOVA(sym_op->aead.digest.data));
 180                 sge->length = icv_len;
 181         }
 182         DPAA2_SET_FLE_FIN(sge);
 183
 184         sge++;
 185         mbuf = sym_op->m_src;
 186
 187         /* Configure Input FLE with Scatter/Gather Entry */
 188         DPAA2_SET_FLE_ADDR(ip_fle, DPAA2_VADDR_TO_IOVA(sge));
 189         DPAA2_SET_FLE_SG_EXT(ip_fle);
 190         DPAA2_SET_FLE_FIN(ip_fle);
 191         ip_fle->length = (sess->dir == DIR_ENC) ?
 192                 (sym_op->aead.data.length + sess->iv.length + auth_only_len) :
 193                 (sym_op->aead.data.length + sess->iv.length + auth_only_len +
 194                  icv_len);
 195
 196         /* Configure Input SGE for Encap/Decap */
 197         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(IV_ptr));
 198         sge->length = sess->iv.length;
 199
 200         sge++;
 201         if (auth_only_len) {
 202                 DPAA2_SET_FLE_ADDR(sge,
 203                                 DPAA2_VADDR_TO_IOVA(sym_op->aead.aad.data));
 204                 sge->length = auth_only_len;
 205                 sge++;
 206         }
 207
 208         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 209         DPAA2_SET_FLE_OFFSET(sge, sym_op->aead.data.offset +
 210                                 mbuf->data_off);
 211         sge->length = mbuf->data_len - sym_op->aead.data.offset;
 212
 213         mbuf = mbuf->next;
 214         /* i/p segs */
 215         while (mbuf) {
 216                 sge++;
 217                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 218                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 219                 sge->length = mbuf->data_len;
 220                 mbuf = mbuf->next;
 221         }
 222
 223         if (sess->dir == DIR_DEC) {
 224                 sge++;
 225                 old_icv = (uint8_t *)(sge + 1);
 226                 memcpy(old_icv, sym_op->aead.digest.data, icv_len);
 227                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_icv));
 228                 sge->length = icv_len;
 229         }
 230
 231         DPAA2_SET_FLE_FIN(sge);
 232         if (auth_only_len) {
 233                 DPAA2_SET_FLE_INTERNAL_JD(ip_fle, auth_only_len);
 234                 DPAA2_SET_FD_INTERNAL_JD(fd, auth_only_len);
 235         }
 236         DPAA2_SET_FD_LEN(fd, ip_fle->length);
 237
 238         return 0;
 239 }
 240
 241 static inline int
 242 build_authenc_gcm_fd(dpaa2_sec_session *sess,
 243                      struct rte_crypto_op *op,
 244                      struct qbman_fd *fd, uint16_t bpid)
 245 {
 246         struct rte_crypto_sym_op *sym_op = op->sym;
 247         struct ctxt_priv *priv = sess->ctxt;
 248         struct qbman_fle *fle, *sge;
 249         struct sec_flow_context *flc;
 250         uint32_t auth_only_len = sess->ext_params.aead_ctxt.auth_only_len;
 251         int icv_len = sess->digest_length, retval;
 252         uint8_t *old_icv;
 253         struct rte_mbuf *dst;
 254         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 255                         sess->iv.offset);
 256
 257         PMD_INIT_FUNC_TRACE();
 258
 259         if (sym_op->m_dst)
 260                 dst = sym_op->m_dst;
 261         else
 262                 dst = sym_op->m_src;
 263
 264         /* TODO we are using the first FLE entry to store Mbuf and session ctxt.
 265          * Currently we donot know which FLE has the mbuf stored.
 266          * So while retreiving we can go back 1 FLE from the FD -ADDR
 267          * to get the MBUF Addr from the previous FLE.
 268          * We can have a better approach to use the inline Mbuf
 269          */
 270         retval = rte_mempool_get(priv->fle_pool, (void **)(&fle));
 271         if (retval) {
 272                 DPAA2_SEC_ERR("GCM: Memory alloc failed for SGE");
 273                 return -1;
 274         }
 275         memset(fle, 0, FLE_POOL_BUF_SIZE);
 276         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 277         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 278         fle = fle + 1;
 279         sge = fle + 2;
 280         if (likely(bpid < MAX_BPID)) {
 281                 DPAA2_SET_FD_BPID(fd, bpid);
 282                 DPAA2_SET_FLE_BPID(fle, bpid);
 283                 DPAA2_SET_FLE_BPID(fle + 1, bpid);
 284                 DPAA2_SET_FLE_BPID(sge, bpid);
 285                 DPAA2_SET_FLE_BPID(sge + 1, bpid);
 286                 DPAA2_SET_FLE_BPID(sge + 2, bpid);
 287                 DPAA2_SET_FLE_BPID(sge + 3, bpid);
 288         } else {
 289                 DPAA2_SET_FD_IVP(fd);
 290                 DPAA2_SET_FLE_IVP(fle);
 291                 DPAA2_SET_FLE_IVP((fle + 1));
 292                 DPAA2_SET_FLE_IVP(sge);
 293                 DPAA2_SET_FLE_IVP((sge + 1));
 294                 DPAA2_SET_FLE_IVP((sge + 2));
 295                 DPAA2_SET_FLE_IVP((sge + 3));
 296         }
 297
 298         /* Save the shared descriptor */
 299         flc = &priv->flc_desc[0].flc;
 300         /* Configure FD as a FRAME LIST */
 301         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(fle));
 302         DPAA2_SET_FD_COMPOUND_FMT(fd);
 303         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 304
 305         DPAA2_SEC_DP_DEBUG("GCM: auth_off: 0x%x/length %d, digest-len=%d\n"
 306                    "iv-len=%d data_off: 0x%x\n",
 307                    sym_op->aead.data.offset,
 308                    sym_op->aead.data.length,
 309                    sess->digest_length,
 310                    sess->iv.length,
 311                    sym_op->m_src->data_off);
 312
 313         /* Configure Output FLE with Scatter/Gather Entry */
 314         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
 315         if (auth_only_len)
 316                 DPAA2_SET_FLE_INTERNAL_JD(fle, auth_only_len);
 317         fle->length = (sess->dir == DIR_ENC) ?
 318                         (sym_op->aead.data.length + icv_len + auth_only_len) :
 319                         sym_op->aead.data.length + auth_only_len;
 320
 321         DPAA2_SET_FLE_SG_EXT(fle);
 322
 323         /* Configure Output SGE for Encap/Decap */
 324         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(dst));
 325         DPAA2_SET_FLE_OFFSET(sge, sym_op->aead.data.offset +
 326                                 dst->data_off - auth_only_len);
 327         sge->length = sym_op->aead.data.length + auth_only_len;
 328
 329         if (sess->dir == DIR_ENC) {
 330                 sge++;
 331                 DPAA2_SET_FLE_ADDR(sge,
 332                                 DPAA2_VADDR_TO_IOVA(sym_op->aead.digest.data));
 333                 sge->length = sess->digest_length;
 334                 DPAA2_SET_FD_LEN(fd, (sym_op->aead.data.length +
 335                                         sess->iv.length + auth_only_len));
 336         }
 337         DPAA2_SET_FLE_FIN(sge);
 338
 339         sge++;
 340         fle++;
 341
 342         /* Configure Input FLE with Scatter/Gather Entry */
 343         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
 344         DPAA2_SET_FLE_SG_EXT(fle);
 345         DPAA2_SET_FLE_FIN(fle);
 346         fle->length = (sess->dir == DIR_ENC) ?
 347                 (sym_op->aead.data.length + sess->iv.length + auth_only_len) :
 348                 (sym_op->aead.data.length + sess->iv.length + auth_only_len +
 349                  sess->digest_length);
 350
 351         /* Configure Input SGE for Encap/Decap */
 352         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(IV_ptr));
 353         sge->length = sess->iv.length;
 354         sge++;
 355         if (auth_only_len) {
 356                 DPAA2_SET_FLE_ADDR(sge,
 357                                 DPAA2_VADDR_TO_IOVA(sym_op->aead.aad.data));
 358                 sge->length = auth_only_len;
 359                 DPAA2_SET_FLE_BPID(sge, bpid);
 360                 sge++;
 361         }
 362
 363         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
 364         DPAA2_SET_FLE_OFFSET(sge, sym_op->aead.data.offset +
 365                                 sym_op->m_src->data_off);
 366         sge->length = sym_op->aead.data.length;
 367         if (sess->dir == DIR_DEC) {
 368                 sge++;
 369                 old_icv = (uint8_t *)(sge + 1);
 370                 memcpy(old_icv, sym_op->aead.digest.data,
 371                        sess->digest_length);
 372                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_icv));
 373                 sge->length = sess->digest_length;
 374                 DPAA2_SET_FD_LEN(fd, (sym_op->aead.data.length +
 375                                  sess->digest_length +
 376                                  sess->iv.length +
 377                                  auth_only_len));
 378         }
 379         DPAA2_SET_FLE_FIN(sge);
 380
 381         if (auth_only_len) {
 382                 DPAA2_SET_FLE_INTERNAL_JD(fle, auth_only_len);
 383                 DPAA2_SET_FD_INTERNAL_JD(fd, auth_only_len);
 384         }
 385
 386         return 0;
 387 }
 388
 389 static inline int
 390 build_authenc_sg_fd(dpaa2_sec_session *sess,
 391                  struct rte_crypto_op *op,
 392                  struct qbman_fd *fd, __rte_unused uint16_t bpid)
 393 {
 394         struct rte_crypto_sym_op *sym_op = op->sym;
 395         struct ctxt_priv *priv = sess->ctxt;
 396         struct qbman_fle *fle, *sge, *ip_fle, *op_fle;
 397         struct sec_flow_context *flc;
 398         uint32_t auth_only_len = sym_op->auth.data.length -
 399                                 sym_op->cipher.data.length;
 400         int icv_len = sess->digest_length;
 401         uint8_t *old_icv;
 402         struct rte_mbuf *mbuf;
 403         uint8_t *iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 404                         sess->iv.offset);
 405
 406         PMD_INIT_FUNC_TRACE();
 407
 408         if (sym_op->m_dst)
 409                 mbuf = sym_op->m_dst;
 410         else
 411                 mbuf = sym_op->m_src;
 412
 413         /* first FLE entry used to store mbuf and session ctxt */
 414         fle = (struct qbman_fle *)rte_malloc(NULL, FLE_SG_MEM_SIZE,
 415                         RTE_CACHE_LINE_SIZE);
 416         if (unlikely(!fle)) {
 417                 DPAA2_SEC_ERR("AUTHENC SG: Memory alloc failed for SGE");
 418                 return -1;
 419         }
 420         memset(fle, 0, FLE_SG_MEM_SIZE);
 421         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 422         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 423
 424         op_fle = fle + 1;
 425         ip_fle = fle + 2;
 426         sge = fle + 3;
 427
 428         /* Save the shared descriptor */
 429         flc = &priv->flc_desc[0].flc;
 430
 431         /* Configure FD as a FRAME LIST */
 432         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(op_fle));
 433         DPAA2_SET_FD_COMPOUND_FMT(fd);
 434         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 435
 436         DPAA2_SEC_DP_DEBUG(
 437                 "AUTHENC SG: auth_off: 0x%x/length %d, digest-len=%d\n"
 438                 "cipher_off: 0x%x/length %d, iv-len=%d data_off: 0x%x\n",
 439                 sym_op->auth.data.offset,
 440                 sym_op->auth.data.length,
 441                 sess->digest_length,
 442                 sym_op->cipher.data.offset,
 443                 sym_op->cipher.data.length,
 444                 sess->iv.length,
 445                 sym_op->m_src->data_off);
 446
 447         /* Configure Output FLE with Scatter/Gather Entry */
 448         DPAA2_SET_FLE_SG_EXT(op_fle);
 449         DPAA2_SET_FLE_ADDR(op_fle, DPAA2_VADDR_TO_IOVA(sge));
 450
 451         if (auth_only_len)
 452                 DPAA2_SET_FLE_INTERNAL_JD(op_fle, auth_only_len);
 453
 454         op_fle->length = (sess->dir == DIR_ENC) ?
 455                         (sym_op->cipher.data.length + icv_len) :
 456                         sym_op->cipher.data.length;
 457
 458         /* Configure Output SGE for Encap/Decap */
 459         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 460         DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off + sym_op->auth.data.offset);
 461         sge->length = mbuf->data_len - sym_op->auth.data.offset;
 462
 463         mbuf = mbuf->next;
 464         /* o/p segs */
 465         while (mbuf) {
 466                 sge++;
 467                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 468                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 469                 sge->length = mbuf->data_len;
 470                 mbuf = mbuf->next;
 471         }
 472         sge->length -= icv_len;
 473
 474         if (sess->dir == DIR_ENC) {
 475                 sge++;
 476                 DPAA2_SET_FLE_ADDR(sge,
 477                                 DPAA2_VADDR_TO_IOVA(sym_op->auth.digest.data));
 478                 sge->length = icv_len;
 479         }
 480         DPAA2_SET_FLE_FIN(sge);
 481
 482         sge++;
 483         mbuf = sym_op->m_src;
 484
 485         /* Configure Input FLE with Scatter/Gather Entry */
 486         DPAA2_SET_FLE_ADDR(ip_fle, DPAA2_VADDR_TO_IOVA(sge));
 487         DPAA2_SET_FLE_SG_EXT(ip_fle);
 488         DPAA2_SET_FLE_FIN(ip_fle);
 489         ip_fle->length = (sess->dir == DIR_ENC) ?
 490                         (sym_op->auth.data.length + sess->iv.length) :
 491                         (sym_op->auth.data.length + sess->iv.length +
 492                          icv_len);
 493
 494         /* Configure Input SGE for Encap/Decap */
 495         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(iv_ptr));
 496         sge->length = sess->iv.length;
 497
 498         sge++;
 499         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 500         DPAA2_SET_FLE_OFFSET(sge, sym_op->auth.data.offset +
 501                                 mbuf->data_off);
 502         sge->length = mbuf->data_len - sym_op->auth.data.offset;
 503
 504         mbuf = mbuf->next;
 505         /* i/p segs */
 506         while (mbuf) {
 507                 sge++;
 508                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 509                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 510                 sge->length = mbuf->data_len;
 511                 mbuf = mbuf->next;
 512         }
 513         sge->length -= icv_len;
 514
 515         if (sess->dir == DIR_DEC) {
 516                 sge++;
 517                 old_icv = (uint8_t *)(sge + 1);
 518                 memcpy(old_icv, sym_op->auth.digest.data,
 519                        icv_len);
 520                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_icv));
 521                 sge->length = icv_len;
 522         }
 523
 524         DPAA2_SET_FLE_FIN(sge);
 525         if (auth_only_len) {
 526                 DPAA2_SET_FLE_INTERNAL_JD(ip_fle, auth_only_len);
 527                 DPAA2_SET_FD_INTERNAL_JD(fd, auth_only_len);
 528         }
 529         DPAA2_SET_FD_LEN(fd, ip_fle->length);
 530
 531         return 0;
 532 }
 533
 534 static inline int
 535 build_authenc_fd(dpaa2_sec_session *sess,
 536                  struct rte_crypto_op *op,
 537                  struct qbman_fd *fd, uint16_t bpid)
 538 {
 539         struct rte_crypto_sym_op *sym_op = op->sym;
 540         struct ctxt_priv *priv = sess->ctxt;
 541         struct qbman_fle *fle, *sge;
 542         struct sec_flow_context *flc;
 543         uint32_t auth_only_len = sym_op->auth.data.length -
 544                                 sym_op->cipher.data.length;
 545         int icv_len = sess->digest_length, retval;
 546         uint8_t *old_icv;
 547         uint8_t *iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 548                         sess->iv.offset);
 549         struct rte_mbuf *dst;
 550
 551         PMD_INIT_FUNC_TRACE();
 552
 553         if (sym_op->m_dst)
 554                 dst = sym_op->m_dst;
 555         else
 556                 dst = sym_op->m_src;
 557
 558         /* we are using the first FLE entry to store Mbuf.
 559          * Currently we donot know which FLE has the mbuf stored.
 560          * So while retreiving we can go back 1 FLE from the FD -ADDR
 561          * to get the MBUF Addr from the previous FLE.
 562          * We can have a better approach to use the inline Mbuf
 563          */
 564         retval = rte_mempool_get(priv->fle_pool, (void **)(&fle));
 565         if (retval) {
 566                 DPAA2_SEC_ERR("Memory alloc failed for SGE");
 567                 return -1;
 568         }
 569         memset(fle, 0, FLE_POOL_BUF_SIZE);
 570         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 571         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 572         fle = fle + 1;
 573         sge = fle + 2;
 574         if (likely(bpid < MAX_BPID)) {
 575                 DPAA2_SET_FD_BPID(fd, bpid);
 576                 DPAA2_SET_FLE_BPID(fle, bpid);
 577                 DPAA2_SET_FLE_BPID(fle + 1, bpid);
 578                 DPAA2_SET_FLE_BPID(sge, bpid);
 579                 DPAA2_SET_FLE_BPID(sge + 1, bpid);
 580                 DPAA2_SET_FLE_BPID(sge + 2, bpid);
 581                 DPAA2_SET_FLE_BPID(sge + 3, bpid);
 582         } else {
 583                 DPAA2_SET_FD_IVP(fd);
 584                 DPAA2_SET_FLE_IVP(fle);
 585                 DPAA2_SET_FLE_IVP((fle + 1));
 586                 DPAA2_SET_FLE_IVP(sge);
 587                 DPAA2_SET_FLE_IVP((sge + 1));
 588                 DPAA2_SET_FLE_IVP((sge + 2));
 589                 DPAA2_SET_FLE_IVP((sge + 3));
 590         }
 591
 592         /* Save the shared descriptor */
 593         flc = &priv->flc_desc[0].flc;
 594         /* Configure FD as a FRAME LIST */
 595         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(fle));
 596         DPAA2_SET_FD_COMPOUND_FMT(fd);
 597         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 598
 599         DPAA2_SEC_DP_DEBUG(
 600                 "AUTHENC: auth_off: 0x%x/length %d, digest-len=%d\n"
 601                 "cipher_off: 0x%x/length %d, iv-len=%d data_off: 0x%x\n",
 602                 sym_op->auth.data.offset,
 603                 sym_op->auth.data.length,
 604                 sess->digest_length,
 605                 sym_op->cipher.data.offset,
 606                 sym_op->cipher.data.length,
 607                 sess->iv.length,
 608                 sym_op->m_src->data_off);
 609
 610         /* Configure Output FLE with Scatter/Gather Entry */
 611         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
 612         if (auth_only_len)
 613                 DPAA2_SET_FLE_INTERNAL_JD(fle, auth_only_len);
 614         fle->length = (sess->dir == DIR_ENC) ?
 615                         (sym_op->cipher.data.length + icv_len) :
 616                         sym_op->cipher.data.length;
 617
 618         DPAA2_SET_FLE_SG_EXT(fle);
 619
 620         /* Configure Output SGE for Encap/Decap */
 621         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(dst));
 622         DPAA2_SET_FLE_OFFSET(sge, sym_op->cipher.data.offset +
 623                                 dst->data_off);
 624         sge->length = sym_op->cipher.data.length;
 625
 626         if (sess->dir == DIR_ENC) {
 627                 sge++;
 628                 DPAA2_SET_FLE_ADDR(sge,
 629                                 DPAA2_VADDR_TO_IOVA(sym_op->auth.digest.data));
 630                 sge->length = sess->digest_length;
 631                 DPAA2_SET_FD_LEN(fd, (sym_op->auth.data.length +
 632                                         sess->iv.length));
 633         }
 634         DPAA2_SET_FLE_FIN(sge);
 635
 636         sge++;
 637         fle++;
 638
 639         /* Configure Input FLE with Scatter/Gather Entry */
 640         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
 641         DPAA2_SET_FLE_SG_EXT(fle);
 642         DPAA2_SET_FLE_FIN(fle);
 643         fle->length = (sess->dir == DIR_ENC) ?
 644                         (sym_op->auth.data.length + sess->iv.length) :
 645                         (sym_op->auth.data.length + sess->iv.length +
 646                          sess->digest_length);
 647
 648         /* Configure Input SGE for Encap/Decap */
 649         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(iv_ptr));
 650         sge->length = sess->iv.length;
 651         sge++;
 652
 653         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
 654         DPAA2_SET_FLE_OFFSET(sge, sym_op->auth.data.offset +
 655                                 sym_op->m_src->data_off);
 656         sge->length = sym_op->auth.data.length;
 657         if (sess->dir == DIR_DEC) {
 658                 sge++;
 659                 old_icv = (uint8_t *)(sge + 1);
 660                 memcpy(old_icv, sym_op->auth.digest.data,
 661                        sess->digest_length);
 662                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_icv));
 663                 sge->length = sess->digest_length;
 664                 DPAA2_SET_FD_LEN(fd, (sym_op->auth.data.length +
 665                                  sess->digest_length +
 666                                  sess->iv.length));
 667         }
 668         DPAA2_SET_FLE_FIN(sge);
 669         if (auth_only_len) {
 670                 DPAA2_SET_FLE_INTERNAL_JD(fle, auth_only_len);
 671                 DPAA2_SET_FD_INTERNAL_JD(fd, auth_only_len);
 672         }
 673         return 0;
 674 }
 675
 676 static inline int build_auth_sg_fd(
 677                 dpaa2_sec_session *sess,
 678                 struct rte_crypto_op *op,
 679                 struct qbman_fd *fd,
 680                 __rte_unused uint16_t bpid)
 681 {
 682         struct rte_crypto_sym_op *sym_op = op->sym;
 683         struct qbman_fle *fle, *sge, *ip_fle, *op_fle;
 684         struct sec_flow_context *flc;
 685         struct ctxt_priv *priv = sess->ctxt;
 686         uint8_t *old_digest;
 687         struct rte_mbuf *mbuf;
 688
 689         PMD_INIT_FUNC_TRACE();
 690
 691         mbuf = sym_op->m_src;
 692         fle = (struct qbman_fle *)rte_malloc(NULL, FLE_SG_MEM_SIZE,
 693                         RTE_CACHE_LINE_SIZE);
 694         if (unlikely(!fle)) {
 695                 DPAA2_SEC_ERR("AUTH SG: Memory alloc failed for SGE");
 696                 return -1;
 697         }
 698         memset(fle, 0, FLE_SG_MEM_SIZE);
 699         /* first FLE entry used to store mbuf and session ctxt */
 700         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 701         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 702         op_fle = fle + 1;
 703         ip_fle = fle + 2;
 704         sge = fle + 3;
 705
 706         flc = &priv->flc_desc[DESC_INITFINAL].flc;
 707         /* sg FD */
 708         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 709         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(op_fle));
 710         DPAA2_SET_FD_COMPOUND_FMT(fd);
 711
 712         /* o/p fle */
 713         DPAA2_SET_FLE_ADDR(op_fle,
 714                                 DPAA2_VADDR_TO_IOVA(sym_op->auth.digest.data));
 715         op_fle->length = sess->digest_length;
 716
 717         /* i/p fle */
 718         DPAA2_SET_FLE_SG_EXT(ip_fle);
 719         DPAA2_SET_FLE_ADDR(ip_fle, DPAA2_VADDR_TO_IOVA(sge));
 720         /* i/p 1st seg */
 721         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 722         DPAA2_SET_FLE_OFFSET(sge, sym_op->auth.data.offset + mbuf->data_off);
 723         sge->length = mbuf->data_len - sym_op->auth.data.offset;
 724
 725         /* i/p segs */
 726         mbuf = mbuf->next;
 727         while (mbuf) {
 728                 sge++;
 729                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 730                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 731                 sge->length = mbuf->data_len;
 732                 mbuf = mbuf->next;
 733         }
 734         if (sess->dir == DIR_ENC) {
 735                 /* Digest calculation case */
 736                 sge->length -= sess->digest_length;
 737                 ip_fle->length = sym_op->auth.data.length;
 738         } else {
 739                 /* Digest verification case */
 740                 sge++;
 741                 old_digest = (uint8_t *)(sge + 1);
 742                 rte_memcpy(old_digest, sym_op->auth.digest.data,
 743                            sess->digest_length);
 744                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_digest));
 745                 sge->length = sess->digest_length;
 746                 ip_fle->length = sym_op->auth.data.length +
 747                                 sess->digest_length;
 748         }
 749         DPAA2_SET_FLE_FIN(sge);
 750         DPAA2_SET_FLE_FIN(ip_fle);
 751         DPAA2_SET_FD_LEN(fd, ip_fle->length);
 752
 753         return 0;
 754 }
 755
 756 static inline int
 757 build_auth_fd(dpaa2_sec_session *sess, struct rte_crypto_op *op,
 758               struct qbman_fd *fd, uint16_t bpid)
 759 {
 760         struct rte_crypto_sym_op *sym_op = op->sym;
 761         struct qbman_fle *fle, *sge;
 762         struct sec_flow_context *flc;
 763         struct ctxt_priv *priv = sess->ctxt;
 764         uint8_t *old_digest;
 765         int retval;
 766
 767         PMD_INIT_FUNC_TRACE();
 768
 769         retval = rte_mempool_get(priv->fle_pool, (void **)(&fle));
 770         if (retval) {
 771                 DPAA2_SEC_ERR("AUTH Memory alloc failed for SGE");
 772                 return -1;
 773         }
 774         memset(fle, 0, FLE_POOL_BUF_SIZE);
 775         /* TODO we are using the first FLE entry to store Mbuf.
 776          * Currently we donot know which FLE has the mbuf stored.
 777          * So while retreiving we can go back 1 FLE from the FD -ADDR
 778          * to get the MBUF Addr from the previous FLE.
 779          * We can have a better approach to use the inline Mbuf
 780          */
 781         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 782         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 783         fle = fle + 1;
 784
 785         if (likely(bpid < MAX_BPID)) {
 786                 DPAA2_SET_FD_BPID(fd, bpid);
 787                 DPAA2_SET_FLE_BPID(fle, bpid);
 788                 DPAA2_SET_FLE_BPID(fle + 1, bpid);
 789         } else {
 790                 DPAA2_SET_FD_IVP(fd);
 791                 DPAA2_SET_FLE_IVP(fle);
 792                 DPAA2_SET_FLE_IVP((fle + 1));
 793         }
 794         flc = &priv->flc_desc[DESC_INITFINAL].flc;
 795         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 796
 797         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sym_op->auth.digest.data));
 798         fle->length = sess->digest_length;
 799
 800         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(fle));
 801         DPAA2_SET_FD_COMPOUND_FMT(fd);
 802         fle++;
 803
 804         if (sess->dir == DIR_ENC) {
 805                 DPAA2_SET_FLE_ADDR(fle,
 806                                    DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
 807                 DPAA2_SET_FLE_OFFSET(fle, sym_op->auth.data.offset +
 808                                      sym_op->m_src->data_off);
 809                 DPAA2_SET_FD_LEN(fd, sym_op->auth.data.length);
 810                 fle->length = sym_op->auth.data.length;
 811         } else {
 812                 sge = fle + 2;
 813                 DPAA2_SET_FLE_SG_EXT(fle);
 814                 DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
 815
 816                 if (likely(bpid < MAX_BPID)) {
 817                         DPAA2_SET_FLE_BPID(sge, bpid);
 818                         DPAA2_SET_FLE_BPID(sge + 1, bpid);
 819                 } else {
 820                         DPAA2_SET_FLE_IVP(sge);
 821                         DPAA2_SET_FLE_IVP((sge + 1));
 822                 }
 823                 DPAA2_SET_FLE_ADDR(sge,
 824                                    DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
 825                 DPAA2_SET_FLE_OFFSET(sge, sym_op->auth.data.offset +
 826                                      sym_op->m_src->data_off);
 827
 828                 DPAA2_SET_FD_LEN(fd, sym_op->auth.data.length +
 829                                  sess->digest_length);
 830                 sge->length = sym_op->auth.data.length;
 831                 sge++;
 832                 old_digest = (uint8_t *)(sge + 1);
 833                 rte_memcpy(old_digest, sym_op->auth.digest.data,
 834                            sess->digest_length);
 835                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_digest));
 836                 sge->length = sess->digest_length;
 837                 fle->length = sym_op->auth.data.length +
 838                                 sess->digest_length;
 839                 DPAA2_SET_FLE_FIN(sge);
 840         }
 841         DPAA2_SET_FLE_FIN(fle);
 842
 843         return 0;
 844 }
 845
 846 static int
 847 build_cipher_sg_fd(dpaa2_sec_session *sess, struct rte_crypto_op *op,
 848                 struct qbman_fd *fd, __rte_unused uint16_t bpid)
 849 {
 850         struct rte_crypto_sym_op *sym_op = op->sym;
 851         struct qbman_fle *ip_fle, *op_fle, *sge, *fle;
 852         struct sec_flow_context *flc;
 853         struct ctxt_priv *priv = sess->ctxt;
 854         struct rte_mbuf *mbuf;
 855         uint8_t *iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 856                         sess->iv.offset);
 857
 858         PMD_INIT_FUNC_TRACE();
 859
 860         if (sym_op->m_dst)
 861                 mbuf = sym_op->m_dst;
 862         else
 863                 mbuf = sym_op->m_src;
 864
 865         fle = (struct qbman_fle *)rte_malloc(NULL, FLE_SG_MEM_SIZE,
 866                         RTE_CACHE_LINE_SIZE);
 867         if (!fle) {
 868                 DPAA2_SEC_ERR("CIPHER SG: Memory alloc failed for SGE");
 869                 return -1;
 870         }
 871         memset(fle, 0, FLE_SG_MEM_SIZE);
 872         /* first FLE entry used to store mbuf and session ctxt */
 873         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 874         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 875
 876         op_fle = fle + 1;
 877         ip_fle = fle + 2;
 878         sge = fle + 3;
 879
 880         flc = &priv->flc_desc[0].flc;
 881
 882         DPAA2_SEC_DP_DEBUG(
 883                 "CIPHER SG: cipher_off: 0x%x/length %d, ivlen=%d"
 884                 " data_off: 0x%x\n",
 885                 sym_op->cipher.data.offset,
 886                 sym_op->cipher.data.length,
 887                 sess->iv.length,
 888                 sym_op->m_src->data_off);
 889
 890         /* o/p fle */
 891         DPAA2_SET_FLE_ADDR(op_fle, DPAA2_VADDR_TO_IOVA(sge));
 892         op_fle->length = sym_op->cipher.data.length;
 893         DPAA2_SET_FLE_SG_EXT(op_fle);
 894
 895         /* o/p 1st seg */
 896         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 897         DPAA2_SET_FLE_OFFSET(sge, sym_op->cipher.data.offset + mbuf->data_off);
 898         sge->length = mbuf->data_len - sym_op->cipher.data.offset;
 899
 900         mbuf = mbuf->next;
 901         /* o/p segs */
 902         while (mbuf) {
 903                 sge++;
 904                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 905                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 906                 sge->length = mbuf->data_len;
 907                 mbuf = mbuf->next;
 908         }
 909         DPAA2_SET_FLE_FIN(sge);
 910
 911         DPAA2_SEC_DP_DEBUG(
 912                 "CIPHER SG: 1 - flc = %p, fle = %p FLEaddr = %x-%x, len %d\n",
 913                 flc, fle, fle->addr_hi, fle->addr_lo,
 914                 fle->length);
 915
 916         /* i/p fle */
 917         mbuf = sym_op->m_src;
 918         sge++;
 919         DPAA2_SET_FLE_ADDR(ip_fle, DPAA2_VADDR_TO_IOVA(sge));
 920         ip_fle->length = sess->iv.length + sym_op->cipher.data.length;
 921         DPAA2_SET_FLE_SG_EXT(ip_fle);
 922
 923         /* i/p IV */
 924         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(iv_ptr));
 925         DPAA2_SET_FLE_OFFSET(sge, 0);
 926         sge->length = sess->iv.length;
 927
 928         sge++;
 929
 930         /* i/p 1st seg */
 931         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 932         DPAA2_SET_FLE_OFFSET(sge, sym_op->cipher.data.offset +
 933                              mbuf->data_off);
 934         sge->length = mbuf->data_len - sym_op->cipher.data.offset;
 935
 936         mbuf = mbuf->next;
 937         /* i/p segs */
 938         while (mbuf) {
 939                 sge++;
 940                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 941                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 942                 sge->length = mbuf->data_len;
 943                 mbuf = mbuf->next;
 944         }
 945         DPAA2_SET_FLE_FIN(sge);
 946         DPAA2_SET_FLE_FIN(ip_fle);
 947
 948         /* sg fd */
 949         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(op_fle));
 950         DPAA2_SET_FD_LEN(fd, ip_fle->length);
 951         DPAA2_SET_FD_COMPOUND_FMT(fd);
 952         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 953
 954         DPAA2_SEC_DP_DEBUG(
 955                 "CIPHER SG: fdaddr =%" PRIx64 " bpid =%d meta =%d"
 956                 " off =%d, len =%d\n",
 957                 DPAA2_GET_FD_ADDR(fd),
 958                 DPAA2_GET_FD_BPID(fd),
 959                 rte_dpaa2_bpid_info[bpid].meta_data_size,
 960                 DPAA2_GET_FD_OFFSET(fd),
 961                 DPAA2_GET_FD_LEN(fd));
 962         return 0;
 963 }
 964
 965 static int
 966 build_cipher_fd(dpaa2_sec_session *sess, struct rte_crypto_op *op,
 967                 struct qbman_fd *fd, uint16_t bpid)
 968 {
 969         struct rte_crypto_sym_op *sym_op = op->sym;
 970         struct qbman_fle *fle, *sge;
 971         int retval;
 972         struct sec_flow_context *flc;
 973         struct ctxt_priv *priv = sess->ctxt;
 974         uint8_t *iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 975                         sess->iv.offset);
 976         struct rte_mbuf *dst;
 977
 978         PMD_INIT_FUNC_TRACE();
 979
 980         if (sym_op->m_dst)
 981                 dst = sym_op->m_dst;
 982         else
 983                 dst = sym_op->m_src;
 984
 985         retval = rte_mempool_get(priv->fle_pool, (void **)(&fle));
 986         if (retval) {
 987                 DPAA2_SEC_ERR("CIPHER: Memory alloc failed for SGE");
 988                 return -1;
 989         }
 990         memset(fle, 0, FLE_POOL_BUF_SIZE);
 991         /* TODO we are using the first FLE entry to store Mbuf.
 992          * Currently we donot know which FLE has the mbuf stored.
 993          * So while retreiving we can go back 1 FLE from the FD -ADDR
 994          * to get the MBUF Addr from the previous FLE.
 995          * We can have a better approach to use the inline Mbuf
 996          */
 997         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 998         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 999         fle = fle + 1;
1000         sge = fle + 2;
1001
1002         if (likely(bpid < MAX_BPID)) {
1003                 DPAA2_SET_FD_BPID(fd, bpid);
1004                 DPAA2_SET_FLE_BPID(fle, bpid);
1005                 DPAA2_SET_FLE_BPID(fle + 1, bpid);
1006                 DPAA2_SET_FLE_BPID(sge, bpid);
1007                 DPAA2_SET_FLE_BPID(sge + 1, bpid);
1008         } else {
1009                 DPAA2_SET_FD_IVP(fd);
1010                 DPAA2_SET_FLE_IVP(fle);
1011                 DPAA2_SET_FLE_IVP((fle + 1));
1012                 DPAA2_SET_FLE_IVP(sge);
1013                 DPAA2_SET_FLE_IVP((sge + 1));
1014         }
1015
1016         flc = &priv->flc_desc[0].flc;
1017         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(fle));
1018         DPAA2_SET_FD_LEN(fd, sym_op->cipher.data.length +
1019                          sess->iv.length);
1020         DPAA2_SET_FD_COMPOUND_FMT(fd);
1021         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
1022
1023         DPAA2_SEC_DP_DEBUG(
1024                 "CIPHER: cipher_off: 0x%x/length %d, ivlen=%d,"
1025                 " data_off: 0x%x\n",
1026                 sym_op->cipher.data.offset,
1027                 sym_op->cipher.data.length,
1028                 sess->iv.length,
1029                 sym_op->m_src->data_off);
1030
1031         DPAA2_SET_FLE_ADDR(fle, DPAA2_MBUF_VADDR_TO_IOVA(dst));
1032         DPAA2_SET_FLE_OFFSET(fle, sym_op->cipher.data.offset +
1033                              dst->data_off);
1034
1035         fle->length = sym_op->cipher.data.length + sess->iv.length;
1036
1037         DPAA2_SEC_DP_DEBUG(
1038                 "CIPHER: 1 - flc = %p, fle = %p FLEaddr = %x-%x, length %d\n",
1039                 flc, fle, fle->addr_hi, fle->addr_lo,
1040                 fle->length);
1041
1042         fle++;
1043
1044         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
1045         fle->length = sym_op->cipher.data.length + sess->iv.length;
1046
1047         DPAA2_SET_FLE_SG_EXT(fle);
1048
1049         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(iv_ptr));
1050         sge->length = sess->iv.length;
1051
1052         sge++;
1053         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
1054         DPAA2_SET_FLE_OFFSET(sge, sym_op->cipher.data.offset +
1055                              sym_op->m_src->data_off);
1056
1057         sge->length = sym_op->cipher.data.length;
1058         DPAA2_SET_FLE_FIN(sge);
1059         DPAA2_SET_FLE_FIN(fle);
1060
1061         DPAA2_SEC_DP_DEBUG(
1062                 "CIPHER: fdaddr =%" PRIx64 " bpid =%d meta =%d"
1063                 " off =%d, len =%d\n",
1064                 DPAA2_GET_FD_ADDR(fd),
1065                 DPAA2_GET_FD_BPID(fd),
1066                 rte_dpaa2_bpid_info[bpid].meta_data_size,
1067                 DPAA2_GET_FD_OFFSET(fd),
1068                 DPAA2_GET_FD_LEN(fd));
1069
1070         return 0;
1071 }
1072
1073 static inline int
1074 build_sec_fd(struct rte_crypto_op *op,
1075              struct qbman_fd *fd, uint16_t bpid)
1076 {
1077         int ret = -1;
1078         dpaa2_sec_session *sess;
1079
1080         PMD_INIT_FUNC_TRACE();
1081
1082         if (op->sess_type == RTE_CRYPTO_OP_WITH_SESSION)
1083                 sess = (dpaa2_sec_session *)get_session_private_data(
1084                                 op->sym->session, cryptodev_driver_id);
1085         else if (op->sess_type == RTE_CRYPTO_OP_SECURITY_SESSION)
1086                 sess = (dpaa2_sec_session *)get_sec_session_private_data(
1087                                 op->sym->sec_session);
1088         else
1089                 return -1;
1090
1091         /* Segmented buffer */
1092         if (unlikely(!rte_pktmbuf_is_contiguous(op->sym->m_src))) {
1093                 switch (sess->ctxt_type) {
1094                 case DPAA2_SEC_CIPHER:
1095                         ret = build_cipher_sg_fd(sess, op, fd, bpid);
1096                         break;
1097                 case DPAA2_SEC_AUTH:
1098                         ret = build_auth_sg_fd(sess, op, fd, bpid);
1099                         break;
1100                 case DPAA2_SEC_AEAD:
1101                         ret = build_authenc_gcm_sg_fd(sess, op, fd, bpid);
1102                         break;
1103                 case DPAA2_SEC_CIPHER_HASH:
1104                         ret = build_authenc_sg_fd(sess, op, fd, bpid);
1105                         break;
1106                 case DPAA2_SEC_HASH_CIPHER:
1107                 default:
1108                         DPAA2_SEC_ERR("error: Unsupported session");
1109                 }
1110         } else {
1111                 switch (sess->ctxt_type) {
1112                 case DPAA2_SEC_CIPHER:
1113                         ret = build_cipher_fd(sess, op, fd, bpid);
1114                         break;
1115                 case DPAA2_SEC_AUTH:
1116                         ret = build_auth_fd(sess, op, fd, bpid);
1117                         break;
1118                 case DPAA2_SEC_AEAD:
1119                         ret = build_authenc_gcm_fd(sess, op, fd, bpid);
1120                         break;
1121                 case DPAA2_SEC_CIPHER_HASH:
1122                         ret = build_authenc_fd(sess, op, fd, bpid);
1123                         break;
1124                 case DPAA2_SEC_IPSEC:
1125                         ret = build_proto_fd(sess, op, fd, bpid);
1126                         break;
1127                 case DPAA2_SEC_HASH_CIPHER:
1128                 default:
1129                         DPAA2_SEC_ERR("error: Unsupported session");
1130                 }
1131         }
1132         return ret;
1133 }
1134
1135 static uint16_t
1136 dpaa2_sec_enqueue_burst(void *qp, struct rte_crypto_op **ops,
1137                         uint16_t nb_ops)
1138 {
1139         /* Function to transmit the frames to given device and VQ*/
1140         uint32_t loop;
1141         int32_t ret;
1142         struct qbman_fd fd_arr[MAX_TX_RING_SLOTS];
1143         uint32_t frames_to_send;
1144         struct qbman_eq_desc eqdesc;
1145         struct dpaa2_sec_qp *dpaa2_qp = (struct dpaa2_sec_qp *)qp;
1146         struct qbman_swp *swp;
1147         uint16_t num_tx = 0;
1148         /*todo - need to support multiple buffer pools */
1149         uint16_t bpid;
1150         struct rte_mempool *mb_pool;
1151
1152         if (unlikely(nb_ops == 0))
1153                 return 0;
1154
1155         if (ops[0]->sess_type == RTE_CRYPTO_OP_SESSIONLESS) {
1156                 DPAA2_SEC_ERR("sessionless crypto op not supported");
1157                 return 0;
1158         }
1159         /*Prepare enqueue descriptor*/
1160         qbman_eq_desc_clear(&eqdesc);
1161         qbman_eq_desc_set_no_orp(&eqdesc, DPAA2_EQ_RESP_ERR_FQ);
1162         qbman_eq_desc_set_response(&eqdesc, 0, 0);
1163         qbman_eq_desc_set_fq(&eqdesc, dpaa2_qp->tx_vq.fqid);
1164
1165         if (!DPAA2_PER_LCORE_DPIO) {
1166                 ret = dpaa2_affine_qbman_swp();
1167                 if (ret) {
1168                         DPAA2_SEC_ERR("Failure in affining portal");
1169                         return 0;
1170                 }
1171         }
1172         swp = DPAA2_PER_LCORE_PORTAL;
1173
1174         while (nb_ops) {
1175                 frames_to_send = (nb_ops >> 3) ? MAX_TX_RING_SLOTS : nb_ops;
1176
1177                 for (loop = 0; loop < frames_to_send; loop++) {
1178                         /*Clear the unused FD fields before sending*/
1179                         memset(&fd_arr[loop], 0, sizeof(struct qbman_fd));
1180                         mb_pool = (*ops)->sym->m_src->pool;
1181                         bpid = mempool_to_bpid(mb_pool);
1182                         ret = build_sec_fd(*ops, &fd_arr[loop], bpid);
1183                         if (ret) {
1184                                 DPAA2_SEC_ERR("error: Improper packet contents"
1185                                               " for crypto operation");
1186                                 goto skip_tx;
1187                         }
1188                         ops++;
1189                 }
1190                 loop = 0;
1191                 while (loop < frames_to_send) {
1192                         loop += qbman_swp_enqueue_multiple(swp, &eqdesc,
1193                                                         &fd_arr[loop],
1194                                                         NULL,
1195                                                         frames_to_send - loop);
1196                 }
1197
1198                 num_tx += frames_to_send;
1199                 nb_ops -= frames_to_send;
1200         }
1201 skip_tx:
1202         dpaa2_qp->tx_vq.tx_pkts += num_tx;
1203         dpaa2_qp->tx_vq.err_pkts += nb_ops;
1204         return num_tx;
1205 }
1206
1207 static inline struct rte_crypto_op *
1208 sec_simple_fd_to_mbuf(const struct qbman_fd *fd, __rte_unused uint8_t id)
1209 {
1210         struct rte_crypto_op *op;
1211         uint16_t len = DPAA2_GET_FD_LEN(fd);
1212         uint16_t diff = 0;
1213         dpaa2_sec_session *sess_priv;
1214
1215         struct rte_mbuf *mbuf = DPAA2_INLINE_MBUF_FROM_BUF(
1216                 DPAA2_IOVA_TO_VADDR(DPAA2_GET_FD_ADDR(fd)),
1217                 rte_dpaa2_bpid_info[DPAA2_GET_FD_BPID(fd)].meta_data_size);
1218
1219         op = (struct rte_crypto_op *)(size_t)mbuf->buf_iova;
1220         mbuf->buf_iova = op->sym->aead.digest.phys_addr;
1221         op->sym->aead.digest.phys_addr = 0L;
1222
1223         sess_priv = (dpaa2_sec_session *)get_sec_session_private_data(
1224                                 op->sym->sec_session);
1225         if (sess_priv->dir == DIR_ENC)
1226                 mbuf->data_off += SEC_FLC_DHR_OUTBOUND;
1227         else
1228                 mbuf->data_off += SEC_FLC_DHR_INBOUND;
1229         diff = len - mbuf->pkt_len;
1230         mbuf->pkt_len += diff;
1231         mbuf->data_len += diff;
1232
1233         return op;
1234 }
1235
1236 static inline struct rte_crypto_op *
1237 sec_fd_to_mbuf(const struct qbman_fd *fd, uint8_t driver_id)
1238 {
1239         struct qbman_fle *fle;
1240         struct rte_crypto_op *op;
1241         struct ctxt_priv *priv;
1242         struct rte_mbuf *dst, *src;
1243
1244         if (DPAA2_FD_GET_FORMAT(fd) == qbman_fd_single)
1245                 return sec_simple_fd_to_mbuf(fd, driver_id);
1246
1247         fle = (struct qbman_fle *)DPAA2_IOVA_TO_VADDR(DPAA2_GET_FD_ADDR(fd));
1248
1249         DPAA2_SEC_DP_DEBUG("FLE addr = %x - %x, offset = %x\n",
1250                            fle->addr_hi, fle->addr_lo, fle->fin_bpid_offset);
1251
1252         /* we are using the first FLE entry to store Mbuf.
1253          * Currently we donot know which FLE has the mbuf stored.
1254          * So while retreiving we can go back 1 FLE from the FD -ADDR
1255          * to get the MBUF Addr from the previous FLE.
1256          * We can have a better approach to use the inline Mbuf
1257          */
1258
1259         if (unlikely(DPAA2_GET_FD_IVP(fd))) {
1260                 /* TODO complete it. */
1261                 DPAA2_SEC_ERR("error: non inline buffer");
1262                 return NULL;
1263         }
1264         op = (struct rte_crypto_op *)DPAA2_IOVA_TO_VADDR(
1265                         DPAA2_GET_FLE_ADDR((fle - 1)));
1266
1267         /* Prefeth op */
1268         src = op->sym->m_src;
1269         rte_prefetch0(src);
1270
1271         if (op->sym->m_dst) {
1272                 dst = op->sym->m_dst;
1273                 rte_prefetch0(dst);
1274         } else
1275                 dst = src;
1276
1277         DPAA2_SEC_DP_DEBUG("mbuf %p BMAN buf addr %p,"
1278                 " fdaddr =%" PRIx64 " bpid =%d meta =%d off =%d, len =%d\n",
1279                 (void *)dst,
1280                 dst->buf_addr,
1281                 DPAA2_GET_FD_ADDR(fd),
1282                 DPAA2_GET_FD_BPID(fd),
1283                 rte_dpaa2_bpid_info[DPAA2_GET_FD_BPID(fd)].meta_data_size,
1284                 DPAA2_GET_FD_OFFSET(fd),
1285                 DPAA2_GET_FD_LEN(fd));
1286
1287         /* free the fle memory */
1288         if (likely(rte_pktmbuf_is_contiguous(src))) {
1289                 priv = (struct ctxt_priv *)(size_t)DPAA2_GET_FLE_CTXT(fle - 1);
1290                 rte_mempool_put(priv->fle_pool, (void *)(fle-1));
1291         } else
1292                 rte_free((void *)(fle-1));
1293
1294         return op;
1295 }
1296
1297 static uint16_t
1298 dpaa2_sec_dequeue_burst(void *qp, struct rte_crypto_op **ops,
1299                         uint16_t nb_ops)
1300 {
1301         /* Function is responsible to receive frames for a given device and VQ*/
1302         struct dpaa2_sec_qp *dpaa2_qp = (struct dpaa2_sec_qp *)qp;
1303         struct rte_cryptodev *dev =
1304                         (struct rte_cryptodev *)(dpaa2_qp->rx_vq.dev);
1305         struct qbman_result *dq_storage;
1306         uint32_t fqid = dpaa2_qp->rx_vq.fqid;
1307         int ret, num_rx = 0;
1308         uint8_t is_last = 0, status;
1309         struct qbman_swp *swp;
1310         const struct qbman_fd *fd;
1311         struct qbman_pull_desc pulldesc;
1312
1313         if (!DPAA2_PER_LCORE_DPIO) {
1314                 ret = dpaa2_affine_qbman_swp();
1315                 if (ret) {
1316                         DPAA2_SEC_ERR("Failure in affining portal");
1317                         return 0;
1318                 }
1319         }
1320         swp = DPAA2_PER_LCORE_PORTAL;
1321         dq_storage = dpaa2_qp->rx_vq.q_storage->dq_storage[0];
1322
1323         qbman_pull_desc_clear(&pulldesc);
1324         qbman_pull_desc_set_numframes(&pulldesc,
1325                                       (nb_ops > DPAA2_DQRR_RING_SIZE) ?
1326                                       DPAA2_DQRR_RING_SIZE : nb_ops);
1327         qbman_pull_desc_set_fq(&pulldesc, fqid);
1328         qbman_pull_desc_set_storage(&pulldesc, dq_storage,
1329                                     (dma_addr_t)DPAA2_VADDR_TO_IOVA(dq_storage),
1330                                     1);
1331
1332         /*Issue a volatile dequeue command. */
1333         while (1) {
1334                 if (qbman_swp_pull(swp, &pulldesc)) {
1335                         DPAA2_SEC_WARN(
1336                                 "SEC VDQ command is not issued : QBMAN busy");
1337                         /* Portal was busy, try again */
1338                         continue;
1339                 }
1340                 break;
1341         };
1342
1343         /* Receive the packets till Last Dequeue entry is found with
1344          * respect to the above issues PULL command.
1345          */
1346         while (!is_last) {
1347                 /* Check if the previous issued command is completed.
1348                  * Also seems like the SWP is shared between the Ethernet Driver
1349                  * and the SEC driver.
1350                  */
1351                 while (!qbman_check_command_complete(dq_storage))
1352                         ;
1353
1354                 /* Loop until the dq_storage is updated with
1355                  * new token by QBMAN
1356                  */
1357                 while (!qbman_check_new_result(dq_storage))
1358                         ;
1359                 /* Check whether Last Pull command is Expired and
1360                  * setting Condition for Loop termination
1361                  */
1362                 if (qbman_result_DQ_is_pull_complete(dq_storage)) {
1363                         is_last = 1;
1364                         /* Check for valid frame. */
1365                         status = (uint8_t)qbman_result_DQ_flags(dq_storage);
1366                         if (unlikely(
1367                                 (status & QBMAN_DQ_STAT_VALIDFRAME) == 0)) {
1368                                 DPAA2_SEC_DP_DEBUG("No frame is delivered\n");
1369                                 continue;
1370                         }
1371                 }
1372
1373                 fd = qbman_result_DQ_fd(dq_storage);
1374                 ops[num_rx] = sec_fd_to_mbuf(fd, dev->driver_id);
1375
1376                 if (unlikely(fd->simple.frc)) {
1377                         /* TODO Parse SEC errors */
1378                         DPAA2_SEC_ERR("SEC returned Error - %x",
1379                                       fd->simple.frc);
1380                         ops[num_rx]->status = RTE_CRYPTO_OP_STATUS_ERROR;
1381                 } else {
1382                         ops[num_rx]->status = RTE_CRYPTO_OP_STATUS_SUCCESS;
1383                 }
1384
1385                 num_rx++;
1386                 dq_storage++;
1387         } /* End of Packet Rx loop */
1388
1389         dpaa2_qp->rx_vq.rx_pkts += num_rx;
1390
1391         DPAA2_SEC_DP_DEBUG("SEC Received %d Packets\n", num_rx);
1392         /*Return the total number of packets received to DPAA2 app*/
1393         return num_rx;
1394 }
1395
1396 /** Release queue pair */
1397 static int
1398 dpaa2_sec_queue_pair_release(struct rte_cryptodev *dev, uint16_t queue_pair_id)
1399 {
1400         struct dpaa2_sec_qp *qp =
1401                 (struct dpaa2_sec_qp *)dev->data->queue_pairs[queue_pair_id];
1402
1403         PMD_INIT_FUNC_TRACE();
1404
1405         if (qp->rx_vq.q_storage) {
1406                 dpaa2_free_dq_storage(qp->rx_vq.q_storage);
1407                 rte_free(qp->rx_vq.q_storage);
1408         }
1409         rte_free(qp);
1410
1411         dev->data->queue_pairs[queue_pair_id] = NULL;
1412
1413         return 0;
1414 }
1415
1416 /** Setup a queue pair */
1417 static int
1418 dpaa2_sec_queue_pair_setup(struct rte_cryptodev *dev, uint16_t qp_id,
1419                 __rte_unused const struct rte_cryptodev_qp_conf *qp_conf,
1420                 __rte_unused int socket_id,
1421                 __rte_unused struct rte_mempool *session_pool)
1422 {
1423         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
1424         struct dpaa2_sec_qp *qp;
1425         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
1426         struct dpseci_rx_queue_cfg cfg;
1427         int32_t retcode;
1428
1429         PMD_INIT_FUNC_TRACE();
1430
1431         /* If qp is already in use free ring memory and qp metadata. */
1432         if (dev->data->queue_pairs[qp_id] != NULL) {
1433                 DPAA2_SEC_INFO("QP already setup");
1434                 return 0;
1435         }
1436
1437         DPAA2_SEC_DEBUG("dev =%p, queue =%d, conf =%p",
1438                     dev, qp_id, qp_conf);
1439
1440         memset(&cfg, 0, sizeof(struct dpseci_rx_queue_cfg));
1441
1442         qp = rte_malloc(NULL, sizeof(struct dpaa2_sec_qp),
1443                         RTE_CACHE_LINE_SIZE);
1444         if (!qp) {
1445                 DPAA2_SEC_ERR("malloc failed for rx/tx queues");
1446                 return -1;
1447         }
1448
1449         qp->rx_vq.dev = dev;
1450         qp->tx_vq.dev = dev;
1451         qp->rx_vq.q_storage = rte_malloc("sec dq storage",
1452                 sizeof(struct queue_storage_info_t),
1453                 RTE_CACHE_LINE_SIZE);
1454         if (!qp->rx_vq.q_storage) {
1455                 DPAA2_SEC_ERR("malloc failed for q_storage");
1456                 return -1;
1457         }
1458         memset(qp->rx_vq.q_storage, 0, sizeof(struct queue_storage_info_t));
1459
1460         if (dpaa2_alloc_dq_storage(qp->rx_vq.q_storage)) {
1461                 DPAA2_SEC_ERR("Unable to allocate dequeue storage");
1462                 return -1;
1463         }
1464
1465         dev->data->queue_pairs[qp_id] = qp;
1466
1467         cfg.options = cfg.options | DPSECI_QUEUE_OPT_USER_CTX;
1468         cfg.user_ctx = (size_t)(&qp->rx_vq);
1469         retcode = dpseci_set_rx_queue(dpseci, CMD_PRI_LOW, priv->token,
1470                                       qp_id, &cfg);
1471         return retcode;
1472 }
1473
1474 /** Start queue pair */
1475 static int
1476 dpaa2_sec_queue_pair_start(__rte_unused struct rte_cryptodev *dev,
1477                            __rte_unused uint16_t queue_pair_id)
1478 {
1479         PMD_INIT_FUNC_TRACE();
1480
1481         return 0;
1482 }
1483
1484 /** Stop queue pair */
1485 static int
1486 dpaa2_sec_queue_pair_stop(__rte_unused struct rte_cryptodev *dev,
1487                           __rte_unused uint16_t queue_pair_id)
1488 {
1489         PMD_INIT_FUNC_TRACE();
1490
1491         return 0;
1492 }
1493
1494 /** Return the number of allocated queue pairs */
1495 static uint32_t
1496 dpaa2_sec_queue_pair_count(struct rte_cryptodev *dev)
1497 {
1498         PMD_INIT_FUNC_TRACE();
1499
1500         return dev->data->nb_queue_pairs;
1501 }
1502
1503 /** Returns the size of the aesni gcm session structure */
1504 static unsigned int
1505 dpaa2_sec_session_get_size(struct rte_cryptodev *dev __rte_unused)
1506 {
1507         PMD_INIT_FUNC_TRACE();
1508
1509         return sizeof(dpaa2_sec_session);
1510 }
1511
1512 static int
1513 dpaa2_sec_cipher_init(struct rte_cryptodev *dev,
1514                       struct rte_crypto_sym_xform *xform,
1515                       dpaa2_sec_session *session)
1516 {
1517         struct dpaa2_sec_dev_private *dev_priv = dev->data->dev_private;
1518         struct alginfo cipherdata;
1519         int bufsize, i;
1520         struct ctxt_priv *priv;
1521         struct sec_flow_context *flc;
1522
1523         PMD_INIT_FUNC_TRACE();
1524
1525         /* For SEC CIPHER only one descriptor is required. */
1526         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
1527                         sizeof(struct ctxt_priv) + sizeof(struct sec_flc_desc),
1528                         RTE_CACHE_LINE_SIZE);
1529         if (priv == NULL) {
1530                 DPAA2_SEC_ERR("No Memory for priv CTXT");
1531                 return -1;
1532         }
1533
1534         priv->fle_pool = dev_priv->fle_pool;
1535
1536         flc = &priv->flc_desc[0].flc;
1537
1538         session->cipher_key.data = rte_zmalloc(NULL, xform->cipher.key.length,
1539                         RTE_CACHE_LINE_SIZE);
1540         if (session->cipher_key.data == NULL) {
1541                 DPAA2_SEC_ERR("No Memory for cipher key");
1542                 rte_free(priv);
1543                 return -1;
1544         }
1545         session->cipher_key.length = xform->cipher.key.length;
1546
1547         memcpy(session->cipher_key.data, xform->cipher.key.data,
1548                xform->cipher.key.length);
1549         cipherdata.key = (size_t)session->cipher_key.data;
1550         cipherdata.keylen = session->cipher_key.length;
1551         cipherdata.key_enc_flags = 0;
1552         cipherdata.key_type = RTA_DATA_IMM;
1553
1554         /* Set IV parameters */
1555         session->iv.offset = xform->cipher.iv.offset;
1556         session->iv.length = xform->cipher.iv.length;
1557
1558         switch (xform->cipher.algo) {
1559         case RTE_CRYPTO_CIPHER_AES_CBC:
1560                 cipherdata.algtype = OP_ALG_ALGSEL_AES;
1561                 cipherdata.algmode = OP_ALG_AAI_CBC;
1562                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CBC;
1563                 break;
1564         case RTE_CRYPTO_CIPHER_3DES_CBC:
1565                 cipherdata.algtype = OP_ALG_ALGSEL_3DES;
1566                 cipherdata.algmode = OP_ALG_AAI_CBC;
1567                 session->cipher_alg = RTE_CRYPTO_CIPHER_3DES_CBC;
1568                 break;
1569         case RTE_CRYPTO_CIPHER_AES_CTR:
1570                 cipherdata.algtype = OP_ALG_ALGSEL_AES;
1571                 cipherdata.algmode = OP_ALG_AAI_CTR;
1572                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CTR;
1573                 break;
1574         case RTE_CRYPTO_CIPHER_3DES_CTR:
1575         case RTE_CRYPTO_CIPHER_AES_ECB:
1576         case RTE_CRYPTO_CIPHER_3DES_ECB:
1577         case RTE_CRYPTO_CIPHER_AES_XTS:
1578         case RTE_CRYPTO_CIPHER_AES_F8:
1579         case RTE_CRYPTO_CIPHER_ARC4:
1580         case RTE_CRYPTO_CIPHER_KASUMI_F8:
1581         case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
1582         case RTE_CRYPTO_CIPHER_ZUC_EEA3:
1583         case RTE_CRYPTO_CIPHER_NULL:
1584                 DPAA2_SEC_ERR("Crypto: Unsupported Cipher alg %u",
1585                         xform->cipher.algo);
1586                 goto error_out;
1587         default:
1588                 DPAA2_SEC_ERR("Crypto: Undefined Cipher specified %u",
1589                         xform->cipher.algo);
1590                 goto error_out;
1591         }
1592         session->dir = (xform->cipher.op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
1593                                 DIR_ENC : DIR_DEC;
1594
1595         bufsize = cnstr_shdsc_blkcipher(priv->flc_desc[0].desc, 1, 0,
1596                                         &cipherdata, NULL, session->iv.length,
1597                                         session->dir);
1598         if (bufsize < 0) {
1599                 DPAA2_SEC_ERR("Crypto: Descriptor build failed");
1600                 goto error_out;
1601         }
1602         flc->dhr = 0;
1603         flc->bpv0 = 0x1;
1604         flc->mode_bits = 0x8000;
1605
1606         flc->word1_sdl = (uint8_t)bufsize;
1607         flc->word2_rflc_31_0 = lower_32_bits(
1608                         (size_t)&(((struct dpaa2_sec_qp *)
1609                         dev->data->queue_pairs[0])->rx_vq));
1610         flc->word3_rflc_63_32 = upper_32_bits(
1611                         (size_t)&(((struct dpaa2_sec_qp *)
1612                         dev->data->queue_pairs[0])->rx_vq));
1613         session->ctxt = priv;
1614
1615         for (i = 0; i < bufsize; i++)
1616                 DPAA2_SEC_DEBUG("DESC[%d]:0x%x", i, priv->flc_desc[0].desc[i]);
1617
1618         return 0;
1619
1620 error_out:
1621         rte_free(session->cipher_key.data);
1622         rte_free(priv);
1623         return -1;
1624 }
1625
1626 static int
1627 dpaa2_sec_auth_init(struct rte_cryptodev *dev,
1628                     struct rte_crypto_sym_xform *xform,
1629                     dpaa2_sec_session *session)
1630 {
1631         struct dpaa2_sec_dev_private *dev_priv = dev->data->dev_private;
1632         struct alginfo authdata;
1633         int bufsize, i;
1634         struct ctxt_priv *priv;
1635         struct sec_flow_context *flc;
1636
1637         PMD_INIT_FUNC_TRACE();
1638
1639         /* For SEC AUTH three descriptors are required for various stages */
1640         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
1641                         sizeof(struct ctxt_priv) + 3 *
1642                         sizeof(struct sec_flc_desc),
1643                         RTE_CACHE_LINE_SIZE);
1644         if (priv == NULL) {
1645                 DPAA2_SEC_ERR("No Memory for priv CTXT");
1646                 return -1;
1647         }
1648
1649         priv->fle_pool = dev_priv->fle_pool;
1650         flc = &priv->flc_desc[DESC_INITFINAL].flc;
1651
1652         session->auth_key.data = rte_zmalloc(NULL, xform->auth.key.length,
1653                         RTE_CACHE_LINE_SIZE);
1654         if (session->auth_key.data == NULL) {
1655                 DPAA2_SEC_ERR("Unable to allocate memory for auth key");
1656                 rte_free(priv);
1657                 return -1;
1658         }
1659         session->auth_key.length = xform->auth.key.length;
1660
1661         memcpy(session->auth_key.data, xform->auth.key.data,
1662                xform->auth.key.length);
1663         authdata.key = (size_t)session->auth_key.data;
1664         authdata.keylen = session->auth_key.length;
1665         authdata.key_enc_flags = 0;
1666         authdata.key_type = RTA_DATA_IMM;
1667
1668         session->digest_length = xform->auth.digest_length;
1669
1670         switch (xform->auth.algo) {
1671         case RTE_CRYPTO_AUTH_SHA1_HMAC:
1672                 authdata.algtype = OP_ALG_ALGSEL_SHA1;
1673                 authdata.algmode = OP_ALG_AAI_HMAC;
1674                 session->auth_alg = RTE_CRYPTO_AUTH_SHA1_HMAC;
1675                 break;
1676         case RTE_CRYPTO_AUTH_MD5_HMAC:
1677                 authdata.algtype = OP_ALG_ALGSEL_MD5;
1678                 authdata.algmode = OP_ALG_AAI_HMAC;
1679                 session->auth_alg = RTE_CRYPTO_AUTH_MD5_HMAC;
1680                 break;
1681         case RTE_CRYPTO_AUTH_SHA256_HMAC:
1682                 authdata.algtype = OP_ALG_ALGSEL_SHA256;
1683                 authdata.algmode = OP_ALG_AAI_HMAC;
1684                 session->auth_alg = RTE_CRYPTO_AUTH_SHA256_HMAC;
1685                 break;
1686         case RTE_CRYPTO_AUTH_SHA384_HMAC:
1687                 authdata.algtype = OP_ALG_ALGSEL_SHA384;
1688                 authdata.algmode = OP_ALG_AAI_HMAC;
1689                 session->auth_alg = RTE_CRYPTO_AUTH_SHA384_HMAC;
1690                 break;
1691         case RTE_CRYPTO_AUTH_SHA512_HMAC:
1692                 authdata.algtype = OP_ALG_ALGSEL_SHA512;
1693                 authdata.algmode = OP_ALG_AAI_HMAC;
1694                 session->auth_alg = RTE_CRYPTO_AUTH_SHA512_HMAC;
1695                 break;
1696         case RTE_CRYPTO_AUTH_SHA224_HMAC:
1697                 authdata.algtype = OP_ALG_ALGSEL_SHA224;
1698                 authdata.algmode = OP_ALG_AAI_HMAC;
1699                 session->auth_alg = RTE_CRYPTO_AUTH_SHA224_HMAC;
1700                 break;
1701         case RTE_CRYPTO_AUTH_AES_XCBC_MAC:
1702         case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
1703         case RTE_CRYPTO_AUTH_NULL:
1704         case RTE_CRYPTO_AUTH_SHA1:
1705         case RTE_CRYPTO_AUTH_SHA256:
1706         case RTE_CRYPTO_AUTH_SHA512:
1707         case RTE_CRYPTO_AUTH_SHA224:
1708         case RTE_CRYPTO_AUTH_SHA384:
1709         case RTE_CRYPTO_AUTH_MD5:
1710         case RTE_CRYPTO_AUTH_AES_GMAC:
1711         case RTE_CRYPTO_AUTH_KASUMI_F9:
1712         case RTE_CRYPTO_AUTH_AES_CMAC:
1713         case RTE_CRYPTO_AUTH_AES_CBC_MAC:
1714         case RTE_CRYPTO_AUTH_ZUC_EIA3:
1715                 DPAA2_SEC_ERR("Crypto: Unsupported auth alg %un",
1716                               xform->auth.algo);
1717                 goto error_out;
1718         default:
1719                 DPAA2_SEC_ERR("Crypto: Undefined Auth specified %u",
1720                               xform->auth.algo);
1721                 goto error_out;
1722         }
1723         session->dir = (xform->auth.op == RTE_CRYPTO_AUTH_OP_GENERATE) ?
1724                                 DIR_ENC : DIR_DEC;
1725
1726         bufsize = cnstr_shdsc_hmac(priv->flc_desc[DESC_INITFINAL].desc,
1727                                    1, 0, &authdata, !session->dir,
1728                                    session->digest_length);
1729         if (bufsize < 0) {
1730                 DPAA2_SEC_ERR("Crypto: Invalid buffer length");
1731                 goto error_out;
1732         }
1733
1734         flc->word1_sdl = (uint8_t)bufsize;
1735         flc->word2_rflc_31_0 = lower_32_bits(
1736                         (size_t)&(((struct dpaa2_sec_qp *)
1737                         dev->data->queue_pairs[0])->rx_vq));
1738         flc->word3_rflc_63_32 = upper_32_bits(
1739                         (size_t)&(((struct dpaa2_sec_qp *)
1740                         dev->data->queue_pairs[0])->rx_vq));
1741         session->ctxt = priv;
1742         for (i = 0; i < bufsize; i++)
1743                 DPAA2_SEC_DEBUG("DESC[%d]:0x%x",
1744                                 i, priv->flc_desc[DESC_INITFINAL].desc[i]);
1745
1746
1747         return 0;
1748
1749 error_out:
1750         rte_free(session->auth_key.data);
1751         rte_free(priv);
1752         return -1;
1753 }
1754
1755 static int
1756 dpaa2_sec_aead_init(struct rte_cryptodev *dev,
1757                     struct rte_crypto_sym_xform *xform,
1758                     dpaa2_sec_session *session)
1759 {
1760         struct dpaa2_sec_aead_ctxt *ctxt = &session->ext_params.aead_ctxt;
1761         struct dpaa2_sec_dev_private *dev_priv = dev->data->dev_private;
1762         struct alginfo aeaddata;
1763         int bufsize, i;
1764         struct ctxt_priv *priv;
1765         struct sec_flow_context *flc;
1766         struct rte_crypto_aead_xform *aead_xform = &xform->aead;
1767         int err;
1768
1769         PMD_INIT_FUNC_TRACE();
1770
1771         /* Set IV parameters */
1772         session->iv.offset = aead_xform->iv.offset;
1773         session->iv.length = aead_xform->iv.length;
1774         session->ctxt_type = DPAA2_SEC_AEAD;
1775
1776         /* For SEC AEAD only one descriptor is required */
1777         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
1778                         sizeof(struct ctxt_priv) + sizeof(struct sec_flc_desc),
1779                         RTE_CACHE_LINE_SIZE);
1780         if (priv == NULL) {
1781                 DPAA2_SEC_ERR("No Memory for priv CTXT");
1782                 return -1;
1783         }
1784
1785         priv->fle_pool = dev_priv->fle_pool;
1786         flc = &priv->flc_desc[0].flc;
1787
1788         session->aead_key.data = rte_zmalloc(NULL, aead_xform->key.length,
1789                                                RTE_CACHE_LINE_SIZE);
1790         if (session->aead_key.data == NULL && aead_xform->key.length > 0) {
1791                 DPAA2_SEC_ERR("No Memory for aead key");
1792                 rte_free(priv);
1793                 return -1;
1794         }
1795         memcpy(session->aead_key.data, aead_xform->key.data,
1796                aead_xform->key.length);
1797
1798         session->digest_length = aead_xform->digest_length;
1799         session->aead_key.length = aead_xform->key.length;
1800         ctxt->auth_only_len = aead_xform->aad_length;
1801
1802         aeaddata.key = (size_t)session->aead_key.data;
1803         aeaddata.keylen = session->aead_key.length;
1804         aeaddata.key_enc_flags = 0;
1805         aeaddata.key_type = RTA_DATA_IMM;
1806
1807         switch (aead_xform->algo) {
1808         case RTE_CRYPTO_AEAD_AES_GCM:
1809                 aeaddata.algtype = OP_ALG_ALGSEL_AES;
1810                 aeaddata.algmode = OP_ALG_AAI_GCM;
1811                 session->aead_alg = RTE_CRYPTO_AEAD_AES_GCM;
1812                 break;
1813         case RTE_CRYPTO_AEAD_AES_CCM:
1814                 DPAA2_SEC_ERR("Crypto: Unsupported AEAD alg %u",
1815                               aead_xform->algo);
1816                 goto error_out;
1817         default:
1818                 DPAA2_SEC_ERR("Crypto: Undefined AEAD specified %u",
1819                               aead_xform->algo);
1820                 goto error_out;
1821         }
1822         session->dir = (aead_xform->op == RTE_CRYPTO_AEAD_OP_ENCRYPT) ?
1823                                 DIR_ENC : DIR_DEC;
1824
1825         priv->flc_desc[0].desc[0] = aeaddata.keylen;
1826         err = rta_inline_query(IPSEC_AUTH_VAR_AES_DEC_BASE_DESC_LEN,
1827                                MIN_JOB_DESC_SIZE,
1828                                (unsigned int *)priv->flc_desc[0].desc,
1829                                &priv->flc_desc[0].desc[1], 1);
1830
1831         if (err < 0) {
1832                 DPAA2_SEC_ERR("Crypto: Incorrect key lengths");
1833                 goto error_out;
1834         }
1835         if (priv->flc_desc[0].desc[1] & 1) {
1836                 aeaddata.key_type = RTA_DATA_IMM;
1837         } else {
1838                 aeaddata.key = DPAA2_VADDR_TO_IOVA(aeaddata.key);
1839                 aeaddata.key_type = RTA_DATA_PTR;
1840         }
1841         priv->flc_desc[0].desc[0] = 0;
1842         priv->flc_desc[0].desc[1] = 0;
1843
1844         if (session->dir == DIR_ENC)
1845                 bufsize = cnstr_shdsc_gcm_encap(
1846                                 priv->flc_desc[0].desc, 1, 0,
1847                                 &aeaddata, session->iv.length,
1848                                 session->digest_length);
1849         else
1850                 bufsize = cnstr_shdsc_gcm_decap(
1851                                 priv->flc_desc[0].desc, 1, 0,
1852                                 &aeaddata, session->iv.length,
1853                                 session->digest_length);
1854         if (bufsize < 0) {
1855                 DPAA2_SEC_ERR("Crypto: Invalid buffer length");
1856                 goto error_out;
1857         }
1858
1859         flc->word1_sdl = (uint8_t)bufsize;
1860         flc->word2_rflc_31_0 = lower_32_bits(
1861                         (size_t)&(((struct dpaa2_sec_qp *)
1862                         dev->data->queue_pairs[0])->rx_vq));
1863         flc->word3_rflc_63_32 = upper_32_bits(
1864                         (size_t)&(((struct dpaa2_sec_qp *)
1865                         dev->data->queue_pairs[0])->rx_vq));
1866         session->ctxt = priv;
1867         for (i = 0; i < bufsize; i++)
1868                 DPAA2_SEC_DEBUG("DESC[%d]:0x%x\n",
1869                             i, priv->flc_desc[0].desc[i]);
1870
1871         return 0;
1872
1873 error_out:
1874         rte_free(session->aead_key.data);
1875         rte_free(priv);
1876         return -1;
1877 }
1878
1879
1880 static int
1881 dpaa2_sec_aead_chain_init(struct rte_cryptodev *dev,
1882                     struct rte_crypto_sym_xform *xform,
1883                     dpaa2_sec_session *session)
1884 {
1885         struct dpaa2_sec_aead_ctxt *ctxt = &session->ext_params.aead_ctxt;
1886         struct dpaa2_sec_dev_private *dev_priv = dev->data->dev_private;
1887         struct alginfo authdata, cipherdata;
1888         int bufsize, i;
1889         struct ctxt_priv *priv;
1890         struct sec_flow_context *flc;
1891         struct rte_crypto_cipher_xform *cipher_xform;
1892         struct rte_crypto_auth_xform *auth_xform;
1893         int err;
1894
1895         PMD_INIT_FUNC_TRACE();
1896
1897         if (session->ext_params.aead_ctxt.auth_cipher_text) {
1898                 cipher_xform = &xform->cipher;
1899                 auth_xform = &xform->next->auth;
1900                 session->ctxt_type =
1901                         (cipher_xform->op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
1902                         DPAA2_SEC_CIPHER_HASH : DPAA2_SEC_HASH_CIPHER;
1903         } else {
1904                 cipher_xform = &xform->next->cipher;
1905                 auth_xform = &xform->auth;
1906                 session->ctxt_type =
1907                         (cipher_xform->op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
1908                         DPAA2_SEC_HASH_CIPHER : DPAA2_SEC_CIPHER_HASH;
1909         }
1910
1911         /* Set IV parameters */
1912         session->iv.offset = cipher_xform->iv.offset;
1913         session->iv.length = cipher_xform->iv.length;
1914
1915         /* For SEC AEAD only one descriptor is required */
1916         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
1917                         sizeof(struct ctxt_priv) + sizeof(struct sec_flc_desc),
1918                         RTE_CACHE_LINE_SIZE);
1919         if (priv == NULL) {
1920                 DPAA2_SEC_ERR("No Memory for priv CTXT");
1921                 return -1;
1922         }
1923
1924         priv->fle_pool = dev_priv->fle_pool;
1925         flc = &priv->flc_desc[0].flc;
1926
1927         session->cipher_key.data = rte_zmalloc(NULL, cipher_xform->key.length,
1928                                                RTE_CACHE_LINE_SIZE);
1929         if (session->cipher_key.data == NULL && cipher_xform->key.length > 0) {
1930                 DPAA2_SEC_ERR("No Memory for cipher key");
1931                 rte_free(priv);
1932                 return -1;
1933         }
1934         session->cipher_key.length = cipher_xform->key.length;
1935         session->auth_key.data = rte_zmalloc(NULL, auth_xform->key.length,
1936                                              RTE_CACHE_LINE_SIZE);
1937         if (session->auth_key.data == NULL && auth_xform->key.length > 0) {
1938                 DPAA2_SEC_ERR("No Memory for auth key");
1939                 rte_free(session->cipher_key.data);
1940                 rte_free(priv);
1941                 return -1;
1942         }
1943         session->auth_key.length = auth_xform->key.length;
1944         memcpy(session->cipher_key.data, cipher_xform->key.data,
1945                cipher_xform->key.length);
1946         memcpy(session->auth_key.data, auth_xform->key.data,
1947                auth_xform->key.length);
1948
1949         authdata.key = (size_t)session->auth_key.data;
1950         authdata.keylen = session->auth_key.length;
1951         authdata.key_enc_flags = 0;
1952         authdata.key_type = RTA_DATA_IMM;
1953
1954         session->digest_length = auth_xform->digest_length;
1955
1956         switch (auth_xform->algo) {
1957         case RTE_CRYPTO_AUTH_SHA1_HMAC:
1958                 authdata.algtype = OP_ALG_ALGSEL_SHA1;
1959                 authdata.algmode = OP_ALG_AAI_HMAC;
1960                 session->auth_alg = RTE_CRYPTO_AUTH_SHA1_HMAC;
1961                 break;
1962         case RTE_CRYPTO_AUTH_MD5_HMAC:
1963                 authdata.algtype = OP_ALG_ALGSEL_MD5;
1964                 authdata.algmode = OP_ALG_AAI_HMAC;
1965                 session->auth_alg = RTE_CRYPTO_AUTH_MD5_HMAC;
1966                 break;
1967         case RTE_CRYPTO_AUTH_SHA224_HMAC:
1968                 authdata.algtype = OP_ALG_ALGSEL_SHA224;
1969                 authdata.algmode = OP_ALG_AAI_HMAC;
1970                 session->auth_alg = RTE_CRYPTO_AUTH_SHA224_HMAC;
1971                 break;
1972         case RTE_CRYPTO_AUTH_SHA256_HMAC:
1973                 authdata.algtype = OP_ALG_ALGSEL_SHA256;
1974                 authdata.algmode = OP_ALG_AAI_HMAC;
1975                 session->auth_alg = RTE_CRYPTO_AUTH_SHA256_HMAC;
1976                 break;
1977         case RTE_CRYPTO_AUTH_SHA384_HMAC:
1978                 authdata.algtype = OP_ALG_ALGSEL_SHA384;
1979                 authdata.algmode = OP_ALG_AAI_HMAC;
1980                 session->auth_alg = RTE_CRYPTO_AUTH_SHA384_HMAC;
1981                 break;
1982         case RTE_CRYPTO_AUTH_SHA512_HMAC:
1983                 authdata.algtype = OP_ALG_ALGSEL_SHA512;
1984                 authdata.algmode = OP_ALG_AAI_HMAC;
1985                 session->auth_alg = RTE_CRYPTO_AUTH_SHA512_HMAC;
1986                 break;
1987         case RTE_CRYPTO_AUTH_AES_XCBC_MAC:
1988         case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
1989         case RTE_CRYPTO_AUTH_NULL:
1990         case RTE_CRYPTO_AUTH_SHA1:
1991         case RTE_CRYPTO_AUTH_SHA256:
1992         case RTE_CRYPTO_AUTH_SHA512:
1993         case RTE_CRYPTO_AUTH_SHA224:
1994         case RTE_CRYPTO_AUTH_SHA384:
1995         case RTE_CRYPTO_AUTH_MD5:
1996         case RTE_CRYPTO_AUTH_AES_GMAC:
1997         case RTE_CRYPTO_AUTH_KASUMI_F9:
1998         case RTE_CRYPTO_AUTH_AES_CMAC:
1999         case RTE_CRYPTO_AUTH_AES_CBC_MAC:
2000         case RTE_CRYPTO_AUTH_ZUC_EIA3:
2001                 DPAA2_SEC_ERR("Crypto: Unsupported auth alg %u",
2002                               auth_xform->algo);
2003                 goto error_out;
2004         default:
2005                 DPAA2_SEC_ERR("Crypto: Undefined Auth specified %u",
2006                               auth_xform->algo);
2007                 goto error_out;
2008         }
2009         cipherdata.key = (size_t)session->cipher_key.data;
2010         cipherdata.keylen = session->cipher_key.length;
2011         cipherdata.key_enc_flags = 0;
2012         cipherdata.key_type = RTA_DATA_IMM;
2013
2014         switch (cipher_xform->algo) {
2015         case RTE_CRYPTO_CIPHER_AES_CBC:
2016                 cipherdata.algtype = OP_ALG_ALGSEL_AES;
2017                 cipherdata.algmode = OP_ALG_AAI_CBC;
2018                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CBC;
2019                 break;
2020         case RTE_CRYPTO_CIPHER_3DES_CBC:
2021                 cipherdata.algtype = OP_ALG_ALGSEL_3DES;
2022                 cipherdata.algmode = OP_ALG_AAI_CBC;
2023                 session->cipher_alg = RTE_CRYPTO_CIPHER_3DES_CBC;
2024                 break;
2025         case RTE_CRYPTO_CIPHER_AES_CTR:
2026                 cipherdata.algtype = OP_ALG_ALGSEL_AES;
2027                 cipherdata.algmode = OP_ALG_AAI_CTR;
2028                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CTR;
2029                 break;
2030         case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
2031         case RTE_CRYPTO_CIPHER_NULL:
2032         case RTE_CRYPTO_CIPHER_3DES_ECB:
2033         case RTE_CRYPTO_CIPHER_AES_ECB:
2034         case RTE_CRYPTO_CIPHER_KASUMI_F8:
2035                 DPAA2_SEC_ERR("Crypto: Unsupported Cipher alg %u",
2036                               cipher_xform->algo);
2037                 goto error_out;
2038         default:
2039                 DPAA2_SEC_ERR("Crypto: Undefined Cipher specified %u",
2040                               cipher_xform->algo);
2041                 goto error_out;
2042         }
2043         session->dir = (cipher_xform->op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
2044                                 DIR_ENC : DIR_DEC;
2045
2046         priv->flc_desc[0].desc[0] = cipherdata.keylen;
2047         priv->flc_desc[0].desc[1] = authdata.keylen;
2048         err = rta_inline_query(IPSEC_AUTH_VAR_AES_DEC_BASE_DESC_LEN,
2049                                MIN_JOB_DESC_SIZE,
2050                                (unsigned int *)priv->flc_desc[0].desc,
2051                                &priv->flc_desc[0].desc[2], 2);
2052
2053         if (err < 0) {
2054                 DPAA2_SEC_ERR("Crypto: Incorrect key lengths");
2055                 goto error_out;
2056         }
2057         if (priv->flc_desc[0].desc[2] & 1) {
2058                 cipherdata.key_type = RTA_DATA_IMM;
2059         } else {
2060                 cipherdata.key = DPAA2_VADDR_TO_IOVA(cipherdata.key);
2061                 cipherdata.key_type = RTA_DATA_PTR;
2062         }
2063         if (priv->flc_desc[0].desc[2] & (1 << 1)) {
2064                 authdata.key_type = RTA_DATA_IMM;
2065         } else {
2066                 authdata.key = DPAA2_VADDR_TO_IOVA(authdata.key);
2067                 authdata.key_type = RTA_DATA_PTR;
2068         }
2069         priv->flc_desc[0].desc[0] = 0;
2070         priv->flc_desc[0].desc[1] = 0;
2071         priv->flc_desc[0].desc[2] = 0;
2072
2073         if (session->ctxt_type == DPAA2_SEC_CIPHER_HASH) {
2074                 bufsize = cnstr_shdsc_authenc(priv->flc_desc[0].desc, 1,
2075                                               0, &cipherdata, &authdata,
2076                                               session->iv.length,
2077                                               ctxt->auth_only_len,
2078                                               session->digest_length,
2079                                               session->dir);
2080                 if (bufsize < 0) {
2081                         DPAA2_SEC_ERR("Crypto: Invalid buffer length");
2082                         goto error_out;
2083                 }
2084         } else {
2085                 DPAA2_SEC_ERR("Hash before cipher not supported");
2086                 goto error_out;
2087         }
2088
2089         flc->word1_sdl = (uint8_t)bufsize;
2090         flc->word2_rflc_31_0 = lower_32_bits(
2091                         (size_t)&(((struct dpaa2_sec_qp *)
2092                         dev->data->queue_pairs[0])->rx_vq));
2093         flc->word3_rflc_63_32 = upper_32_bits(
2094                         (size_t)&(((struct dpaa2_sec_qp *)
2095                         dev->data->queue_pairs[0])->rx_vq));
2096         session->ctxt = priv;
2097         for (i = 0; i < bufsize; i++)
2098                 DPAA2_SEC_DEBUG("DESC[%d]:0x%x",
2099                             i, priv->flc_desc[0].desc[i]);
2100
2101         return 0;
2102
2103 error_out:
2104         rte_free(session->cipher_key.data);
2105         rte_free(session->auth_key.data);
2106         rte_free(priv);
2107         return -1;
2108 }
2109
2110 static int
2111 dpaa2_sec_set_session_parameters(struct rte_cryptodev *dev,
2112                             struct rte_crypto_sym_xform *xform, void *sess)
2113 {
2114         dpaa2_sec_session *session = sess;
2115
2116         PMD_INIT_FUNC_TRACE();
2117
2118         if (unlikely(sess == NULL)) {
2119                 DPAA2_SEC_ERR("Invalid session struct");
2120                 return -1;
2121         }
2122
2123         /* Default IV length = 0 */
2124         session->iv.length = 0;
2125
2126         /* Cipher Only */
2127         if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER && xform->next == NULL) {
2128                 session->ctxt_type = DPAA2_SEC_CIPHER;
2129                 dpaa2_sec_cipher_init(dev, xform, session);
2130
2131         /* Authentication Only */
2132         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AUTH &&
2133                    xform->next == NULL) {
2134                 session->ctxt_type = DPAA2_SEC_AUTH;
2135                 dpaa2_sec_auth_init(dev, xform, session);
2136
2137         /* Cipher then Authenticate */
2138         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER &&
2139                    xform->next->type == RTE_CRYPTO_SYM_XFORM_AUTH) {
2140                 session->ext_params.aead_ctxt.auth_cipher_text = true;
2141                 dpaa2_sec_aead_chain_init(dev, xform, session);
2142
2143         /* Authenticate then Cipher */
2144         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AUTH &&
2145                    xform->next->type == RTE_CRYPTO_SYM_XFORM_CIPHER) {
2146                 session->ext_params.aead_ctxt.auth_cipher_text = false;
2147                 dpaa2_sec_aead_chain_init(dev, xform, session);
2148
2149         /* AEAD operation for AES-GCM kind of Algorithms */
2150         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AEAD &&
2151                    xform->next == NULL) {
2152                 dpaa2_sec_aead_init(dev, xform, session);
2153
2154         } else {
2155                 DPAA2_SEC_ERR("Invalid crypto type");
2156                 return -EINVAL;
2157         }
2158
2159         return 0;
2160 }
2161
2162 static int
2163 dpaa2_sec_set_ipsec_session(struct rte_cryptodev *dev,
2164                             struct rte_security_session_conf *conf,
2165                             void *sess)
2166 {
2167         struct rte_security_ipsec_xform *ipsec_xform = &conf->ipsec;
2168         struct rte_crypto_auth_xform *auth_xform;
2169         struct rte_crypto_cipher_xform *cipher_xform;
2170         dpaa2_sec_session *session = (dpaa2_sec_session *)sess;
2171         struct ctxt_priv *priv;
2172         struct ipsec_encap_pdb encap_pdb;
2173         struct ipsec_decap_pdb decap_pdb;
2174         struct alginfo authdata, cipherdata;
2175         int bufsize;
2176         struct sec_flow_context *flc;
2177
2178         PMD_INIT_FUNC_TRACE();
2179
2180         if (ipsec_xform->direction == RTE_SECURITY_IPSEC_SA_DIR_EGRESS) {
2181                 cipher_xform = &conf->crypto_xform->cipher;
2182                 auth_xform = &conf->crypto_xform->next->auth;
2183         } else {
2184                 auth_xform = &conf->crypto_xform->auth;
2185                 cipher_xform = &conf->crypto_xform->next->cipher;
2186         }
2187         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
2188                                 sizeof(struct ctxt_priv) +
2189                                 sizeof(struct sec_flc_desc),
2190                                 RTE_CACHE_LINE_SIZE);
2191
2192         if (priv == NULL) {
2193                 DPAA2_SEC_ERR("No memory for priv CTXT");
2194                 return -ENOMEM;
2195         }
2196
2197         flc = &priv->flc_desc[0].flc;
2198
2199         session->ctxt_type = DPAA2_SEC_IPSEC;
2200         session->cipher_key.data = rte_zmalloc(NULL,
2201                                                cipher_xform->key.length,
2202                                                RTE_CACHE_LINE_SIZE);
2203         if (session->cipher_key.data == NULL &&
2204                         cipher_xform->key.length > 0) {
2205                 DPAA2_SEC_ERR("No Memory for cipher key");
2206                 rte_free(priv);
2207                 return -ENOMEM;
2208         }
2209
2210         session->cipher_key.length = cipher_xform->key.length;
2211         session->auth_key.data = rte_zmalloc(NULL,
2212                                         auth_xform->key.length,
2213                                         RTE_CACHE_LINE_SIZE);
2214         if (session->auth_key.data == NULL &&
2215                         auth_xform->key.length > 0) {
2216                 DPAA2_SEC_ERR("No Memory for auth key");
2217                 rte_free(session->cipher_key.data);
2218                 rte_free(priv);
2219                 return -ENOMEM;
2220         }
2221         session->auth_key.length = auth_xform->key.length;
2222         memcpy(session->cipher_key.data, cipher_xform->key.data,
2223                         cipher_xform->key.length);
2224         memcpy(session->auth_key.data, auth_xform->key.data,
2225                         auth_xform->key.length);
2226
2227         authdata.key = (size_t)session->auth_key.data;
2228         authdata.keylen = session->auth_key.length;
2229         authdata.key_enc_flags = 0;
2230         authdata.key_type = RTA_DATA_IMM;
2231         switch (auth_xform->algo) {
2232         case RTE_CRYPTO_AUTH_SHA1_HMAC:
2233                 authdata.algtype = OP_PCL_IPSEC_HMAC_SHA1_96;
2234                 authdata.algmode = OP_ALG_AAI_HMAC;
2235                 session->auth_alg = RTE_CRYPTO_AUTH_SHA1_HMAC;
2236                 break;
2237         case RTE_CRYPTO_AUTH_MD5_HMAC:
2238                 authdata.algtype = OP_PCL_IPSEC_HMAC_MD5_96;
2239                 authdata.algmode = OP_ALG_AAI_HMAC;
2240                 session->auth_alg = RTE_CRYPTO_AUTH_MD5_HMAC;
2241                 break;
2242         case RTE_CRYPTO_AUTH_SHA256_HMAC:
2243                 authdata.algtype = OP_PCL_IPSEC_HMAC_SHA2_256_128;
2244                 authdata.algmode = OP_ALG_AAI_HMAC;
2245                 session->auth_alg = RTE_CRYPTO_AUTH_SHA256_HMAC;
2246                 break;
2247         case RTE_CRYPTO_AUTH_SHA384_HMAC:
2248                 authdata.algtype = OP_PCL_IPSEC_HMAC_SHA2_384_192;
2249                 authdata.algmode = OP_ALG_AAI_HMAC;
2250                 session->auth_alg = RTE_CRYPTO_AUTH_SHA384_HMAC;
2251                 break;
2252         case RTE_CRYPTO_AUTH_SHA512_HMAC:
2253                 authdata.algtype = OP_PCL_IPSEC_HMAC_SHA2_512_256;
2254                 authdata.algmode = OP_ALG_AAI_HMAC;
2255                 session->auth_alg = RTE_CRYPTO_AUTH_SHA512_HMAC;
2256                 break;
2257         case RTE_CRYPTO_AUTH_AES_CMAC:
2258                 authdata.algtype = OP_PCL_IPSEC_AES_CMAC_96;
2259                 session->auth_alg = RTE_CRYPTO_AUTH_AES_CMAC;
2260                 break;
2261         case RTE_CRYPTO_AUTH_NULL:
2262                 authdata.algtype = OP_PCL_IPSEC_HMAC_NULL;
2263                 session->auth_alg = RTE_CRYPTO_AUTH_NULL;
2264                 break;
2265         case RTE_CRYPTO_AUTH_SHA224_HMAC:
2266         case RTE_CRYPTO_AUTH_AES_XCBC_MAC:
2267         case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
2268         case RTE_CRYPTO_AUTH_SHA1:
2269         case RTE_CRYPTO_AUTH_SHA256:
2270         case RTE_CRYPTO_AUTH_SHA512:
2271         case RTE_CRYPTO_AUTH_SHA224:
2272         case RTE_CRYPTO_AUTH_SHA384:
2273         case RTE_CRYPTO_AUTH_MD5:
2274         case RTE_CRYPTO_AUTH_AES_GMAC:
2275         case RTE_CRYPTO_AUTH_KASUMI_F9:
2276         case RTE_CRYPTO_AUTH_AES_CBC_MAC:
2277         case RTE_CRYPTO_AUTH_ZUC_EIA3:
2278                 DPAA2_SEC_ERR("Crypto: Unsupported auth alg %u",
2279                               auth_xform->algo);
2280                 goto out;
2281         default:
2282                 DPAA2_SEC_ERR("Crypto: Undefined Auth specified %u",
2283                               auth_xform->algo);
2284                 goto out;
2285         }
2286         cipherdata.key = (size_t)session->cipher_key.data;
2287         cipherdata.keylen = session->cipher_key.length;
2288         cipherdata.key_enc_flags = 0;
2289         cipherdata.key_type = RTA_DATA_IMM;
2290
2291         switch (cipher_xform->algo) {
2292         case RTE_CRYPTO_CIPHER_AES_CBC:
2293                 cipherdata.algtype = OP_PCL_IPSEC_AES_CBC;
2294                 cipherdata.algmode = OP_ALG_AAI_CBC;
2295                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CBC;
2296                 break;
2297         case RTE_CRYPTO_CIPHER_3DES_CBC:
2298                 cipherdata.algtype = OP_PCL_IPSEC_3DES;
2299                 cipherdata.algmode = OP_ALG_AAI_CBC;
2300                 session->cipher_alg = RTE_CRYPTO_CIPHER_3DES_CBC;
2301                 break;
2302         case RTE_CRYPTO_CIPHER_AES_CTR:
2303                 cipherdata.algtype = OP_PCL_IPSEC_AES_CTR;
2304                 cipherdata.algmode = OP_ALG_AAI_CTR;
2305                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CTR;
2306                 break;
2307         case RTE_CRYPTO_CIPHER_NULL:
2308                 cipherdata.algtype = OP_PCL_IPSEC_NULL;
2309                 break;
2310         case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
2311         case RTE_CRYPTO_CIPHER_3DES_ECB:
2312         case RTE_CRYPTO_CIPHER_AES_ECB:
2313         case RTE_CRYPTO_CIPHER_KASUMI_F8:
2314                 DPAA2_SEC_ERR("Crypto: Unsupported Cipher alg %u",
2315                               cipher_xform->algo);
2316                 goto out;
2317         default:
2318                 DPAA2_SEC_ERR("Crypto: Undefined Cipher specified %u",
2319                               cipher_xform->algo);
2320                 goto out;
2321         }
2322
2323         if (ipsec_xform->direction == RTE_SECURITY_IPSEC_SA_DIR_EGRESS) {
2324                 struct ip ip4_hdr;
2325
2326                 flc->dhr = SEC_FLC_DHR_OUTBOUND;
2327                 ip4_hdr.ip_v = IPVERSION;
2328                 ip4_hdr.ip_hl = 5;
2329                 ip4_hdr.ip_len = rte_cpu_to_be_16(sizeof(ip4_hdr));
2330                 ip4_hdr.ip_tos = ipsec_xform->tunnel.ipv4.dscp;
2331                 ip4_hdr.ip_id = 0;
2332                 ip4_hdr.ip_off = 0;
2333                 ip4_hdr.ip_ttl = ipsec_xform->tunnel.ipv4.ttl;
2334                 ip4_hdr.ip_p = 0x32;
2335                 ip4_hdr.ip_sum = 0;
2336                 ip4_hdr.ip_src = ipsec_xform->tunnel.ipv4.src_ip;
2337                 ip4_hdr.ip_dst = ipsec_xform->tunnel.ipv4.dst_ip;
2338                 ip4_hdr.ip_sum = calc_chksum((uint16_t *)(void *)&ip4_hdr,
2339                         sizeof(struct ip));
2340
2341                 /* For Sec Proto only one descriptor is required. */
2342                 memset(&encap_pdb, 0, sizeof(struct ipsec_encap_pdb));
2343                 encap_pdb.options = (IPVERSION << PDBNH_ESP_ENCAP_SHIFT) |
2344                         PDBOPTS_ESP_OIHI_PDB_INL |
2345                         PDBOPTS_ESP_IVSRC |
2346                         PDBHMO_ESP_ENCAP_DTTL;
2347                 encap_pdb.spi = ipsec_xform->spi;
2348                 encap_pdb.ip_hdr_len = sizeof(struct ip);
2349
2350                 session->dir = DIR_ENC;
2351                 bufsize = cnstr_shdsc_ipsec_new_encap(priv->flc_desc[0].desc,
2352                                 1, 0, &encap_pdb,
2353                                 (uint8_t *)&ip4_hdr,
2354                                 &cipherdata, &authdata);
2355         } else if (ipsec_xform->direction ==
2356                         RTE_SECURITY_IPSEC_SA_DIR_INGRESS) {
2357                 flc->dhr = SEC_FLC_DHR_INBOUND;
2358                 memset(&decap_pdb, 0, sizeof(struct ipsec_decap_pdb));
2359                 decap_pdb.options = sizeof(struct ip) << 16;
2360                 session->dir = DIR_DEC;
2361                 bufsize = cnstr_shdsc_ipsec_new_decap(priv->flc_desc[0].desc,
2362                                 1, 0, &decap_pdb, &cipherdata, &authdata);
2363         } else
2364                 goto out;
2365
2366         if (bufsize < 0) {
2367                 DPAA2_SEC_ERR("Crypto: Invalid buffer length");
2368                 goto out;
2369         }
2370
2371         flc->word1_sdl = (uint8_t)bufsize;
2372
2373         /* Enable the stashing control bit */
2374         DPAA2_SET_FLC_RSC(flc);
2375         flc->word2_rflc_31_0 = lower_32_bits(
2376                         (size_t)&(((struct dpaa2_sec_qp *)
2377                         dev->data->queue_pairs[0])->rx_vq) | 0x14);
2378         flc->word3_rflc_63_32 = upper_32_bits(
2379                         (size_t)&(((struct dpaa2_sec_qp *)
2380                         dev->data->queue_pairs[0])->rx_vq));
2381
2382         /* Set EWS bit i.e. enable write-safe */
2383         DPAA2_SET_FLC_EWS(flc);
2384         /* Set BS = 1 i.e reuse input buffers as output buffers */
2385         DPAA2_SET_FLC_REUSE_BS(flc);
2386         /* Set FF = 10; reuse input buffers if they provide sufficient space */
2387         DPAA2_SET_FLC_REUSE_FF(flc);
2388
2389         session->ctxt = priv;
2390
2391         return 0;
2392 out:
2393         rte_free(session->auth_key.data);
2394         rte_free(session->cipher_key.data);
2395         rte_free(priv);
2396         return -1;
2397 }
2398
2399 static int
2400 dpaa2_sec_security_session_create(void *dev,
2401                                   struct rte_security_session_conf *conf,
2402                                   struct rte_security_session *sess,
2403                                   struct rte_mempool *mempool)
2404 {
2405         void *sess_private_data;
2406         struct rte_cryptodev *cdev = (struct rte_cryptodev *)dev;
2407         int ret;
2408
2409         if (rte_mempool_get(mempool, &sess_private_data)) {
2410                 DPAA2_SEC_ERR("Couldn't get object from session mempool");
2411                 return -ENOMEM;
2412         }
2413
2414         switch (conf->protocol) {
2415         case RTE_SECURITY_PROTOCOL_IPSEC:
2416                 ret = dpaa2_sec_set_ipsec_session(cdev, conf,
2417                                 sess_private_data);
2418                 break;
2419         case RTE_SECURITY_PROTOCOL_MACSEC:
2420                 return -ENOTSUP;
2421         default:
2422                 return -EINVAL;
2423         }
2424         if (ret != 0) {
2425                 DPAA2_SEC_ERR("Failed to configure session parameters");
2426                 /* Return session to mempool */
2427                 rte_mempool_put(mempool, sess_private_data);
2428                 return ret;
2429         }
2430
2431         set_sec_session_private_data(sess, sess_private_data);
2432
2433         return ret;
2434 }
2435
2436 /** Clear the memory of session so it doesn't leave key material behind */
2437 static int
2438 dpaa2_sec_security_session_destroy(void *dev __rte_unused,
2439                 struct rte_security_session *sess)
2440 {
2441         PMD_INIT_FUNC_TRACE();
2442         void *sess_priv = get_sec_session_private_data(sess);
2443
2444         dpaa2_sec_session *s = (dpaa2_sec_session *)sess_priv;
2445
2446         if (sess_priv) {
2447                 struct rte_mempool *sess_mp = rte_mempool_from_obj(sess_priv);
2448
2449                 rte_free(s->ctxt);
2450                 rte_free(s->cipher_key.data);
2451                 rte_free(s->auth_key.data);
2452                 memset(sess, 0, sizeof(dpaa2_sec_session));
2453                 set_sec_session_private_data(sess, NULL);
2454                 rte_mempool_put(sess_mp, sess_priv);
2455         }
2456         return 0;
2457 }
2458
2459 static int
2460 dpaa2_sec_session_configure(struct rte_cryptodev *dev,
2461                 struct rte_crypto_sym_xform *xform,
2462                 struct rte_cryptodev_sym_session *sess,
2463                 struct rte_mempool *mempool)
2464 {
2465         void *sess_private_data;
2466         int ret;
2467
2468         if (rte_mempool_get(mempool, &sess_private_data)) {
2469                 DPAA2_SEC_ERR("Couldn't get object from session mempool");
2470                 return -ENOMEM;
2471         }
2472
2473         ret = dpaa2_sec_set_session_parameters(dev, xform, sess_private_data);
2474         if (ret != 0) {
2475                 DPAA2_SEC_ERR("Failed to configure session parameters");
2476                 /* Return session to mempool */
2477                 rte_mempool_put(mempool, sess_private_data);
2478                 return ret;
2479         }
2480
2481         set_session_private_data(sess, dev->driver_id,
2482                 sess_private_data);
2483
2484         return 0;
2485 }
2486
2487 /** Clear the memory of session so it doesn't leave key material behind */
2488 static void
2489 dpaa2_sec_session_clear(struct rte_cryptodev *dev,
2490                 struct rte_cryptodev_sym_session *sess)
2491 {
2492         PMD_INIT_FUNC_TRACE();
2493         uint8_t index = dev->driver_id;
2494         void *sess_priv = get_session_private_data(sess, index);
2495         dpaa2_sec_session *s = (dpaa2_sec_session *)sess_priv;
2496
2497         if (sess_priv) {
2498                 rte_free(s->ctxt);
2499                 rte_free(s->cipher_key.data);
2500                 rte_free(s->auth_key.data);
2501                 memset(sess, 0, sizeof(dpaa2_sec_session));
2502                 struct rte_mempool *sess_mp = rte_mempool_from_obj(sess_priv);
2503                 set_session_private_data(sess, index, NULL);
2504                 rte_mempool_put(sess_mp, sess_priv);
2505         }
2506 }
2507
2508 static int
2509 dpaa2_sec_dev_configure(struct rte_cryptodev *dev __rte_unused,
2510                         struct rte_cryptodev_config *config __rte_unused)
2511 {
2512         PMD_INIT_FUNC_TRACE();
2513
2514         return 0;
2515 }
2516
2517 static int
2518 dpaa2_sec_dev_start(struct rte_cryptodev *dev)
2519 {
2520         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
2521         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
2522         struct dpseci_attr attr;
2523         struct dpaa2_queue *dpaa2_q;
2524         struct dpaa2_sec_qp **qp = (struct dpaa2_sec_qp **)
2525                                         dev->data->queue_pairs;
2526         struct dpseci_rx_queue_attr rx_attr;
2527         struct dpseci_tx_queue_attr tx_attr;
2528         int ret, i;
2529
2530         PMD_INIT_FUNC_TRACE();
2531
2532         memset(&attr, 0, sizeof(struct dpseci_attr));
2533
2534         ret = dpseci_enable(dpseci, CMD_PRI_LOW, priv->token);
2535         if (ret) {
2536                 DPAA2_SEC_ERR("DPSECI with HW_ID = %d ENABLE FAILED",
2537                               priv->hw_id);
2538                 goto get_attr_failure;
2539         }
2540         ret = dpseci_get_attributes(dpseci, CMD_PRI_LOW, priv->token, &attr);
2541         if (ret) {
2542                 DPAA2_SEC_ERR("DPSEC ATTRIBUTE READ FAILED, disabling DPSEC");
2543                 goto get_attr_failure;
2544         }
2545         for (i = 0; i < attr.num_rx_queues && qp[i]; i++) {
2546                 dpaa2_q = &qp[i]->rx_vq;
2547                 dpseci_get_rx_queue(dpseci, CMD_PRI_LOW, priv->token, i,
2548                                     &rx_attr);
2549                 dpaa2_q->fqid = rx_attr.fqid;
2550                 DPAA2_SEC_DEBUG("rx_fqid: %d", dpaa2_q->fqid);
2551         }
2552         for (i = 0; i < attr.num_tx_queues && qp[i]; i++) {
2553                 dpaa2_q = &qp[i]->tx_vq;
2554                 dpseci_get_tx_queue(dpseci, CMD_PRI_LOW, priv->token, i,
2555                                     &tx_attr);
2556                 dpaa2_q->fqid = tx_attr.fqid;
2557                 DPAA2_SEC_DEBUG("tx_fqid: %d", dpaa2_q->fqid);
2558         }
2559
2560         return 0;
2561 get_attr_failure:
2562         dpseci_disable(dpseci, CMD_PRI_LOW, priv->token);
2563         return -1;
2564 }
2565
2566 static void
2567 dpaa2_sec_dev_stop(struct rte_cryptodev *dev)
2568 {
2569         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
2570         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
2571         int ret;
2572
2573         PMD_INIT_FUNC_TRACE();
2574
2575         ret = dpseci_disable(dpseci, CMD_PRI_LOW, priv->token);
2576         if (ret) {
2577                 DPAA2_SEC_ERR("Failure in disabling dpseci %d device",
2578                              priv->hw_id);
2579                 return;
2580         }
2581
2582         ret = dpseci_reset(dpseci, CMD_PRI_LOW, priv->token);
2583         if (ret < 0) {
2584                 DPAA2_SEC_ERR("SEC Device cannot be reset:Error = %0x", ret);
2585                 return;
2586         }
2587 }
2588
2589 static int
2590 dpaa2_sec_dev_close(struct rte_cryptodev *dev)
2591 {
2592         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
2593         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
2594         int ret;
2595
2596         PMD_INIT_FUNC_TRACE();
2597
2598         /* Function is reverse of dpaa2_sec_dev_init.
2599          * It does the following:
2600          * 1. Detach a DPSECI from attached resources i.e. buffer pools, dpbp_id
2601          * 2. Close the DPSECI device
2602          * 3. Free the allocated resources.
2603          */
2604
2605         /*Close the device at underlying layer*/
2606         ret = dpseci_close(dpseci, CMD_PRI_LOW, priv->token);
2607         if (ret) {
2608                 DPAA2_SEC_ERR("Failure closing dpseci device: err(%d)", ret);
2609                 return -1;
2610         }
2611
2612         /*Free the allocated memory for ethernet private data and dpseci*/
2613         priv->hw = NULL;
2614         rte_free(dpseci);
2615
2616         return 0;
2617 }
2618
2619 static void
2620 dpaa2_sec_dev_infos_get(struct rte_cryptodev *dev,
2621                         struct rte_cryptodev_info *info)
2622 {
2623         struct dpaa2_sec_dev_private *internals = dev->data->dev_private;
2624
2625         PMD_INIT_FUNC_TRACE();
2626         if (info != NULL) {
2627                 info->max_nb_queue_pairs = internals->max_nb_queue_pairs;
2628                 info->feature_flags = dev->feature_flags;
2629                 info->capabilities = dpaa2_sec_capabilities;
2630                 info->sym.max_nb_sessions = internals->max_nb_sessions;
2631                 info->driver_id = cryptodev_driver_id;
2632         }
2633 }
2634
2635 static
2636 void dpaa2_sec_stats_get(struct rte_cryptodev *dev,
2637                          struct rte_cryptodev_stats *stats)
2638 {
2639         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
2640         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
2641         struct dpseci_sec_counters counters = {0};
2642         struct dpaa2_sec_qp **qp = (struct dpaa2_sec_qp **)
2643                                         dev->data->queue_pairs;
2644         int ret, i;
2645
2646         PMD_INIT_FUNC_TRACE();
2647         if (stats == NULL) {
2648                 DPAA2_SEC_ERR("Invalid stats ptr NULL");
2649                 return;
2650         }
2651         for (i = 0; i < dev->data->nb_queue_pairs; i++) {
2652                 if (qp[i] == NULL) {
2653                         DPAA2_SEC_DEBUG("Uninitialised queue pair");
2654                         continue;
2655                 }
2656
2657                 stats->enqueued_count += qp[i]->tx_vq.tx_pkts;
2658                 stats->dequeued_count += qp[i]->rx_vq.rx_pkts;
2659                 stats->enqueue_err_count += qp[i]->tx_vq.err_pkts;
2660                 stats->dequeue_err_count += qp[i]->rx_vq.err_pkts;
2661         }
2662
2663         ret = dpseci_get_sec_counters(dpseci, CMD_PRI_LOW, priv->token,
2664                                       &counters);
2665         if (ret) {
2666                 DPAA2_SEC_ERR("SEC counters failed");
2667         } else {
2668                 DPAA2_SEC_INFO("dpseci hardware stats:"
2669                             "\n\tNum of Requests Dequeued = %" PRIu64
2670                             "\n\tNum of Outbound Encrypt Requests = %" PRIu64
2671                             "\n\tNum of Inbound Decrypt Requests = %" PRIu64
2672                             "\n\tNum of Outbound Bytes Encrypted = %" PRIu64
2673                             "\n\tNum of Outbound Bytes Protected = %" PRIu64
2674                             "\n\tNum of Inbound Bytes Decrypted = %" PRIu64
2675                             "\n\tNum of Inbound Bytes Validated = %" PRIu64,
2676                             counters.dequeued_requests,
2677                             counters.ob_enc_requests,
2678                             counters.ib_dec_requests,
2679                             counters.ob_enc_bytes,
2680                             counters.ob_prot_bytes,
2681                             counters.ib_dec_bytes,
2682                             counters.ib_valid_bytes);
2683         }
2684 }
2685
2686 static
2687 void dpaa2_sec_stats_reset(struct rte_cryptodev *dev)
2688 {
2689         int i;
2690         struct dpaa2_sec_qp **qp = (struct dpaa2_sec_qp **)
2691                                    (dev->data->queue_pairs);
2692
2693         PMD_INIT_FUNC_TRACE();
2694
2695         for (i = 0; i < dev->data->nb_queue_pairs; i++) {
2696                 if (qp[i] == NULL) {
2697                         DPAA2_SEC_DEBUG("Uninitialised queue pair");
2698                         continue;
2699                 }
2700                 qp[i]->tx_vq.rx_pkts = 0;
2701                 qp[i]->tx_vq.tx_pkts = 0;
2702                 qp[i]->tx_vq.err_pkts = 0;
2703                 qp[i]->rx_vq.rx_pkts = 0;
2704                 qp[i]->rx_vq.tx_pkts = 0;
2705                 qp[i]->rx_vq.err_pkts = 0;
2706         }
2707 }
2708
2709 static struct rte_cryptodev_ops crypto_ops = {
2710         .dev_configure        = dpaa2_sec_dev_configure,
2711         .dev_start            = dpaa2_sec_dev_start,
2712         .dev_stop             = dpaa2_sec_dev_stop,
2713         .dev_close            = dpaa2_sec_dev_close,
2714         .dev_infos_get        = dpaa2_sec_dev_infos_get,
2715         .stats_get            = dpaa2_sec_stats_get,
2716         .stats_reset          = dpaa2_sec_stats_reset,
2717         .queue_pair_setup     = dpaa2_sec_queue_pair_setup,
2718         .queue_pair_release   = dpaa2_sec_queue_pair_release,
2719         .queue_pair_start     = dpaa2_sec_queue_pair_start,
2720         .queue_pair_stop      = dpaa2_sec_queue_pair_stop,
2721         .queue_pair_count     = dpaa2_sec_queue_pair_count,
2722         .session_get_size     = dpaa2_sec_session_get_size,
2723         .session_configure    = dpaa2_sec_session_configure,
2724         .session_clear        = dpaa2_sec_session_clear,
2725 };
2726
2727 static const struct rte_security_capability *
2728 dpaa2_sec_capabilities_get(void *device __rte_unused)
2729 {
2730         return dpaa2_sec_security_cap;
2731 }
2732
2733 struct rte_security_ops dpaa2_sec_security_ops = {
2734         .session_create = dpaa2_sec_security_session_create,
2735         .session_update = NULL,
2736         .session_stats_get = NULL,
2737         .session_destroy = dpaa2_sec_security_session_destroy,
2738         .set_pkt_metadata = NULL,
2739         .capabilities_get = dpaa2_sec_capabilities_get
2740 };
2741
2742 static int
2743 dpaa2_sec_uninit(const struct rte_cryptodev *dev)
2744 {
2745         struct dpaa2_sec_dev_private *internals = dev->data->dev_private;
2746
2747         rte_free(dev->security_ctx);
2748
2749         rte_mempool_free(internals->fle_pool);
2750
2751         DPAA2_SEC_INFO("Closing DPAA2_SEC device %s on numa socket %u",
2752                        dev->data->name, rte_socket_id());
2753
2754         return 0;
2755 }
2756
2757 static int
2758 dpaa2_sec_dev_init(struct rte_cryptodev *cryptodev)
2759 {
2760         struct dpaa2_sec_dev_private *internals;
2761         struct rte_device *dev = cryptodev->device;
2762         struct rte_dpaa2_device *dpaa2_dev;
2763         struct rte_security_ctx *security_instance;
2764         struct fsl_mc_io *dpseci;
2765         uint16_t token;
2766         struct dpseci_attr attr;
2767         int retcode, hw_id;
2768         char str[20];
2769
2770         PMD_INIT_FUNC_TRACE();
2771         dpaa2_dev = container_of(dev, struct rte_dpaa2_device, device);
2772         if (dpaa2_dev == NULL) {
2773                 DPAA2_SEC_ERR("DPAA2 SEC device not found");
2774                 return -1;
2775         }
2776         hw_id = dpaa2_dev->object_id;
2777
2778         cryptodev->driver_id = cryptodev_driver_id;
2779         cryptodev->dev_ops = &crypto_ops;
2780
2781         cryptodev->enqueue_burst = dpaa2_sec_enqueue_burst;
2782         cryptodev->dequeue_burst = dpaa2_sec_dequeue_burst;
2783         cryptodev->feature_flags = RTE_CRYPTODEV_FF_SYMMETRIC_CRYPTO |
2784                         RTE_CRYPTODEV_FF_HW_ACCELERATED |
2785                         RTE_CRYPTODEV_FF_SYM_OPERATION_CHAINING |
2786                         RTE_CRYPTODEV_FF_SECURITY |
2787                         RTE_CRYPTODEV_FF_MBUF_SCATTER_GATHER;
2788
2789         internals = cryptodev->data->dev_private;
2790         internals->max_nb_sessions = RTE_DPAA2_SEC_PMD_MAX_NB_SESSIONS;
2791
2792         /*
2793          * For secondary processes, we don't initialise any further as primary
2794          * has already done this work. Only check we don't need a different
2795          * RX function
2796          */
2797         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
2798                 DPAA2_SEC_DEBUG("Device already init by primary process");
2799                 return 0;
2800         }
2801
2802         /* Initialize security_ctx only for primary process*/
2803         security_instance = rte_malloc("rte_security_instances_ops",
2804                                 sizeof(struct rte_security_ctx), 0);
2805         if (security_instance == NULL)
2806                 return -ENOMEM;
2807         security_instance->device = (void *)cryptodev;
2808         security_instance->ops = &dpaa2_sec_security_ops;
2809         security_instance->sess_cnt = 0;
2810         cryptodev->security_ctx = security_instance;
2811
2812         /*Open the rte device via MC and save the handle for further use*/
2813         dpseci = (struct fsl_mc_io *)rte_calloc(NULL, 1,
2814                                 sizeof(struct fsl_mc_io), 0);
2815         if (!dpseci) {
2816                 DPAA2_SEC_ERR(
2817                         "Error in allocating the memory for dpsec object");
2818                 return -1;
2819         }
2820         dpseci->regs = rte_mcp_ptr_list[0];
2821
2822         retcode = dpseci_open(dpseci, CMD_PRI_LOW, hw_id, &token);
2823         if (retcode != 0) {
2824                 DPAA2_SEC_ERR("Cannot open the dpsec device: Error = %x",
2825                               retcode);
2826                 goto init_error;
2827         }
2828         retcode = dpseci_get_attributes(dpseci, CMD_PRI_LOW, token, &attr);
2829         if (retcode != 0) {
2830                 DPAA2_SEC_ERR(
2831                              "Cannot get dpsec device attributed: Error = %x",
2832                              retcode);
2833                 goto init_error;
2834         }
2835         sprintf(cryptodev->data->name, "dpsec-%u", hw_id);
2836
2837         internals->max_nb_queue_pairs = attr.num_tx_queues;
2838         cryptodev->data->nb_queue_pairs = internals->max_nb_queue_pairs;
2839         internals->hw = dpseci;
2840         internals->token = token;
2841
2842         sprintf(str, "fle_pool_%d", cryptodev->data->dev_id);
2843         internals->fle_pool = rte_mempool_create((const char *)str,
2844                         FLE_POOL_NUM_BUFS,
2845                         FLE_POOL_BUF_SIZE,
2846                         FLE_POOL_CACHE_SIZE, 0,
2847                         NULL, NULL, NULL, NULL,
2848                         SOCKET_ID_ANY, 0);
2849         if (!internals->fle_pool) {
2850                 DPAA2_SEC_ERR("Mempool (%s) creation failed", str);
2851                 goto init_error;
2852         }
2853
2854         DPAA2_SEC_INFO("driver %s: created", cryptodev->data->name);
2855         return 0;
2856
2857 init_error:
2858         DPAA2_SEC_ERR("driver %s: create failed", cryptodev->data->name);
2859
2860         /* dpaa2_sec_uninit(crypto_dev_name); */
2861         return -EFAULT;
2862 }
2863
2864 static int
2865 cryptodev_dpaa2_sec_probe(struct rte_dpaa2_driver *dpaa2_drv,
2866                           struct rte_dpaa2_device *dpaa2_dev)
2867 {
2868         struct rte_cryptodev *cryptodev;
2869         char cryptodev_name[RTE_CRYPTODEV_NAME_MAX_LEN];
2870
2871         int retval;
2872
2873         sprintf(cryptodev_name, "dpsec-%d", dpaa2_dev->object_id);
2874
2875         cryptodev = rte_cryptodev_pmd_allocate(cryptodev_name, rte_socket_id());
2876         if (cryptodev == NULL)
2877                 return -ENOMEM;
2878
2879         if (rte_eal_process_type() == RTE_PROC_PRIMARY) {
2880                 cryptodev->data->dev_private = rte_zmalloc_socket(
2881                                         "cryptodev private structure",
2882                                         sizeof(struct dpaa2_sec_dev_private),
2883                                         RTE_CACHE_LINE_SIZE,
2884                                         rte_socket_id());
2885
2886                 if (cryptodev->data->dev_private == NULL)
2887                         rte_panic("Cannot allocate memzone for private "
2888                                   "device data");
2889         }
2890
2891         dpaa2_dev->cryptodev = cryptodev;
2892         cryptodev->device = &dpaa2_dev->device;
2893         cryptodev->device->driver = &dpaa2_drv->driver;
2894
2895         /* init user callbacks */
2896         TAILQ_INIT(&(cryptodev->link_intr_cbs));
2897
2898         /* Invoke PMD device initialization function */
2899         retval = dpaa2_sec_dev_init(cryptodev);
2900         if (retval == 0)
2901                 return 0;
2902
2903         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
2904                 rte_free(cryptodev->data->dev_private);
2905
2906         cryptodev->attached = RTE_CRYPTODEV_DETACHED;
2907
2908         return -ENXIO;
2909 }
2910
2911 static int
2912 cryptodev_dpaa2_sec_remove(struct rte_dpaa2_device *dpaa2_dev)
2913 {
2914         struct rte_cryptodev *cryptodev;
2915         int ret;
2916
2917         cryptodev = dpaa2_dev->cryptodev;
2918         if (cryptodev == NULL)
2919                 return -ENODEV;
2920
2921         ret = dpaa2_sec_uninit(cryptodev);
2922         if (ret)
2923                 return ret;
2924
2925         return rte_cryptodev_pmd_destroy(cryptodev);
2926 }
2927
2928 static struct rte_dpaa2_driver rte_dpaa2_sec_driver = {
2929         .drv_flags = RTE_DPAA2_DRV_IOVA_AS_VA,
2930         .drv_type = DPAA2_CRYPTO,
2931         .driver = {
2932                 .name = "DPAA2 SEC PMD"
2933         },
2934         .probe = cryptodev_dpaa2_sec_probe,
2935         .remove = cryptodev_dpaa2_sec_remove,
2936 };
2937
2938 static struct cryptodev_driver dpaa2_sec_crypto_drv;
2939
2940 RTE_PMD_REGISTER_DPAA2(CRYPTODEV_NAME_DPAA2_SEC_PMD, rte_dpaa2_sec_driver);
2941 RTE_PMD_REGISTER_CRYPTO_DRIVER(dpaa2_sec_crypto_drv,
2942                 rte_dpaa2_sec_driver.driver, cryptodev_driver_id);
2943
2944 RTE_INIT(dpaa2_sec_init_log);
2945 static void
2946 dpaa2_sec_init_log(void)
2947 {
2948         /* Bus level logs */
2949         dpaa2_logtype_sec = rte_log_register("pmd.crypto.dpaa2");
2950         if (dpaa2_logtype_sec >= 0)
2951                 rte_log_set_level(dpaa2_logtype_sec, RTE_LOG_NOTICE);
2952 }