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-2019 NXP
   5  *
   6  */
   7
   8 #include <time.h>
   9 #include <net/if.h>
  10 #include <unistd.h>
  11
  12 #include <rte_ip.h>
  13 #include <rte_mbuf.h>
  14 #include <rte_cryptodev.h>
  15 #include <rte_malloc.h>
  16 #include <rte_memcpy.h>
  17 #include <rte_string_fns.h>
  18 #include <rte_cycles.h>
  19 #include <rte_kvargs.h>
  20 #include <rte_dev.h>
  21 #include <rte_cryptodev_pmd.h>
  22 #include <rte_common.h>
  23 #include <rte_fslmc.h>
  24 #include <fslmc_vfio.h>
  25 #include <dpaa2_hw_pvt.h>
  26 #include <dpaa2_hw_dpio.h>
  27 #include <dpaa2_hw_mempool.h>
  28 #include <fsl_dpopr.h>
  29 #include <fsl_dpseci.h>
  30 #include <fsl_mc_sys.h>
  31
  32 #include "dpaa2_sec_priv.h"
  33 #include "dpaa2_sec_event.h"
  34 #include "dpaa2_sec_logs.h"
  35
  36 /* RTA header files */
  37 #include <desc/ipsec.h>
  38 #include <desc/pdcp.h>
  39 #include <desc/algo.h>
  40
  41 /* Minimum job descriptor consists of a oneword job descriptor HEADER and
  42  * a pointer to the shared descriptor
  43  */
  44 #define MIN_JOB_DESC_SIZE       (CAAM_CMD_SZ + CAAM_PTR_SZ)
  45 #define FSL_VENDOR_ID           0x1957
  46 #define FSL_DEVICE_ID           0x410
  47 #define FSL_SUBSYSTEM_SEC       1
  48 #define FSL_MC_DPSECI_DEVID     3
  49
  50 #define NO_PREFETCH 0
  51 /* FLE_POOL_NUM_BUFS is set as per the ipsec-secgw application */
  52 #define FLE_POOL_NUM_BUFS       32000
  53 #define FLE_POOL_BUF_SIZE       256
  54 #define FLE_POOL_CACHE_SIZE     512
  55 #define FLE_SG_MEM_SIZE(num)    (FLE_POOL_BUF_SIZE + ((num) * 32))
  56 #define SEC_FLC_DHR_OUTBOUND    -114
  57 #define SEC_FLC_DHR_INBOUND     0
  58
  59 enum rta_sec_era rta_sec_era = RTA_SEC_ERA_8;
  60
  61 static uint8_t cryptodev_driver_id;
  62
  63 int dpaa2_logtype_sec;
  64
  65 #ifdef RTE_LIBRTE_SECURITY
  66 static inline int
  67 build_proto_compound_sg_fd(dpaa2_sec_session *sess,
  68                            struct rte_crypto_op *op,
  69                            struct qbman_fd *fd, uint16_t bpid)
  70 {
  71         struct rte_crypto_sym_op *sym_op = op->sym;
  72         struct ctxt_priv *priv = sess->ctxt;
  73         struct qbman_fle *fle, *sge, *ip_fle, *op_fle;
  74         struct sec_flow_context *flc;
  75         struct rte_mbuf *mbuf;
  76         uint32_t in_len = 0, out_len = 0;
  77
  78         if (sym_op->m_dst)
  79                 mbuf = sym_op->m_dst;
  80         else
  81                 mbuf = sym_op->m_src;
  82
  83         /* first FLE entry used to store mbuf and session ctxt */
  84         fle = (struct qbman_fle *)rte_malloc(NULL,
  85                         FLE_SG_MEM_SIZE(mbuf->nb_segs + sym_op->m_src->nb_segs),
  86                         RTE_CACHE_LINE_SIZE);
  87         if (unlikely(!fle)) {
  88                 DPAA2_SEC_DP_ERR("Proto:SG: Memory alloc failed for SGE");
  89                 return -1;
  90         }
  91         memset(fle, 0, FLE_SG_MEM_SIZE(mbuf->nb_segs + sym_op->m_src->nb_segs));
  92         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
  93         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
  94
  95         /* Save the shared descriptor */
  96         flc = &priv->flc_desc[0].flc;
  97
  98         op_fle = fle + 1;
  99         ip_fle = fle + 2;
 100         sge = fle + 3;
 101
 102         if (likely(bpid < MAX_BPID)) {
 103                 DPAA2_SET_FD_BPID(fd, bpid);
 104                 DPAA2_SET_FLE_BPID(op_fle, bpid);
 105                 DPAA2_SET_FLE_BPID(ip_fle, bpid);
 106         } else {
 107                 DPAA2_SET_FD_IVP(fd);
 108                 DPAA2_SET_FLE_IVP(op_fle);
 109                 DPAA2_SET_FLE_IVP(ip_fle);
 110         }
 111
 112         /* Configure FD as a FRAME LIST */
 113         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(op_fle));
 114         DPAA2_SET_FD_COMPOUND_FMT(fd);
 115         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 116
 117         /* Configure Output FLE with Scatter/Gather Entry */
 118         DPAA2_SET_FLE_SG_EXT(op_fle);
 119         DPAA2_SET_FLE_ADDR(op_fle, DPAA2_VADDR_TO_IOVA(sge));
 120
 121         /* Configure Output SGE for Encap/Decap */
 122         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 123         DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 124         /* o/p segs */
 125         while (mbuf->next) {
 126                 sge->length = mbuf->data_len;
 127                 out_len += sge->length;
 128                 sge++;
 129                 mbuf = mbuf->next;
 130                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 131                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 132         }
 133         /* using buf_len for last buf - so that extra data can be added */
 134         sge->length = mbuf->buf_len - mbuf->data_off;
 135         out_len += sge->length;
 136
 137         DPAA2_SET_FLE_FIN(sge);
 138         op_fle->length = out_len;
 139
 140         sge++;
 141         mbuf = sym_op->m_src;
 142
 143         /* Configure Input FLE with Scatter/Gather Entry */
 144         DPAA2_SET_FLE_ADDR(ip_fle, DPAA2_VADDR_TO_IOVA(sge));
 145         DPAA2_SET_FLE_SG_EXT(ip_fle);
 146         DPAA2_SET_FLE_FIN(ip_fle);
 147
 148         /* Configure input SGE for Encap/Decap */
 149         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 150         DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 151         sge->length = mbuf->data_len;
 152         in_len += sge->length;
 153
 154         mbuf = mbuf->next;
 155         /* i/p segs */
 156         while (mbuf) {
 157                 sge++;
 158                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 159                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 160                 sge->length = mbuf->data_len;
 161                 in_len += sge->length;
 162                 mbuf = mbuf->next;
 163         }
 164         ip_fle->length = in_len;
 165         DPAA2_SET_FLE_FIN(sge);
 166
 167         /* In case of PDCP, per packet HFN is stored in
 168          * mbuf priv after sym_op.
 169          */
 170         if (sess->ctxt_type == DPAA2_SEC_PDCP && sess->pdcp.hfn_ovd) {
 171                 uint32_t hfn_ovd = *((uint8_t *)op + sess->pdcp.hfn_ovd_offset);
 172                 /*enable HFN override override */
 173                 DPAA2_SET_FLE_INTERNAL_JD(ip_fle, hfn_ovd);
 174                 DPAA2_SET_FLE_INTERNAL_JD(op_fle, hfn_ovd);
 175                 DPAA2_SET_FD_INTERNAL_JD(fd, hfn_ovd);
 176         }
 177         DPAA2_SET_FD_LEN(fd, ip_fle->length);
 178
 179         return 0;
 180 }
 181
 182 static inline int
 183 build_proto_compound_fd(dpaa2_sec_session *sess,
 184                struct rte_crypto_op *op,
 185                struct qbman_fd *fd, uint16_t bpid)
 186 {
 187         struct rte_crypto_sym_op *sym_op = op->sym;
 188         struct ctxt_priv *priv = sess->ctxt;
 189         struct qbman_fle *fle, *ip_fle, *op_fle;
 190         struct sec_flow_context *flc;
 191         struct rte_mbuf *src_mbuf = sym_op->m_src;
 192         struct rte_mbuf *dst_mbuf = sym_op->m_dst;
 193         int retval;
 194
 195         if (!dst_mbuf)
 196                 dst_mbuf = src_mbuf;
 197
 198         /* Save the shared descriptor */
 199         flc = &priv->flc_desc[0].flc;
 200
 201         /* we are using the first FLE entry to store Mbuf */
 202         retval = rte_mempool_get(priv->fle_pool, (void **)(&fle));
 203         if (retval) {
 204                 DPAA2_SEC_DP_ERR("Memory alloc failed");
 205                 return -1;
 206         }
 207         memset(fle, 0, FLE_POOL_BUF_SIZE);
 208         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 209         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 210
 211         op_fle = fle + 1;
 212         ip_fle = fle + 2;
 213
 214         if (likely(bpid < MAX_BPID)) {
 215                 DPAA2_SET_FD_BPID(fd, bpid);
 216                 DPAA2_SET_FLE_BPID(op_fle, bpid);
 217                 DPAA2_SET_FLE_BPID(ip_fle, bpid);
 218         } else {
 219                 DPAA2_SET_FD_IVP(fd);
 220                 DPAA2_SET_FLE_IVP(op_fle);
 221                 DPAA2_SET_FLE_IVP(ip_fle);
 222         }
 223
 224         /* Configure FD as a FRAME LIST */
 225         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(op_fle));
 226         DPAA2_SET_FD_COMPOUND_FMT(fd);
 227         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 228
 229         /* Configure Output FLE with dst mbuf data  */
 230         DPAA2_SET_FLE_ADDR(op_fle, DPAA2_MBUF_VADDR_TO_IOVA(dst_mbuf));
 231         DPAA2_SET_FLE_OFFSET(op_fle, dst_mbuf->data_off);
 232         DPAA2_SET_FLE_LEN(op_fle, dst_mbuf->buf_len);
 233
 234         /* Configure Input FLE with src mbuf data */
 235         DPAA2_SET_FLE_ADDR(ip_fle, DPAA2_MBUF_VADDR_TO_IOVA(src_mbuf));
 236         DPAA2_SET_FLE_OFFSET(ip_fle, src_mbuf->data_off);
 237         DPAA2_SET_FLE_LEN(ip_fle, src_mbuf->pkt_len);
 238
 239         DPAA2_SET_FD_LEN(fd, ip_fle->length);
 240         DPAA2_SET_FLE_FIN(ip_fle);
 241
 242         /* In case of PDCP, per packet HFN is stored in
 243          * mbuf priv after sym_op.
 244          */
 245         if (sess->ctxt_type == DPAA2_SEC_PDCP && sess->pdcp.hfn_ovd) {
 246                 uint32_t hfn_ovd = *((uint8_t *)op + sess->pdcp.hfn_ovd_offset);
 247                 /*enable HFN override override */
 248                 DPAA2_SET_FLE_INTERNAL_JD(ip_fle, hfn_ovd);
 249                 DPAA2_SET_FLE_INTERNAL_JD(op_fle, hfn_ovd);
 250                 DPAA2_SET_FD_INTERNAL_JD(fd, hfn_ovd);
 251         }
 252
 253         return 0;
 254
 255 }
 256
 257 static inline int
 258 build_proto_fd(dpaa2_sec_session *sess,
 259                struct rte_crypto_op *op,
 260                struct qbman_fd *fd, uint16_t bpid)
 261 {
 262         struct rte_crypto_sym_op *sym_op = op->sym;
 263         if (sym_op->m_dst)
 264                 return build_proto_compound_fd(sess, op, fd, bpid);
 265
 266         struct ctxt_priv *priv = sess->ctxt;
 267         struct sec_flow_context *flc;
 268         struct rte_mbuf *mbuf = sym_op->m_src;
 269
 270         if (likely(bpid < MAX_BPID))
 271                 DPAA2_SET_FD_BPID(fd, bpid);
 272         else
 273                 DPAA2_SET_FD_IVP(fd);
 274
 275         /* Save the shared descriptor */
 276         flc = &priv->flc_desc[0].flc;
 277
 278         DPAA2_SET_FD_ADDR(fd, DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
 279         DPAA2_SET_FD_OFFSET(fd, sym_op->m_src->data_off);
 280         DPAA2_SET_FD_LEN(fd, sym_op->m_src->pkt_len);
 281         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 282
 283         /* save physical address of mbuf */
 284         op->sym->aead.digest.phys_addr = mbuf->buf_iova;
 285         mbuf->buf_iova = (size_t)op;
 286
 287         return 0;
 288 }
 289 #endif
 290
 291 static inline int
 292 build_authenc_gcm_sg_fd(dpaa2_sec_session *sess,
 293                  struct rte_crypto_op *op,
 294                  struct qbman_fd *fd, __rte_unused uint16_t bpid)
 295 {
 296         struct rte_crypto_sym_op *sym_op = op->sym;
 297         struct ctxt_priv *priv = sess->ctxt;
 298         struct qbman_fle *fle, *sge, *ip_fle, *op_fle;
 299         struct sec_flow_context *flc;
 300         uint32_t auth_only_len = sess->ext_params.aead_ctxt.auth_only_len;
 301         int icv_len = sess->digest_length;
 302         uint8_t *old_icv;
 303         struct rte_mbuf *mbuf;
 304         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 305                         sess->iv.offset);
 306
 307         if (sym_op->m_dst)
 308                 mbuf = sym_op->m_dst;
 309         else
 310                 mbuf = sym_op->m_src;
 311
 312         /* first FLE entry used to store mbuf and session ctxt */
 313         fle = (struct qbman_fle *)rte_malloc(NULL,
 314                         FLE_SG_MEM_SIZE(mbuf->nb_segs + sym_op->m_src->nb_segs),
 315                         RTE_CACHE_LINE_SIZE);
 316         if (unlikely(!fle)) {
 317                 DPAA2_SEC_ERR("GCM SG: Memory alloc failed for SGE");
 318                 return -1;
 319         }
 320         memset(fle, 0, FLE_SG_MEM_SIZE(mbuf->nb_segs + sym_op->m_src->nb_segs));
 321         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 322         DPAA2_FLE_SAVE_CTXT(fle, (size_t)priv);
 323
 324         op_fle = fle + 1;
 325         ip_fle = fle + 2;
 326         sge = fle + 3;
 327
 328         /* Save the shared descriptor */
 329         flc = &priv->flc_desc[0].flc;
 330
 331         /* Configure FD as a FRAME LIST */
 332         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(op_fle));
 333         DPAA2_SET_FD_COMPOUND_FMT(fd);
 334         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 335
 336         DPAA2_SEC_DP_DEBUG("GCM SG: auth_off: 0x%x/length %d, digest-len=%d\n"
 337                    "iv-len=%d data_off: 0x%x\n",
 338                    sym_op->aead.data.offset,
 339                    sym_op->aead.data.length,
 340                    sess->digest_length,
 341                    sess->iv.length,
 342                    sym_op->m_src->data_off);
 343
 344         /* Configure Output FLE with Scatter/Gather Entry */
 345         DPAA2_SET_FLE_SG_EXT(op_fle);
 346         DPAA2_SET_FLE_ADDR(op_fle, DPAA2_VADDR_TO_IOVA(sge));
 347
 348         if (auth_only_len)
 349                 DPAA2_SET_FLE_INTERNAL_JD(op_fle, auth_only_len);
 350
 351         op_fle->length = (sess->dir == DIR_ENC) ?
 352                         (sym_op->aead.data.length + icv_len) :
 353                         sym_op->aead.data.length;
 354
 355         /* Configure Output SGE for Encap/Decap */
 356         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 357         DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off + sym_op->aead.data.offset);
 358         sge->length = mbuf->data_len - sym_op->aead.data.offset;
 359
 360         mbuf = mbuf->next;
 361         /* o/p segs */
 362         while (mbuf) {
 363                 sge++;
 364                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 365                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 366                 sge->length = mbuf->data_len;
 367                 mbuf = mbuf->next;
 368         }
 369         sge->length -= icv_len;
 370
 371         if (sess->dir == DIR_ENC) {
 372                 sge++;
 373                 DPAA2_SET_FLE_ADDR(sge,
 374                                 DPAA2_VADDR_TO_IOVA(sym_op->aead.digest.data));
 375                 sge->length = icv_len;
 376         }
 377         DPAA2_SET_FLE_FIN(sge);
 378
 379         sge++;
 380         mbuf = sym_op->m_src;
 381
 382         /* Configure Input FLE with Scatter/Gather Entry */
 383         DPAA2_SET_FLE_ADDR(ip_fle, DPAA2_VADDR_TO_IOVA(sge));
 384         DPAA2_SET_FLE_SG_EXT(ip_fle);
 385         DPAA2_SET_FLE_FIN(ip_fle);
 386         ip_fle->length = (sess->dir == DIR_ENC) ?
 387                 (sym_op->aead.data.length + sess->iv.length + auth_only_len) :
 388                 (sym_op->aead.data.length + sess->iv.length + auth_only_len +
 389                  icv_len);
 390
 391         /* Configure Input SGE for Encap/Decap */
 392         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(IV_ptr));
 393         sge->length = sess->iv.length;
 394
 395         sge++;
 396         if (auth_only_len) {
 397                 DPAA2_SET_FLE_ADDR(sge,
 398                                 DPAA2_VADDR_TO_IOVA(sym_op->aead.aad.data));
 399                 sge->length = auth_only_len;
 400                 sge++;
 401         }
 402
 403         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 404         DPAA2_SET_FLE_OFFSET(sge, sym_op->aead.data.offset +
 405                                 mbuf->data_off);
 406         sge->length = mbuf->data_len - sym_op->aead.data.offset;
 407
 408         mbuf = mbuf->next;
 409         /* i/p segs */
 410         while (mbuf) {
 411                 sge++;
 412                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 413                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 414                 sge->length = mbuf->data_len;
 415                 mbuf = mbuf->next;
 416         }
 417
 418         if (sess->dir == DIR_DEC) {
 419                 sge++;
 420                 old_icv = (uint8_t *)(sge + 1);
 421                 memcpy(old_icv, sym_op->aead.digest.data, icv_len);
 422                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_icv));
 423                 sge->length = icv_len;
 424         }
 425
 426         DPAA2_SET_FLE_FIN(sge);
 427         if (auth_only_len) {
 428                 DPAA2_SET_FLE_INTERNAL_JD(ip_fle, auth_only_len);
 429                 DPAA2_SET_FD_INTERNAL_JD(fd, auth_only_len);
 430         }
 431         DPAA2_SET_FD_LEN(fd, ip_fle->length);
 432
 433         return 0;
 434 }
 435
 436 static inline int
 437 build_authenc_gcm_fd(dpaa2_sec_session *sess,
 438                      struct rte_crypto_op *op,
 439                      struct qbman_fd *fd, uint16_t bpid)
 440 {
 441         struct rte_crypto_sym_op *sym_op = op->sym;
 442         struct ctxt_priv *priv = sess->ctxt;
 443         struct qbman_fle *fle, *sge;
 444         struct sec_flow_context *flc;
 445         uint32_t auth_only_len = sess->ext_params.aead_ctxt.auth_only_len;
 446         int icv_len = sess->digest_length, retval;
 447         uint8_t *old_icv;
 448         struct rte_mbuf *dst;
 449         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 450                         sess->iv.offset);
 451
 452         if (sym_op->m_dst)
 453                 dst = sym_op->m_dst;
 454         else
 455                 dst = sym_op->m_src;
 456
 457         /* TODO we are using the first FLE entry to store Mbuf and session ctxt.
 458          * Currently we donot know which FLE has the mbuf stored.
 459          * So while retreiving we can go back 1 FLE from the FD -ADDR
 460          * to get the MBUF Addr from the previous FLE.
 461          * We can have a better approach to use the inline Mbuf
 462          */
 463         retval = rte_mempool_get(priv->fle_pool, (void **)(&fle));
 464         if (retval) {
 465                 DPAA2_SEC_ERR("GCM: Memory alloc failed for SGE");
 466                 return -1;
 467         }
 468         memset(fle, 0, FLE_POOL_BUF_SIZE);
 469         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 470         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 471         fle = fle + 1;
 472         sge = fle + 2;
 473         if (likely(bpid < MAX_BPID)) {
 474                 DPAA2_SET_FD_BPID(fd, bpid);
 475                 DPAA2_SET_FLE_BPID(fle, bpid);
 476                 DPAA2_SET_FLE_BPID(fle + 1, bpid);
 477                 DPAA2_SET_FLE_BPID(sge, bpid);
 478                 DPAA2_SET_FLE_BPID(sge + 1, bpid);
 479                 DPAA2_SET_FLE_BPID(sge + 2, bpid);
 480                 DPAA2_SET_FLE_BPID(sge + 3, bpid);
 481         } else {
 482                 DPAA2_SET_FD_IVP(fd);
 483                 DPAA2_SET_FLE_IVP(fle);
 484                 DPAA2_SET_FLE_IVP((fle + 1));
 485                 DPAA2_SET_FLE_IVP(sge);
 486                 DPAA2_SET_FLE_IVP((sge + 1));
 487                 DPAA2_SET_FLE_IVP((sge + 2));
 488                 DPAA2_SET_FLE_IVP((sge + 3));
 489         }
 490
 491         /* Save the shared descriptor */
 492         flc = &priv->flc_desc[0].flc;
 493         /* Configure FD as a FRAME LIST */
 494         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(fle));
 495         DPAA2_SET_FD_COMPOUND_FMT(fd);
 496         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 497
 498         DPAA2_SEC_DP_DEBUG("GCM: auth_off: 0x%x/length %d, digest-len=%d\n"
 499                    "iv-len=%d data_off: 0x%x\n",
 500                    sym_op->aead.data.offset,
 501                    sym_op->aead.data.length,
 502                    sess->digest_length,
 503                    sess->iv.length,
 504                    sym_op->m_src->data_off);
 505
 506         /* Configure Output FLE with Scatter/Gather Entry */
 507         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
 508         if (auth_only_len)
 509                 DPAA2_SET_FLE_INTERNAL_JD(fle, auth_only_len);
 510         fle->length = (sess->dir == DIR_ENC) ?
 511                         (sym_op->aead.data.length + icv_len) :
 512                         sym_op->aead.data.length;
 513
 514         DPAA2_SET_FLE_SG_EXT(fle);
 515
 516         /* Configure Output SGE for Encap/Decap */
 517         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(dst));
 518         DPAA2_SET_FLE_OFFSET(sge, dst->data_off + sym_op->aead.data.offset);
 519         sge->length = sym_op->aead.data.length;
 520
 521         if (sess->dir == DIR_ENC) {
 522                 sge++;
 523                 DPAA2_SET_FLE_ADDR(sge,
 524                                 DPAA2_VADDR_TO_IOVA(sym_op->aead.digest.data));
 525                 sge->length = sess->digest_length;
 526         }
 527         DPAA2_SET_FLE_FIN(sge);
 528
 529         sge++;
 530         fle++;
 531
 532         /* Configure Input FLE with Scatter/Gather Entry */
 533         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
 534         DPAA2_SET_FLE_SG_EXT(fle);
 535         DPAA2_SET_FLE_FIN(fle);
 536         fle->length = (sess->dir == DIR_ENC) ?
 537                 (sym_op->aead.data.length + sess->iv.length + auth_only_len) :
 538                 (sym_op->aead.data.length + sess->iv.length + auth_only_len +
 539                  sess->digest_length);
 540
 541         /* Configure Input SGE for Encap/Decap */
 542         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(IV_ptr));
 543         sge->length = sess->iv.length;
 544         sge++;
 545         if (auth_only_len) {
 546                 DPAA2_SET_FLE_ADDR(sge,
 547                                 DPAA2_VADDR_TO_IOVA(sym_op->aead.aad.data));
 548                 sge->length = auth_only_len;
 549                 DPAA2_SET_FLE_BPID(sge, bpid);
 550                 sge++;
 551         }
 552
 553         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
 554         DPAA2_SET_FLE_OFFSET(sge, sym_op->aead.data.offset +
 555                                 sym_op->m_src->data_off);
 556         sge->length = sym_op->aead.data.length;
 557         if (sess->dir == DIR_DEC) {
 558                 sge++;
 559                 old_icv = (uint8_t *)(sge + 1);
 560                 memcpy(old_icv, sym_op->aead.digest.data,
 561                        sess->digest_length);
 562                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_icv));
 563                 sge->length = sess->digest_length;
 564         }
 565         DPAA2_SET_FLE_FIN(sge);
 566
 567         if (auth_only_len) {
 568                 DPAA2_SET_FLE_INTERNAL_JD(fle, auth_only_len);
 569                 DPAA2_SET_FD_INTERNAL_JD(fd, auth_only_len);
 570         }
 571
 572         DPAA2_SET_FD_LEN(fd, fle->length);
 573         return 0;
 574 }
 575
 576 static inline int
 577 build_authenc_sg_fd(dpaa2_sec_session *sess,
 578                  struct rte_crypto_op *op,
 579                  struct qbman_fd *fd, __rte_unused uint16_t bpid)
 580 {
 581         struct rte_crypto_sym_op *sym_op = op->sym;
 582         struct ctxt_priv *priv = sess->ctxt;
 583         struct qbman_fle *fle, *sge, *ip_fle, *op_fle;
 584         struct sec_flow_context *flc;
 585         uint16_t auth_hdr_len = sym_op->cipher.data.offset -
 586                                 sym_op->auth.data.offset;
 587         uint16_t auth_tail_len = sym_op->auth.data.length -
 588                                 sym_op->cipher.data.length - auth_hdr_len;
 589         uint32_t auth_only_len = (auth_tail_len << 16) | auth_hdr_len;
 590         int icv_len = sess->digest_length;
 591         uint8_t *old_icv;
 592         struct rte_mbuf *mbuf;
 593         uint8_t *iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 594                         sess->iv.offset);
 595
 596         if (sym_op->m_dst)
 597                 mbuf = sym_op->m_dst;
 598         else
 599                 mbuf = sym_op->m_src;
 600
 601         /* first FLE entry used to store mbuf and session ctxt */
 602         fle = (struct qbman_fle *)rte_malloc(NULL,
 603                         FLE_SG_MEM_SIZE(mbuf->nb_segs + sym_op->m_src->nb_segs),
 604                         RTE_CACHE_LINE_SIZE);
 605         if (unlikely(!fle)) {
 606                 DPAA2_SEC_ERR("AUTHENC SG: Memory alloc failed for SGE");
 607                 return -1;
 608         }
 609         memset(fle, 0, FLE_SG_MEM_SIZE(mbuf->nb_segs + sym_op->m_src->nb_segs));
 610         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 611         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 612
 613         op_fle = fle + 1;
 614         ip_fle = fle + 2;
 615         sge = fle + 3;
 616
 617         /* Save the shared descriptor */
 618         flc = &priv->flc_desc[0].flc;
 619
 620         /* Configure FD as a FRAME LIST */
 621         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(op_fle));
 622         DPAA2_SET_FD_COMPOUND_FMT(fd);
 623         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 624
 625         DPAA2_SEC_DP_DEBUG(
 626                 "AUTHENC SG: auth_off: 0x%x/length %d, digest-len=%d\n"
 627                 "cipher_off: 0x%x/length %d, iv-len=%d data_off: 0x%x\n",
 628                 sym_op->auth.data.offset,
 629                 sym_op->auth.data.length,
 630                 sess->digest_length,
 631                 sym_op->cipher.data.offset,
 632                 sym_op->cipher.data.length,
 633                 sess->iv.length,
 634                 sym_op->m_src->data_off);
 635
 636         /* Configure Output FLE with Scatter/Gather Entry */
 637         DPAA2_SET_FLE_SG_EXT(op_fle);
 638         DPAA2_SET_FLE_ADDR(op_fle, DPAA2_VADDR_TO_IOVA(sge));
 639
 640         if (auth_only_len)
 641                 DPAA2_SET_FLE_INTERNAL_JD(op_fle, auth_only_len);
 642
 643         op_fle->length = (sess->dir == DIR_ENC) ?
 644                         (sym_op->cipher.data.length + icv_len) :
 645                         sym_op->cipher.data.length;
 646
 647         /* Configure Output SGE for Encap/Decap */
 648         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 649         DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off + sym_op->auth.data.offset);
 650         sge->length = mbuf->data_len - sym_op->auth.data.offset;
 651
 652         mbuf = mbuf->next;
 653         /* o/p segs */
 654         while (mbuf) {
 655                 sge++;
 656                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 657                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 658                 sge->length = mbuf->data_len;
 659                 mbuf = mbuf->next;
 660         }
 661         sge->length -= icv_len;
 662
 663         if (sess->dir == DIR_ENC) {
 664                 sge++;
 665                 DPAA2_SET_FLE_ADDR(sge,
 666                                 DPAA2_VADDR_TO_IOVA(sym_op->auth.digest.data));
 667                 sge->length = icv_len;
 668         }
 669         DPAA2_SET_FLE_FIN(sge);
 670
 671         sge++;
 672         mbuf = sym_op->m_src;
 673
 674         /* Configure Input FLE with Scatter/Gather Entry */
 675         DPAA2_SET_FLE_ADDR(ip_fle, DPAA2_VADDR_TO_IOVA(sge));
 676         DPAA2_SET_FLE_SG_EXT(ip_fle);
 677         DPAA2_SET_FLE_FIN(ip_fle);
 678         ip_fle->length = (sess->dir == DIR_ENC) ?
 679                         (sym_op->auth.data.length + sess->iv.length) :
 680                         (sym_op->auth.data.length + sess->iv.length +
 681                          icv_len);
 682
 683         /* Configure Input SGE for Encap/Decap */
 684         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(iv_ptr));
 685         sge->length = sess->iv.length;
 686
 687         sge++;
 688         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 689         DPAA2_SET_FLE_OFFSET(sge, sym_op->auth.data.offset +
 690                                 mbuf->data_off);
 691         sge->length = mbuf->data_len - sym_op->auth.data.offset;
 692
 693         mbuf = mbuf->next;
 694         /* i/p segs */
 695         while (mbuf) {
 696                 sge++;
 697                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 698                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 699                 sge->length = mbuf->data_len;
 700                 mbuf = mbuf->next;
 701         }
 702         sge->length -= icv_len;
 703
 704         if (sess->dir == DIR_DEC) {
 705                 sge++;
 706                 old_icv = (uint8_t *)(sge + 1);
 707                 memcpy(old_icv, sym_op->auth.digest.data,
 708                        icv_len);
 709                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_icv));
 710                 sge->length = icv_len;
 711         }
 712
 713         DPAA2_SET_FLE_FIN(sge);
 714         if (auth_only_len) {
 715                 DPAA2_SET_FLE_INTERNAL_JD(ip_fle, auth_only_len);
 716                 DPAA2_SET_FD_INTERNAL_JD(fd, auth_only_len);
 717         }
 718         DPAA2_SET_FD_LEN(fd, ip_fle->length);
 719
 720         return 0;
 721 }
 722
 723 static inline int
 724 build_authenc_fd(dpaa2_sec_session *sess,
 725                  struct rte_crypto_op *op,
 726                  struct qbman_fd *fd, uint16_t bpid)
 727 {
 728         struct rte_crypto_sym_op *sym_op = op->sym;
 729         struct ctxt_priv *priv = sess->ctxt;
 730         struct qbman_fle *fle, *sge;
 731         struct sec_flow_context *flc;
 732         uint16_t auth_hdr_len = sym_op->cipher.data.offset -
 733                                 sym_op->auth.data.offset;
 734         uint16_t auth_tail_len = sym_op->auth.data.length -
 735                                 sym_op->cipher.data.length - auth_hdr_len;
 736         uint32_t auth_only_len = (auth_tail_len << 16) | auth_hdr_len;
 737
 738         int icv_len = sess->digest_length, retval;
 739         uint8_t *old_icv;
 740         uint8_t *iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 741                         sess->iv.offset);
 742         struct rte_mbuf *dst;
 743
 744         if (sym_op->m_dst)
 745                 dst = sym_op->m_dst;
 746         else
 747                 dst = sym_op->m_src;
 748
 749         /* we are using the first FLE entry to store Mbuf.
 750          * Currently we donot know which FLE has the mbuf stored.
 751          * So while retreiving we can go back 1 FLE from the FD -ADDR
 752          * to get the MBUF Addr from the previous FLE.
 753          * We can have a better approach to use the inline Mbuf
 754          */
 755         retval = rte_mempool_get(priv->fle_pool, (void **)(&fle));
 756         if (retval) {
 757                 DPAA2_SEC_ERR("Memory alloc failed for SGE");
 758                 return -1;
 759         }
 760         memset(fle, 0, FLE_POOL_BUF_SIZE);
 761         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 762         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 763         fle = fle + 1;
 764         sge = fle + 2;
 765         if (likely(bpid < MAX_BPID)) {
 766                 DPAA2_SET_FD_BPID(fd, bpid);
 767                 DPAA2_SET_FLE_BPID(fle, bpid);
 768                 DPAA2_SET_FLE_BPID(fle + 1, bpid);
 769                 DPAA2_SET_FLE_BPID(sge, bpid);
 770                 DPAA2_SET_FLE_BPID(sge + 1, bpid);
 771                 DPAA2_SET_FLE_BPID(sge + 2, bpid);
 772                 DPAA2_SET_FLE_BPID(sge + 3, bpid);
 773         } else {
 774                 DPAA2_SET_FD_IVP(fd);
 775                 DPAA2_SET_FLE_IVP(fle);
 776                 DPAA2_SET_FLE_IVP((fle + 1));
 777                 DPAA2_SET_FLE_IVP(sge);
 778                 DPAA2_SET_FLE_IVP((sge + 1));
 779                 DPAA2_SET_FLE_IVP((sge + 2));
 780                 DPAA2_SET_FLE_IVP((sge + 3));
 781         }
 782
 783         /* Save the shared descriptor */
 784         flc = &priv->flc_desc[0].flc;
 785         /* Configure FD as a FRAME LIST */
 786         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(fle));
 787         DPAA2_SET_FD_COMPOUND_FMT(fd);
 788         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 789
 790         DPAA2_SEC_DP_DEBUG(
 791                 "AUTHENC: auth_off: 0x%x/length %d, digest-len=%d\n"
 792                 "cipher_off: 0x%x/length %d, iv-len=%d data_off: 0x%x\n",
 793                 sym_op->auth.data.offset,
 794                 sym_op->auth.data.length,
 795                 sess->digest_length,
 796                 sym_op->cipher.data.offset,
 797                 sym_op->cipher.data.length,
 798                 sess->iv.length,
 799                 sym_op->m_src->data_off);
 800
 801         /* Configure Output FLE with Scatter/Gather Entry */
 802         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
 803         if (auth_only_len)
 804                 DPAA2_SET_FLE_INTERNAL_JD(fle, auth_only_len);
 805         fle->length = (sess->dir == DIR_ENC) ?
 806                         (sym_op->cipher.data.length + icv_len) :
 807                         sym_op->cipher.data.length;
 808
 809         DPAA2_SET_FLE_SG_EXT(fle);
 810
 811         /* Configure Output SGE for Encap/Decap */
 812         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(dst));
 813         DPAA2_SET_FLE_OFFSET(sge, sym_op->cipher.data.offset +
 814                                 dst->data_off);
 815         sge->length = sym_op->cipher.data.length;
 816
 817         if (sess->dir == DIR_ENC) {
 818                 sge++;
 819                 DPAA2_SET_FLE_ADDR(sge,
 820                                 DPAA2_VADDR_TO_IOVA(sym_op->auth.digest.data));
 821                 sge->length = sess->digest_length;
 822                 DPAA2_SET_FD_LEN(fd, (sym_op->auth.data.length +
 823                                         sess->iv.length));
 824         }
 825         DPAA2_SET_FLE_FIN(sge);
 826
 827         sge++;
 828         fle++;
 829
 830         /* Configure Input FLE with Scatter/Gather Entry */
 831         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
 832         DPAA2_SET_FLE_SG_EXT(fle);
 833         DPAA2_SET_FLE_FIN(fle);
 834         fle->length = (sess->dir == DIR_ENC) ?
 835                         (sym_op->auth.data.length + sess->iv.length) :
 836                         (sym_op->auth.data.length + sess->iv.length +
 837                          sess->digest_length);
 838
 839         /* Configure Input SGE for Encap/Decap */
 840         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(iv_ptr));
 841         sge->length = sess->iv.length;
 842         sge++;
 843
 844         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
 845         DPAA2_SET_FLE_OFFSET(sge, sym_op->auth.data.offset +
 846                                 sym_op->m_src->data_off);
 847         sge->length = sym_op->auth.data.length;
 848         if (sess->dir == DIR_DEC) {
 849                 sge++;
 850                 old_icv = (uint8_t *)(sge + 1);
 851                 memcpy(old_icv, sym_op->auth.digest.data,
 852                        sess->digest_length);
 853                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_icv));
 854                 sge->length = sess->digest_length;
 855                 DPAA2_SET_FD_LEN(fd, (sym_op->auth.data.length +
 856                                  sess->digest_length +
 857                                  sess->iv.length));
 858         }
 859         DPAA2_SET_FLE_FIN(sge);
 860         if (auth_only_len) {
 861                 DPAA2_SET_FLE_INTERNAL_JD(fle, auth_only_len);
 862                 DPAA2_SET_FD_INTERNAL_JD(fd, auth_only_len);
 863         }
 864         return 0;
 865 }
 866
 867 static inline int build_auth_sg_fd(
 868                 dpaa2_sec_session *sess,
 869                 struct rte_crypto_op *op,
 870                 struct qbman_fd *fd,
 871                 __rte_unused uint16_t bpid)
 872 {
 873         struct rte_crypto_sym_op *sym_op = op->sym;
 874         struct qbman_fle *fle, *sge, *ip_fle, *op_fle;
 875         struct sec_flow_context *flc;
 876         struct ctxt_priv *priv = sess->ctxt;
 877         int data_len, data_offset;
 878         uint8_t *old_digest;
 879         struct rte_mbuf *mbuf;
 880
 881         data_len = sym_op->auth.data.length;
 882         data_offset = sym_op->auth.data.offset;
 883
 884         if (sess->auth_alg == RTE_CRYPTO_AUTH_SNOW3G_UIA2 ||
 885             sess->auth_alg == RTE_CRYPTO_AUTH_ZUC_EIA3) {
 886                 if ((data_len & 7) || (data_offset & 7)) {
 887                         DPAA2_SEC_ERR("AUTH: len/offset must be full bytes");
 888                         return -1;
 889                 }
 890
 891                 data_len = data_len >> 3;
 892                 data_offset = data_offset >> 3;
 893         }
 894
 895         mbuf = sym_op->m_src;
 896         fle = (struct qbman_fle *)rte_malloc(NULL,
 897                         FLE_SG_MEM_SIZE(mbuf->nb_segs),
 898                         RTE_CACHE_LINE_SIZE);
 899         if (unlikely(!fle)) {
 900                 DPAA2_SEC_ERR("AUTH SG: Memory alloc failed for SGE");
 901                 return -1;
 902         }
 903         memset(fle, 0, FLE_SG_MEM_SIZE(mbuf->nb_segs));
 904         /* first FLE entry used to store mbuf and session ctxt */
 905         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
 906         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
 907         op_fle = fle + 1;
 908         ip_fle = fle + 2;
 909         sge = fle + 3;
 910
 911         flc = &priv->flc_desc[DESC_INITFINAL].flc;
 912         /* sg FD */
 913         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
 914         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(op_fle));
 915         DPAA2_SET_FD_COMPOUND_FMT(fd);
 916
 917         /* o/p fle */
 918         DPAA2_SET_FLE_ADDR(op_fle,
 919                                 DPAA2_VADDR_TO_IOVA(sym_op->auth.digest.data));
 920         op_fle->length = sess->digest_length;
 921
 922         /* i/p fle */
 923         DPAA2_SET_FLE_SG_EXT(ip_fle);
 924         DPAA2_SET_FLE_ADDR(ip_fle, DPAA2_VADDR_TO_IOVA(sge));
 925         ip_fle->length = data_len;
 926
 927         if (sess->iv.length) {
 928                 uint8_t *iv_ptr;
 929
 930                 iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 931                                                    sess->iv.offset);
 932
 933                 if (sess->auth_alg == RTE_CRYPTO_AUTH_SNOW3G_UIA2) {
 934                         iv_ptr = conv_to_snow_f9_iv(iv_ptr);
 935                         sge->length = 12;
 936                 } else if (sess->auth_alg == RTE_CRYPTO_AUTH_ZUC_EIA3) {
 937                         iv_ptr = conv_to_zuc_eia_iv(iv_ptr);
 938                         sge->length = 8;
 939                 } else {
 940                         sge->length = sess->iv.length;
 941                 }
 942                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(iv_ptr));
 943                 ip_fle->length += sge->length;
 944                 sge++;
 945         }
 946         /* i/p 1st seg */
 947         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 948         DPAA2_SET_FLE_OFFSET(sge, data_offset + mbuf->data_off);
 949
 950         if (data_len <= (mbuf->data_len - data_offset)) {
 951                 sge->length = data_len;
 952                 data_len = 0;
 953         } else {
 954                 sge->length = mbuf->data_len - data_offset;
 955
 956                 /* remaining i/p segs */
 957                 while ((data_len = data_len - sge->length) &&
 958                        (mbuf = mbuf->next)) {
 959                         sge++;
 960                         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
 961                         DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
 962                         if (data_len > mbuf->data_len)
 963                                 sge->length = mbuf->data_len;
 964                         else
 965                                 sge->length = data_len;
 966                 }
 967         }
 968
 969         if (sess->dir == DIR_DEC) {
 970                 /* Digest verification case */
 971                 sge++;
 972                 old_digest = (uint8_t *)(sge + 1);
 973                 rte_memcpy(old_digest, sym_op->auth.digest.data,
 974                            sess->digest_length);
 975                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_digest));
 976                 sge->length = sess->digest_length;
 977                 ip_fle->length += sess->digest_length;
 978         }
 979         DPAA2_SET_FLE_FIN(sge);
 980         DPAA2_SET_FLE_FIN(ip_fle);
 981         DPAA2_SET_FD_LEN(fd, ip_fle->length);
 982
 983         return 0;
 984 }
 985
 986 static inline int
 987 build_auth_fd(dpaa2_sec_session *sess, struct rte_crypto_op *op,
 988               struct qbman_fd *fd, uint16_t bpid)
 989 {
 990         struct rte_crypto_sym_op *sym_op = op->sym;
 991         struct qbman_fle *fle, *sge;
 992         struct sec_flow_context *flc;
 993         struct ctxt_priv *priv = sess->ctxt;
 994         int data_len, data_offset;
 995         uint8_t *old_digest;
 996         int retval;
 997
 998         data_len = sym_op->auth.data.length;
 999         data_offset = sym_op->auth.data.offset;
1000
1001         if (sess->auth_alg == RTE_CRYPTO_AUTH_SNOW3G_UIA2 ||
1002             sess->auth_alg == RTE_CRYPTO_AUTH_ZUC_EIA3) {
1003                 if ((data_len & 7) || (data_offset & 7)) {
1004                         DPAA2_SEC_ERR("AUTH: len/offset must be full bytes");
1005                         return -1;
1006                 }
1007
1008                 data_len = data_len >> 3;
1009                 data_offset = data_offset >> 3;
1010         }
1011
1012         retval = rte_mempool_get(priv->fle_pool, (void **)(&fle));
1013         if (retval) {
1014                 DPAA2_SEC_ERR("AUTH Memory alloc failed for SGE");
1015                 return -1;
1016         }
1017         memset(fle, 0, FLE_POOL_BUF_SIZE);
1018         /* TODO we are using the first FLE entry to store Mbuf.
1019          * Currently we donot know which FLE has the mbuf stored.
1020          * So while retreiving we can go back 1 FLE from the FD -ADDR
1021          * to get the MBUF Addr from the previous FLE.
1022          * We can have a better approach to use the inline Mbuf
1023          */
1024         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
1025         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
1026         fle = fle + 1;
1027         sge = fle + 2;
1028
1029         if (likely(bpid < MAX_BPID)) {
1030                 DPAA2_SET_FD_BPID(fd, bpid);
1031                 DPAA2_SET_FLE_BPID(fle, bpid);
1032                 DPAA2_SET_FLE_BPID(fle + 1, bpid);
1033                 DPAA2_SET_FLE_BPID(sge, bpid);
1034                 DPAA2_SET_FLE_BPID(sge + 1, bpid);
1035         } else {
1036                 DPAA2_SET_FD_IVP(fd);
1037                 DPAA2_SET_FLE_IVP(fle);
1038                 DPAA2_SET_FLE_IVP((fle + 1));
1039                 DPAA2_SET_FLE_IVP(sge);
1040                 DPAA2_SET_FLE_IVP((sge + 1));
1041         }
1042
1043         flc = &priv->flc_desc[DESC_INITFINAL].flc;
1044         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
1045         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(fle));
1046         DPAA2_SET_FD_COMPOUND_FMT(fd);
1047
1048         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sym_op->auth.digest.data));
1049         fle->length = sess->digest_length;
1050         fle++;
1051
1052         /* Setting input FLE */
1053         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
1054         DPAA2_SET_FLE_SG_EXT(fle);
1055         fle->length = data_len;
1056
1057         if (sess->iv.length) {
1058                 uint8_t *iv_ptr;
1059
1060                 iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1061                                                    sess->iv.offset);
1062
1063                 if (sess->auth_alg == RTE_CRYPTO_AUTH_SNOW3G_UIA2) {
1064                         iv_ptr = conv_to_snow_f9_iv(iv_ptr);
1065                         sge->length = 12;
1066                 } else if (sess->auth_alg == RTE_CRYPTO_AUTH_ZUC_EIA3) {
1067                         iv_ptr = conv_to_zuc_eia_iv(iv_ptr);
1068                         sge->length = 8;
1069                 } else {
1070                         sge->length = sess->iv.length;
1071                 }
1072
1073                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(iv_ptr));
1074                 fle->length = fle->length + sge->length;
1075                 sge++;
1076         }
1077
1078         /* Setting data to authenticate */
1079         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
1080         DPAA2_SET_FLE_OFFSET(sge, data_offset + sym_op->m_src->data_off);
1081         sge->length = data_len;
1082
1083         if (sess->dir == DIR_DEC) {
1084                 sge++;
1085                 old_digest = (uint8_t *)(sge + 1);
1086                 rte_memcpy(old_digest, sym_op->auth.digest.data,
1087                            sess->digest_length);
1088                 DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(old_digest));
1089                 sge->length = sess->digest_length;
1090                 fle->length = fle->length + sess->digest_length;
1091         }
1092
1093         DPAA2_SET_FLE_FIN(sge);
1094         DPAA2_SET_FLE_FIN(fle);
1095         DPAA2_SET_FD_LEN(fd, fle->length);
1096
1097         return 0;
1098 }
1099
1100 static int
1101 build_cipher_sg_fd(dpaa2_sec_session *sess, struct rte_crypto_op *op,
1102                 struct qbman_fd *fd, __rte_unused uint16_t bpid)
1103 {
1104         struct rte_crypto_sym_op *sym_op = op->sym;
1105         struct qbman_fle *ip_fle, *op_fle, *sge, *fle;
1106         int data_len, data_offset;
1107         struct sec_flow_context *flc;
1108         struct ctxt_priv *priv = sess->ctxt;
1109         struct rte_mbuf *mbuf;
1110         uint8_t *iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1111                         sess->iv.offset);
1112
1113         data_len = sym_op->cipher.data.length;
1114         data_offset = sym_op->cipher.data.offset;
1115
1116         if (sess->cipher_alg == RTE_CRYPTO_CIPHER_SNOW3G_UEA2 ||
1117                 sess->cipher_alg == RTE_CRYPTO_CIPHER_ZUC_EEA3) {
1118                 if ((data_len & 7) || (data_offset & 7)) {
1119                         DPAA2_SEC_ERR("CIPHER: len/offset must be full bytes");
1120                         return -1;
1121                 }
1122
1123                 data_len = data_len >> 3;
1124                 data_offset = data_offset >> 3;
1125         }
1126
1127         if (sym_op->m_dst)
1128                 mbuf = sym_op->m_dst;
1129         else
1130                 mbuf = sym_op->m_src;
1131
1132         /* first FLE entry used to store mbuf and session ctxt */
1133         fle = (struct qbman_fle *)rte_malloc(NULL,
1134                         FLE_SG_MEM_SIZE(mbuf->nb_segs + sym_op->m_src->nb_segs),
1135                         RTE_CACHE_LINE_SIZE);
1136         if (!fle) {
1137                 DPAA2_SEC_ERR("CIPHER SG: Memory alloc failed for SGE");
1138                 return -1;
1139         }
1140         memset(fle, 0, FLE_SG_MEM_SIZE(mbuf->nb_segs + sym_op->m_src->nb_segs));
1141         /* first FLE entry used to store mbuf and session ctxt */
1142         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
1143         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
1144
1145         op_fle = fle + 1;
1146         ip_fle = fle + 2;
1147         sge = fle + 3;
1148
1149         flc = &priv->flc_desc[0].flc;
1150
1151         DPAA2_SEC_DP_DEBUG(
1152                 "CIPHER SG: cipher_off: 0x%x/length %d, ivlen=%d"
1153                 " data_off: 0x%x\n",
1154                 data_offset,
1155                 data_len,
1156                 sess->iv.length,
1157                 sym_op->m_src->data_off);
1158
1159         /* o/p fle */
1160         DPAA2_SET_FLE_ADDR(op_fle, DPAA2_VADDR_TO_IOVA(sge));
1161         op_fle->length = data_len;
1162         DPAA2_SET_FLE_SG_EXT(op_fle);
1163
1164         /* o/p 1st seg */
1165         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
1166         DPAA2_SET_FLE_OFFSET(sge, data_offset + mbuf->data_off);
1167         sge->length = mbuf->data_len - data_offset;
1168
1169         mbuf = mbuf->next;
1170         /* o/p segs */
1171         while (mbuf) {
1172                 sge++;
1173                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
1174                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
1175                 sge->length = mbuf->data_len;
1176                 mbuf = mbuf->next;
1177         }
1178         DPAA2_SET_FLE_FIN(sge);
1179
1180         DPAA2_SEC_DP_DEBUG(
1181                 "CIPHER SG: 1 - flc = %p, fle = %p FLEaddr = %x-%x, len %d\n",
1182                 flc, fle, fle->addr_hi, fle->addr_lo,
1183                 fle->length);
1184
1185         /* i/p fle */
1186         mbuf = sym_op->m_src;
1187         sge++;
1188         DPAA2_SET_FLE_ADDR(ip_fle, DPAA2_VADDR_TO_IOVA(sge));
1189         ip_fle->length = sess->iv.length + data_len;
1190         DPAA2_SET_FLE_SG_EXT(ip_fle);
1191
1192         /* i/p IV */
1193         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(iv_ptr));
1194         DPAA2_SET_FLE_OFFSET(sge, 0);
1195         sge->length = sess->iv.length;
1196
1197         sge++;
1198
1199         /* i/p 1st seg */
1200         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
1201         DPAA2_SET_FLE_OFFSET(sge, data_offset + mbuf->data_off);
1202         sge->length = mbuf->data_len - data_offset;
1203
1204         mbuf = mbuf->next;
1205         /* i/p segs */
1206         while (mbuf) {
1207                 sge++;
1208                 DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(mbuf));
1209                 DPAA2_SET_FLE_OFFSET(sge, mbuf->data_off);
1210                 sge->length = mbuf->data_len;
1211                 mbuf = mbuf->next;
1212         }
1213         DPAA2_SET_FLE_FIN(sge);
1214         DPAA2_SET_FLE_FIN(ip_fle);
1215
1216         /* sg fd */
1217         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(op_fle));
1218         DPAA2_SET_FD_LEN(fd, ip_fle->length);
1219         DPAA2_SET_FD_COMPOUND_FMT(fd);
1220         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
1221
1222         DPAA2_SEC_DP_DEBUG(
1223                 "CIPHER SG: fdaddr =%" PRIx64 " bpid =%d meta =%d"
1224                 " off =%d, len =%d\n",
1225                 DPAA2_GET_FD_ADDR(fd),
1226                 DPAA2_GET_FD_BPID(fd),
1227                 rte_dpaa2_bpid_info[bpid].meta_data_size,
1228                 DPAA2_GET_FD_OFFSET(fd),
1229                 DPAA2_GET_FD_LEN(fd));
1230         return 0;
1231 }
1232
1233 static int
1234 build_cipher_fd(dpaa2_sec_session *sess, struct rte_crypto_op *op,
1235                 struct qbman_fd *fd, uint16_t bpid)
1236 {
1237         struct rte_crypto_sym_op *sym_op = op->sym;
1238         struct qbman_fle *fle, *sge;
1239         int retval, data_len, data_offset;
1240         struct sec_flow_context *flc;
1241         struct ctxt_priv *priv = sess->ctxt;
1242         uint8_t *iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1243                         sess->iv.offset);
1244         struct rte_mbuf *dst;
1245
1246         data_len = sym_op->cipher.data.length;
1247         data_offset = sym_op->cipher.data.offset;
1248
1249         if (sess->cipher_alg == RTE_CRYPTO_CIPHER_SNOW3G_UEA2 ||
1250                 sess->cipher_alg == RTE_CRYPTO_CIPHER_ZUC_EEA3) {
1251                 if ((data_len & 7) || (data_offset & 7)) {
1252                         DPAA2_SEC_ERR("CIPHER: len/offset must be full bytes");
1253                         return -1;
1254                 }
1255
1256                 data_len = data_len >> 3;
1257                 data_offset = data_offset >> 3;
1258         }
1259
1260         if (sym_op->m_dst)
1261                 dst = sym_op->m_dst;
1262         else
1263                 dst = sym_op->m_src;
1264
1265         retval = rte_mempool_get(priv->fle_pool, (void **)(&fle));
1266         if (retval) {
1267                 DPAA2_SEC_ERR("CIPHER: Memory alloc failed for SGE");
1268                 return -1;
1269         }
1270         memset(fle, 0, FLE_POOL_BUF_SIZE);
1271         /* TODO we are using the first FLE entry to store Mbuf.
1272          * Currently we donot know which FLE has the mbuf stored.
1273          * So while retreiving we can go back 1 FLE from the FD -ADDR
1274          * to get the MBUF Addr from the previous FLE.
1275          * We can have a better approach to use the inline Mbuf
1276          */
1277         DPAA2_SET_FLE_ADDR(fle, (size_t)op);
1278         DPAA2_FLE_SAVE_CTXT(fle, (ptrdiff_t)priv);
1279         fle = fle + 1;
1280         sge = fle + 2;
1281
1282         if (likely(bpid < MAX_BPID)) {
1283                 DPAA2_SET_FD_BPID(fd, bpid);
1284                 DPAA2_SET_FLE_BPID(fle, bpid);
1285                 DPAA2_SET_FLE_BPID(fle + 1, bpid);
1286                 DPAA2_SET_FLE_BPID(sge, bpid);
1287                 DPAA2_SET_FLE_BPID(sge + 1, bpid);
1288         } else {
1289                 DPAA2_SET_FD_IVP(fd);
1290                 DPAA2_SET_FLE_IVP(fle);
1291                 DPAA2_SET_FLE_IVP((fle + 1));
1292                 DPAA2_SET_FLE_IVP(sge);
1293                 DPAA2_SET_FLE_IVP((sge + 1));
1294         }
1295
1296         flc = &priv->flc_desc[0].flc;
1297         DPAA2_SET_FD_ADDR(fd, DPAA2_VADDR_TO_IOVA(fle));
1298         DPAA2_SET_FD_LEN(fd, data_len + sess->iv.length);
1299         DPAA2_SET_FD_COMPOUND_FMT(fd);
1300         DPAA2_SET_FD_FLC(fd, DPAA2_VADDR_TO_IOVA(flc));
1301
1302         DPAA2_SEC_DP_DEBUG(
1303                 "CIPHER: cipher_off: 0x%x/length %d, ivlen=%d,"
1304                 " data_off: 0x%x\n",
1305                 data_offset,
1306                 data_len,
1307                 sess->iv.length,
1308                 sym_op->m_src->data_off);
1309
1310         DPAA2_SET_FLE_ADDR(fle, DPAA2_MBUF_VADDR_TO_IOVA(dst));
1311         DPAA2_SET_FLE_OFFSET(fle, data_offset + dst->data_off);
1312
1313         fle->length = data_len + sess->iv.length;
1314
1315         DPAA2_SEC_DP_DEBUG(
1316                 "CIPHER: 1 - flc = %p, fle = %p FLEaddr = %x-%x, length %d\n",
1317                 flc, fle, fle->addr_hi, fle->addr_lo,
1318                 fle->length);
1319
1320         fle++;
1321
1322         DPAA2_SET_FLE_ADDR(fle, DPAA2_VADDR_TO_IOVA(sge));
1323         fle->length = data_len + sess->iv.length;
1324
1325         DPAA2_SET_FLE_SG_EXT(fle);
1326
1327         DPAA2_SET_FLE_ADDR(sge, DPAA2_VADDR_TO_IOVA(iv_ptr));
1328         sge->length = sess->iv.length;
1329
1330         sge++;
1331         DPAA2_SET_FLE_ADDR(sge, DPAA2_MBUF_VADDR_TO_IOVA(sym_op->m_src));
1332         DPAA2_SET_FLE_OFFSET(sge, data_offset + sym_op->m_src->data_off);
1333
1334         sge->length = data_len;
1335         DPAA2_SET_FLE_FIN(sge);
1336         DPAA2_SET_FLE_FIN(fle);
1337
1338         DPAA2_SEC_DP_DEBUG(
1339                 "CIPHER: fdaddr =%" PRIx64 " bpid =%d meta =%d"
1340                 " off =%d, len =%d\n",
1341                 DPAA2_GET_FD_ADDR(fd),
1342                 DPAA2_GET_FD_BPID(fd),
1343                 rte_dpaa2_bpid_info[bpid].meta_data_size,
1344                 DPAA2_GET_FD_OFFSET(fd),
1345                 DPAA2_GET_FD_LEN(fd));
1346
1347         return 0;
1348 }
1349
1350 static inline int
1351 build_sec_fd(struct rte_crypto_op *op,
1352              struct qbman_fd *fd, uint16_t bpid)
1353 {
1354         int ret = -1;
1355         dpaa2_sec_session *sess;
1356
1357         if (op->sess_type == RTE_CRYPTO_OP_WITH_SESSION)
1358                 sess = (dpaa2_sec_session *)get_sym_session_private_data(
1359                                 op->sym->session, cryptodev_driver_id);
1360 #ifdef RTE_LIBRTE_SECURITY
1361         else if (op->sess_type == RTE_CRYPTO_OP_SECURITY_SESSION)
1362                 sess = (dpaa2_sec_session *)get_sec_session_private_data(
1363                                 op->sym->sec_session);
1364 #endif
1365         else
1366                 return -1;
1367
1368         if (!sess)
1369                 return -1;
1370
1371         /* Any of the buffer is segmented*/
1372         if (!rte_pktmbuf_is_contiguous(op->sym->m_src) ||
1373                   ((op->sym->m_dst != NULL) &&
1374                    !rte_pktmbuf_is_contiguous(op->sym->m_dst))) {
1375                 switch (sess->ctxt_type) {
1376                 case DPAA2_SEC_CIPHER:
1377                         ret = build_cipher_sg_fd(sess, op, fd, bpid);
1378                         break;
1379                 case DPAA2_SEC_AUTH:
1380                         ret = build_auth_sg_fd(sess, op, fd, bpid);
1381                         break;
1382                 case DPAA2_SEC_AEAD:
1383                         ret = build_authenc_gcm_sg_fd(sess, op, fd, bpid);
1384                         break;
1385                 case DPAA2_SEC_CIPHER_HASH:
1386                         ret = build_authenc_sg_fd(sess, op, fd, bpid);
1387                         break;
1388 #ifdef RTE_LIBRTE_SECURITY
1389                 case DPAA2_SEC_IPSEC:
1390                 case DPAA2_SEC_PDCP:
1391                         ret = build_proto_compound_sg_fd(sess, op, fd, bpid);
1392                         break;
1393 #endif
1394                 case DPAA2_SEC_HASH_CIPHER:
1395                 default:
1396                         DPAA2_SEC_ERR("error: Unsupported session");
1397                 }
1398         } else {
1399                 switch (sess->ctxt_type) {
1400                 case DPAA2_SEC_CIPHER:
1401                         ret = build_cipher_fd(sess, op, fd, bpid);
1402                         break;
1403                 case DPAA2_SEC_AUTH:
1404                         ret = build_auth_fd(sess, op, fd, bpid);
1405                         break;
1406                 case DPAA2_SEC_AEAD:
1407                         ret = build_authenc_gcm_fd(sess, op, fd, bpid);
1408                         break;
1409                 case DPAA2_SEC_CIPHER_HASH:
1410                         ret = build_authenc_fd(sess, op, fd, bpid);
1411                         break;
1412 #ifdef RTE_LIBRTE_SECURITY
1413                 case DPAA2_SEC_IPSEC:
1414                         ret = build_proto_fd(sess, op, fd, bpid);
1415                         break;
1416                 case DPAA2_SEC_PDCP:
1417                         ret = build_proto_compound_fd(sess, op, fd, bpid);
1418                         break;
1419 #endif
1420                 case DPAA2_SEC_HASH_CIPHER:
1421                 default:
1422                         DPAA2_SEC_ERR("error: Unsupported session");
1423                 }
1424         }
1425         return ret;
1426 }
1427
1428 static uint16_t
1429 dpaa2_sec_enqueue_burst(void *qp, struct rte_crypto_op **ops,
1430                         uint16_t nb_ops)
1431 {
1432         /* Function to transmit the frames to given device and VQ*/
1433         uint32_t loop;
1434         int32_t ret;
1435         struct qbman_fd fd_arr[MAX_TX_RING_SLOTS];
1436         uint32_t frames_to_send;
1437         struct qbman_eq_desc eqdesc;
1438         struct dpaa2_sec_qp *dpaa2_qp = (struct dpaa2_sec_qp *)qp;
1439         struct qbman_swp *swp;
1440         uint16_t num_tx = 0;
1441         uint32_t flags[MAX_TX_RING_SLOTS] = {0};
1442         /*todo - need to support multiple buffer pools */
1443         uint16_t bpid;
1444         struct rte_mempool *mb_pool;
1445
1446         if (unlikely(nb_ops == 0))
1447                 return 0;
1448
1449         if (ops[0]->sess_type == RTE_CRYPTO_OP_SESSIONLESS) {
1450                 DPAA2_SEC_ERR("sessionless crypto op not supported");
1451                 return 0;
1452         }
1453         /*Prepare enqueue descriptor*/
1454         qbman_eq_desc_clear(&eqdesc);
1455         qbman_eq_desc_set_no_orp(&eqdesc, DPAA2_EQ_RESP_ERR_FQ);
1456         qbman_eq_desc_set_response(&eqdesc, 0, 0);
1457         qbman_eq_desc_set_fq(&eqdesc, dpaa2_qp->tx_vq.fqid);
1458
1459         if (!DPAA2_PER_LCORE_DPIO) {
1460                 ret = dpaa2_affine_qbman_swp();
1461                 if (ret) {
1462                         DPAA2_SEC_ERR("Failure in affining portal");
1463                         return 0;
1464                 }
1465         }
1466         swp = DPAA2_PER_LCORE_PORTAL;
1467
1468         while (nb_ops) {
1469                 frames_to_send = (nb_ops > dpaa2_eqcr_size) ?
1470                         dpaa2_eqcr_size : nb_ops;
1471
1472                 for (loop = 0; loop < frames_to_send; loop++) {
1473                         if ((*ops)->sym->m_src->seqn) {
1474                          uint8_t dqrr_index = (*ops)->sym->m_src->seqn - 1;
1475
1476                          flags[loop] = QBMAN_ENQUEUE_FLAG_DCA | dqrr_index;
1477                          DPAA2_PER_LCORE_DQRR_SIZE--;
1478                          DPAA2_PER_LCORE_DQRR_HELD &= ~(1 << dqrr_index);
1479                          (*ops)->sym->m_src->seqn = DPAA2_INVALID_MBUF_SEQN;
1480                         }
1481
1482                         /*Clear the unused FD fields before sending*/
1483                         memset(&fd_arr[loop], 0, sizeof(struct qbman_fd));
1484                         mb_pool = (*ops)->sym->m_src->pool;
1485                         bpid = mempool_to_bpid(mb_pool);
1486                         ret = build_sec_fd(*ops, &fd_arr[loop], bpid);
1487                         if (ret) {
1488                                 DPAA2_SEC_ERR("error: Improper packet contents"
1489                                               " for crypto operation");
1490                                 goto skip_tx;
1491                         }
1492                         ops++;
1493                 }
1494                 loop = 0;
1495                 while (loop < frames_to_send) {
1496                         loop += qbman_swp_enqueue_multiple(swp, &eqdesc,
1497                                                         &fd_arr[loop],
1498                                                         &flags[loop],
1499                                                         frames_to_send - loop);
1500                 }
1501
1502                 num_tx += frames_to_send;
1503                 nb_ops -= frames_to_send;
1504         }
1505 skip_tx:
1506         dpaa2_qp->tx_vq.tx_pkts += num_tx;
1507         dpaa2_qp->tx_vq.err_pkts += nb_ops;
1508         return num_tx;
1509 }
1510
1511 #ifdef RTE_LIBRTE_SECURITY
1512 static inline struct rte_crypto_op *
1513 sec_simple_fd_to_mbuf(const struct qbman_fd *fd)
1514 {
1515         struct rte_crypto_op *op;
1516         uint16_t len = DPAA2_GET_FD_LEN(fd);
1517         int16_t diff = 0;
1518         dpaa2_sec_session *sess_priv __rte_unused;
1519
1520         struct rte_mbuf *mbuf = DPAA2_INLINE_MBUF_FROM_BUF(
1521                 DPAA2_IOVA_TO_VADDR(DPAA2_GET_FD_ADDR(fd)),
1522                 rte_dpaa2_bpid_info[DPAA2_GET_FD_BPID(fd)].meta_data_size);
1523
1524         diff = len - mbuf->pkt_len;
1525         mbuf->pkt_len += diff;
1526         mbuf->data_len += diff;
1527         op = (struct rte_crypto_op *)(size_t)mbuf->buf_iova;
1528         mbuf->buf_iova = op->sym->aead.digest.phys_addr;
1529         op->sym->aead.digest.phys_addr = 0L;
1530
1531         sess_priv = (dpaa2_sec_session *)get_sec_session_private_data(
1532                                 op->sym->sec_session);
1533         if (sess_priv->dir == DIR_ENC)
1534                 mbuf->data_off += SEC_FLC_DHR_OUTBOUND;
1535         else
1536                 mbuf->data_off += SEC_FLC_DHR_INBOUND;
1537
1538         return op;
1539 }
1540 #endif
1541
1542 static inline struct rte_crypto_op *
1543 sec_fd_to_mbuf(const struct qbman_fd *fd)
1544 {
1545         struct qbman_fle *fle;
1546         struct rte_crypto_op *op;
1547         struct ctxt_priv *priv;
1548         struct rte_mbuf *dst, *src;
1549
1550 #ifdef RTE_LIBRTE_SECURITY
1551         if (DPAA2_FD_GET_FORMAT(fd) == qbman_fd_single)
1552                 return sec_simple_fd_to_mbuf(fd);
1553 #endif
1554         fle = (struct qbman_fle *)DPAA2_IOVA_TO_VADDR(DPAA2_GET_FD_ADDR(fd));
1555
1556         DPAA2_SEC_DP_DEBUG("FLE addr = %x - %x, offset = %x\n",
1557                            fle->addr_hi, fle->addr_lo, fle->fin_bpid_offset);
1558
1559         /* we are using the first FLE entry to store Mbuf.
1560          * Currently we donot know which FLE has the mbuf stored.
1561          * So while retreiving we can go back 1 FLE from the FD -ADDR
1562          * to get the MBUF Addr from the previous FLE.
1563          * We can have a better approach to use the inline Mbuf
1564          */
1565
1566         if (unlikely(DPAA2_GET_FD_IVP(fd))) {
1567                 /* TODO complete it. */
1568                 DPAA2_SEC_ERR("error: non inline buffer");
1569                 return NULL;
1570         }
1571         op = (struct rte_crypto_op *)DPAA2_GET_FLE_ADDR((fle - 1));
1572
1573         /* Prefeth op */
1574         src = op->sym->m_src;
1575         rte_prefetch0(src);
1576
1577         if (op->sym->m_dst) {
1578                 dst = op->sym->m_dst;
1579                 rte_prefetch0(dst);
1580         } else
1581                 dst = src;
1582
1583 #ifdef RTE_LIBRTE_SECURITY
1584         if (op->sess_type == RTE_CRYPTO_OP_SECURITY_SESSION) {
1585                 uint16_t len = DPAA2_GET_FD_LEN(fd);
1586                 dst->pkt_len = len;
1587                 while (dst->next != NULL) {
1588                         len -= dst->data_len;
1589                         dst = dst->next;
1590                 }
1591                 dst->data_len = len;
1592         }
1593 #endif
1594         DPAA2_SEC_DP_DEBUG("mbuf %p BMAN buf addr %p,"
1595                 " fdaddr =%" PRIx64 " bpid =%d meta =%d off =%d, len =%d\n",
1596                 (void *)dst,
1597                 dst->buf_addr,
1598                 DPAA2_GET_FD_ADDR(fd),
1599                 DPAA2_GET_FD_BPID(fd),
1600                 rte_dpaa2_bpid_info[DPAA2_GET_FD_BPID(fd)].meta_data_size,
1601                 DPAA2_GET_FD_OFFSET(fd),
1602                 DPAA2_GET_FD_LEN(fd));
1603
1604         /* free the fle memory */
1605         if (likely(rte_pktmbuf_is_contiguous(src))) {
1606                 priv = (struct ctxt_priv *)(size_t)DPAA2_GET_FLE_CTXT(fle - 1);
1607                 rte_mempool_put(priv->fle_pool, (void *)(fle-1));
1608         } else
1609                 rte_free((void *)(fle-1));
1610
1611         return op;
1612 }
1613
1614 static uint16_t
1615 dpaa2_sec_dequeue_burst(void *qp, struct rte_crypto_op **ops,
1616                         uint16_t nb_ops)
1617 {
1618         /* Function is responsible to receive frames for a given device and VQ*/
1619         struct dpaa2_sec_qp *dpaa2_qp = (struct dpaa2_sec_qp *)qp;
1620         struct qbman_result *dq_storage;
1621         uint32_t fqid = dpaa2_qp->rx_vq.fqid;
1622         int ret, num_rx = 0;
1623         uint8_t is_last = 0, status;
1624         struct qbman_swp *swp;
1625         const struct qbman_fd *fd;
1626         struct qbman_pull_desc pulldesc;
1627
1628         if (!DPAA2_PER_LCORE_DPIO) {
1629                 ret = dpaa2_affine_qbman_swp();
1630                 if (ret) {
1631                         DPAA2_SEC_ERR("Failure in affining portal");
1632                         return 0;
1633                 }
1634         }
1635         swp = DPAA2_PER_LCORE_PORTAL;
1636         dq_storage = dpaa2_qp->rx_vq.q_storage->dq_storage[0];
1637
1638         qbman_pull_desc_clear(&pulldesc);
1639         qbman_pull_desc_set_numframes(&pulldesc,
1640                                       (nb_ops > dpaa2_dqrr_size) ?
1641                                       dpaa2_dqrr_size : nb_ops);
1642         qbman_pull_desc_set_fq(&pulldesc, fqid);
1643         qbman_pull_desc_set_storage(&pulldesc, dq_storage,
1644                                     (dma_addr_t)DPAA2_VADDR_TO_IOVA(dq_storage),
1645                                     1);
1646
1647         /*Issue a volatile dequeue command. */
1648         while (1) {
1649                 if (qbman_swp_pull(swp, &pulldesc)) {
1650                         DPAA2_SEC_WARN(
1651                                 "SEC VDQ command is not issued : QBMAN busy");
1652                         /* Portal was busy, try again */
1653                         continue;
1654                 }
1655                 break;
1656         };
1657
1658         /* Receive the packets till Last Dequeue entry is found with
1659          * respect to the above issues PULL command.
1660          */
1661         while (!is_last) {
1662                 /* Check if the previous issued command is completed.
1663                  * Also seems like the SWP is shared between the Ethernet Driver
1664                  * and the SEC driver.
1665                  */
1666                 while (!qbman_check_command_complete(dq_storage))
1667                         ;
1668
1669                 /* Loop until the dq_storage is updated with
1670                  * new token by QBMAN
1671                  */
1672                 while (!qbman_check_new_result(dq_storage))
1673                         ;
1674                 /* Check whether Last Pull command is Expired and
1675                  * setting Condition for Loop termination
1676                  */
1677                 if (qbman_result_DQ_is_pull_complete(dq_storage)) {
1678                         is_last = 1;
1679                         /* Check for valid frame. */
1680                         status = (uint8_t)qbman_result_DQ_flags(dq_storage);
1681                         if (unlikely(
1682                                 (status & QBMAN_DQ_STAT_VALIDFRAME) == 0)) {
1683                                 DPAA2_SEC_DP_DEBUG("No frame is delivered\n");
1684                                 continue;
1685                         }
1686                 }
1687
1688                 fd = qbman_result_DQ_fd(dq_storage);
1689                 ops[num_rx] = sec_fd_to_mbuf(fd);
1690
1691                 if (unlikely(fd->simple.frc)) {
1692                         /* TODO Parse SEC errors */
1693                         DPAA2_SEC_ERR("SEC returned Error - %x",
1694                                       fd->simple.frc);
1695                         ops[num_rx]->status = RTE_CRYPTO_OP_STATUS_ERROR;
1696                 } else {
1697                         ops[num_rx]->status = RTE_CRYPTO_OP_STATUS_SUCCESS;
1698                 }
1699
1700                 num_rx++;
1701                 dq_storage++;
1702         } /* End of Packet Rx loop */
1703
1704         dpaa2_qp->rx_vq.rx_pkts += num_rx;
1705
1706         DPAA2_SEC_DP_DEBUG("SEC Received %d Packets\n", num_rx);
1707         /*Return the total number of packets received to DPAA2 app*/
1708         return num_rx;
1709 }
1710
1711 /** Release queue pair */
1712 static int
1713 dpaa2_sec_queue_pair_release(struct rte_cryptodev *dev, uint16_t queue_pair_id)
1714 {
1715         struct dpaa2_sec_qp *qp =
1716                 (struct dpaa2_sec_qp *)dev->data->queue_pairs[queue_pair_id];
1717
1718         PMD_INIT_FUNC_TRACE();
1719
1720         if (qp->rx_vq.q_storage) {
1721                 dpaa2_free_dq_storage(qp->rx_vq.q_storage);
1722                 rte_free(qp->rx_vq.q_storage);
1723         }
1724         rte_free(qp);
1725
1726         dev->data->queue_pairs[queue_pair_id] = NULL;
1727
1728         return 0;
1729 }
1730
1731 /** Setup a queue pair */
1732 static int
1733 dpaa2_sec_queue_pair_setup(struct rte_cryptodev *dev, uint16_t qp_id,
1734                 __rte_unused const struct rte_cryptodev_qp_conf *qp_conf,
1735                 __rte_unused int socket_id)
1736 {
1737         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
1738         struct dpaa2_sec_qp *qp;
1739         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
1740         struct dpseci_rx_queue_cfg cfg;
1741         int32_t retcode;
1742
1743         PMD_INIT_FUNC_TRACE();
1744
1745         /* If qp is already in use free ring memory and qp metadata. */
1746         if (dev->data->queue_pairs[qp_id] != NULL) {
1747                 DPAA2_SEC_INFO("QP already setup");
1748                 return 0;
1749         }
1750
1751         DPAA2_SEC_DEBUG("dev =%p, queue =%d, conf =%p",
1752                     dev, qp_id, qp_conf);
1753
1754         memset(&cfg, 0, sizeof(struct dpseci_rx_queue_cfg));
1755
1756         qp = rte_malloc(NULL, sizeof(struct dpaa2_sec_qp),
1757                         RTE_CACHE_LINE_SIZE);
1758         if (!qp) {
1759                 DPAA2_SEC_ERR("malloc failed for rx/tx queues");
1760                 return -1;
1761         }
1762
1763         qp->rx_vq.crypto_data = dev->data;
1764         qp->tx_vq.crypto_data = dev->data;
1765         qp->rx_vq.q_storage = rte_malloc("sec dq storage",
1766                 sizeof(struct queue_storage_info_t),
1767                 RTE_CACHE_LINE_SIZE);
1768         if (!qp->rx_vq.q_storage) {
1769                 DPAA2_SEC_ERR("malloc failed for q_storage");
1770                 return -1;
1771         }
1772         memset(qp->rx_vq.q_storage, 0, sizeof(struct queue_storage_info_t));
1773
1774         if (dpaa2_alloc_dq_storage(qp->rx_vq.q_storage)) {
1775                 DPAA2_SEC_ERR("Unable to allocate dequeue storage");
1776                 return -1;
1777         }
1778
1779         dev->data->queue_pairs[qp_id] = qp;
1780
1781         cfg.options = cfg.options | DPSECI_QUEUE_OPT_USER_CTX;
1782         cfg.user_ctx = (size_t)(&qp->rx_vq);
1783         retcode = dpseci_set_rx_queue(dpseci, CMD_PRI_LOW, priv->token,
1784                                       qp_id, &cfg);
1785         return retcode;
1786 }
1787
1788 /** Return the number of allocated queue pairs */
1789 static uint32_t
1790 dpaa2_sec_queue_pair_count(struct rte_cryptodev *dev)
1791 {
1792         PMD_INIT_FUNC_TRACE();
1793
1794         return dev->data->nb_queue_pairs;
1795 }
1796
1797 /** Returns the size of the aesni gcm session structure */
1798 static unsigned int
1799 dpaa2_sec_sym_session_get_size(struct rte_cryptodev *dev __rte_unused)
1800 {
1801         PMD_INIT_FUNC_TRACE();
1802
1803         return sizeof(dpaa2_sec_session);
1804 }
1805
1806 static int
1807 dpaa2_sec_cipher_init(struct rte_cryptodev *dev,
1808                       struct rte_crypto_sym_xform *xform,
1809                       dpaa2_sec_session *session)
1810 {
1811         struct dpaa2_sec_dev_private *dev_priv = dev->data->dev_private;
1812         struct alginfo cipherdata;
1813         int bufsize;
1814         struct ctxt_priv *priv;
1815         struct sec_flow_context *flc;
1816
1817         PMD_INIT_FUNC_TRACE();
1818
1819         /* For SEC CIPHER only one descriptor is required. */
1820         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
1821                         sizeof(struct ctxt_priv) + sizeof(struct sec_flc_desc),
1822                         RTE_CACHE_LINE_SIZE);
1823         if (priv == NULL) {
1824                 DPAA2_SEC_ERR("No Memory for priv CTXT");
1825                 return -1;
1826         }
1827
1828         priv->fle_pool = dev_priv->fle_pool;
1829
1830         flc = &priv->flc_desc[0].flc;
1831
1832         session->ctxt_type = DPAA2_SEC_CIPHER;
1833         session->cipher_key.data = rte_zmalloc(NULL, xform->cipher.key.length,
1834                         RTE_CACHE_LINE_SIZE);
1835         if (session->cipher_key.data == NULL) {
1836                 DPAA2_SEC_ERR("No Memory for cipher key");
1837                 rte_free(priv);
1838                 return -1;
1839         }
1840         session->cipher_key.length = xform->cipher.key.length;
1841
1842         memcpy(session->cipher_key.data, xform->cipher.key.data,
1843                xform->cipher.key.length);
1844         cipherdata.key = (size_t)session->cipher_key.data;
1845         cipherdata.keylen = session->cipher_key.length;
1846         cipherdata.key_enc_flags = 0;
1847         cipherdata.key_type = RTA_DATA_IMM;
1848
1849         /* Set IV parameters */
1850         session->iv.offset = xform->cipher.iv.offset;
1851         session->iv.length = xform->cipher.iv.length;
1852         session->dir = (xform->cipher.op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
1853                                 DIR_ENC : DIR_DEC;
1854
1855         switch (xform->cipher.algo) {
1856         case RTE_CRYPTO_CIPHER_AES_CBC:
1857                 cipherdata.algtype = OP_ALG_ALGSEL_AES;
1858                 cipherdata.algmode = OP_ALG_AAI_CBC;
1859                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CBC;
1860                 bufsize = cnstr_shdsc_blkcipher(priv->flc_desc[0].desc, 1, 0,
1861                                                 SHR_NEVER, &cipherdata,
1862                                                 session->iv.length,
1863                                                 session->dir);
1864                 break;
1865         case RTE_CRYPTO_CIPHER_3DES_CBC:
1866                 cipherdata.algtype = OP_ALG_ALGSEL_3DES;
1867                 cipherdata.algmode = OP_ALG_AAI_CBC;
1868                 session->cipher_alg = RTE_CRYPTO_CIPHER_3DES_CBC;
1869                 bufsize = cnstr_shdsc_blkcipher(priv->flc_desc[0].desc, 1, 0,
1870                                                 SHR_NEVER, &cipherdata,
1871                                                 session->iv.length,
1872                                                 session->dir);
1873                 break;
1874         case RTE_CRYPTO_CIPHER_AES_CTR:
1875                 cipherdata.algtype = OP_ALG_ALGSEL_AES;
1876                 cipherdata.algmode = OP_ALG_AAI_CTR;
1877                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CTR;
1878                 bufsize = cnstr_shdsc_blkcipher(priv->flc_desc[0].desc, 1, 0,
1879                                                 SHR_NEVER, &cipherdata,
1880                                                 session->iv.length,
1881                                                 session->dir);
1882                 break;
1883         case RTE_CRYPTO_CIPHER_3DES_CTR:
1884                 cipherdata.algtype = OP_ALG_ALGSEL_3DES;
1885                 cipherdata.algmode = OP_ALG_AAI_CTR;
1886                 session->cipher_alg = RTE_CRYPTO_CIPHER_3DES_CTR;
1887                 bufsize = cnstr_shdsc_blkcipher(priv->flc_desc[0].desc, 1, 0,
1888                                                 SHR_NEVER, &cipherdata,
1889                                                 session->iv.length,
1890                                                 session->dir);
1891                 break;
1892         case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
1893                 cipherdata.algtype = OP_ALG_ALGSEL_SNOW_F8;
1894                 session->cipher_alg = RTE_CRYPTO_CIPHER_SNOW3G_UEA2;
1895                 bufsize = cnstr_shdsc_snow_f8(priv->flc_desc[0].desc, 1, 0,
1896                                               &cipherdata,
1897                                               session->dir);
1898                 break;
1899         case RTE_CRYPTO_CIPHER_ZUC_EEA3:
1900                 cipherdata.algtype = OP_ALG_ALGSEL_ZUCE;
1901                 session->cipher_alg = RTE_CRYPTO_CIPHER_ZUC_EEA3;
1902                 bufsize = cnstr_shdsc_zuce(priv->flc_desc[0].desc, 1, 0,
1903                                               &cipherdata,
1904                                               session->dir);
1905                 break;
1906         case RTE_CRYPTO_CIPHER_KASUMI_F8:
1907         case RTE_CRYPTO_CIPHER_AES_F8:
1908         case RTE_CRYPTO_CIPHER_AES_ECB:
1909         case RTE_CRYPTO_CIPHER_3DES_ECB:
1910         case RTE_CRYPTO_CIPHER_AES_XTS:
1911         case RTE_CRYPTO_CIPHER_ARC4:
1912         case RTE_CRYPTO_CIPHER_NULL:
1913                 DPAA2_SEC_ERR("Crypto: Unsupported Cipher alg %u",
1914                         xform->cipher.algo);
1915                 goto error_out;
1916         default:
1917                 DPAA2_SEC_ERR("Crypto: Undefined Cipher specified %u",
1918                         xform->cipher.algo);
1919                 goto error_out;
1920         }
1921
1922         if (bufsize < 0) {
1923                 DPAA2_SEC_ERR("Crypto: Descriptor build failed");
1924                 goto error_out;
1925         }
1926
1927         flc->word1_sdl = (uint8_t)bufsize;
1928         session->ctxt = priv;
1929
1930 #ifdef CAAM_DESC_DEBUG
1931         int i;
1932         for (i = 0; i < bufsize; i++)
1933                 DPAA2_SEC_DEBUG("DESC[%d]:0x%x", i, priv->flc_desc[0].desc[i]);
1934 #endif
1935         return 0;
1936
1937 error_out:
1938         rte_free(session->cipher_key.data);
1939         rte_free(priv);
1940         return -1;
1941 }
1942
1943 static int
1944 dpaa2_sec_auth_init(struct rte_cryptodev *dev,
1945                     struct rte_crypto_sym_xform *xform,
1946                     dpaa2_sec_session *session)
1947 {
1948         struct dpaa2_sec_dev_private *dev_priv = dev->data->dev_private;
1949         struct alginfo authdata;
1950         int bufsize;
1951         struct ctxt_priv *priv;
1952         struct sec_flow_context *flc;
1953
1954         PMD_INIT_FUNC_TRACE();
1955
1956         /* For SEC AUTH three descriptors are required for various stages */
1957         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
1958                         sizeof(struct ctxt_priv) + 3 *
1959                         sizeof(struct sec_flc_desc),
1960                         RTE_CACHE_LINE_SIZE);
1961         if (priv == NULL) {
1962                 DPAA2_SEC_ERR("No Memory for priv CTXT");
1963                 return -1;
1964         }
1965
1966         priv->fle_pool = dev_priv->fle_pool;
1967         flc = &priv->flc_desc[DESC_INITFINAL].flc;
1968
1969         session->ctxt_type = DPAA2_SEC_AUTH;
1970         session->auth_key.data = rte_zmalloc(NULL, xform->auth.key.length,
1971                         RTE_CACHE_LINE_SIZE);
1972         if (session->auth_key.data == NULL) {
1973                 DPAA2_SEC_ERR("Unable to allocate memory for auth key");
1974                 rte_free(priv);
1975                 return -1;
1976         }
1977         session->auth_key.length = xform->auth.key.length;
1978
1979         memcpy(session->auth_key.data, xform->auth.key.data,
1980                xform->auth.key.length);
1981         authdata.key = (size_t)session->auth_key.data;
1982         authdata.keylen = session->auth_key.length;
1983         authdata.key_enc_flags = 0;
1984         authdata.key_type = RTA_DATA_IMM;
1985
1986         session->digest_length = xform->auth.digest_length;
1987         session->dir = (xform->auth.op == RTE_CRYPTO_AUTH_OP_GENERATE) ?
1988                                 DIR_ENC : DIR_DEC;
1989
1990         switch (xform->auth.algo) {
1991         case RTE_CRYPTO_AUTH_SHA1_HMAC:
1992                 authdata.algtype = OP_ALG_ALGSEL_SHA1;
1993                 authdata.algmode = OP_ALG_AAI_HMAC;
1994                 session->auth_alg = RTE_CRYPTO_AUTH_SHA1_HMAC;
1995                 bufsize = cnstr_shdsc_hmac(priv->flc_desc[DESC_INITFINAL].desc,
1996                                            1, 0, SHR_NEVER, &authdata,
1997                                            !session->dir,
1998                                            session->digest_length);
1999                 break;
2000         case RTE_CRYPTO_AUTH_MD5_HMAC:
2001                 authdata.algtype = OP_ALG_ALGSEL_MD5;
2002                 authdata.algmode = OP_ALG_AAI_HMAC;
2003                 session->auth_alg = RTE_CRYPTO_AUTH_MD5_HMAC;
2004                 bufsize = cnstr_shdsc_hmac(priv->flc_desc[DESC_INITFINAL].desc,
2005                                            1, 0, SHR_NEVER, &authdata,
2006                                            !session->dir,
2007                                            session->digest_length);
2008                 break;
2009         case RTE_CRYPTO_AUTH_SHA256_HMAC:
2010                 authdata.algtype = OP_ALG_ALGSEL_SHA256;
2011                 authdata.algmode = OP_ALG_AAI_HMAC;
2012                 session->auth_alg = RTE_CRYPTO_AUTH_SHA256_HMAC;
2013                 bufsize = cnstr_shdsc_hmac(priv->flc_desc[DESC_INITFINAL].desc,
2014                                            1, 0, SHR_NEVER, &authdata,
2015                                            !session->dir,
2016                                            session->digest_length);
2017                 break;
2018         case RTE_CRYPTO_AUTH_SHA384_HMAC:
2019                 authdata.algtype = OP_ALG_ALGSEL_SHA384;
2020                 authdata.algmode = OP_ALG_AAI_HMAC;
2021                 session->auth_alg = RTE_CRYPTO_AUTH_SHA384_HMAC;
2022                 bufsize = cnstr_shdsc_hmac(priv->flc_desc[DESC_INITFINAL].desc,
2023                                            1, 0, SHR_NEVER, &authdata,
2024                                            !session->dir,
2025                                            session->digest_length);
2026                 break;
2027         case RTE_CRYPTO_AUTH_SHA512_HMAC:
2028                 authdata.algtype = OP_ALG_ALGSEL_SHA512;
2029                 authdata.algmode = OP_ALG_AAI_HMAC;
2030                 session->auth_alg = RTE_CRYPTO_AUTH_SHA512_HMAC;
2031                 bufsize = cnstr_shdsc_hmac(priv->flc_desc[DESC_INITFINAL].desc,
2032                                            1, 0, SHR_NEVER, &authdata,
2033                                            !session->dir,
2034                                            session->digest_length);
2035                 break;
2036         case RTE_CRYPTO_AUTH_SHA224_HMAC:
2037                 authdata.algtype = OP_ALG_ALGSEL_SHA224;
2038                 authdata.algmode = OP_ALG_AAI_HMAC;
2039                 session->auth_alg = RTE_CRYPTO_AUTH_SHA224_HMAC;
2040                 bufsize = cnstr_shdsc_hmac(priv->flc_desc[DESC_INITFINAL].desc,
2041                                            1, 0, SHR_NEVER, &authdata,
2042                                            !session->dir,
2043                                            session->digest_length);
2044                 break;
2045         case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
2046                 authdata.algtype = OP_ALG_ALGSEL_SNOW_F9;
2047                 authdata.algmode = OP_ALG_AAI_F9;
2048                 session->auth_alg = RTE_CRYPTO_AUTH_SNOW3G_UIA2;
2049                 session->iv.offset = xform->auth.iv.offset;
2050                 session->iv.length = xform->auth.iv.length;
2051                 bufsize = cnstr_shdsc_snow_f9(priv->flc_desc[DESC_INITFINAL].desc,
2052                                               1, 0, &authdata,
2053                                               !session->dir,
2054                                               session->digest_length);
2055                 break;
2056         case RTE_CRYPTO_AUTH_ZUC_EIA3:
2057                 authdata.algtype = OP_ALG_ALGSEL_ZUCA;
2058                 authdata.algmode = OP_ALG_AAI_F9;
2059                 session->auth_alg = RTE_CRYPTO_AUTH_ZUC_EIA3;
2060                 session->iv.offset = xform->auth.iv.offset;
2061                 session->iv.length = xform->auth.iv.length;
2062                 bufsize = cnstr_shdsc_zuca(priv->flc_desc[DESC_INITFINAL].desc,
2063                                            1, 0, &authdata,
2064                                            !session->dir,
2065                                            session->digest_length);
2066                 break;
2067         case RTE_CRYPTO_AUTH_KASUMI_F9:
2068         case RTE_CRYPTO_AUTH_NULL:
2069         case RTE_CRYPTO_AUTH_SHA1:
2070         case RTE_CRYPTO_AUTH_SHA256:
2071         case RTE_CRYPTO_AUTH_SHA512:
2072         case RTE_CRYPTO_AUTH_SHA224:
2073         case RTE_CRYPTO_AUTH_SHA384:
2074         case RTE_CRYPTO_AUTH_MD5:
2075         case RTE_CRYPTO_AUTH_AES_GMAC:
2076         case RTE_CRYPTO_AUTH_AES_XCBC_MAC:
2077         case RTE_CRYPTO_AUTH_AES_CMAC:
2078         case RTE_CRYPTO_AUTH_AES_CBC_MAC:
2079                 DPAA2_SEC_ERR("Crypto: Unsupported auth alg %un",
2080                               xform->auth.algo);
2081                 goto error_out;
2082         default:
2083                 DPAA2_SEC_ERR("Crypto: Undefined Auth specified %u",
2084                               xform->auth.algo);
2085                 goto error_out;
2086         }
2087
2088         if (bufsize < 0) {
2089                 DPAA2_SEC_ERR("Crypto: Invalid buffer length");
2090                 goto error_out;
2091         }
2092
2093         flc->word1_sdl = (uint8_t)bufsize;
2094         session->ctxt = priv;
2095 #ifdef CAAM_DESC_DEBUG
2096         int i;
2097         for (i = 0; i < bufsize; i++)
2098                 DPAA2_SEC_DEBUG("DESC[%d]:0x%x",
2099                                 i, priv->flc_desc[DESC_INITFINAL].desc[i]);
2100 #endif
2101
2102         return 0;
2103
2104 error_out:
2105         rte_free(session->auth_key.data);
2106         rte_free(priv);
2107         return -1;
2108 }
2109
2110 static int
2111 dpaa2_sec_aead_init(struct rte_cryptodev *dev,
2112                     struct rte_crypto_sym_xform *xform,
2113                     dpaa2_sec_session *session)
2114 {
2115         struct dpaa2_sec_aead_ctxt *ctxt = &session->ext_params.aead_ctxt;
2116         struct dpaa2_sec_dev_private *dev_priv = dev->data->dev_private;
2117         struct alginfo aeaddata;
2118         int bufsize;
2119         struct ctxt_priv *priv;
2120         struct sec_flow_context *flc;
2121         struct rte_crypto_aead_xform *aead_xform = &xform->aead;
2122         int err;
2123
2124         PMD_INIT_FUNC_TRACE();
2125
2126         /* Set IV parameters */
2127         session->iv.offset = aead_xform->iv.offset;
2128         session->iv.length = aead_xform->iv.length;
2129         session->ctxt_type = DPAA2_SEC_AEAD;
2130
2131         /* For SEC AEAD only one descriptor is required */
2132         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
2133                         sizeof(struct ctxt_priv) + sizeof(struct sec_flc_desc),
2134                         RTE_CACHE_LINE_SIZE);
2135         if (priv == NULL) {
2136                 DPAA2_SEC_ERR("No Memory for priv CTXT");
2137                 return -1;
2138         }
2139
2140         priv->fle_pool = dev_priv->fle_pool;
2141         flc = &priv->flc_desc[0].flc;
2142
2143         session->aead_key.data = rte_zmalloc(NULL, aead_xform->key.length,
2144                                                RTE_CACHE_LINE_SIZE);
2145         if (session->aead_key.data == NULL && aead_xform->key.length > 0) {
2146                 DPAA2_SEC_ERR("No Memory for aead key");
2147                 rte_free(priv);
2148                 return -1;
2149         }
2150         memcpy(session->aead_key.data, aead_xform->key.data,
2151                aead_xform->key.length);
2152
2153         session->digest_length = aead_xform->digest_length;
2154         session->aead_key.length = aead_xform->key.length;
2155         ctxt->auth_only_len = aead_xform->aad_length;
2156
2157         aeaddata.key = (size_t)session->aead_key.data;
2158         aeaddata.keylen = session->aead_key.length;
2159         aeaddata.key_enc_flags = 0;
2160         aeaddata.key_type = RTA_DATA_IMM;
2161
2162         switch (aead_xform->algo) {
2163         case RTE_CRYPTO_AEAD_AES_GCM:
2164                 aeaddata.algtype = OP_ALG_ALGSEL_AES;
2165                 aeaddata.algmode = OP_ALG_AAI_GCM;
2166                 session->aead_alg = RTE_CRYPTO_AEAD_AES_GCM;
2167                 break;
2168         case RTE_CRYPTO_AEAD_AES_CCM:
2169                 DPAA2_SEC_ERR("Crypto: Unsupported AEAD alg %u",
2170                               aead_xform->algo);
2171                 goto error_out;
2172         default:
2173                 DPAA2_SEC_ERR("Crypto: Undefined AEAD specified %u",
2174                               aead_xform->algo);
2175                 goto error_out;
2176         }
2177         session->dir = (aead_xform->op == RTE_CRYPTO_AEAD_OP_ENCRYPT) ?
2178                                 DIR_ENC : DIR_DEC;
2179
2180         priv->flc_desc[0].desc[0] = aeaddata.keylen;
2181         err = rta_inline_query(IPSEC_AUTH_VAR_AES_DEC_BASE_DESC_LEN,
2182                                MIN_JOB_DESC_SIZE,
2183                                (unsigned int *)priv->flc_desc[0].desc,
2184                                &priv->flc_desc[0].desc[1], 1);
2185
2186         if (err < 0) {
2187                 DPAA2_SEC_ERR("Crypto: Incorrect key lengths");
2188                 goto error_out;
2189         }
2190         if (priv->flc_desc[0].desc[1] & 1) {
2191                 aeaddata.key_type = RTA_DATA_IMM;
2192         } else {
2193                 aeaddata.key = DPAA2_VADDR_TO_IOVA(aeaddata.key);
2194                 aeaddata.key_type = RTA_DATA_PTR;
2195         }
2196         priv->flc_desc[0].desc[0] = 0;
2197         priv->flc_desc[0].desc[1] = 0;
2198
2199         if (session->dir == DIR_ENC)
2200                 bufsize = cnstr_shdsc_gcm_encap(
2201                                 priv->flc_desc[0].desc, 1, 0, SHR_NEVER,
2202                                 &aeaddata, session->iv.length,
2203                                 session->digest_length);
2204         else
2205                 bufsize = cnstr_shdsc_gcm_decap(
2206                                 priv->flc_desc[0].desc, 1, 0, SHR_NEVER,
2207                                 &aeaddata, session->iv.length,
2208                                 session->digest_length);
2209         if (bufsize < 0) {
2210                 DPAA2_SEC_ERR("Crypto: Invalid buffer length");
2211                 goto error_out;
2212         }
2213
2214         flc->word1_sdl = (uint8_t)bufsize;
2215         session->ctxt = priv;
2216 #ifdef CAAM_DESC_DEBUG
2217         int i;
2218         for (i = 0; i < bufsize; i++)
2219                 DPAA2_SEC_DEBUG("DESC[%d]:0x%x\n",
2220                             i, priv->flc_desc[0].desc[i]);
2221 #endif
2222         return 0;
2223
2224 error_out:
2225         rte_free(session->aead_key.data);
2226         rte_free(priv);
2227         return -1;
2228 }
2229
2230
2231 static int
2232 dpaa2_sec_aead_chain_init(struct rte_cryptodev *dev,
2233                     struct rte_crypto_sym_xform *xform,
2234                     dpaa2_sec_session *session)
2235 {
2236         struct dpaa2_sec_dev_private *dev_priv = dev->data->dev_private;
2237         struct alginfo authdata, cipherdata;
2238         int bufsize;
2239         struct ctxt_priv *priv;
2240         struct sec_flow_context *flc;
2241         struct rte_crypto_cipher_xform *cipher_xform;
2242         struct rte_crypto_auth_xform *auth_xform;
2243         int err;
2244
2245         PMD_INIT_FUNC_TRACE();
2246
2247         if (session->ext_params.aead_ctxt.auth_cipher_text) {
2248                 cipher_xform = &xform->cipher;
2249                 auth_xform = &xform->next->auth;
2250                 session->ctxt_type =
2251                         (cipher_xform->op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
2252                         DPAA2_SEC_CIPHER_HASH : DPAA2_SEC_HASH_CIPHER;
2253         } else {
2254                 cipher_xform = &xform->next->cipher;
2255                 auth_xform = &xform->auth;
2256                 session->ctxt_type =
2257                         (cipher_xform->op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
2258                         DPAA2_SEC_HASH_CIPHER : DPAA2_SEC_CIPHER_HASH;
2259         }
2260
2261         /* Set IV parameters */
2262         session->iv.offset = cipher_xform->iv.offset;
2263         session->iv.length = cipher_xform->iv.length;
2264
2265         /* For SEC AEAD only one descriptor is required */
2266         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
2267                         sizeof(struct ctxt_priv) + sizeof(struct sec_flc_desc),
2268                         RTE_CACHE_LINE_SIZE);
2269         if (priv == NULL) {
2270                 DPAA2_SEC_ERR("No Memory for priv CTXT");
2271                 return -1;
2272         }
2273
2274         priv->fle_pool = dev_priv->fle_pool;
2275         flc = &priv->flc_desc[0].flc;
2276
2277         session->cipher_key.data = rte_zmalloc(NULL, cipher_xform->key.length,
2278                                                RTE_CACHE_LINE_SIZE);
2279         if (session->cipher_key.data == NULL && cipher_xform->key.length > 0) {
2280                 DPAA2_SEC_ERR("No Memory for cipher key");
2281                 rte_free(priv);
2282                 return -1;
2283         }
2284         session->cipher_key.length = cipher_xform->key.length;
2285         session->auth_key.data = rte_zmalloc(NULL, auth_xform->key.length,
2286                                              RTE_CACHE_LINE_SIZE);
2287         if (session->auth_key.data == NULL && auth_xform->key.length > 0) {
2288                 DPAA2_SEC_ERR("No Memory for auth key");
2289                 rte_free(session->cipher_key.data);
2290                 rte_free(priv);
2291                 return -1;
2292         }
2293         session->auth_key.length = auth_xform->key.length;
2294         memcpy(session->cipher_key.data, cipher_xform->key.data,
2295                cipher_xform->key.length);
2296         memcpy(session->auth_key.data, auth_xform->key.data,
2297                auth_xform->key.length);
2298
2299         authdata.key = (size_t)session->auth_key.data;
2300         authdata.keylen = session->auth_key.length;
2301         authdata.key_enc_flags = 0;
2302         authdata.key_type = RTA_DATA_IMM;
2303
2304         session->digest_length = auth_xform->digest_length;
2305
2306         switch (auth_xform->algo) {
2307         case RTE_CRYPTO_AUTH_SHA1_HMAC:
2308                 authdata.algtype = OP_ALG_ALGSEL_SHA1;
2309                 authdata.algmode = OP_ALG_AAI_HMAC;
2310                 session->auth_alg = RTE_CRYPTO_AUTH_SHA1_HMAC;
2311                 break;
2312         case RTE_CRYPTO_AUTH_MD5_HMAC:
2313                 authdata.algtype = OP_ALG_ALGSEL_MD5;
2314                 authdata.algmode = OP_ALG_AAI_HMAC;
2315                 session->auth_alg = RTE_CRYPTO_AUTH_MD5_HMAC;
2316                 break;
2317         case RTE_CRYPTO_AUTH_SHA224_HMAC:
2318                 authdata.algtype = OP_ALG_ALGSEL_SHA224;
2319                 authdata.algmode = OP_ALG_AAI_HMAC;
2320                 session->auth_alg = RTE_CRYPTO_AUTH_SHA224_HMAC;
2321                 break;
2322         case RTE_CRYPTO_AUTH_SHA256_HMAC:
2323                 authdata.algtype = OP_ALG_ALGSEL_SHA256;
2324                 authdata.algmode = OP_ALG_AAI_HMAC;
2325                 session->auth_alg = RTE_CRYPTO_AUTH_SHA256_HMAC;
2326                 break;
2327         case RTE_CRYPTO_AUTH_SHA384_HMAC:
2328                 authdata.algtype = OP_ALG_ALGSEL_SHA384;
2329                 authdata.algmode = OP_ALG_AAI_HMAC;
2330                 session->auth_alg = RTE_CRYPTO_AUTH_SHA384_HMAC;
2331                 break;
2332         case RTE_CRYPTO_AUTH_SHA512_HMAC:
2333                 authdata.algtype = OP_ALG_ALGSEL_SHA512;
2334                 authdata.algmode = OP_ALG_AAI_HMAC;
2335                 session->auth_alg = RTE_CRYPTO_AUTH_SHA512_HMAC;
2336                 break;
2337         case RTE_CRYPTO_AUTH_AES_XCBC_MAC:
2338         case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
2339         case RTE_CRYPTO_AUTH_NULL:
2340         case RTE_CRYPTO_AUTH_SHA1:
2341         case RTE_CRYPTO_AUTH_SHA256:
2342         case RTE_CRYPTO_AUTH_SHA512:
2343         case RTE_CRYPTO_AUTH_SHA224:
2344         case RTE_CRYPTO_AUTH_SHA384:
2345         case RTE_CRYPTO_AUTH_MD5:
2346         case RTE_CRYPTO_AUTH_AES_GMAC:
2347         case RTE_CRYPTO_AUTH_KASUMI_F9:
2348         case RTE_CRYPTO_AUTH_AES_CMAC:
2349         case RTE_CRYPTO_AUTH_AES_CBC_MAC:
2350         case RTE_CRYPTO_AUTH_ZUC_EIA3:
2351                 DPAA2_SEC_ERR("Crypto: Unsupported auth alg %u",
2352                               auth_xform->algo);
2353                 goto error_out;
2354         default:
2355                 DPAA2_SEC_ERR("Crypto: Undefined Auth specified %u",
2356                               auth_xform->algo);
2357                 goto error_out;
2358         }
2359         cipherdata.key = (size_t)session->cipher_key.data;
2360         cipherdata.keylen = session->cipher_key.length;
2361         cipherdata.key_enc_flags = 0;
2362         cipherdata.key_type = RTA_DATA_IMM;
2363
2364         switch (cipher_xform->algo) {
2365         case RTE_CRYPTO_CIPHER_AES_CBC:
2366                 cipherdata.algtype = OP_ALG_ALGSEL_AES;
2367                 cipherdata.algmode = OP_ALG_AAI_CBC;
2368                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CBC;
2369                 break;
2370         case RTE_CRYPTO_CIPHER_3DES_CBC:
2371                 cipherdata.algtype = OP_ALG_ALGSEL_3DES;
2372                 cipherdata.algmode = OP_ALG_AAI_CBC;
2373                 session->cipher_alg = RTE_CRYPTO_CIPHER_3DES_CBC;
2374                 break;
2375         case RTE_CRYPTO_CIPHER_AES_CTR:
2376                 cipherdata.algtype = OP_ALG_ALGSEL_AES;
2377                 cipherdata.algmode = OP_ALG_AAI_CTR;
2378                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CTR;
2379                 break;
2380         case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
2381         case RTE_CRYPTO_CIPHER_ZUC_EEA3:
2382         case RTE_CRYPTO_CIPHER_NULL:
2383         case RTE_CRYPTO_CIPHER_3DES_ECB:
2384         case RTE_CRYPTO_CIPHER_AES_ECB:
2385         case RTE_CRYPTO_CIPHER_KASUMI_F8:
2386                 DPAA2_SEC_ERR("Crypto: Unsupported Cipher alg %u",
2387                               cipher_xform->algo);
2388                 goto error_out;
2389         default:
2390                 DPAA2_SEC_ERR("Crypto: Undefined Cipher specified %u",
2391                               cipher_xform->algo);
2392                 goto error_out;
2393         }
2394         session->dir = (cipher_xform->op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
2395                                 DIR_ENC : DIR_DEC;
2396
2397         priv->flc_desc[0].desc[0] = cipherdata.keylen;
2398         priv->flc_desc[0].desc[1] = authdata.keylen;
2399         err = rta_inline_query(IPSEC_AUTH_VAR_AES_DEC_BASE_DESC_LEN,
2400                                MIN_JOB_DESC_SIZE,
2401                                (unsigned int *)priv->flc_desc[0].desc,
2402                                &priv->flc_desc[0].desc[2], 2);
2403
2404         if (err < 0) {
2405                 DPAA2_SEC_ERR("Crypto: Incorrect key lengths");
2406                 goto error_out;
2407         }
2408         if (priv->flc_desc[0].desc[2] & 1) {
2409                 cipherdata.key_type = RTA_DATA_IMM;
2410         } else {
2411                 cipherdata.key = DPAA2_VADDR_TO_IOVA(cipherdata.key);
2412                 cipherdata.key_type = RTA_DATA_PTR;
2413         }
2414         if (priv->flc_desc[0].desc[2] & (1 << 1)) {
2415                 authdata.key_type = RTA_DATA_IMM;
2416         } else {
2417                 authdata.key = DPAA2_VADDR_TO_IOVA(authdata.key);
2418                 authdata.key_type = RTA_DATA_PTR;
2419         }
2420         priv->flc_desc[0].desc[0] = 0;
2421         priv->flc_desc[0].desc[1] = 0;
2422         priv->flc_desc[0].desc[2] = 0;
2423
2424         if (session->ctxt_type == DPAA2_SEC_CIPHER_HASH) {
2425                 bufsize = cnstr_shdsc_authenc(priv->flc_desc[0].desc, 1,
2426                                               0, SHR_SERIAL,
2427                                               &cipherdata, &authdata,
2428                                               session->iv.length,
2429                                               session->digest_length,
2430                                               session->dir);
2431                 if (bufsize < 0) {
2432                         DPAA2_SEC_ERR("Crypto: Invalid buffer length");
2433                         goto error_out;
2434                 }
2435         } else {
2436                 DPAA2_SEC_ERR("Hash before cipher not supported");
2437                 goto error_out;
2438         }
2439
2440         flc->word1_sdl = (uint8_t)bufsize;
2441         session->ctxt = priv;
2442 #ifdef CAAM_DESC_DEBUG
2443         int i;
2444         for (i = 0; i < bufsize; i++)
2445                 DPAA2_SEC_DEBUG("DESC[%d]:0x%x",
2446                             i, priv->flc_desc[0].desc[i]);
2447 #endif
2448
2449         return 0;
2450
2451 error_out:
2452         rte_free(session->cipher_key.data);
2453         rte_free(session->auth_key.data);
2454         rte_free(priv);
2455         return -1;
2456 }
2457
2458 static int
2459 dpaa2_sec_set_session_parameters(struct rte_cryptodev *dev,
2460                             struct rte_crypto_sym_xform *xform, void *sess)
2461 {
2462         dpaa2_sec_session *session = sess;
2463         int ret;
2464
2465         PMD_INIT_FUNC_TRACE();
2466
2467         if (unlikely(sess == NULL)) {
2468                 DPAA2_SEC_ERR("Invalid session struct");
2469                 return -1;
2470         }
2471
2472         memset(session, 0, sizeof(dpaa2_sec_session));
2473         /* Default IV length = 0 */
2474         session->iv.length = 0;
2475
2476         /* Cipher Only */
2477         if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER && xform->next == NULL) {
2478                 ret = dpaa2_sec_cipher_init(dev, xform, session);
2479
2480         /* Authentication Only */
2481         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AUTH &&
2482                    xform->next == NULL) {
2483                 ret = dpaa2_sec_auth_init(dev, xform, session);
2484
2485         /* Cipher then Authenticate */
2486         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER &&
2487                    xform->next->type == RTE_CRYPTO_SYM_XFORM_AUTH) {
2488                 session->ext_params.aead_ctxt.auth_cipher_text = true;
2489                 if (xform->cipher.algo == RTE_CRYPTO_CIPHER_NULL)
2490                         ret = dpaa2_sec_auth_init(dev, xform, session);
2491                 else if (xform->next->auth.algo == RTE_CRYPTO_AUTH_NULL)
2492                         ret = dpaa2_sec_cipher_init(dev, xform, session);
2493                 else
2494                         ret = dpaa2_sec_aead_chain_init(dev, xform, session);
2495         /* Authenticate then Cipher */
2496         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AUTH &&
2497                    xform->next->type == RTE_CRYPTO_SYM_XFORM_CIPHER) {
2498                 session->ext_params.aead_ctxt.auth_cipher_text = false;
2499                 if (xform->auth.algo == RTE_CRYPTO_AUTH_NULL)
2500                         ret = dpaa2_sec_cipher_init(dev, xform, session);
2501                 else if (xform->next->cipher.algo == RTE_CRYPTO_CIPHER_NULL)
2502                         ret = dpaa2_sec_auth_init(dev, xform, session);
2503                 else
2504                         ret = dpaa2_sec_aead_chain_init(dev, xform, session);
2505         /* AEAD operation for AES-GCM kind of Algorithms */
2506         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AEAD &&
2507                    xform->next == NULL) {
2508                 ret = dpaa2_sec_aead_init(dev, xform, session);
2509
2510         } else {
2511                 DPAA2_SEC_ERR("Invalid crypto type");
2512                 return -EINVAL;
2513         }
2514
2515         return ret;
2516 }
2517
2518 #ifdef RTE_LIBRTE_SECURITY
2519 static int
2520 dpaa2_sec_ipsec_aead_init(struct rte_crypto_aead_xform *aead_xform,
2521                         dpaa2_sec_session *session,
2522                         struct alginfo *aeaddata)
2523 {
2524         PMD_INIT_FUNC_TRACE();
2525
2526         session->aead_key.data = rte_zmalloc(NULL, aead_xform->key.length,
2527                                                RTE_CACHE_LINE_SIZE);
2528         if (session->aead_key.data == NULL && aead_xform->key.length > 0) {
2529                 DPAA2_SEC_ERR("No Memory for aead key");
2530                 return -1;
2531         }
2532         memcpy(session->aead_key.data, aead_xform->key.data,
2533                aead_xform->key.length);
2534
2535         session->digest_length = aead_xform->digest_length;
2536         session->aead_key.length = aead_xform->key.length;
2537
2538         aeaddata->key = (size_t)session->aead_key.data;
2539         aeaddata->keylen = session->aead_key.length;
2540         aeaddata->key_enc_flags = 0;
2541         aeaddata->key_type = RTA_DATA_IMM;
2542
2543         switch (aead_xform->algo) {
2544         case RTE_CRYPTO_AEAD_AES_GCM:
2545                 switch (session->digest_length) {
2546                 case 8:
2547                         aeaddata->algtype = OP_PCL_IPSEC_AES_GCM8;
2548                         break;
2549                 case 12:
2550                         aeaddata->algtype = OP_PCL_IPSEC_AES_GCM12;
2551                         break;
2552                 case 16:
2553                         aeaddata->algtype = OP_PCL_IPSEC_AES_GCM16;
2554                         break;
2555                 default:
2556                         DPAA2_SEC_ERR("Crypto: Undefined GCM digest %d",
2557                                       session->digest_length);
2558                         return -1;
2559                 }
2560                 aeaddata->algmode = OP_ALG_AAI_GCM;
2561                 session->aead_alg = RTE_CRYPTO_AEAD_AES_GCM;
2562                 break;
2563         case RTE_CRYPTO_AEAD_AES_CCM:
2564                 switch (session->digest_length) {
2565                 case 8:
2566                         aeaddata->algtype = OP_PCL_IPSEC_AES_CCM8;
2567                         break;
2568                 case 12:
2569                         aeaddata->algtype = OP_PCL_IPSEC_AES_CCM12;
2570                         break;
2571                 case 16:
2572                         aeaddata->algtype = OP_PCL_IPSEC_AES_CCM16;
2573                         break;
2574                 default:
2575                         DPAA2_SEC_ERR("Crypto: Undefined CCM digest %d",
2576                                       session->digest_length);
2577                         return -1;
2578                 }
2579                 aeaddata->algmode = OP_ALG_AAI_CCM;
2580                 session->aead_alg = RTE_CRYPTO_AEAD_AES_CCM;
2581                 break;
2582         default:
2583                 DPAA2_SEC_ERR("Crypto: Undefined AEAD specified %u",
2584                               aead_xform->algo);
2585                 return -1;
2586         }
2587         session->dir = (aead_xform->op == RTE_CRYPTO_AEAD_OP_ENCRYPT) ?
2588                                 DIR_ENC : DIR_DEC;
2589
2590         return 0;
2591 }
2592
2593 static int
2594 dpaa2_sec_ipsec_proto_init(struct rte_crypto_cipher_xform *cipher_xform,
2595         struct rte_crypto_auth_xform *auth_xform,
2596         dpaa2_sec_session *session,
2597         struct alginfo *cipherdata,
2598         struct alginfo *authdata)
2599 {
2600         if (cipher_xform) {
2601                 session->cipher_key.data = rte_zmalloc(NULL,
2602                                                        cipher_xform->key.length,
2603                                                        RTE_CACHE_LINE_SIZE);
2604                 if (session->cipher_key.data == NULL &&
2605                                 cipher_xform->key.length > 0) {
2606                         DPAA2_SEC_ERR("No Memory for cipher key");
2607                         return -ENOMEM;
2608                 }
2609
2610                 session->cipher_key.length = cipher_xform->key.length;
2611                 memcpy(session->cipher_key.data, cipher_xform->key.data,
2612                                 cipher_xform->key.length);
2613                 session->cipher_alg = cipher_xform->algo;
2614         } else {
2615                 session->cipher_key.data = NULL;
2616                 session->cipher_key.length = 0;
2617                 session->cipher_alg = RTE_CRYPTO_CIPHER_NULL;
2618         }
2619
2620         if (auth_xform) {
2621                 session->auth_key.data = rte_zmalloc(NULL,
2622                                                 auth_xform->key.length,
2623                                                 RTE_CACHE_LINE_SIZE);
2624                 if (session->auth_key.data == NULL &&
2625                                 auth_xform->key.length > 0) {
2626                         DPAA2_SEC_ERR("No Memory for auth key");
2627                         return -ENOMEM;
2628                 }
2629                 session->auth_key.length = auth_xform->key.length;
2630                 memcpy(session->auth_key.data, auth_xform->key.data,
2631                                 auth_xform->key.length);
2632                 session->auth_alg = auth_xform->algo;
2633                 session->digest_length = auth_xform->digest_length;
2634         } else {
2635                 session->auth_key.data = NULL;
2636                 session->auth_key.length = 0;
2637                 session->auth_alg = RTE_CRYPTO_AUTH_NULL;
2638         }
2639
2640         authdata->key = (size_t)session->auth_key.data;
2641         authdata->keylen = session->auth_key.length;
2642         authdata->key_enc_flags = 0;
2643         authdata->key_type = RTA_DATA_IMM;
2644         switch (session->auth_alg) {
2645         case RTE_CRYPTO_AUTH_SHA1_HMAC:
2646                 authdata->algtype = OP_PCL_IPSEC_HMAC_SHA1_96;
2647                 authdata->algmode = OP_ALG_AAI_HMAC;
2648                 break;
2649         case RTE_CRYPTO_AUTH_MD5_HMAC:
2650                 authdata->algtype = OP_PCL_IPSEC_HMAC_MD5_96;
2651                 authdata->algmode = OP_ALG_AAI_HMAC;
2652                 break;
2653         case RTE_CRYPTO_AUTH_SHA256_HMAC:
2654                 authdata->algtype = OP_PCL_IPSEC_HMAC_SHA2_256_128;
2655                 authdata->algmode = OP_ALG_AAI_HMAC;
2656                 if (session->digest_length != 16)
2657                         DPAA2_SEC_WARN(
2658                         "+++Using sha256-hmac truncated len is non-standard,"
2659                         "it will not work with lookaside proto");
2660                 break;
2661         case RTE_CRYPTO_AUTH_SHA384_HMAC:
2662                 authdata->algtype = OP_PCL_IPSEC_HMAC_SHA2_384_192;
2663                 authdata->algmode = OP_ALG_AAI_HMAC;
2664                 break;
2665         case RTE_CRYPTO_AUTH_SHA512_HMAC:
2666                 authdata->algtype = OP_PCL_IPSEC_HMAC_SHA2_512_256;
2667                 authdata->algmode = OP_ALG_AAI_HMAC;
2668                 break;
2669         case RTE_CRYPTO_AUTH_AES_CMAC:
2670                 authdata->algtype = OP_PCL_IPSEC_AES_CMAC_96;
2671                 break;
2672         case RTE_CRYPTO_AUTH_NULL:
2673                 authdata->algtype = OP_PCL_IPSEC_HMAC_NULL;
2674                 break;
2675         case RTE_CRYPTO_AUTH_SHA224_HMAC:
2676         case RTE_CRYPTO_AUTH_AES_XCBC_MAC:
2677         case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
2678         case RTE_CRYPTO_AUTH_SHA1:
2679         case RTE_CRYPTO_AUTH_SHA256:
2680         case RTE_CRYPTO_AUTH_SHA512:
2681         case RTE_CRYPTO_AUTH_SHA224:
2682         case RTE_CRYPTO_AUTH_SHA384:
2683         case RTE_CRYPTO_AUTH_MD5:
2684         case RTE_CRYPTO_AUTH_AES_GMAC:
2685         case RTE_CRYPTO_AUTH_KASUMI_F9:
2686         case RTE_CRYPTO_AUTH_AES_CBC_MAC:
2687         case RTE_CRYPTO_AUTH_ZUC_EIA3:
2688                 DPAA2_SEC_ERR("Crypto: Unsupported auth alg %u",
2689                               session->auth_alg);
2690                 return -1;
2691         default:
2692                 DPAA2_SEC_ERR("Crypto: Undefined Auth specified %u",
2693                               session->auth_alg);
2694                 return -1;
2695         }
2696         cipherdata->key = (size_t)session->cipher_key.data;
2697         cipherdata->keylen = session->cipher_key.length;
2698         cipherdata->key_enc_flags = 0;
2699         cipherdata->key_type = RTA_DATA_IMM;
2700
2701         switch (session->cipher_alg) {
2702         case RTE_CRYPTO_CIPHER_AES_CBC:
2703                 cipherdata->algtype = OP_PCL_IPSEC_AES_CBC;
2704                 cipherdata->algmode = OP_ALG_AAI_CBC;
2705                 break;
2706         case RTE_CRYPTO_CIPHER_3DES_CBC:
2707                 cipherdata->algtype = OP_PCL_IPSEC_3DES;
2708                 cipherdata->algmode = OP_ALG_AAI_CBC;
2709                 break;
2710         case RTE_CRYPTO_CIPHER_AES_CTR:
2711                 cipherdata->algtype = OP_PCL_IPSEC_AES_CTR;
2712                 cipherdata->algmode = OP_ALG_AAI_CTR;
2713                 break;
2714         case RTE_CRYPTO_CIPHER_NULL:
2715                 cipherdata->algtype = OP_PCL_IPSEC_NULL;
2716                 break;
2717         case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
2718         case RTE_CRYPTO_CIPHER_ZUC_EEA3:
2719         case RTE_CRYPTO_CIPHER_3DES_ECB:
2720         case RTE_CRYPTO_CIPHER_AES_ECB:
2721         case RTE_CRYPTO_CIPHER_KASUMI_F8:
2722                 DPAA2_SEC_ERR("Crypto: Unsupported Cipher alg %u",
2723                               session->cipher_alg);
2724                 return -1;
2725         default:
2726                 DPAA2_SEC_ERR("Crypto: Undefined Cipher specified %u",
2727                               session->cipher_alg);
2728                 return -1;
2729         }
2730
2731         return 0;
2732 }
2733
2734 #ifdef RTE_LIBRTE_SECURITY_TEST
2735 static uint8_t aes_cbc_iv[] = {
2736         0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
2737         0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f };
2738 #endif
2739
2740 static int
2741 dpaa2_sec_set_ipsec_session(struct rte_cryptodev *dev,
2742                             struct rte_security_session_conf *conf,
2743                             void *sess)
2744 {
2745         struct rte_security_ipsec_xform *ipsec_xform = &conf->ipsec;
2746         struct rte_crypto_cipher_xform *cipher_xform = NULL;
2747         struct rte_crypto_auth_xform *auth_xform = NULL;
2748         struct rte_crypto_aead_xform *aead_xform = NULL;
2749         dpaa2_sec_session *session = (dpaa2_sec_session *)sess;
2750         struct ctxt_priv *priv;
2751         struct alginfo authdata, cipherdata;
2752         int bufsize;
2753         struct sec_flow_context *flc;
2754         struct dpaa2_sec_dev_private *dev_priv = dev->data->dev_private;
2755         int ret = -1;
2756
2757         PMD_INIT_FUNC_TRACE();
2758
2759         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
2760                                 sizeof(struct ctxt_priv) +
2761                                 sizeof(struct sec_flc_desc),
2762                                 RTE_CACHE_LINE_SIZE);
2763
2764         if (priv == NULL) {
2765                 DPAA2_SEC_ERR("No memory for priv CTXT");
2766                 return -ENOMEM;
2767         }
2768
2769         priv->fle_pool = dev_priv->fle_pool;
2770         flc = &priv->flc_desc[0].flc;
2771
2772         memset(session, 0, sizeof(dpaa2_sec_session));
2773
2774         if (conf->crypto_xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER) {
2775                 cipher_xform = &conf->crypto_xform->cipher;
2776                 if (conf->crypto_xform->next)
2777                         auth_xform = &conf->crypto_xform->next->auth;
2778                 ret = dpaa2_sec_ipsec_proto_init(cipher_xform, auth_xform,
2779                                         session, &cipherdata, &authdata);
2780         } else if (conf->crypto_xform->type == RTE_CRYPTO_SYM_XFORM_AUTH) {
2781                 auth_xform = &conf->crypto_xform->auth;
2782                 if (conf->crypto_xform->next)
2783                         cipher_xform = &conf->crypto_xform->next->cipher;
2784                 ret = dpaa2_sec_ipsec_proto_init(cipher_xform, auth_xform,
2785                                         session, &cipherdata, &authdata);
2786         } else if (conf->crypto_xform->type == RTE_CRYPTO_SYM_XFORM_AEAD) {
2787                 aead_xform = &conf->crypto_xform->aead;
2788                 ret = dpaa2_sec_ipsec_aead_init(aead_xform,
2789                                         session, &cipherdata);
2790                 authdata.keylen = 0;
2791                 authdata.algtype = 0;
2792         } else {
2793                 DPAA2_SEC_ERR("XFORM not specified");
2794                 ret = -EINVAL;
2795                 goto out;
2796         }
2797         if (ret) {
2798                 DPAA2_SEC_ERR("Failed to process xform");
2799                 goto out;
2800         }
2801
2802         session->ctxt_type = DPAA2_SEC_IPSEC;
2803         if (ipsec_xform->direction == RTE_SECURITY_IPSEC_SA_DIR_EGRESS) {
2804                 uint8_t *hdr = NULL;
2805                 struct ip ip4_hdr;
2806                 struct rte_ipv6_hdr ip6_hdr;
2807                 struct ipsec_encap_pdb encap_pdb;
2808
2809                 flc->dhr = SEC_FLC_DHR_OUTBOUND;
2810                 /* For Sec Proto only one descriptor is required. */
2811                 memset(&encap_pdb, 0, sizeof(struct ipsec_encap_pdb));
2812
2813                 /* copy algo specific data to PDB */
2814                 switch (cipherdata.algtype) {
2815                 case OP_PCL_IPSEC_AES_CTR:
2816                         encap_pdb.ctr.ctr_initial = 0x00000001;
2817                         encap_pdb.ctr.ctr_nonce = ipsec_xform->salt;
2818                         break;
2819                 case OP_PCL_IPSEC_AES_GCM8:
2820                 case OP_PCL_IPSEC_AES_GCM12:
2821                 case OP_PCL_IPSEC_AES_GCM16:
2822                         memcpy(encap_pdb.gcm.salt,
2823                                 (uint8_t *)&(ipsec_xform->salt), 4);
2824                         break;
2825                 }
2826
2827                 encap_pdb.options = (IPVERSION << PDBNH_ESP_ENCAP_SHIFT) |
2828                         PDBOPTS_ESP_OIHI_PDB_INL |
2829                         PDBOPTS_ESP_IVSRC |
2830                         PDBHMO_ESP_ENCAP_DTTL |
2831                         PDBHMO_ESP_SNR;
2832                 if (ipsec_xform->options.esn)
2833                         encap_pdb.options |= PDBOPTS_ESP_ESN;
2834                 encap_pdb.spi = ipsec_xform->spi;
2835                 session->dir = DIR_ENC;
2836                 if (ipsec_xform->tunnel.type ==
2837                                 RTE_SECURITY_IPSEC_TUNNEL_IPV4) {
2838                         encap_pdb.ip_hdr_len = sizeof(struct ip);
2839                         ip4_hdr.ip_v = IPVERSION;
2840                         ip4_hdr.ip_hl = 5;
2841                         ip4_hdr.ip_len = rte_cpu_to_be_16(sizeof(ip4_hdr));
2842                         ip4_hdr.ip_tos = ipsec_xform->tunnel.ipv4.dscp;
2843                         ip4_hdr.ip_id = 0;
2844                         ip4_hdr.ip_off = 0;
2845                         ip4_hdr.ip_ttl = ipsec_xform->tunnel.ipv4.ttl;
2846                         ip4_hdr.ip_p = IPPROTO_ESP;
2847                         ip4_hdr.ip_sum = 0;
2848                         ip4_hdr.ip_src = ipsec_xform->tunnel.ipv4.src_ip;
2849                         ip4_hdr.ip_dst = ipsec_xform->tunnel.ipv4.dst_ip;
2850                         ip4_hdr.ip_sum = calc_chksum((uint16_t *)(void *)
2851                                         &ip4_hdr, sizeof(struct ip));
2852                         hdr = (uint8_t *)&ip4_hdr;
2853                 } else if (ipsec_xform->tunnel.type ==
2854                                 RTE_SECURITY_IPSEC_TUNNEL_IPV6) {
2855                         ip6_hdr.vtc_flow = rte_cpu_to_be_32(
2856                                 DPAA2_IPv6_DEFAULT_VTC_FLOW |
2857                                 ((ipsec_xform->tunnel.ipv6.dscp <<
2858                                         RTE_IPV6_HDR_TC_SHIFT) &
2859                                         RTE_IPV6_HDR_TC_MASK) |
2860                                 ((ipsec_xform->tunnel.ipv6.flabel <<
2861                                         RTE_IPV6_HDR_FL_SHIFT) &
2862                                         RTE_IPV6_HDR_FL_MASK));
2863                         /* Payload length will be updated by HW */
2864                         ip6_hdr.payload_len = 0;
2865                         ip6_hdr.hop_limits =
2866                                         ipsec_xform->tunnel.ipv6.hlimit;
2867                         ip6_hdr.proto = (ipsec_xform->proto ==
2868                                         RTE_SECURITY_IPSEC_SA_PROTO_ESP) ?
2869                                         IPPROTO_ESP : IPPROTO_AH;
2870                         memcpy(&ip6_hdr.src_addr,
2871                                 &ipsec_xform->tunnel.ipv6.src_addr, 16);
2872                         memcpy(&ip6_hdr.dst_addr,
2873                                 &ipsec_xform->tunnel.ipv6.dst_addr, 16);
2874                         encap_pdb.ip_hdr_len = sizeof(struct rte_ipv6_hdr);
2875                         hdr = (uint8_t *)&ip6_hdr;
2876                 }
2877
2878                 bufsize = cnstr_shdsc_ipsec_new_encap(priv->flc_desc[0].desc,
2879                                 1, 0, SHR_SERIAL, &encap_pdb,
2880                                 hdr, &cipherdata, &authdata);
2881         } else if (ipsec_xform->direction ==
2882                         RTE_SECURITY_IPSEC_SA_DIR_INGRESS) {
2883                 struct ipsec_decap_pdb decap_pdb;
2884
2885                 flc->dhr = SEC_FLC_DHR_INBOUND;
2886                 memset(&decap_pdb, 0, sizeof(struct ipsec_decap_pdb));
2887                 /* copy algo specific data to PDB */
2888                 switch (cipherdata.algtype) {
2889                 case OP_PCL_IPSEC_AES_CTR:
2890                         decap_pdb.ctr.ctr_initial = 0x00000001;
2891                         decap_pdb.ctr.ctr_nonce = ipsec_xform->salt;
2892                         break;
2893                 case OP_PCL_IPSEC_AES_GCM8:
2894                 case OP_PCL_IPSEC_AES_GCM12:
2895                 case OP_PCL_IPSEC_AES_GCM16:
2896                         memcpy(decap_pdb.gcm.salt,
2897                                 (uint8_t *)&(ipsec_xform->salt), 4);
2898                         break;
2899                 }
2900
2901                 decap_pdb.options = (ipsec_xform->tunnel.type ==
2902                                 RTE_SECURITY_IPSEC_TUNNEL_IPV4) ?
2903                                 sizeof(struct ip) << 16 :
2904                                 sizeof(struct rte_ipv6_hdr) << 16;
2905                 if (ipsec_xform->options.esn)
2906                         decap_pdb.options |= PDBOPTS_ESP_ESN;
2907                 session->dir = DIR_DEC;
2908                 bufsize = cnstr_shdsc_ipsec_new_decap(priv->flc_desc[0].desc,
2909                                 1, 0, SHR_SERIAL,
2910                                 &decap_pdb, &cipherdata, &authdata);
2911         } else
2912                 goto out;
2913
2914         if (bufsize < 0) {
2915                 DPAA2_SEC_ERR("Crypto: Invalid buffer length");
2916                 goto out;
2917         }
2918
2919         flc->word1_sdl = (uint8_t)bufsize;
2920
2921         /* Enable the stashing control bit */
2922         DPAA2_SET_FLC_RSC(flc);
2923         flc->word2_rflc_31_0 = lower_32_bits(
2924                         (size_t)&(((struct dpaa2_sec_qp *)
2925                         dev->data->queue_pairs[0])->rx_vq) | 0x14);
2926         flc->word3_rflc_63_32 = upper_32_bits(
2927                         (size_t)&(((struct dpaa2_sec_qp *)
2928                         dev->data->queue_pairs[0])->rx_vq));
2929
2930         /* Set EWS bit i.e. enable write-safe */
2931         DPAA2_SET_FLC_EWS(flc);
2932         /* Set BS = 1 i.e reuse input buffers as output buffers */
2933         DPAA2_SET_FLC_REUSE_BS(flc);
2934         /* Set FF = 10; reuse input buffers if they provide sufficient space */
2935         DPAA2_SET_FLC_REUSE_FF(flc);
2936
2937         session->ctxt = priv;
2938
2939         return 0;
2940 out:
2941         rte_free(session->auth_key.data);
2942         rte_free(session->cipher_key.data);
2943         rte_free(priv);
2944         return ret;
2945 }
2946
2947 static int
2948 dpaa2_sec_set_pdcp_session(struct rte_cryptodev *dev,
2949                            struct rte_security_session_conf *conf,
2950                            void *sess)
2951 {
2952         struct rte_security_pdcp_xform *pdcp_xform = &conf->pdcp;
2953         struct rte_crypto_sym_xform *xform = conf->crypto_xform;
2954         struct rte_crypto_auth_xform *auth_xform = NULL;
2955         struct rte_crypto_cipher_xform *cipher_xform;
2956         dpaa2_sec_session *session = (dpaa2_sec_session *)sess;
2957         struct ctxt_priv *priv;
2958         struct dpaa2_sec_dev_private *dev_priv = dev->data->dev_private;
2959         struct alginfo authdata, cipherdata;
2960         struct alginfo *p_authdata = NULL;
2961         int bufsize = -1;
2962         struct sec_flow_context *flc;
2963 #if RTE_BYTE_ORDER == RTE_BIG_ENDIAN
2964         int swap = true;
2965 #else
2966         int swap = false;
2967 #endif
2968
2969         PMD_INIT_FUNC_TRACE();
2970
2971         memset(session, 0, sizeof(dpaa2_sec_session));
2972
2973         priv = (struct ctxt_priv *)rte_zmalloc(NULL,
2974                                 sizeof(struct ctxt_priv) +
2975                                 sizeof(struct sec_flc_desc),
2976                                 RTE_CACHE_LINE_SIZE);
2977
2978         if (priv == NULL) {
2979                 DPAA2_SEC_ERR("No memory for priv CTXT");
2980                 return -ENOMEM;
2981         }
2982
2983         priv->fle_pool = dev_priv->fle_pool;
2984         flc = &priv->flc_desc[0].flc;
2985
2986         /* find xfrm types */
2987         if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER && xform->next == NULL) {
2988                 cipher_xform = &xform->cipher;
2989         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER &&
2990                    xform->next->type == RTE_CRYPTO_SYM_XFORM_AUTH) {
2991                 session->ext_params.aead_ctxt.auth_cipher_text = true;
2992                 cipher_xform = &xform->cipher;
2993                 auth_xform = &xform->next->auth;
2994         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AUTH &&
2995                    xform->next->type == RTE_CRYPTO_SYM_XFORM_CIPHER) {
2996                 session->ext_params.aead_ctxt.auth_cipher_text = false;
2997                 cipher_xform = &xform->next->cipher;
2998                 auth_xform = &xform->auth;
2999         } else {
3000                 DPAA2_SEC_ERR("Invalid crypto type");
3001                 return -EINVAL;
3002         }
3003
3004         session->ctxt_type = DPAA2_SEC_PDCP;
3005         if (cipher_xform) {
3006                 session->cipher_key.data = rte_zmalloc(NULL,
3007                                                cipher_xform->key.length,
3008                                                RTE_CACHE_LINE_SIZE);
3009                 if (session->cipher_key.data == NULL &&
3010                                 cipher_xform->key.length > 0) {
3011                         DPAA2_SEC_ERR("No Memory for cipher key");
3012                         rte_free(priv);
3013                         return -ENOMEM;
3014                 }
3015                 session->cipher_key.length = cipher_xform->key.length;
3016                 memcpy(session->cipher_key.data, cipher_xform->key.data,
3017                         cipher_xform->key.length);
3018                 session->dir =
3019                         (cipher_xform->op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
3020                                         DIR_ENC : DIR_DEC;
3021                 session->cipher_alg = cipher_xform->algo;
3022         } else {
3023                 session->cipher_key.data = NULL;
3024                 session->cipher_key.length = 0;
3025                 session->cipher_alg = RTE_CRYPTO_CIPHER_NULL;
3026                 session->dir = DIR_ENC;
3027         }
3028
3029         session->pdcp.domain = pdcp_xform->domain;
3030         session->pdcp.bearer = pdcp_xform->bearer;
3031         session->pdcp.pkt_dir = pdcp_xform->pkt_dir;
3032         session->pdcp.sn_size = pdcp_xform->sn_size;
3033         session->pdcp.hfn = pdcp_xform->hfn;
3034         session->pdcp.hfn_threshold = pdcp_xform->hfn_threshold;
3035         session->pdcp.hfn_ovd = pdcp_xform->hfn_ovrd;
3036         /* hfv ovd offset location is stored in iv.offset value*/
3037         session->pdcp.hfn_ovd_offset = cipher_xform->iv.offset;
3038
3039         cipherdata.key = (size_t)session->cipher_key.data;
3040         cipherdata.keylen = session->cipher_key.length;
3041         cipherdata.key_enc_flags = 0;
3042         cipherdata.key_type = RTA_DATA_IMM;
3043
3044         switch (session->cipher_alg) {
3045         case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
3046                 cipherdata.algtype = PDCP_CIPHER_TYPE_SNOW;
3047                 break;
3048         case RTE_CRYPTO_CIPHER_ZUC_EEA3:
3049                 cipherdata.algtype = PDCP_CIPHER_TYPE_ZUC;
3050                 break;
3051         case RTE_CRYPTO_CIPHER_AES_CTR:
3052                 cipherdata.algtype = PDCP_CIPHER_TYPE_AES;
3053                 break;
3054         case RTE_CRYPTO_CIPHER_NULL:
3055                 cipherdata.algtype = PDCP_CIPHER_TYPE_NULL;
3056                 break;
3057         default:
3058                 DPAA2_SEC_ERR("Crypto: Undefined Cipher specified %u",
3059                               session->cipher_alg);
3060                 goto out;
3061         }
3062
3063         if (auth_xform) {
3064                 session->auth_key.data = rte_zmalloc(NULL,
3065                                                      auth_xform->key.length,
3066                                                      RTE_CACHE_LINE_SIZE);
3067                 if (!session->auth_key.data &&
3068                     auth_xform->key.length > 0) {
3069                         DPAA2_SEC_ERR("No Memory for auth key");
3070                         rte_free(session->cipher_key.data);
3071                         rte_free(priv);
3072                         return -ENOMEM;
3073                 }
3074                 session->auth_key.length = auth_xform->key.length;
3075                 memcpy(session->auth_key.data, auth_xform->key.data,
3076                        auth_xform->key.length);
3077                 session->auth_alg = auth_xform->algo;
3078         } else {
3079                 session->auth_key.data = NULL;
3080                 session->auth_key.length = 0;
3081                 session->auth_alg = 0;
3082         }
3083         authdata.key = (size_t)session->auth_key.data;
3084         authdata.keylen = session->auth_key.length;
3085         authdata.key_enc_flags = 0;
3086         authdata.key_type = RTA_DATA_IMM;
3087
3088         if (session->auth_alg) {
3089                 switch (session->auth_alg) {
3090                 case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
3091                         authdata.algtype = PDCP_AUTH_TYPE_SNOW;
3092                         break;
3093                 case RTE_CRYPTO_AUTH_ZUC_EIA3:
3094                         authdata.algtype = PDCP_AUTH_TYPE_ZUC;
3095                         break;
3096                 case RTE_CRYPTO_AUTH_AES_CMAC:
3097                         authdata.algtype = PDCP_AUTH_TYPE_AES;
3098                         break;
3099                 case RTE_CRYPTO_AUTH_NULL:
3100                         authdata.algtype = PDCP_AUTH_TYPE_NULL;
3101                         break;
3102                 default:
3103                         DPAA2_SEC_ERR("Crypto: Unsupported auth alg %u",
3104                                       session->auth_alg);
3105                         goto out;
3106                 }
3107
3108                 p_authdata = &authdata;
3109         } else if (pdcp_xform->domain == RTE_SECURITY_PDCP_MODE_CONTROL) {
3110                 DPAA2_SEC_ERR("Crypto: Integrity must for c-plane");
3111                 goto out;
3112         }
3113
3114         if (pdcp_xform->domain == RTE_SECURITY_PDCP_MODE_CONTROL) {
3115                 if (session->dir == DIR_ENC)
3116                         bufsize = cnstr_shdsc_pdcp_c_plane_encap(
3117                                         priv->flc_desc[0].desc, 1, swap,
3118                                         pdcp_xform->hfn,
3119                                         session->pdcp.sn_size,
3120                                         pdcp_xform->bearer,
3121                                         pdcp_xform->pkt_dir,
3122                                         pdcp_xform->hfn_threshold,
3123                                         &cipherdata, &authdata,
3124                                         0);
3125                 else if (session->dir == DIR_DEC)
3126                         bufsize = cnstr_shdsc_pdcp_c_plane_decap(
3127                                         priv->flc_desc[0].desc, 1, swap,
3128                                         pdcp_xform->hfn,
3129                                         session->pdcp.sn_size,
3130                                         pdcp_xform->bearer,
3131                                         pdcp_xform->pkt_dir,
3132                                         pdcp_xform->hfn_threshold,
3133                                         &cipherdata, &authdata,
3134                                         0);
3135         } else {
3136                 if (session->dir == DIR_ENC)
3137                         bufsize = cnstr_shdsc_pdcp_u_plane_encap(
3138                                         priv->flc_desc[0].desc, 1, swap,
3139                                         session->pdcp.sn_size,
3140                                         pdcp_xform->hfn,
3141                                         pdcp_xform->bearer,
3142                                         pdcp_xform->pkt_dir,
3143                                         pdcp_xform->hfn_threshold,
3144                                         &cipherdata, p_authdata, 0);
3145                 else if (session->dir == DIR_DEC)
3146                         bufsize = cnstr_shdsc_pdcp_u_plane_decap(
3147                                         priv->flc_desc[0].desc, 1, swap,
3148                                         session->pdcp.sn_size,
3149                                         pdcp_xform->hfn,
3150                                         pdcp_xform->bearer,
3151                                         pdcp_xform->pkt_dir,
3152                                         pdcp_xform->hfn_threshold,
3153                                         &cipherdata, p_authdata, 0);
3154         }
3155
3156         if (bufsize < 0) {
3157                 DPAA2_SEC_ERR("Crypto: Invalid buffer length");
3158                 goto out;
3159         }
3160
3161         /* Enable the stashing control bit */
3162         DPAA2_SET_FLC_RSC(flc);
3163         flc->word2_rflc_31_0 = lower_32_bits(
3164                         (size_t)&(((struct dpaa2_sec_qp *)
3165                         dev->data->queue_pairs[0])->rx_vq) | 0x14);
3166         flc->word3_rflc_63_32 = upper_32_bits(
3167                         (size_t)&(((struct dpaa2_sec_qp *)
3168                         dev->data->queue_pairs[0])->rx_vq));
3169
3170         flc->word1_sdl = (uint8_t)bufsize;
3171
3172         /* TODO - check the perf impact or
3173          * align as per descriptor type
3174          * Set EWS bit i.e. enable write-safe
3175          * DPAA2_SET_FLC_EWS(flc);
3176          */
3177
3178         /* Set BS = 1 i.e reuse input buffers as output buffers */
3179         DPAA2_SET_FLC_REUSE_BS(flc);
3180         /* Set FF = 10; reuse input buffers if they provide sufficient space */
3181         DPAA2_SET_FLC_REUSE_FF(flc);
3182
3183         session->ctxt = priv;
3184
3185         return 0;
3186 out:
3187         rte_free(session->auth_key.data);
3188         rte_free(session->cipher_key.data);
3189         rte_free(priv);
3190         return -1;
3191 }
3192
3193 static int
3194 dpaa2_sec_security_session_create(void *dev,
3195                                   struct rte_security_session_conf *conf,
3196                                   struct rte_security_session *sess,
3197                                   struct rte_mempool *mempool)
3198 {
3199         void *sess_private_data;
3200         struct rte_cryptodev *cdev = (struct rte_cryptodev *)dev;
3201         int ret;
3202
3203         if (rte_mempool_get(mempool, &sess_private_data)) {
3204                 DPAA2_SEC_ERR("Couldn't get object from session mempool");
3205                 return -ENOMEM;
3206         }
3207
3208         switch (conf->protocol) {
3209         case RTE_SECURITY_PROTOCOL_IPSEC:
3210                 ret = dpaa2_sec_set_ipsec_session(cdev, conf,
3211                                 sess_private_data);
3212                 break;
3213         case RTE_SECURITY_PROTOCOL_MACSEC:
3214                 return -ENOTSUP;
3215         case RTE_SECURITY_PROTOCOL_PDCP:
3216                 ret = dpaa2_sec_set_pdcp_session(cdev, conf,
3217                                 sess_private_data);
3218                 break;
3219         default:
3220                 return -EINVAL;
3221         }
3222         if (ret != 0) {
3223                 DPAA2_SEC_ERR("Failed to configure session parameters");
3224                 /* Return session to mempool */
3225                 rte_mempool_put(mempool, sess_private_data);
3226                 return ret;
3227         }
3228
3229         set_sec_session_private_data(sess, sess_private_data);
3230
3231         return ret;
3232 }
3233
3234 /** Clear the memory of session so it doesn't leave key material behind */
3235 static int
3236 dpaa2_sec_security_session_destroy(void *dev __rte_unused,
3237                 struct rte_security_session *sess)
3238 {
3239         PMD_INIT_FUNC_TRACE();
3240         void *sess_priv = get_sec_session_private_data(sess);
3241
3242         dpaa2_sec_session *s = (dpaa2_sec_session *)sess_priv;
3243
3244         if (sess_priv) {
3245                 struct rte_mempool *sess_mp = rte_mempool_from_obj(sess_priv);
3246
3247                 rte_free(s->ctxt);
3248                 rte_free(s->cipher_key.data);
3249                 rte_free(s->auth_key.data);
3250                 memset(s, 0, sizeof(dpaa2_sec_session));
3251                 set_sec_session_private_data(sess, NULL);
3252                 rte_mempool_put(sess_mp, sess_priv);
3253         }
3254         return 0;
3255 }
3256 #endif
3257 static int
3258 dpaa2_sec_sym_session_configure(struct rte_cryptodev *dev,
3259                 struct rte_crypto_sym_xform *xform,
3260                 struct rte_cryptodev_sym_session *sess,
3261                 struct rte_mempool *mempool)
3262 {
3263         void *sess_private_data;
3264         int ret;
3265
3266         if (rte_mempool_get(mempool, &sess_private_data)) {
3267                 DPAA2_SEC_ERR("Couldn't get object from session mempool");
3268                 return -ENOMEM;
3269         }
3270
3271         ret = dpaa2_sec_set_session_parameters(dev, xform, sess_private_data);
3272         if (ret != 0) {
3273                 DPAA2_SEC_ERR("Failed to configure session parameters");
3274                 /* Return session to mempool */
3275                 rte_mempool_put(mempool, sess_private_data);
3276                 return ret;
3277         }
3278
3279         set_sym_session_private_data(sess, dev->driver_id,
3280                 sess_private_data);
3281
3282         return 0;
3283 }
3284
3285 /** Clear the memory of session so it doesn't leave key material behind */
3286 static void
3287 dpaa2_sec_sym_session_clear(struct rte_cryptodev *dev,
3288                 struct rte_cryptodev_sym_session *sess)
3289 {
3290         PMD_INIT_FUNC_TRACE();
3291         uint8_t index = dev->driver_id;
3292         void *sess_priv = get_sym_session_private_data(sess, index);
3293         dpaa2_sec_session *s = (dpaa2_sec_session *)sess_priv;
3294
3295         if (sess_priv) {
3296                 rte_free(s->ctxt);
3297                 rte_free(s->cipher_key.data);
3298                 rte_free(s->auth_key.data);
3299                 memset(s, 0, sizeof(dpaa2_sec_session));
3300                 struct rte_mempool *sess_mp = rte_mempool_from_obj(sess_priv);
3301                 set_sym_session_private_data(sess, index, NULL);
3302                 rte_mempool_put(sess_mp, sess_priv);
3303         }
3304 }
3305
3306 static int
3307 dpaa2_sec_dev_configure(struct rte_cryptodev *dev __rte_unused,
3308                         struct rte_cryptodev_config *config __rte_unused)
3309 {
3310         PMD_INIT_FUNC_TRACE();
3311
3312         return 0;
3313 }
3314
3315 static int
3316 dpaa2_sec_dev_start(struct rte_cryptodev *dev)
3317 {
3318         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
3319         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
3320         struct dpseci_attr attr;
3321         struct dpaa2_queue *dpaa2_q;
3322         struct dpaa2_sec_qp **qp = (struct dpaa2_sec_qp **)
3323                                         dev->data->queue_pairs;
3324         struct dpseci_rx_queue_attr rx_attr;
3325         struct dpseci_tx_queue_attr tx_attr;
3326         int ret, i;
3327
3328         PMD_INIT_FUNC_TRACE();
3329
3330         memset(&attr, 0, sizeof(struct dpseci_attr));
3331
3332         ret = dpseci_enable(dpseci, CMD_PRI_LOW, priv->token);
3333         if (ret) {
3334                 DPAA2_SEC_ERR("DPSECI with HW_ID = %d ENABLE FAILED",
3335                               priv->hw_id);
3336                 goto get_attr_failure;
3337         }
3338         ret = dpseci_get_attributes(dpseci, CMD_PRI_LOW, priv->token, &attr);
3339         if (ret) {
3340                 DPAA2_SEC_ERR("DPSEC ATTRIBUTE READ FAILED, disabling DPSEC");
3341                 goto get_attr_failure;
3342         }
3343         for (i = 0; i < attr.num_rx_queues && qp[i]; i++) {
3344                 dpaa2_q = &qp[i]->rx_vq;
3345                 dpseci_get_rx_queue(dpseci, CMD_PRI_LOW, priv->token, i,
3346                                     &rx_attr);
3347                 dpaa2_q->fqid = rx_attr.fqid;
3348                 DPAA2_SEC_DEBUG("rx_fqid: %d", dpaa2_q->fqid);
3349         }
3350         for (i = 0; i < attr.num_tx_queues && qp[i]; i++) {
3351                 dpaa2_q = &qp[i]->tx_vq;
3352                 dpseci_get_tx_queue(dpseci, CMD_PRI_LOW, priv->token, i,
3353                                     &tx_attr);
3354                 dpaa2_q->fqid = tx_attr.fqid;
3355                 DPAA2_SEC_DEBUG("tx_fqid: %d", dpaa2_q->fqid);
3356         }
3357
3358         return 0;
3359 get_attr_failure:
3360         dpseci_disable(dpseci, CMD_PRI_LOW, priv->token);
3361         return -1;
3362 }
3363
3364 static void
3365 dpaa2_sec_dev_stop(struct rte_cryptodev *dev)
3366 {
3367         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
3368         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
3369         int ret;
3370
3371         PMD_INIT_FUNC_TRACE();
3372
3373         ret = dpseci_disable(dpseci, CMD_PRI_LOW, priv->token);
3374         if (ret) {
3375                 DPAA2_SEC_ERR("Failure in disabling dpseci %d device",
3376                              priv->hw_id);
3377                 return;
3378         }
3379
3380         ret = dpseci_reset(dpseci, CMD_PRI_LOW, priv->token);
3381         if (ret < 0) {
3382                 DPAA2_SEC_ERR("SEC Device cannot be reset:Error = %0x", ret);
3383                 return;
3384         }
3385 }
3386
3387 static int
3388 dpaa2_sec_dev_close(struct rte_cryptodev *dev)
3389 {
3390         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
3391         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
3392         int ret;
3393
3394         PMD_INIT_FUNC_TRACE();
3395
3396         /* Function is reverse of dpaa2_sec_dev_init.
3397          * It does the following:
3398          * 1. Detach a DPSECI from attached resources i.e. buffer pools, dpbp_id
3399          * 2. Close the DPSECI device
3400          * 3. Free the allocated resources.
3401          */
3402
3403         /*Close the device at underlying layer*/
3404         ret = dpseci_close(dpseci, CMD_PRI_LOW, priv->token);
3405         if (ret) {
3406                 DPAA2_SEC_ERR("Failure closing dpseci device: err(%d)", ret);
3407                 return -1;
3408         }
3409
3410         /*Free the allocated memory for ethernet private data and dpseci*/
3411         priv->hw = NULL;
3412         rte_free(dpseci);
3413
3414         return 0;
3415 }
3416
3417 static void
3418 dpaa2_sec_dev_infos_get(struct rte_cryptodev *dev,
3419                         struct rte_cryptodev_info *info)
3420 {
3421         struct dpaa2_sec_dev_private *internals = dev->data->dev_private;
3422
3423         PMD_INIT_FUNC_TRACE();
3424         if (info != NULL) {
3425                 info->max_nb_queue_pairs = internals->max_nb_queue_pairs;
3426                 info->feature_flags = dev->feature_flags;
3427                 info->capabilities = dpaa2_sec_capabilities;
3428                 /* No limit of number of sessions */
3429                 info->sym.max_nb_sessions = 0;
3430                 info->driver_id = cryptodev_driver_id;
3431         }
3432 }
3433
3434 static
3435 void dpaa2_sec_stats_get(struct rte_cryptodev *dev,
3436                          struct rte_cryptodev_stats *stats)
3437 {
3438         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
3439         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
3440         struct dpseci_sec_counters counters = {0};
3441         struct dpaa2_sec_qp **qp = (struct dpaa2_sec_qp **)
3442                                         dev->data->queue_pairs;
3443         int ret, i;
3444
3445         PMD_INIT_FUNC_TRACE();
3446         if (stats == NULL) {
3447                 DPAA2_SEC_ERR("Invalid stats ptr NULL");
3448                 return;
3449         }
3450         for (i = 0; i < dev->data->nb_queue_pairs; i++) {
3451                 if (qp[i] == NULL) {
3452                         DPAA2_SEC_DEBUG("Uninitialised queue pair");
3453                         continue;
3454                 }
3455
3456                 stats->enqueued_count += qp[i]->tx_vq.tx_pkts;
3457                 stats->dequeued_count += qp[i]->rx_vq.rx_pkts;
3458                 stats->enqueue_err_count += qp[i]->tx_vq.err_pkts;
3459                 stats->dequeue_err_count += qp[i]->rx_vq.err_pkts;
3460         }
3461
3462         ret = dpseci_get_sec_counters(dpseci, CMD_PRI_LOW, priv->token,
3463                                       &counters);
3464         if (ret) {
3465                 DPAA2_SEC_ERR("SEC counters failed");
3466         } else {
3467                 DPAA2_SEC_INFO("dpseci hardware stats:"
3468                             "\n\tNum of Requests Dequeued = %" PRIu64
3469                             "\n\tNum of Outbound Encrypt Requests = %" PRIu64
3470                             "\n\tNum of Inbound Decrypt Requests = %" PRIu64
3471                             "\n\tNum of Outbound Bytes Encrypted = %" PRIu64
3472                             "\n\tNum of Outbound Bytes Protected = %" PRIu64
3473                             "\n\tNum of Inbound Bytes Decrypted = %" PRIu64
3474                             "\n\tNum of Inbound Bytes Validated = %" PRIu64,
3475                             counters.dequeued_requests,
3476                             counters.ob_enc_requests,
3477                             counters.ib_dec_requests,
3478                             counters.ob_enc_bytes,
3479                             counters.ob_prot_bytes,
3480                             counters.ib_dec_bytes,
3481                             counters.ib_valid_bytes);
3482         }
3483 }
3484
3485 static
3486 void dpaa2_sec_stats_reset(struct rte_cryptodev *dev)
3487 {
3488         int i;
3489         struct dpaa2_sec_qp **qp = (struct dpaa2_sec_qp **)
3490                                    (dev->data->queue_pairs);
3491
3492         PMD_INIT_FUNC_TRACE();
3493
3494         for (i = 0; i < dev->data->nb_queue_pairs; i++) {
3495                 if (qp[i] == NULL) {
3496                         DPAA2_SEC_DEBUG("Uninitialised queue pair");
3497                         continue;
3498                 }
3499                 qp[i]->tx_vq.rx_pkts = 0;
3500                 qp[i]->tx_vq.tx_pkts = 0;
3501                 qp[i]->tx_vq.err_pkts = 0;
3502                 qp[i]->rx_vq.rx_pkts = 0;
3503                 qp[i]->rx_vq.tx_pkts = 0;
3504                 qp[i]->rx_vq.err_pkts = 0;
3505         }
3506 }
3507
3508 static void __attribute__((hot))
3509 dpaa2_sec_process_parallel_event(struct qbman_swp *swp,
3510                                  const struct qbman_fd *fd,
3511                                  const struct qbman_result *dq,
3512                                  struct dpaa2_queue *rxq,
3513                                  struct rte_event *ev)
3514 {
3515         /* Prefetching mbuf */
3516         rte_prefetch0((void *)(size_t)(DPAA2_GET_FD_ADDR(fd)-
3517                 rte_dpaa2_bpid_info[DPAA2_GET_FD_BPID(fd)].meta_data_size));
3518
3519         /* Prefetching ipsec crypto_op stored in priv data of mbuf */
3520         rte_prefetch0((void *)(size_t)(DPAA2_GET_FD_ADDR(fd)-64));
3521
3522         ev->flow_id = rxq->ev.flow_id;
3523         ev->sub_event_type = rxq->ev.sub_event_type;
3524         ev->event_type = RTE_EVENT_TYPE_CRYPTODEV;
3525         ev->op = RTE_EVENT_OP_NEW;
3526         ev->sched_type = rxq->ev.sched_type;
3527         ev->queue_id = rxq->ev.queue_id;
3528         ev->priority = rxq->ev.priority;
3529         ev->event_ptr = sec_fd_to_mbuf(fd);
3530
3531         qbman_swp_dqrr_consume(swp, dq);
3532 }
3533 static void
3534 dpaa2_sec_process_atomic_event(struct qbman_swp *swp __attribute__((unused)),
3535                                  const struct qbman_fd *fd,
3536                                  const struct qbman_result *dq,
3537                                  struct dpaa2_queue *rxq,
3538                                  struct rte_event *ev)
3539 {
3540         uint8_t dqrr_index;
3541         struct rte_crypto_op *crypto_op = (struct rte_crypto_op *)ev->event_ptr;
3542         /* Prefetching mbuf */
3543         rte_prefetch0((void *)(size_t)(DPAA2_GET_FD_ADDR(fd)-
3544                 rte_dpaa2_bpid_info[DPAA2_GET_FD_BPID(fd)].meta_data_size));
3545
3546         /* Prefetching ipsec crypto_op stored in priv data of mbuf */
3547         rte_prefetch0((void *)(size_t)(DPAA2_GET_FD_ADDR(fd)-64));
3548
3549         ev->flow_id = rxq->ev.flow_id;
3550         ev->sub_event_type = rxq->ev.sub_event_type;
3551         ev->event_type = RTE_EVENT_TYPE_CRYPTODEV;
3552         ev->op = RTE_EVENT_OP_NEW;
3553         ev->sched_type = rxq->ev.sched_type;
3554         ev->queue_id = rxq->ev.queue_id;
3555         ev->priority = rxq->ev.priority;
3556
3557         ev->event_ptr = sec_fd_to_mbuf(fd);
3558         dqrr_index = qbman_get_dqrr_idx(dq);
3559         crypto_op->sym->m_src->seqn = dqrr_index + 1;
3560         DPAA2_PER_LCORE_DQRR_SIZE++;
3561         DPAA2_PER_LCORE_DQRR_HELD |= 1 << dqrr_index;
3562         DPAA2_PER_LCORE_DQRR_MBUF(dqrr_index) = crypto_op->sym->m_src;
3563 }
3564
3565 int
3566 dpaa2_sec_eventq_attach(const struct rte_cryptodev *dev,
3567                 int qp_id,
3568                 struct dpaa2_dpcon_dev *dpcon,
3569                 const struct rte_event *event)
3570 {
3571         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
3572         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
3573         struct dpaa2_sec_qp *qp = dev->data->queue_pairs[qp_id];
3574         struct dpseci_rx_queue_cfg cfg;
3575         uint8_t priority;
3576         int ret;
3577
3578         if (event->sched_type == RTE_SCHED_TYPE_PARALLEL)
3579                 qp->rx_vq.cb = dpaa2_sec_process_parallel_event;
3580         else if (event->sched_type == RTE_SCHED_TYPE_ATOMIC)
3581                 qp->rx_vq.cb = dpaa2_sec_process_atomic_event;
3582         else
3583                 return -EINVAL;
3584
3585         priority = (RTE_EVENT_DEV_PRIORITY_LOWEST / event->priority) *
3586                    (dpcon->num_priorities - 1);
3587
3588         memset(&cfg, 0, sizeof(struct dpseci_rx_queue_cfg));
3589         cfg.options = DPSECI_QUEUE_OPT_DEST;
3590         cfg.dest_cfg.dest_type = DPSECI_DEST_DPCON;
3591         cfg.dest_cfg.dest_id = dpcon->dpcon_id;
3592         cfg.dest_cfg.priority = priority;
3593
3594         cfg.options |= DPSECI_QUEUE_OPT_USER_CTX;
3595         cfg.user_ctx = (size_t)(qp);
3596         if (event->sched_type == RTE_SCHED_TYPE_ATOMIC) {
3597                 cfg.options |= DPSECI_QUEUE_OPT_ORDER_PRESERVATION;
3598                 cfg.order_preservation_en = 1;
3599         }
3600         ret = dpseci_set_rx_queue(dpseci, CMD_PRI_LOW, priv->token,
3601                                   qp_id, &cfg);
3602         if (ret) {
3603                 RTE_LOG(ERR, PMD, "Error in dpseci_set_queue: ret: %d\n", ret);
3604                 return ret;
3605         }
3606
3607         memcpy(&qp->rx_vq.ev, event, sizeof(struct rte_event));
3608
3609         return 0;
3610 }
3611
3612 int
3613 dpaa2_sec_eventq_detach(const struct rte_cryptodev *dev,
3614                         int qp_id)
3615 {
3616         struct dpaa2_sec_dev_private *priv = dev->data->dev_private;
3617         struct fsl_mc_io *dpseci = (struct fsl_mc_io *)priv->hw;
3618         struct dpseci_rx_queue_cfg cfg;
3619         int ret;
3620
3621         memset(&cfg, 0, sizeof(struct dpseci_rx_queue_cfg));
3622         cfg.options = DPSECI_QUEUE_OPT_DEST;
3623         cfg.dest_cfg.dest_type = DPSECI_DEST_NONE;
3624
3625         ret = dpseci_set_rx_queue(dpseci, CMD_PRI_LOW, priv->token,
3626                                   qp_id, &cfg);
3627         if (ret)
3628                 RTE_LOG(ERR, PMD, "Error in dpseci_set_queue: ret: %d\n", ret);
3629
3630         return ret;
3631 }
3632
3633 static struct rte_cryptodev_ops crypto_ops = {
3634         .dev_configure        = dpaa2_sec_dev_configure,
3635         .dev_start            = dpaa2_sec_dev_start,
3636         .dev_stop             = dpaa2_sec_dev_stop,
3637         .dev_close            = dpaa2_sec_dev_close,
3638         .dev_infos_get        = dpaa2_sec_dev_infos_get,
3639         .stats_get            = dpaa2_sec_stats_get,
3640         .stats_reset          = dpaa2_sec_stats_reset,
3641         .queue_pair_setup     = dpaa2_sec_queue_pair_setup,
3642         .queue_pair_release   = dpaa2_sec_queue_pair_release,
3643         .queue_pair_count     = dpaa2_sec_queue_pair_count,
3644         .sym_session_get_size     = dpaa2_sec_sym_session_get_size,
3645         .sym_session_configure    = dpaa2_sec_sym_session_configure,
3646         .sym_session_clear        = dpaa2_sec_sym_session_clear,
3647 };
3648
3649 #ifdef RTE_LIBRTE_SECURITY
3650 static const struct rte_security_capability *
3651 dpaa2_sec_capabilities_get(void *device __rte_unused)
3652 {
3653         return dpaa2_sec_security_cap;
3654 }
3655
3656 static const struct rte_security_ops dpaa2_sec_security_ops = {
3657         .session_create = dpaa2_sec_security_session_create,
3658         .session_update = NULL,
3659         .session_stats_get = NULL,
3660         .session_destroy = dpaa2_sec_security_session_destroy,
3661         .set_pkt_metadata = NULL,
3662         .capabilities_get = dpaa2_sec_capabilities_get
3663 };
3664 #endif
3665
3666 static int
3667 dpaa2_sec_uninit(const struct rte_cryptodev *dev)
3668 {
3669         struct dpaa2_sec_dev_private *internals = dev->data->dev_private;
3670
3671         rte_free(dev->security_ctx);
3672
3673         rte_mempool_free(internals->fle_pool);
3674
3675         DPAA2_SEC_INFO("Closing DPAA2_SEC device %s on numa socket %u",
3676                        dev->data->name, rte_socket_id());
3677
3678         return 0;
3679 }
3680
3681 static int
3682 dpaa2_sec_dev_init(struct rte_cryptodev *cryptodev)
3683 {
3684         struct dpaa2_sec_dev_private *internals;
3685         struct rte_device *dev = cryptodev->device;
3686         struct rte_dpaa2_device *dpaa2_dev;
3687 #ifdef RTE_LIBRTE_SECURITY
3688         struct rte_security_ctx *security_instance;
3689 #endif
3690         struct fsl_mc_io *dpseci;
3691         uint16_t token;
3692         struct dpseci_attr attr;
3693         int retcode, hw_id;
3694         char str[30];
3695
3696         PMD_INIT_FUNC_TRACE();
3697         dpaa2_dev = container_of(dev, struct rte_dpaa2_device, device);
3698         if (dpaa2_dev == NULL) {
3699                 DPAA2_SEC_ERR("DPAA2 SEC device not found");
3700                 return -1;
3701         }
3702         hw_id = dpaa2_dev->object_id;
3703
3704         cryptodev->driver_id = cryptodev_driver_id;
3705         cryptodev->dev_ops = &crypto_ops;
3706
3707         cryptodev->enqueue_burst = dpaa2_sec_enqueue_burst;
3708         cryptodev->dequeue_burst = dpaa2_sec_dequeue_burst;
3709         cryptodev->feature_flags = RTE_CRYPTODEV_FF_SYMMETRIC_CRYPTO |
3710                         RTE_CRYPTODEV_FF_HW_ACCELERATED |
3711                         RTE_CRYPTODEV_FF_SYM_OPERATION_CHAINING |
3712                         RTE_CRYPTODEV_FF_SECURITY |
3713                         RTE_CRYPTODEV_FF_IN_PLACE_SGL |
3714                         RTE_CRYPTODEV_FF_OOP_SGL_IN_SGL_OUT |
3715                         RTE_CRYPTODEV_FF_OOP_SGL_IN_LB_OUT |
3716                         RTE_CRYPTODEV_FF_OOP_LB_IN_SGL_OUT |
3717                         RTE_CRYPTODEV_FF_OOP_LB_IN_LB_OUT;
3718
3719         internals = cryptodev->data->dev_private;
3720
3721         /*
3722          * For secondary processes, we don't initialise any further as primary
3723          * has already done this work. Only check we don't need a different
3724          * RX function
3725          */
3726         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
3727                 DPAA2_SEC_DEBUG("Device already init by primary process");
3728                 return 0;
3729         }
3730 #ifdef RTE_LIBRTE_SECURITY
3731         /* Initialize security_ctx only for primary process*/
3732         security_instance = rte_malloc("rte_security_instances_ops",
3733                                 sizeof(struct rte_security_ctx), 0);
3734         if (security_instance == NULL)
3735                 return -ENOMEM;
3736         security_instance->device = (void *)cryptodev;
3737         security_instance->ops = &dpaa2_sec_security_ops;
3738         security_instance->sess_cnt = 0;
3739         cryptodev->security_ctx = security_instance;
3740 #endif
3741         /*Open the rte device via MC and save the handle for further use*/
3742         dpseci = (struct fsl_mc_io *)rte_calloc(NULL, 1,
3743                                 sizeof(struct fsl_mc_io), 0);
3744         if (!dpseci) {
3745                 DPAA2_SEC_ERR(
3746                         "Error in allocating the memory for dpsec object");
3747                 return -1;
3748         }
3749         dpseci->regs = rte_mcp_ptr_list[0];
3750
3751         retcode = dpseci_open(dpseci, CMD_PRI_LOW, hw_id, &token);
3752         if (retcode != 0) {
3753                 DPAA2_SEC_ERR("Cannot open the dpsec device: Error = %x",
3754                               retcode);
3755                 goto init_error;
3756         }
3757         retcode = dpseci_get_attributes(dpseci, CMD_PRI_LOW, token, &attr);
3758         if (retcode != 0) {
3759                 DPAA2_SEC_ERR(
3760                              "Cannot get dpsec device attributed: Error = %x",
3761                              retcode);
3762                 goto init_error;
3763         }
3764         snprintf(cryptodev->data->name, sizeof(cryptodev->data->name),
3765                         "dpsec-%u", hw_id);
3766
3767         internals->max_nb_queue_pairs = attr.num_tx_queues;
3768         cryptodev->data->nb_queue_pairs = internals->max_nb_queue_pairs;
3769         internals->hw = dpseci;
3770         internals->token = token;
3771
3772         snprintf(str, sizeof(str), "sec_fle_pool_p%d_%d",
3773                         getpid(), cryptodev->data->dev_id);
3774         internals->fle_pool = rte_mempool_create((const char *)str,
3775                         FLE_POOL_NUM_BUFS,
3776                         FLE_POOL_BUF_SIZE,
3777                         FLE_POOL_CACHE_SIZE, 0,
3778                         NULL, NULL, NULL, NULL,
3779                         SOCKET_ID_ANY, 0);
3780         if (!internals->fle_pool) {
3781                 DPAA2_SEC_ERR("Mempool (%s) creation failed", str);
3782                 goto init_error;
3783         }
3784
3785         DPAA2_SEC_INFO("driver %s: created", cryptodev->data->name);
3786         return 0;
3787
3788 init_error:
3789         DPAA2_SEC_ERR("driver %s: create failed", cryptodev->data->name);
3790
3791         /* dpaa2_sec_uninit(crypto_dev_name); */
3792         return -EFAULT;
3793 }
3794
3795 static int
3796 cryptodev_dpaa2_sec_probe(struct rte_dpaa2_driver *dpaa2_drv __rte_unused,
3797                           struct rte_dpaa2_device *dpaa2_dev)
3798 {
3799         struct rte_cryptodev *cryptodev;
3800         char cryptodev_name[RTE_CRYPTODEV_NAME_MAX_LEN];
3801
3802         int retval;
3803
3804         snprintf(cryptodev_name, sizeof(cryptodev_name), "dpsec-%d",
3805                         dpaa2_dev->object_id);
3806
3807         cryptodev = rte_cryptodev_pmd_allocate(cryptodev_name, rte_socket_id());
3808         if (cryptodev == NULL)
3809                 return -ENOMEM;
3810
3811         if (rte_eal_process_type() == RTE_PROC_PRIMARY) {
3812                 cryptodev->data->dev_private = rte_zmalloc_socket(
3813                                         "cryptodev private structure",
3814                                         sizeof(struct dpaa2_sec_dev_private),
3815                                         RTE_CACHE_LINE_SIZE,
3816                                         rte_socket_id());
3817
3818                 if (cryptodev->data->dev_private == NULL)
3819                         rte_panic("Cannot allocate memzone for private "
3820                                   "device data");
3821         }
3822
3823         dpaa2_dev->cryptodev = cryptodev;
3824         cryptodev->device = &dpaa2_dev->device;
3825
3826         /* init user callbacks */
3827         TAILQ_INIT(&(cryptodev->link_intr_cbs));
3828
3829         if (dpaa2_svr_family == SVR_LX2160A)
3830                 rta_set_sec_era(RTA_SEC_ERA_10);
3831
3832         DPAA2_SEC_INFO("2-SEC ERA is %d", rta_get_sec_era());
3833
3834         /* Invoke PMD device initialization function */
3835         retval = dpaa2_sec_dev_init(cryptodev);
3836         if (retval == 0)
3837                 return 0;
3838
3839         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
3840                 rte_free(cryptodev->data->dev_private);
3841
3842         cryptodev->attached = RTE_CRYPTODEV_DETACHED;
3843
3844         return -ENXIO;
3845 }
3846
3847 static int
3848 cryptodev_dpaa2_sec_remove(struct rte_dpaa2_device *dpaa2_dev)
3849 {
3850         struct rte_cryptodev *cryptodev;
3851         int ret;
3852
3853         cryptodev = dpaa2_dev->cryptodev;
3854         if (cryptodev == NULL)
3855                 return -ENODEV;
3856
3857         ret = dpaa2_sec_uninit(cryptodev);
3858         if (ret)
3859                 return ret;
3860
3861         return rte_cryptodev_pmd_destroy(cryptodev);
3862 }
3863
3864 static struct rte_dpaa2_driver rte_dpaa2_sec_driver = {
3865         .drv_flags = RTE_DPAA2_DRV_IOVA_AS_VA,
3866         .drv_type = DPAA2_CRYPTO,
3867         .driver = {
3868                 .name = "DPAA2 SEC PMD"
3869         },
3870         .probe = cryptodev_dpaa2_sec_probe,
3871         .remove = cryptodev_dpaa2_sec_remove,
3872 };
3873
3874 static struct cryptodev_driver dpaa2_sec_crypto_drv;
3875
3876 RTE_PMD_REGISTER_DPAA2(CRYPTODEV_NAME_DPAA2_SEC_PMD, rte_dpaa2_sec_driver);
3877 RTE_PMD_REGISTER_CRYPTO_DRIVER(dpaa2_sec_crypto_drv,
3878                 rte_dpaa2_sec_driver.driver, cryptodev_driver_id);
3879
3880 RTE_INIT(dpaa2_sec_init_log)
3881 {
3882         /* Bus level logs */
3883         dpaa2_logtype_sec = rte_log_register("pmd.crypto.dpaa2");
3884         if (dpaa2_logtype_sec >= 0)
3885                 rte_log_set_level(dpaa2_logtype_sec, RTE_LOG_NOTICE);
3886 }