drivers/crypto/dpaa_sec/dpaa_sec.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  *
   3  *   Copyright (c) 2016 Freescale Semiconductor, Inc. All rights reserved.
   4  *   Copyright 2017-2019 NXP
   5  *
   6  */
   7
   8 #include <fcntl.h>
   9 #include <unistd.h>
  10 #include <sched.h>
  11 #include <net/if.h>
  12
  13 #include <rte_byteorder.h>
  14 #include <rte_common.h>
  15 #include <rte_cryptodev_pmd.h>
  16 #include <rte_crypto.h>
  17 #include <rte_cryptodev.h>
  18 #ifdef RTE_LIBRTE_SECURITY
  19 #include <rte_security_driver.h>
  20 #endif
  21 #include <rte_cycles.h>
  22 #include <rte_dev.h>
  23 #include <rte_kvargs.h>
  24 #include <rte_malloc.h>
  25 #include <rte_mbuf.h>
  26 #include <rte_memcpy.h>
  27 #include <rte_string_fns.h>
  28 #include <rte_spinlock.h>
  29
  30 #include <fsl_usd.h>
  31 #include <fsl_qman.h>
  32 #include <dpaa_of.h>
  33
  34 /* RTA header files */
  35 #include <desc/common.h>
  36 #include <desc/algo.h>
  37 #include <desc/ipsec.h>
  38 #include <desc/pdcp.h>
  39
  40 #include <rte_dpaa_bus.h>
  41 #include <dpaa_sec.h>
  42 #include <dpaa_sec_event.h>
  43 #include <dpaa_sec_log.h>
  44 #include <dpaax_iova_table.h>
  45
  46 enum rta_sec_era rta_sec_era;
  47
  48 int dpaa_logtype_sec;
  49
  50 static uint8_t cryptodev_driver_id;
  51
  52 static __thread struct rte_crypto_op **dpaa_sec_ops;
  53 static __thread int dpaa_sec_op_nb;
  54
  55 static int
  56 dpaa_sec_attach_sess_q(struct dpaa_sec_qp *qp, dpaa_sec_session *sess);
  57
  58 static inline void
  59 dpaa_sec_op_ending(struct dpaa_sec_op_ctx *ctx)
  60 {
  61         if (!ctx->fd_status) {
  62                 ctx->op->status = RTE_CRYPTO_OP_STATUS_SUCCESS;
  63         } else {
  64                 DPAA_SEC_DP_WARN("SEC return err: 0x%x", ctx->fd_status);
  65                 ctx->op->status = RTE_CRYPTO_OP_STATUS_ERROR;
  66         }
  67 }
  68
  69 static inline struct dpaa_sec_op_ctx *
  70 dpaa_sec_alloc_ctx(dpaa_sec_session *ses, int sg_count)
  71 {
  72         struct dpaa_sec_op_ctx *ctx;
  73         int i, retval;
  74
  75         retval = rte_mempool_get(
  76                         ses->qp[rte_lcore_id() % MAX_DPAA_CORES]->ctx_pool,
  77                         (void **)(&ctx));
  78         if (!ctx || retval) {
  79                 DPAA_SEC_DP_WARN("Alloc sec descriptor failed!");
  80                 return NULL;
  81         }
  82         /*
  83          * Clear SG memory. There are 16 SG entries of 16 Bytes each.
  84          * one call to dcbz_64() clear 64 bytes, hence calling it 4 times
  85          * to clear all the SG entries. dpaa_sec_alloc_ctx() is called for
  86          * each packet, memset is costlier than dcbz_64().
  87          */
  88         for (i = 0; i < sg_count && i < MAX_JOB_SG_ENTRIES; i += 4)
  89                 dcbz_64(&ctx->job.sg[i]);
  90
  91         ctx->ctx_pool = ses->qp[rte_lcore_id() % MAX_DPAA_CORES]->ctx_pool;
  92         ctx->vtop_offset = (size_t) ctx - rte_mempool_virt2iova(ctx);
  93
  94         return ctx;
  95 }
  96
  97 static void
  98 ern_sec_fq_handler(struct qman_portal *qm __rte_unused,
  99                    struct qman_fq *fq,
 100                    const struct qm_mr_entry *msg)
 101 {
 102         DPAA_SEC_DP_ERR("sec fq %d error, RC = %x, seqnum = %x\n",
 103                         fq->fqid, msg->ern.rc, msg->ern.seqnum);
 104 }
 105
 106 /* initialize the queue with dest chan as caam chan so that
 107  * all the packets in this queue could be dispatched into caam
 108  */
 109 static int
 110 dpaa_sec_init_rx(struct qman_fq *fq_in, rte_iova_t hwdesc,
 111                  uint32_t fqid_out)
 112 {
 113         struct qm_mcc_initfq fq_opts;
 114         uint32_t flags;
 115         int ret = -1;
 116
 117         /* Clear FQ options */
 118         memset(&fq_opts, 0x00, sizeof(struct qm_mcc_initfq));
 119
 120         flags = QMAN_INITFQ_FLAG_SCHED;
 121         fq_opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_CONTEXTA |
 122                           QM_INITFQ_WE_CONTEXTB;
 123
 124         qm_fqd_context_a_set64(&fq_opts.fqd, hwdesc);
 125         fq_opts.fqd.context_b = fqid_out;
 126         fq_opts.fqd.dest.channel = qm_channel_caam;
 127         fq_opts.fqd.dest.wq = 0;
 128
 129         fq_in->cb.ern  = ern_sec_fq_handler;
 130
 131         DPAA_SEC_DEBUG("in-%x out-%x", fq_in->fqid, fqid_out);
 132
 133         ret = qman_init_fq(fq_in, flags, &fq_opts);
 134         if (unlikely(ret != 0))
 135                 DPAA_SEC_ERR("qman_init_fq failed %d", ret);
 136
 137         return ret;
 138 }
 139
 140 /* something is put into in_fq and caam put the crypto result into out_fq */
 141 static enum qman_cb_dqrr_result
 142 dqrr_out_fq_cb_rx(struct qman_portal *qm __always_unused,
 143                   struct qman_fq *fq __always_unused,
 144                   const struct qm_dqrr_entry *dqrr)
 145 {
 146         const struct qm_fd *fd;
 147         struct dpaa_sec_job *job;
 148         struct dpaa_sec_op_ctx *ctx;
 149
 150         if (dpaa_sec_op_nb >= DPAA_SEC_BURST)
 151                 return qman_cb_dqrr_defer;
 152
 153         if (!(dqrr->stat & QM_DQRR_STAT_FD_VALID))
 154                 return qman_cb_dqrr_consume;
 155
 156         fd = &dqrr->fd;
 157         /* sg is embedded in an op ctx,
 158          * sg[0] is for output
 159          * sg[1] for input
 160          */
 161         job = rte_dpaa_mem_ptov(qm_fd_addr_get64(fd));
 162
 163         ctx = container_of(job, struct dpaa_sec_op_ctx, job);
 164         ctx->fd_status = fd->status;
 165         if (ctx->op->sess_type == RTE_CRYPTO_OP_SECURITY_SESSION) {
 166                 struct qm_sg_entry *sg_out;
 167                 uint32_t len;
 168                 struct rte_mbuf *mbuf = (ctx->op->sym->m_dst == NULL) ?
 169                                 ctx->op->sym->m_src : ctx->op->sym->m_dst;
 170
 171                 sg_out = &job->sg[0];
 172                 hw_sg_to_cpu(sg_out);
 173                 len = sg_out->length;
 174                 mbuf->pkt_len = len;
 175                 while (mbuf->next != NULL) {
 176                         len -= mbuf->data_len;
 177                         mbuf = mbuf->next;
 178                 }
 179                 mbuf->data_len = len;
 180         }
 181         dpaa_sec_ops[dpaa_sec_op_nb++] = ctx->op;
 182         dpaa_sec_op_ending(ctx);
 183
 184         return qman_cb_dqrr_consume;
 185 }
 186
 187 /* caam result is put into this queue */
 188 static int
 189 dpaa_sec_init_tx(struct qman_fq *fq)
 190 {
 191         int ret;
 192         struct qm_mcc_initfq opts;
 193         uint32_t flags;
 194
 195         flags = QMAN_FQ_FLAG_NO_ENQUEUE | QMAN_FQ_FLAG_LOCKED |
 196                 QMAN_FQ_FLAG_DYNAMIC_FQID;
 197
 198         ret = qman_create_fq(0, flags, fq);
 199         if (unlikely(ret)) {
 200                 DPAA_SEC_ERR("qman_create_fq failed");
 201                 return ret;
 202         }
 203
 204         memset(&opts, 0, sizeof(opts));
 205         opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_FQCTRL |
 206                        QM_INITFQ_WE_CONTEXTA | QM_INITFQ_WE_CONTEXTB;
 207
 208         /* opts.fqd.dest.channel = dpaa_sec_pool_chan; */
 209
 210         fq->cb.dqrr = dqrr_out_fq_cb_rx;
 211         fq->cb.ern  = ern_sec_fq_handler;
 212
 213         ret = qman_init_fq(fq, 0, &opts);
 214         if (unlikely(ret)) {
 215                 DPAA_SEC_ERR("unable to init caam source fq!");
 216                 return ret;
 217         }
 218
 219         return ret;
 220 }
 221
 222 static inline int is_encode(dpaa_sec_session *ses)
 223 {
 224         return ses->dir == DIR_ENC;
 225 }
 226
 227 static inline int is_decode(dpaa_sec_session *ses)
 228 {
 229         return ses->dir == DIR_DEC;
 230 }
 231
 232 #ifdef RTE_LIBRTE_SECURITY
 233 static int
 234 dpaa_sec_prep_pdcp_cdb(dpaa_sec_session *ses)
 235 {
 236         struct alginfo authdata = {0}, cipherdata = {0};
 237         struct sec_cdb *cdb = &ses->cdb;
 238         struct alginfo *p_authdata = NULL;
 239         int32_t shared_desc_len = 0;
 240         int err;
 241 #if RTE_BYTE_ORDER == RTE_BIG_ENDIAN
 242         int swap = false;
 243 #else
 244         int swap = true;
 245 #endif
 246
 247         cipherdata.key = (size_t)ses->cipher_key.data;
 248         cipherdata.keylen = ses->cipher_key.length;
 249         cipherdata.key_enc_flags = 0;
 250         cipherdata.key_type = RTA_DATA_IMM;
 251         cipherdata.algtype = ses->cipher_key.alg;
 252         cipherdata.algmode = ses->cipher_key.algmode;
 253
 254         cdb->sh_desc[0] = cipherdata.keylen;
 255         cdb->sh_desc[1] = 0;
 256         cdb->sh_desc[2] = 0;
 257
 258         if (ses->auth_alg) {
 259                 authdata.key = (size_t)ses->auth_key.data;
 260                 authdata.keylen = ses->auth_key.length;
 261                 authdata.key_enc_flags = 0;
 262                 authdata.key_type = RTA_DATA_IMM;
 263                 authdata.algtype = ses->auth_key.alg;
 264                 authdata.algmode = ses->auth_key.algmode;
 265
 266                 p_authdata = &authdata;
 267
 268                 cdb->sh_desc[1] = authdata.keylen;
 269         }
 270
 271         err = rta_inline_query(IPSEC_AUTH_VAR_AES_DEC_BASE_DESC_LEN,
 272                                MIN_JOB_DESC_SIZE,
 273                                (unsigned int *)cdb->sh_desc,
 274                                &cdb->sh_desc[2], 2);
 275         if (err < 0) {
 276                 DPAA_SEC_ERR("Crypto: Incorrect key lengths");
 277                 return err;
 278         }
 279
 280         if (!(cdb->sh_desc[2] & 1) && cipherdata.keylen) {
 281                 cipherdata.key =
 282                         (size_t)rte_dpaa_mem_vtop((void *)(size_t)cipherdata.key);
 283                 cipherdata.key_type = RTA_DATA_PTR;
 284         }
 285         if (!(cdb->sh_desc[2] & (1 << 1)) &&  authdata.keylen) {
 286                 authdata.key =
 287                         (size_t)rte_dpaa_mem_vtop((void *)(size_t)authdata.key);
 288                 authdata.key_type = RTA_DATA_PTR;
 289         }
 290
 291         cdb->sh_desc[0] = 0;
 292         cdb->sh_desc[1] = 0;
 293         cdb->sh_desc[2] = 0;
 294
 295         if (ses->pdcp.domain == RTE_SECURITY_PDCP_MODE_CONTROL) {
 296                 if (ses->dir == DIR_ENC)
 297                         shared_desc_len = cnstr_shdsc_pdcp_c_plane_encap(
 298                                         cdb->sh_desc, 1, swap,
 299                                         ses->pdcp.hfn,
 300                                         ses->pdcp.sn_size,
 301                                         ses->pdcp.bearer,
 302                                         ses->pdcp.pkt_dir,
 303                                         ses->pdcp.hfn_threshold,
 304                                         &cipherdata, &authdata,
 305                                         0);
 306                 else if (ses->dir == DIR_DEC)
 307                         shared_desc_len = cnstr_shdsc_pdcp_c_plane_decap(
 308                                         cdb->sh_desc, 1, swap,
 309                                         ses->pdcp.hfn,
 310                                         ses->pdcp.sn_size,
 311                                         ses->pdcp.bearer,
 312                                         ses->pdcp.pkt_dir,
 313                                         ses->pdcp.hfn_threshold,
 314                                         &cipherdata, &authdata,
 315                                         0);
 316         } else {
 317                 if (ses->dir == DIR_ENC)
 318                         shared_desc_len = cnstr_shdsc_pdcp_u_plane_encap(
 319                                         cdb->sh_desc, 1, swap,
 320                                         ses->pdcp.sn_size,
 321                                         ses->pdcp.hfn,
 322                                         ses->pdcp.bearer,
 323                                         ses->pdcp.pkt_dir,
 324                                         ses->pdcp.hfn_threshold,
 325                                         &cipherdata, p_authdata, 0);
 326                 else if (ses->dir == DIR_DEC)
 327                         shared_desc_len = cnstr_shdsc_pdcp_u_plane_decap(
 328                                         cdb->sh_desc, 1, swap,
 329                                         ses->pdcp.sn_size,
 330                                         ses->pdcp.hfn,
 331                                         ses->pdcp.bearer,
 332                                         ses->pdcp.pkt_dir,
 333                                         ses->pdcp.hfn_threshold,
 334                                         &cipherdata, p_authdata, 0);
 335         }
 336         return shared_desc_len;
 337 }
 338
 339 /* prepare ipsec proto command block of the session */
 340 static int
 341 dpaa_sec_prep_ipsec_cdb(dpaa_sec_session *ses)
 342 {
 343         struct alginfo cipherdata = {0}, authdata = {0};
 344         struct sec_cdb *cdb = &ses->cdb;
 345         int32_t shared_desc_len = 0;
 346         int err;
 347 #if RTE_BYTE_ORDER == RTE_BIG_ENDIAN
 348         int swap = false;
 349 #else
 350         int swap = true;
 351 #endif
 352
 353         cipherdata.key = (size_t)ses->cipher_key.data;
 354         cipherdata.keylen = ses->cipher_key.length;
 355         cipherdata.key_enc_flags = 0;
 356         cipherdata.key_type = RTA_DATA_IMM;
 357         cipherdata.algtype = ses->cipher_key.alg;
 358         cipherdata.algmode = ses->cipher_key.algmode;
 359
 360         if (ses->auth_key.length) {
 361                 authdata.key = (size_t)ses->auth_key.data;
 362                 authdata.keylen = ses->auth_key.length;
 363                 authdata.key_enc_flags = 0;
 364                 authdata.key_type = RTA_DATA_IMM;
 365                 authdata.algtype = ses->auth_key.alg;
 366                 authdata.algmode = ses->auth_key.algmode;
 367         }
 368
 369         cdb->sh_desc[0] = cipherdata.keylen;
 370         cdb->sh_desc[1] = authdata.keylen;
 371         err = rta_inline_query(IPSEC_AUTH_VAR_AES_DEC_BASE_DESC_LEN,
 372                                MIN_JOB_DESC_SIZE,
 373                                (unsigned int *)cdb->sh_desc,
 374                                &cdb->sh_desc[2], 2);
 375
 376         if (err < 0) {
 377                 DPAA_SEC_ERR("Crypto: Incorrect key lengths");
 378                 return err;
 379         }
 380         if (cdb->sh_desc[2] & 1)
 381                 cipherdata.key_type = RTA_DATA_IMM;
 382         else {
 383                 cipherdata.key = (size_t)rte_dpaa_mem_vtop(
 384                                         (void *)(size_t)cipherdata.key);
 385                 cipherdata.key_type = RTA_DATA_PTR;
 386         }
 387         if (cdb->sh_desc[2] & (1<<1))
 388                 authdata.key_type = RTA_DATA_IMM;
 389         else {
 390                 authdata.key = (size_t)rte_dpaa_mem_vtop(
 391                                         (void *)(size_t)authdata.key);
 392                 authdata.key_type = RTA_DATA_PTR;
 393         }
 394
 395         cdb->sh_desc[0] = 0;
 396         cdb->sh_desc[1] = 0;
 397         cdb->sh_desc[2] = 0;
 398         if (ses->dir == DIR_ENC) {
 399                 shared_desc_len = cnstr_shdsc_ipsec_new_encap(
 400                                 cdb->sh_desc,
 401                                 true, swap, SHR_SERIAL,
 402                                 &ses->encap_pdb,
 403                                 (uint8_t *)&ses->ip4_hdr,
 404                                 &cipherdata, &authdata);
 405         } else if (ses->dir == DIR_DEC) {
 406                 shared_desc_len = cnstr_shdsc_ipsec_new_decap(
 407                                 cdb->sh_desc,
 408                                 true, swap, SHR_SERIAL,
 409                                 &ses->decap_pdb,
 410                                 &cipherdata, &authdata);
 411         }
 412         return shared_desc_len;
 413 }
 414 #endif
 415 /* prepare command block of the session */
 416 static int
 417 dpaa_sec_prep_cdb(dpaa_sec_session *ses)
 418 {
 419         struct alginfo alginfo_c = {0}, alginfo_a = {0}, alginfo = {0};
 420         int32_t shared_desc_len = 0;
 421         struct sec_cdb *cdb = &ses->cdb;
 422         int err;
 423 #if RTE_BYTE_ORDER == RTE_BIG_ENDIAN
 424         int swap = false;
 425 #else
 426         int swap = true;
 427 #endif
 428
 429         memset(cdb, 0, sizeof(struct sec_cdb));
 430
 431         switch (ses->ctxt) {
 432 #ifdef RTE_LIBRTE_SECURITY
 433         case DPAA_SEC_IPSEC:
 434                 shared_desc_len = dpaa_sec_prep_ipsec_cdb(ses);
 435                 break;
 436         case DPAA_SEC_PDCP:
 437                 shared_desc_len = dpaa_sec_prep_pdcp_cdb(ses);
 438                 break;
 439 #endif
 440         case DPAA_SEC_CIPHER:
 441                 alginfo_c.key = (size_t)ses->cipher_key.data;
 442                 alginfo_c.keylen = ses->cipher_key.length;
 443                 alginfo_c.key_enc_flags = 0;
 444                 alginfo_c.key_type = RTA_DATA_IMM;
 445                 alginfo_c.algtype = ses->cipher_key.alg;
 446                 alginfo_c.algmode = ses->cipher_key.algmode;
 447
 448                 switch (ses->cipher_alg) {
 449                 case RTE_CRYPTO_CIPHER_AES_CBC:
 450                 case RTE_CRYPTO_CIPHER_3DES_CBC:
 451                 case RTE_CRYPTO_CIPHER_AES_CTR:
 452                 case RTE_CRYPTO_CIPHER_3DES_CTR:
 453                         shared_desc_len = cnstr_shdsc_blkcipher(
 454                                         cdb->sh_desc, true,
 455                                         swap, SHR_NEVER, &alginfo_c,
 456                                         ses->iv.length,
 457                                         ses->dir);
 458                         break;
 459                 case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
 460                         shared_desc_len = cnstr_shdsc_snow_f8(
 461                                         cdb->sh_desc, true, swap,
 462                                         &alginfo_c,
 463                                         ses->dir);
 464                         break;
 465                 case RTE_CRYPTO_CIPHER_ZUC_EEA3:
 466                         shared_desc_len = cnstr_shdsc_zuce(
 467                                         cdb->sh_desc, true, swap,
 468                                         &alginfo_c,
 469                                         ses->dir);
 470                         break;
 471                 default:
 472                         DPAA_SEC_ERR("unsupported cipher alg %d",
 473                                      ses->cipher_alg);
 474                         return -ENOTSUP;
 475                 }
 476                 break;
 477         case DPAA_SEC_AUTH:
 478                 alginfo_a.key = (size_t)ses->auth_key.data;
 479                 alginfo_a.keylen = ses->auth_key.length;
 480                 alginfo_a.key_enc_flags = 0;
 481                 alginfo_a.key_type = RTA_DATA_IMM;
 482                 alginfo_a.algtype = ses->auth_key.alg;
 483                 alginfo_a.algmode = ses->auth_key.algmode;
 484                 switch (ses->auth_alg) {
 485                 case RTE_CRYPTO_AUTH_MD5_HMAC:
 486                 case RTE_CRYPTO_AUTH_SHA1_HMAC:
 487                 case RTE_CRYPTO_AUTH_SHA224_HMAC:
 488                 case RTE_CRYPTO_AUTH_SHA256_HMAC:
 489                 case RTE_CRYPTO_AUTH_SHA384_HMAC:
 490                 case RTE_CRYPTO_AUTH_SHA512_HMAC:
 491                         shared_desc_len = cnstr_shdsc_hmac(
 492                                                 cdb->sh_desc, true,
 493                                                 swap, SHR_NEVER, &alginfo_a,
 494                                                 !ses->dir,
 495                                                 ses->digest_length);
 496                         break;
 497                 case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
 498                         shared_desc_len = cnstr_shdsc_snow_f9(
 499                                                 cdb->sh_desc, true, swap,
 500                                                 &alginfo_a,
 501                                                 !ses->dir,
 502                                                 ses->digest_length);
 503                         break;
 504                 case RTE_CRYPTO_AUTH_ZUC_EIA3:
 505                         shared_desc_len = cnstr_shdsc_zuca(
 506                                                 cdb->sh_desc, true, swap,
 507                                                 &alginfo_a,
 508                                                 !ses->dir,
 509                                                 ses->digest_length);
 510                         break;
 511                 default:
 512                         DPAA_SEC_ERR("unsupported auth alg %u", ses->auth_alg);
 513                 }
 514                 break;
 515         case DPAA_SEC_AEAD:
 516                 if (alginfo.algtype == (unsigned int)DPAA_SEC_ALG_UNSUPPORT) {
 517                         DPAA_SEC_ERR("not supported aead alg");
 518                         return -ENOTSUP;
 519                 }
 520                 alginfo.key = (size_t)ses->aead_key.data;
 521                 alginfo.keylen = ses->aead_key.length;
 522                 alginfo.key_enc_flags = 0;
 523                 alginfo.key_type = RTA_DATA_IMM;
 524                 alginfo.algtype = ses->aead_key.alg;
 525                 alginfo.algmode = ses->aead_key.algmode;
 526
 527                 if (ses->dir == DIR_ENC)
 528                         shared_desc_len = cnstr_shdsc_gcm_encap(
 529                                         cdb->sh_desc, true, swap, SHR_NEVER,
 530                                         &alginfo,
 531                                         ses->iv.length,
 532                                         ses->digest_length);
 533                 else
 534                         shared_desc_len = cnstr_shdsc_gcm_decap(
 535                                         cdb->sh_desc, true, swap, SHR_NEVER,
 536                                         &alginfo,
 537                                         ses->iv.length,
 538                                         ses->digest_length);
 539                 break;
 540         case DPAA_SEC_CIPHER_HASH:
 541                 alginfo_c.key = (size_t)ses->cipher_key.data;
 542                 alginfo_c.keylen = ses->cipher_key.length;
 543                 alginfo_c.key_enc_flags = 0;
 544                 alginfo_c.key_type = RTA_DATA_IMM;
 545                 alginfo_c.algtype = ses->cipher_key.alg;
 546                 alginfo_c.algmode = ses->cipher_key.algmode;
 547
 548                 alginfo_a.key = (size_t)ses->auth_key.data;
 549                 alginfo_a.keylen = ses->auth_key.length;
 550                 alginfo_a.key_enc_flags = 0;
 551                 alginfo_a.key_type = RTA_DATA_IMM;
 552                 alginfo_a.algtype = ses->auth_key.alg;
 553                 alginfo_a.algmode = ses->auth_key.algmode;
 554
 555                 cdb->sh_desc[0] = alginfo_c.keylen;
 556                 cdb->sh_desc[1] = alginfo_a.keylen;
 557                 err = rta_inline_query(IPSEC_AUTH_VAR_AES_DEC_BASE_DESC_LEN,
 558                                        MIN_JOB_DESC_SIZE,
 559                                        (unsigned int *)cdb->sh_desc,
 560                                        &cdb->sh_desc[2], 2);
 561
 562                 if (err < 0) {
 563                         DPAA_SEC_ERR("Crypto: Incorrect key lengths");
 564                         return err;
 565                 }
 566                 if (cdb->sh_desc[2] & 1)
 567                         alginfo_c.key_type = RTA_DATA_IMM;
 568                 else {
 569                         alginfo_c.key = (size_t)rte_dpaa_mem_vtop(
 570                                                 (void *)(size_t)alginfo_c.key);
 571                         alginfo_c.key_type = RTA_DATA_PTR;
 572                 }
 573                 if (cdb->sh_desc[2] & (1<<1))
 574                         alginfo_a.key_type = RTA_DATA_IMM;
 575                 else {
 576                         alginfo_a.key = (size_t)rte_dpaa_mem_vtop(
 577                                                 (void *)(size_t)alginfo_a.key);
 578                         alginfo_a.key_type = RTA_DATA_PTR;
 579                 }
 580                 cdb->sh_desc[0] = 0;
 581                 cdb->sh_desc[1] = 0;
 582                 cdb->sh_desc[2] = 0;
 583                 /* Auth_only_len is set as 0 here and it will be
 584                  * overwritten in fd for each packet.
 585                  */
 586                 shared_desc_len = cnstr_shdsc_authenc(cdb->sh_desc,
 587                                 true, swap, SHR_SERIAL, &alginfo_c, &alginfo_a,
 588                                 ses->iv.length,
 589                                 ses->digest_length, ses->dir);
 590                 break;
 591         case DPAA_SEC_HASH_CIPHER:
 592         default:
 593                 DPAA_SEC_ERR("error: Unsupported session");
 594                 return -ENOTSUP;
 595         }
 596
 597         if (shared_desc_len < 0) {
 598                 DPAA_SEC_ERR("error in preparing command block");
 599                 return shared_desc_len;
 600         }
 601
 602         cdb->sh_hdr.hi.field.idlen = shared_desc_len;
 603         cdb->sh_hdr.hi.word = rte_cpu_to_be_32(cdb->sh_hdr.hi.word);
 604         cdb->sh_hdr.lo.word = rte_cpu_to_be_32(cdb->sh_hdr.lo.word);
 605
 606         return 0;
 607 }
 608
 609 /* qp is lockless, should be accessed by only one thread */
 610 static int
 611 dpaa_sec_deq(struct dpaa_sec_qp *qp, struct rte_crypto_op **ops, int nb_ops)
 612 {
 613         struct qman_fq *fq;
 614         unsigned int pkts = 0;
 615         int num_rx_bufs, ret;
 616         struct qm_dqrr_entry *dq;
 617         uint32_t vdqcr_flags = 0;
 618
 619         fq = &qp->outq;
 620         /*
 621          * Until request for four buffers, we provide exact number of buffers.
 622          * Otherwise we do not set the QM_VDQCR_EXACT flag.
 623          * Not setting QM_VDQCR_EXACT flag can provide two more buffers than
 624          * requested, so we request two less in this case.
 625          */
 626         if (nb_ops < 4) {
 627                 vdqcr_flags = QM_VDQCR_EXACT;
 628                 num_rx_bufs = nb_ops;
 629         } else {
 630                 num_rx_bufs = nb_ops > DPAA_MAX_DEQUEUE_NUM_FRAMES ?
 631                         (DPAA_MAX_DEQUEUE_NUM_FRAMES - 2) : (nb_ops - 2);
 632         }
 633         ret = qman_set_vdq(fq, num_rx_bufs, vdqcr_flags);
 634         if (ret)
 635                 return 0;
 636
 637         do {
 638                 const struct qm_fd *fd;
 639                 struct dpaa_sec_job *job;
 640                 struct dpaa_sec_op_ctx *ctx;
 641                 struct rte_crypto_op *op;
 642
 643                 dq = qman_dequeue(fq);
 644                 if (!dq)
 645                         continue;
 646
 647                 fd = &dq->fd;
 648                 /* sg is embedded in an op ctx,
 649                  * sg[0] is for output
 650                  * sg[1] for input
 651                  */
 652                 job = rte_dpaa_mem_ptov(qm_fd_addr_get64(fd));
 653
 654                 ctx = container_of(job, struct dpaa_sec_op_ctx, job);
 655                 ctx->fd_status = fd->status;
 656                 op = ctx->op;
 657                 if (op->sess_type == RTE_CRYPTO_OP_SECURITY_SESSION) {
 658                         struct qm_sg_entry *sg_out;
 659                         uint32_t len;
 660                         struct rte_mbuf *mbuf = (op->sym->m_dst == NULL) ?
 661                                                 op->sym->m_src : op->sym->m_dst;
 662
 663                         sg_out = &job->sg[0];
 664                         hw_sg_to_cpu(sg_out);
 665                         len = sg_out->length;
 666                         mbuf->pkt_len = len;
 667                         while (mbuf->next != NULL) {
 668                                 len -= mbuf->data_len;
 669                                 mbuf = mbuf->next;
 670                         }
 671                         mbuf->data_len = len;
 672                 }
 673                 if (!ctx->fd_status) {
 674                         op->status = RTE_CRYPTO_OP_STATUS_SUCCESS;
 675                 } else {
 676                         DPAA_SEC_DP_WARN("SEC return err:0x%x", ctx->fd_status);
 677                         op->status = RTE_CRYPTO_OP_STATUS_ERROR;
 678                 }
 679                 ops[pkts++] = op;
 680
 681                 /* report op status to sym->op and then free the ctx memeory */
 682                 rte_mempool_put(ctx->ctx_pool, (void *)ctx);
 683
 684                 qman_dqrr_consume(fq, dq);
 685         } while (fq->flags & QMAN_FQ_STATE_VDQCR);
 686
 687         return pkts;
 688 }
 689
 690 static inline struct dpaa_sec_job *
 691 build_auth_only_sg(struct rte_crypto_op *op, dpaa_sec_session *ses)
 692 {
 693         struct rte_crypto_sym_op *sym = op->sym;
 694         struct rte_mbuf *mbuf = sym->m_src;
 695         struct dpaa_sec_job *cf;
 696         struct dpaa_sec_op_ctx *ctx;
 697         struct qm_sg_entry *sg, *out_sg, *in_sg;
 698         phys_addr_t start_addr;
 699         uint8_t *old_digest, extra_segs;
 700         int data_len, data_offset;
 701
 702         data_len = sym->auth.data.length;
 703         data_offset = sym->auth.data.offset;
 704
 705         if (ses->auth_alg == RTE_CRYPTO_AUTH_SNOW3G_UIA2 ||
 706             ses->auth_alg == RTE_CRYPTO_AUTH_ZUC_EIA3) {
 707                 if ((data_len & 7) || (data_offset & 7)) {
 708                         DPAA_SEC_ERR("AUTH: len/offset must be full bytes");
 709                         return NULL;
 710                 }
 711
 712                 data_len = data_len >> 3;
 713                 data_offset = data_offset >> 3;
 714         }
 715
 716         if (is_decode(ses))
 717                 extra_segs = 3;
 718         else
 719                 extra_segs = 2;
 720
 721         if (mbuf->nb_segs > MAX_SG_ENTRIES) {
 722                 DPAA_SEC_DP_ERR("Auth: Max sec segs supported is %d",
 723                                 MAX_SG_ENTRIES);
 724                 return NULL;
 725         }
 726         ctx = dpaa_sec_alloc_ctx(ses, mbuf->nb_segs + extra_segs);
 727         if (!ctx)
 728                 return NULL;
 729
 730         cf = &ctx->job;
 731         ctx->op = op;
 732         old_digest = ctx->digest;
 733
 734         /* output */
 735         out_sg = &cf->sg[0];
 736         qm_sg_entry_set64(out_sg, sym->auth.digest.phys_addr);
 737         out_sg->length = ses->digest_length;
 738         cpu_to_hw_sg(out_sg);
 739
 740         /* input */
 741         in_sg = &cf->sg[1];
 742         /* need to extend the input to a compound frame */
 743         in_sg->extension = 1;
 744         in_sg->final = 1;
 745         in_sg->length = data_len;
 746         qm_sg_entry_set64(in_sg, rte_dpaa_mem_vtop(&cf->sg[2]));
 747
 748         /* 1st seg */
 749         sg = in_sg + 1;
 750
 751         if (ses->iv.length) {
 752                 uint8_t *iv_ptr;
 753
 754                 iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 755                                                    ses->iv.offset);
 756
 757                 if (ses->auth_alg == RTE_CRYPTO_AUTH_SNOW3G_UIA2) {
 758                         iv_ptr = conv_to_snow_f9_iv(iv_ptr);
 759                         sg->length = 12;
 760                 } else if (ses->auth_alg == RTE_CRYPTO_AUTH_ZUC_EIA3) {
 761                         iv_ptr = conv_to_zuc_eia_iv(iv_ptr);
 762                         sg->length = 8;
 763                 } else {
 764                         sg->length = ses->iv.length;
 765                 }
 766                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(iv_ptr));
 767                 in_sg->length += sg->length;
 768                 cpu_to_hw_sg(sg);
 769                 sg++;
 770         }
 771
 772         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 773         sg->offset = data_offset;
 774
 775         if (data_len <= (mbuf->data_len - data_offset)) {
 776                 sg->length = data_len;
 777         } else {
 778                 sg->length = mbuf->data_len - data_offset;
 779
 780                 /* remaining i/p segs */
 781                 while ((data_len = data_len - sg->length) &&
 782                        (mbuf = mbuf->next)) {
 783                         cpu_to_hw_sg(sg);
 784                         sg++;
 785                         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 786                         if (data_len > mbuf->data_len)
 787                                 sg->length = mbuf->data_len;
 788                         else
 789                                 sg->length = data_len;
 790                 }
 791         }
 792
 793         if (is_decode(ses)) {
 794                 /* Digest verification case */
 795                 cpu_to_hw_sg(sg);
 796                 sg++;
 797                 rte_memcpy(old_digest, sym->auth.digest.data,
 798                                 ses->digest_length);
 799                 start_addr = rte_dpaa_mem_vtop(old_digest);
 800                 qm_sg_entry_set64(sg, start_addr);
 801                 sg->length = ses->digest_length;
 802                 in_sg->length += ses->digest_length;
 803         }
 804         sg->final = 1;
 805         cpu_to_hw_sg(sg);
 806         cpu_to_hw_sg(in_sg);
 807
 808         return cf;
 809 }
 810
 811 /**
 812  * packet looks like:
 813  *              |<----data_len------->|
 814  *    |ip_header|ah_header|icv|payload|
 815  *              ^
 816  *              |
 817  *         mbuf->pkt.data
 818  */
 819 static inline struct dpaa_sec_job *
 820 build_auth_only(struct rte_crypto_op *op, dpaa_sec_session *ses)
 821 {
 822         struct rte_crypto_sym_op *sym = op->sym;
 823         struct rte_mbuf *mbuf = sym->m_src;
 824         struct dpaa_sec_job *cf;
 825         struct dpaa_sec_op_ctx *ctx;
 826         struct qm_sg_entry *sg, *in_sg;
 827         rte_iova_t start_addr;
 828         uint8_t *old_digest;
 829         int data_len, data_offset;
 830
 831         data_len = sym->auth.data.length;
 832         data_offset = sym->auth.data.offset;
 833
 834         if (ses->auth_alg == RTE_CRYPTO_AUTH_SNOW3G_UIA2 ||
 835             ses->auth_alg == RTE_CRYPTO_AUTH_ZUC_EIA3) {
 836                 if ((data_len & 7) || (data_offset & 7)) {
 837                         DPAA_SEC_ERR("AUTH: len/offset must be full bytes");
 838                         return NULL;
 839                 }
 840
 841                 data_len = data_len >> 3;
 842                 data_offset = data_offset >> 3;
 843         }
 844
 845         ctx = dpaa_sec_alloc_ctx(ses, 4);
 846         if (!ctx)
 847                 return NULL;
 848
 849         cf = &ctx->job;
 850         ctx->op = op;
 851         old_digest = ctx->digest;
 852
 853         start_addr = rte_pktmbuf_iova(mbuf);
 854         /* output */
 855         sg = &cf->sg[0];
 856         qm_sg_entry_set64(sg, sym->auth.digest.phys_addr);
 857         sg->length = ses->digest_length;
 858         cpu_to_hw_sg(sg);
 859
 860         /* input */
 861         in_sg = &cf->sg[1];
 862         /* need to extend the input to a compound frame */
 863         in_sg->extension = 1;
 864         in_sg->final = 1;
 865         in_sg->length = data_len;
 866         qm_sg_entry_set64(in_sg, rte_dpaa_mem_vtop(&cf->sg[2]));
 867         sg = &cf->sg[2];
 868
 869         if (ses->iv.length) {
 870                 uint8_t *iv_ptr;
 871
 872                 iv_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 873                                                    ses->iv.offset);
 874
 875                 if (ses->auth_alg == RTE_CRYPTO_AUTH_SNOW3G_UIA2) {
 876                         iv_ptr = conv_to_snow_f9_iv(iv_ptr);
 877                         sg->length = 12;
 878                 } else if (ses->auth_alg == RTE_CRYPTO_AUTH_ZUC_EIA3) {
 879                         iv_ptr = conv_to_zuc_eia_iv(iv_ptr);
 880                         sg->length = 8;
 881                 } else {
 882                         sg->length = ses->iv.length;
 883                 }
 884                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(iv_ptr));
 885                 in_sg->length += sg->length;
 886                 cpu_to_hw_sg(sg);
 887                 sg++;
 888         }
 889
 890         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 891         sg->offset = data_offset;
 892         sg->length = data_len;
 893
 894         if (is_decode(ses)) {
 895                 /* Digest verification case */
 896                 cpu_to_hw_sg(sg);
 897                 /* hash result or digest, save digest first */
 898                 rte_memcpy(old_digest, sym->auth.digest.data,
 899                                 ses->digest_length);
 900                 /* let's check digest by hw */
 901                 start_addr = rte_dpaa_mem_vtop(old_digest);
 902                 sg++;
 903                 qm_sg_entry_set64(sg, start_addr);
 904                 sg->length = ses->digest_length;
 905                 in_sg->length += ses->digest_length;
 906         }
 907         sg->final = 1;
 908         cpu_to_hw_sg(sg);
 909         cpu_to_hw_sg(in_sg);
 910
 911         return cf;
 912 }
 913
 914 static inline struct dpaa_sec_job *
 915 build_cipher_only_sg(struct rte_crypto_op *op, dpaa_sec_session *ses)
 916 {
 917         struct rte_crypto_sym_op *sym = op->sym;
 918         struct dpaa_sec_job *cf;
 919         struct dpaa_sec_op_ctx *ctx;
 920         struct qm_sg_entry *sg, *out_sg, *in_sg;
 921         struct rte_mbuf *mbuf;
 922         uint8_t req_segs;
 923         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 924                         ses->iv.offset);
 925         int data_len, data_offset;
 926
 927         data_len = sym->cipher.data.length;
 928         data_offset = sym->cipher.data.offset;
 929
 930         if (ses->cipher_alg == RTE_CRYPTO_CIPHER_SNOW3G_UEA2 ||
 931                 ses->cipher_alg == RTE_CRYPTO_CIPHER_ZUC_EEA3) {
 932                 if ((data_len & 7) || (data_offset & 7)) {
 933                         DPAA_SEC_ERR("CIPHER: len/offset must be full bytes");
 934                         return NULL;
 935                 }
 936
 937                 data_len = data_len >> 3;
 938                 data_offset = data_offset >> 3;
 939         }
 940
 941         if (sym->m_dst) {
 942                 mbuf = sym->m_dst;
 943                 req_segs = mbuf->nb_segs + sym->m_src->nb_segs + 3;
 944         } else {
 945                 mbuf = sym->m_src;
 946                 req_segs = mbuf->nb_segs * 2 + 3;
 947         }
 948         if (mbuf->nb_segs > MAX_SG_ENTRIES) {
 949                 DPAA_SEC_DP_ERR("Cipher: Max sec segs supported is %d",
 950                                 MAX_SG_ENTRIES);
 951                 return NULL;
 952         }
 953
 954         ctx = dpaa_sec_alloc_ctx(ses, req_segs);
 955         if (!ctx)
 956                 return NULL;
 957
 958         cf = &ctx->job;
 959         ctx->op = op;
 960
 961         /* output */
 962         out_sg = &cf->sg[0];
 963         out_sg->extension = 1;
 964         out_sg->length = data_len;
 965         qm_sg_entry_set64(out_sg, rte_dpaa_mem_vtop(&cf->sg[2]));
 966         cpu_to_hw_sg(out_sg);
 967
 968         /* 1st seg */
 969         sg = &cf->sg[2];
 970         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 971         sg->length = mbuf->data_len - data_offset;
 972         sg->offset = data_offset;
 973
 974         /* Successive segs */
 975         mbuf = mbuf->next;
 976         while (mbuf) {
 977                 cpu_to_hw_sg(sg);
 978                 sg++;
 979                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 980                 sg->length = mbuf->data_len;
 981                 mbuf = mbuf->next;
 982         }
 983         sg->final = 1;
 984         cpu_to_hw_sg(sg);
 985
 986         /* input */
 987         mbuf = sym->m_src;
 988         in_sg = &cf->sg[1];
 989         in_sg->extension = 1;
 990         in_sg->final = 1;
 991         in_sg->length = data_len + ses->iv.length;
 992
 993         sg++;
 994         qm_sg_entry_set64(in_sg, rte_dpaa_mem_vtop(sg));
 995         cpu_to_hw_sg(in_sg);
 996
 997         /* IV */
 998         qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(IV_ptr));
 999         sg->length = ses->iv.length;
1000         cpu_to_hw_sg(sg);
1001
1002         /* 1st seg */
1003         sg++;
1004         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1005         sg->length = mbuf->data_len - data_offset;
1006         sg->offset = data_offset;
1007
1008         /* Successive segs */
1009         mbuf = mbuf->next;
1010         while (mbuf) {
1011                 cpu_to_hw_sg(sg);
1012                 sg++;
1013                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1014                 sg->length = mbuf->data_len;
1015                 mbuf = mbuf->next;
1016         }
1017         sg->final = 1;
1018         cpu_to_hw_sg(sg);
1019
1020         return cf;
1021 }
1022
1023 static inline struct dpaa_sec_job *
1024 build_cipher_only(struct rte_crypto_op *op, dpaa_sec_session *ses)
1025 {
1026         struct rte_crypto_sym_op *sym = op->sym;
1027         struct dpaa_sec_job *cf;
1028         struct dpaa_sec_op_ctx *ctx;
1029         struct qm_sg_entry *sg;
1030         rte_iova_t src_start_addr, dst_start_addr;
1031         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1032                         ses->iv.offset);
1033         int data_len, data_offset;
1034
1035         data_len = sym->cipher.data.length;
1036         data_offset = sym->cipher.data.offset;
1037
1038         if (ses->cipher_alg == RTE_CRYPTO_CIPHER_SNOW3G_UEA2 ||
1039                 ses->cipher_alg == RTE_CRYPTO_CIPHER_ZUC_EEA3) {
1040                 if ((data_len & 7) || (data_offset & 7)) {
1041                         DPAA_SEC_ERR("CIPHER: len/offset must be full bytes");
1042                         return NULL;
1043                 }
1044
1045                 data_len = data_len >> 3;
1046                 data_offset = data_offset >> 3;
1047         }
1048
1049         ctx = dpaa_sec_alloc_ctx(ses, 4);
1050         if (!ctx)
1051                 return NULL;
1052
1053         cf = &ctx->job;
1054         ctx->op = op;
1055
1056         src_start_addr = rte_pktmbuf_iova(sym->m_src);
1057
1058         if (sym->m_dst)
1059                 dst_start_addr = rte_pktmbuf_iova(sym->m_dst);
1060         else
1061                 dst_start_addr = src_start_addr;
1062
1063         /* output */
1064         sg = &cf->sg[0];
1065         qm_sg_entry_set64(sg, dst_start_addr + data_offset);
1066         sg->length = data_len + ses->iv.length;
1067         cpu_to_hw_sg(sg);
1068
1069         /* input */
1070         sg = &cf->sg[1];
1071
1072         /* need to extend the input to a compound frame */
1073         sg->extension = 1;
1074         sg->final = 1;
1075         sg->length = data_len + ses->iv.length;
1076         qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(&cf->sg[2]));
1077         cpu_to_hw_sg(sg);
1078
1079         sg = &cf->sg[2];
1080         qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(IV_ptr));
1081         sg->length = ses->iv.length;
1082         cpu_to_hw_sg(sg);
1083
1084         sg++;
1085         qm_sg_entry_set64(sg, src_start_addr + data_offset);
1086         sg->length = data_len;
1087         sg->final = 1;
1088         cpu_to_hw_sg(sg);
1089
1090         return cf;
1091 }
1092
1093 static inline struct dpaa_sec_job *
1094 build_cipher_auth_gcm_sg(struct rte_crypto_op *op, dpaa_sec_session *ses)
1095 {
1096         struct rte_crypto_sym_op *sym = op->sym;
1097         struct dpaa_sec_job *cf;
1098         struct dpaa_sec_op_ctx *ctx;
1099         struct qm_sg_entry *sg, *out_sg, *in_sg;
1100         struct rte_mbuf *mbuf;
1101         uint8_t req_segs;
1102         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1103                         ses->iv.offset);
1104
1105         if (sym->m_dst) {
1106                 mbuf = sym->m_dst;
1107                 req_segs = mbuf->nb_segs + sym->m_src->nb_segs + 4;
1108         } else {
1109                 mbuf = sym->m_src;
1110                 req_segs = mbuf->nb_segs * 2 + 4;
1111         }
1112
1113         if (ses->auth_only_len)
1114                 req_segs++;
1115
1116         if (mbuf->nb_segs > MAX_SG_ENTRIES) {
1117                 DPAA_SEC_DP_ERR("AEAD: Max sec segs supported is %d",
1118                                 MAX_SG_ENTRIES);
1119                 return NULL;
1120         }
1121
1122         ctx = dpaa_sec_alloc_ctx(ses, req_segs);
1123         if (!ctx)
1124                 return NULL;
1125
1126         cf = &ctx->job;
1127         ctx->op = op;
1128
1129         rte_prefetch0(cf->sg);
1130
1131         /* output */
1132         out_sg = &cf->sg[0];
1133         out_sg->extension = 1;
1134         if (is_encode(ses))
1135                 out_sg->length = sym->aead.data.length + ses->digest_length;
1136         else
1137                 out_sg->length = sym->aead.data.length;
1138
1139         /* output sg entries */
1140         sg = &cf->sg[2];
1141         qm_sg_entry_set64(out_sg, rte_dpaa_mem_vtop(sg));
1142         cpu_to_hw_sg(out_sg);
1143
1144         /* 1st seg */
1145         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1146         sg->length = mbuf->data_len - sym->aead.data.offset;
1147         sg->offset = sym->aead.data.offset;
1148
1149         /* Successive segs */
1150         mbuf = mbuf->next;
1151         while (mbuf) {
1152                 cpu_to_hw_sg(sg);
1153                 sg++;
1154                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1155                 sg->length = mbuf->data_len;
1156                 mbuf = mbuf->next;
1157         }
1158         sg->length -= ses->digest_length;
1159
1160         if (is_encode(ses)) {
1161                 cpu_to_hw_sg(sg);
1162                 /* set auth output */
1163                 sg++;
1164                 qm_sg_entry_set64(sg, sym->aead.digest.phys_addr);
1165                 sg->length = ses->digest_length;
1166         }
1167         sg->final = 1;
1168         cpu_to_hw_sg(sg);
1169
1170         /* input */
1171         mbuf = sym->m_src;
1172         in_sg = &cf->sg[1];
1173         in_sg->extension = 1;
1174         in_sg->final = 1;
1175         if (is_encode(ses))
1176                 in_sg->length = ses->iv.length + sym->aead.data.length
1177                                                         + ses->auth_only_len;
1178         else
1179                 in_sg->length = ses->iv.length + sym->aead.data.length
1180                                 + ses->auth_only_len + ses->digest_length;
1181
1182         /* input sg entries */
1183         sg++;
1184         qm_sg_entry_set64(in_sg, rte_dpaa_mem_vtop(sg));
1185         cpu_to_hw_sg(in_sg);
1186
1187         /* 1st seg IV */
1188         qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(IV_ptr));
1189         sg->length = ses->iv.length;
1190         cpu_to_hw_sg(sg);
1191
1192         /* 2nd seg auth only */
1193         if (ses->auth_only_len) {
1194                 sg++;
1195                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(sym->aead.aad.data));
1196                 sg->length = ses->auth_only_len;
1197                 cpu_to_hw_sg(sg);
1198         }
1199
1200         /* 3rd seg */
1201         sg++;
1202         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1203         sg->length = mbuf->data_len - sym->aead.data.offset;
1204         sg->offset = sym->aead.data.offset;
1205
1206         /* Successive segs */
1207         mbuf = mbuf->next;
1208         while (mbuf) {
1209                 cpu_to_hw_sg(sg);
1210                 sg++;
1211                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1212                 sg->length = mbuf->data_len;
1213                 mbuf = mbuf->next;
1214         }
1215
1216         if (is_decode(ses)) {
1217                 cpu_to_hw_sg(sg);
1218                 sg++;
1219                 memcpy(ctx->digest, sym->aead.digest.data,
1220                         ses->digest_length);
1221                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(ctx->digest));
1222                 sg->length = ses->digest_length;
1223         }
1224         sg->final = 1;
1225         cpu_to_hw_sg(sg);
1226
1227         return cf;
1228 }
1229
1230 static inline struct dpaa_sec_job *
1231 build_cipher_auth_gcm(struct rte_crypto_op *op, dpaa_sec_session *ses)
1232 {
1233         struct rte_crypto_sym_op *sym = op->sym;
1234         struct dpaa_sec_job *cf;
1235         struct dpaa_sec_op_ctx *ctx;
1236         struct qm_sg_entry *sg;
1237         uint32_t length = 0;
1238         rte_iova_t src_start_addr, dst_start_addr;
1239         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1240                         ses->iv.offset);
1241
1242         src_start_addr = sym->m_src->buf_iova + sym->m_src->data_off;
1243
1244         if (sym->m_dst)
1245                 dst_start_addr = sym->m_dst->buf_iova + sym->m_dst->data_off;
1246         else
1247                 dst_start_addr = src_start_addr;
1248
1249         ctx = dpaa_sec_alloc_ctx(ses, 7);
1250         if (!ctx)
1251                 return NULL;
1252
1253         cf = &ctx->job;
1254         ctx->op = op;
1255
1256         /* input */
1257         rte_prefetch0(cf->sg);
1258         sg = &cf->sg[2];
1259         qm_sg_entry_set64(&cf->sg[1], rte_dpaa_mem_vtop(sg));
1260         if (is_encode(ses)) {
1261                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(IV_ptr));
1262                 sg->length = ses->iv.length;
1263                 length += sg->length;
1264                 cpu_to_hw_sg(sg);
1265
1266                 sg++;
1267                 if (ses->auth_only_len) {
1268                         qm_sg_entry_set64(sg,
1269                                           rte_dpaa_mem_vtop(sym->aead.aad.data));
1270                         sg->length = ses->auth_only_len;
1271                         length += sg->length;
1272                         cpu_to_hw_sg(sg);
1273                         sg++;
1274                 }
1275                 qm_sg_entry_set64(sg, src_start_addr + sym->aead.data.offset);
1276                 sg->length = sym->aead.data.length;
1277                 length += sg->length;
1278                 sg->final = 1;
1279                 cpu_to_hw_sg(sg);
1280         } else {
1281                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(IV_ptr));
1282                 sg->length = ses->iv.length;
1283                 length += sg->length;
1284                 cpu_to_hw_sg(sg);
1285
1286                 sg++;
1287                 if (ses->auth_only_len) {
1288                         qm_sg_entry_set64(sg,
1289                                           rte_dpaa_mem_vtop(sym->aead.aad.data));
1290                         sg->length = ses->auth_only_len;
1291                         length += sg->length;
1292                         cpu_to_hw_sg(sg);
1293                         sg++;
1294                 }
1295                 qm_sg_entry_set64(sg, src_start_addr + sym->aead.data.offset);
1296                 sg->length = sym->aead.data.length;
1297                 length += sg->length;
1298                 cpu_to_hw_sg(sg);
1299
1300                 memcpy(ctx->digest, sym->aead.digest.data,
1301                        ses->digest_length);
1302                 sg++;
1303
1304                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(ctx->digest));
1305                 sg->length = ses->digest_length;
1306                 length += sg->length;
1307                 sg->final = 1;
1308                 cpu_to_hw_sg(sg);
1309         }
1310         /* input compound frame */
1311         cf->sg[1].length = length;
1312         cf->sg[1].extension = 1;
1313         cf->sg[1].final = 1;
1314         cpu_to_hw_sg(&cf->sg[1]);
1315
1316         /* output */
1317         sg++;
1318         qm_sg_entry_set64(&cf->sg[0], rte_dpaa_mem_vtop(sg));
1319         qm_sg_entry_set64(sg,
1320                 dst_start_addr + sym->aead.data.offset);
1321         sg->length = sym->aead.data.length;
1322         length = sg->length;
1323         if (is_encode(ses)) {
1324                 cpu_to_hw_sg(sg);
1325                 /* set auth output */
1326                 sg++;
1327                 qm_sg_entry_set64(sg, sym->aead.digest.phys_addr);
1328                 sg->length = ses->digest_length;
1329                 length += sg->length;
1330         }
1331         sg->final = 1;
1332         cpu_to_hw_sg(sg);
1333
1334         /* output compound frame */
1335         cf->sg[0].length = length;
1336         cf->sg[0].extension = 1;
1337         cpu_to_hw_sg(&cf->sg[0]);
1338
1339         return cf;
1340 }
1341
1342 static inline struct dpaa_sec_job *
1343 build_cipher_auth_sg(struct rte_crypto_op *op, dpaa_sec_session *ses)
1344 {
1345         struct rte_crypto_sym_op *sym = op->sym;
1346         struct dpaa_sec_job *cf;
1347         struct dpaa_sec_op_ctx *ctx;
1348         struct qm_sg_entry *sg, *out_sg, *in_sg;
1349         struct rte_mbuf *mbuf;
1350         uint8_t req_segs;
1351         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1352                         ses->iv.offset);
1353
1354         if (sym->m_dst) {
1355                 mbuf = sym->m_dst;
1356                 req_segs = mbuf->nb_segs + sym->m_src->nb_segs + 4;
1357         } else {
1358                 mbuf = sym->m_src;
1359                 req_segs = mbuf->nb_segs * 2 + 4;
1360         }
1361
1362         if (mbuf->nb_segs > MAX_SG_ENTRIES) {
1363                 DPAA_SEC_DP_ERR("Cipher-Auth: Max sec segs supported is %d",
1364                                 MAX_SG_ENTRIES);
1365                 return NULL;
1366         }
1367
1368         ctx = dpaa_sec_alloc_ctx(ses, req_segs);
1369         if (!ctx)
1370                 return NULL;
1371
1372         cf = &ctx->job;
1373         ctx->op = op;
1374
1375         rte_prefetch0(cf->sg);
1376
1377         /* output */
1378         out_sg = &cf->sg[0];
1379         out_sg->extension = 1;
1380         if (is_encode(ses))
1381                 out_sg->length = sym->auth.data.length + ses->digest_length;
1382         else
1383                 out_sg->length = sym->auth.data.length;
1384
1385         /* output sg entries */
1386         sg = &cf->sg[2];
1387         qm_sg_entry_set64(out_sg, rte_dpaa_mem_vtop(sg));
1388         cpu_to_hw_sg(out_sg);
1389
1390         /* 1st seg */
1391         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1392         sg->length = mbuf->data_len - sym->auth.data.offset;
1393         sg->offset = sym->auth.data.offset;
1394
1395         /* Successive segs */
1396         mbuf = mbuf->next;
1397         while (mbuf) {
1398                 cpu_to_hw_sg(sg);
1399                 sg++;
1400                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1401                 sg->length = mbuf->data_len;
1402                 mbuf = mbuf->next;
1403         }
1404         sg->length -= ses->digest_length;
1405
1406         if (is_encode(ses)) {
1407                 cpu_to_hw_sg(sg);
1408                 /* set auth output */
1409                 sg++;
1410                 qm_sg_entry_set64(sg, sym->auth.digest.phys_addr);
1411                 sg->length = ses->digest_length;
1412         }
1413         sg->final = 1;
1414         cpu_to_hw_sg(sg);
1415
1416         /* input */
1417         mbuf = sym->m_src;
1418         in_sg = &cf->sg[1];
1419         in_sg->extension = 1;
1420         in_sg->final = 1;
1421         if (is_encode(ses))
1422                 in_sg->length = ses->iv.length + sym->auth.data.length;
1423         else
1424                 in_sg->length = ses->iv.length + sym->auth.data.length
1425                                                 + ses->digest_length;
1426
1427         /* input sg entries */
1428         sg++;
1429         qm_sg_entry_set64(in_sg, rte_dpaa_mem_vtop(sg));
1430         cpu_to_hw_sg(in_sg);
1431
1432         /* 1st seg IV */
1433         qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(IV_ptr));
1434         sg->length = ses->iv.length;
1435         cpu_to_hw_sg(sg);
1436
1437         /* 2nd seg */
1438         sg++;
1439         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1440         sg->length = mbuf->data_len - sym->auth.data.offset;
1441         sg->offset = sym->auth.data.offset;
1442
1443         /* Successive segs */
1444         mbuf = mbuf->next;
1445         while (mbuf) {
1446                 cpu_to_hw_sg(sg);
1447                 sg++;
1448                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1449                 sg->length = mbuf->data_len;
1450                 mbuf = mbuf->next;
1451         }
1452
1453         sg->length -= ses->digest_length;
1454         if (is_decode(ses)) {
1455                 cpu_to_hw_sg(sg);
1456                 sg++;
1457                 memcpy(ctx->digest, sym->auth.digest.data,
1458                         ses->digest_length);
1459                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(ctx->digest));
1460                 sg->length = ses->digest_length;
1461         }
1462         sg->final = 1;
1463         cpu_to_hw_sg(sg);
1464
1465         return cf;
1466 }
1467
1468 static inline struct dpaa_sec_job *
1469 build_cipher_auth(struct rte_crypto_op *op, dpaa_sec_session *ses)
1470 {
1471         struct rte_crypto_sym_op *sym = op->sym;
1472         struct dpaa_sec_job *cf;
1473         struct dpaa_sec_op_ctx *ctx;
1474         struct qm_sg_entry *sg;
1475         rte_iova_t src_start_addr, dst_start_addr;
1476         uint32_t length = 0;
1477         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1478                         ses->iv.offset);
1479
1480         src_start_addr = sym->m_src->buf_iova + sym->m_src->data_off;
1481         if (sym->m_dst)
1482                 dst_start_addr = sym->m_dst->buf_iova + sym->m_dst->data_off;
1483         else
1484                 dst_start_addr = src_start_addr;
1485
1486         ctx = dpaa_sec_alloc_ctx(ses, 7);
1487         if (!ctx)
1488                 return NULL;
1489
1490         cf = &ctx->job;
1491         ctx->op = op;
1492
1493         /* input */
1494         rte_prefetch0(cf->sg);
1495         sg = &cf->sg[2];
1496         qm_sg_entry_set64(&cf->sg[1], rte_dpaa_mem_vtop(sg));
1497         if (is_encode(ses)) {
1498                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(IV_ptr));
1499                 sg->length = ses->iv.length;
1500                 length += sg->length;
1501                 cpu_to_hw_sg(sg);
1502
1503                 sg++;
1504                 qm_sg_entry_set64(sg, src_start_addr + sym->auth.data.offset);
1505                 sg->length = sym->auth.data.length;
1506                 length += sg->length;
1507                 sg->final = 1;
1508                 cpu_to_hw_sg(sg);
1509         } else {
1510                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(IV_ptr));
1511                 sg->length = ses->iv.length;
1512                 length += sg->length;
1513                 cpu_to_hw_sg(sg);
1514
1515                 sg++;
1516
1517                 qm_sg_entry_set64(sg, src_start_addr + sym->auth.data.offset);
1518                 sg->length = sym->auth.data.length;
1519                 length += sg->length;
1520                 cpu_to_hw_sg(sg);
1521
1522                 memcpy(ctx->digest, sym->auth.digest.data,
1523                        ses->digest_length);
1524                 sg++;
1525
1526                 qm_sg_entry_set64(sg, rte_dpaa_mem_vtop(ctx->digest));
1527                 sg->length = ses->digest_length;
1528                 length += sg->length;
1529                 sg->final = 1;
1530                 cpu_to_hw_sg(sg);
1531         }
1532         /* input compound frame */
1533         cf->sg[1].length = length;
1534         cf->sg[1].extension = 1;
1535         cf->sg[1].final = 1;
1536         cpu_to_hw_sg(&cf->sg[1]);
1537
1538         /* output */
1539         sg++;
1540         qm_sg_entry_set64(&cf->sg[0], rte_dpaa_mem_vtop(sg));
1541         qm_sg_entry_set64(sg, dst_start_addr + sym->cipher.data.offset);
1542         sg->length = sym->cipher.data.length;
1543         length = sg->length;
1544         if (is_encode(ses)) {
1545                 cpu_to_hw_sg(sg);
1546                 /* set auth output */
1547                 sg++;
1548                 qm_sg_entry_set64(sg, sym->auth.digest.phys_addr);
1549                 sg->length = ses->digest_length;
1550                 length += sg->length;
1551         }
1552         sg->final = 1;
1553         cpu_to_hw_sg(sg);
1554
1555         /* output compound frame */
1556         cf->sg[0].length = length;
1557         cf->sg[0].extension = 1;
1558         cpu_to_hw_sg(&cf->sg[0]);
1559
1560         return cf;
1561 }
1562
1563 #ifdef RTE_LIBRTE_SECURITY
1564 static inline struct dpaa_sec_job *
1565 build_proto(struct rte_crypto_op *op, dpaa_sec_session *ses)
1566 {
1567         struct rte_crypto_sym_op *sym = op->sym;
1568         struct dpaa_sec_job *cf;
1569         struct dpaa_sec_op_ctx *ctx;
1570         struct qm_sg_entry *sg;
1571         phys_addr_t src_start_addr, dst_start_addr;
1572
1573         ctx = dpaa_sec_alloc_ctx(ses, 2);
1574         if (!ctx)
1575                 return NULL;
1576         cf = &ctx->job;
1577         ctx->op = op;
1578
1579         src_start_addr = rte_pktmbuf_mtophys(sym->m_src);
1580
1581         if (sym->m_dst)
1582                 dst_start_addr = rte_pktmbuf_mtophys(sym->m_dst);
1583         else
1584                 dst_start_addr = src_start_addr;
1585
1586         /* input */
1587         sg = &cf->sg[1];
1588         qm_sg_entry_set64(sg, src_start_addr);
1589         sg->length = sym->m_src->pkt_len;
1590         sg->final = 1;
1591         cpu_to_hw_sg(sg);
1592
1593         sym->m_src->packet_type &= ~RTE_PTYPE_L4_MASK;
1594         /* output */
1595         sg = &cf->sg[0];
1596         qm_sg_entry_set64(sg, dst_start_addr);
1597         sg->length = sym->m_src->buf_len - sym->m_src->data_off;
1598         cpu_to_hw_sg(sg);
1599
1600         return cf;
1601 }
1602
1603 static inline struct dpaa_sec_job *
1604 build_proto_sg(struct rte_crypto_op *op, dpaa_sec_session *ses)
1605 {
1606         struct rte_crypto_sym_op *sym = op->sym;
1607         struct dpaa_sec_job *cf;
1608         struct dpaa_sec_op_ctx *ctx;
1609         struct qm_sg_entry *sg, *out_sg, *in_sg;
1610         struct rte_mbuf *mbuf;
1611         uint8_t req_segs;
1612         uint32_t in_len = 0, out_len = 0;
1613
1614         if (sym->m_dst)
1615                 mbuf = sym->m_dst;
1616         else
1617                 mbuf = sym->m_src;
1618
1619         req_segs = mbuf->nb_segs + sym->m_src->nb_segs + 2;
1620         if (mbuf->nb_segs > MAX_SG_ENTRIES) {
1621                 DPAA_SEC_DP_ERR("Proto: Max sec segs supported is %d",
1622                                 MAX_SG_ENTRIES);
1623                 return NULL;
1624         }
1625
1626         ctx = dpaa_sec_alloc_ctx(ses, req_segs);
1627         if (!ctx)
1628                 return NULL;
1629         cf = &ctx->job;
1630         ctx->op = op;
1631         /* output */
1632         out_sg = &cf->sg[0];
1633         out_sg->extension = 1;
1634         qm_sg_entry_set64(out_sg, rte_dpaa_mem_vtop(&cf->sg[2]));
1635
1636         /* 1st seg */
1637         sg = &cf->sg[2];
1638         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1639         sg->offset = 0;
1640
1641         /* Successive segs */
1642         while (mbuf->next) {
1643                 sg->length = mbuf->data_len;
1644                 out_len += sg->length;
1645                 mbuf = mbuf->next;
1646                 cpu_to_hw_sg(sg);
1647                 sg++;
1648                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1649                 sg->offset = 0;
1650         }
1651         sg->length = mbuf->buf_len - mbuf->data_off;
1652         out_len += sg->length;
1653         sg->final = 1;
1654         cpu_to_hw_sg(sg);
1655
1656         out_sg->length = out_len;
1657         cpu_to_hw_sg(out_sg);
1658
1659         /* input */
1660         mbuf = sym->m_src;
1661         in_sg = &cf->sg[1];
1662         in_sg->extension = 1;
1663         in_sg->final = 1;
1664         in_len = mbuf->data_len;
1665
1666         sg++;
1667         qm_sg_entry_set64(in_sg, rte_dpaa_mem_vtop(sg));
1668
1669         /* 1st seg */
1670         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1671         sg->length = mbuf->data_len;
1672         sg->offset = 0;
1673
1674         /* Successive segs */
1675         mbuf = mbuf->next;
1676         while (mbuf) {
1677                 cpu_to_hw_sg(sg);
1678                 sg++;
1679                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1680                 sg->length = mbuf->data_len;
1681                 sg->offset = 0;
1682                 in_len += sg->length;
1683                 mbuf = mbuf->next;
1684         }
1685         sg->final = 1;
1686         cpu_to_hw_sg(sg);
1687
1688         in_sg->length = in_len;
1689         cpu_to_hw_sg(in_sg);
1690
1691         sym->m_src->packet_type &= ~RTE_PTYPE_L4_MASK;
1692
1693         return cf;
1694 }
1695 #endif
1696
1697 static uint16_t
1698 dpaa_sec_enqueue_burst(void *qp, struct rte_crypto_op **ops,
1699                        uint16_t nb_ops)
1700 {
1701         /* Function to transmit the frames to given device and queuepair */
1702         uint32_t loop;
1703         struct dpaa_sec_qp *dpaa_qp = (struct dpaa_sec_qp *)qp;
1704         uint16_t num_tx = 0;
1705         struct qm_fd fds[DPAA_SEC_BURST], *fd;
1706         uint32_t frames_to_send;
1707         struct rte_crypto_op *op;
1708         struct dpaa_sec_job *cf;
1709         dpaa_sec_session *ses;
1710         uint16_t auth_hdr_len, auth_tail_len;
1711         uint32_t index, flags[DPAA_SEC_BURST] = {0};
1712         struct qman_fq *inq[DPAA_SEC_BURST];
1713
1714         while (nb_ops) {
1715                 frames_to_send = (nb_ops > DPAA_SEC_BURST) ?
1716                                 DPAA_SEC_BURST : nb_ops;
1717                 for (loop = 0; loop < frames_to_send; loop++) {
1718                         op = *(ops++);
1719                         if (op->sym->m_src->seqn != 0) {
1720                                 index = op->sym->m_src->seqn - 1;
1721                                 if (DPAA_PER_LCORE_DQRR_HELD & (1 << index)) {
1722                                         /* QM_EQCR_DCA_IDXMASK = 0x0f */
1723                                         flags[loop] = ((index & 0x0f) << 8);
1724                                         flags[loop] |= QMAN_ENQUEUE_FLAG_DCA;
1725                                         DPAA_PER_LCORE_DQRR_SIZE--;
1726                                         DPAA_PER_LCORE_DQRR_HELD &=
1727                                                                 ~(1 << index);
1728                                 }
1729                         }
1730
1731                         switch (op->sess_type) {
1732                         case RTE_CRYPTO_OP_WITH_SESSION:
1733                                 ses = (dpaa_sec_session *)
1734                                         get_sym_session_private_data(
1735                                                         op->sym->session,
1736                                                         cryptodev_driver_id);
1737                                 break;
1738 #ifdef RTE_LIBRTE_SECURITY
1739                         case RTE_CRYPTO_OP_SECURITY_SESSION:
1740                                 ses = (dpaa_sec_session *)
1741                                         get_sec_session_private_data(
1742                                                         op->sym->sec_session);
1743                                 break;
1744 #endif
1745                         default:
1746                                 DPAA_SEC_DP_ERR(
1747                                         "sessionless crypto op not supported");
1748                                 frames_to_send = loop;
1749                                 nb_ops = loop;
1750                                 goto send_pkts;
1751                         }
1752
1753                         if (!ses) {
1754                                 DPAA_SEC_DP_ERR("session not available");
1755                                 frames_to_send = loop;
1756                                 nb_ops = loop;
1757                                 goto send_pkts;
1758                         }
1759
1760                         if (unlikely(!ses->qp[rte_lcore_id() % MAX_DPAA_CORES])) {
1761                                 if (dpaa_sec_attach_sess_q(qp, ses)) {
1762                                         frames_to_send = loop;
1763                                         nb_ops = loop;
1764                                         goto send_pkts;
1765                                 }
1766                         } else if (unlikely(ses->qp[rte_lcore_id() %
1767                                                 MAX_DPAA_CORES] != qp)) {
1768                                 DPAA_SEC_DP_ERR("Old:sess->qp = %p"
1769                                         " New qp = %p\n",
1770                                         ses->qp[rte_lcore_id() %
1771                                         MAX_DPAA_CORES], qp);
1772                                 frames_to_send = loop;
1773                                 nb_ops = loop;
1774                                 goto send_pkts;
1775                         }
1776
1777                         auth_hdr_len = op->sym->auth.data.length -
1778                                                 op->sym->cipher.data.length;
1779                         auth_tail_len = 0;
1780
1781                         if (rte_pktmbuf_is_contiguous(op->sym->m_src) &&
1782                                   ((op->sym->m_dst == NULL) ||
1783                                    rte_pktmbuf_is_contiguous(op->sym->m_dst))) {
1784                                 switch (ses->ctxt) {
1785 #ifdef RTE_LIBRTE_SECURITY
1786                                 case DPAA_SEC_PDCP:
1787                                 case DPAA_SEC_IPSEC:
1788                                         cf = build_proto(op, ses);
1789                                         break;
1790 #endif
1791                                 case DPAA_SEC_AUTH:
1792                                         cf = build_auth_only(op, ses);
1793                                         break;
1794                                 case DPAA_SEC_CIPHER:
1795                                         cf = build_cipher_only(op, ses);
1796                                         break;
1797                                 case DPAA_SEC_AEAD:
1798                                         cf = build_cipher_auth_gcm(op, ses);
1799                                         auth_hdr_len = ses->auth_only_len;
1800                                         break;
1801                                 case DPAA_SEC_CIPHER_HASH:
1802                                         auth_hdr_len =
1803                                                 op->sym->cipher.data.offset
1804                                                 - op->sym->auth.data.offset;
1805                                         auth_tail_len =
1806                                                 op->sym->auth.data.length
1807                                                 - op->sym->cipher.data.length
1808                                                 - auth_hdr_len;
1809                                         cf = build_cipher_auth(op, ses);
1810                                         break;
1811                                 default:
1812                                         DPAA_SEC_DP_ERR("not supported ops");
1813                                         frames_to_send = loop;
1814                                         nb_ops = loop;
1815                                         goto send_pkts;
1816                                 }
1817                         } else {
1818                                 switch (ses->ctxt) {
1819 #ifdef RTE_LIBRTE_SECURITY
1820                                 case DPAA_SEC_PDCP:
1821                                 case DPAA_SEC_IPSEC:
1822                                         cf = build_proto_sg(op, ses);
1823                                         break;
1824 #endif
1825                                 case DPAA_SEC_AUTH:
1826                                         cf = build_auth_only_sg(op, ses);
1827                                         break;
1828                                 case DPAA_SEC_CIPHER:
1829                                         cf = build_cipher_only_sg(op, ses);
1830                                         break;
1831                                 case DPAA_SEC_AEAD:
1832                                         cf = build_cipher_auth_gcm_sg(op, ses);
1833                                         auth_hdr_len = ses->auth_only_len;
1834                                         break;
1835                                 case DPAA_SEC_CIPHER_HASH:
1836                                         auth_hdr_len =
1837                                                 op->sym->cipher.data.offset
1838                                                 - op->sym->auth.data.offset;
1839                                         auth_tail_len =
1840                                                 op->sym->auth.data.length
1841                                                 - op->sym->cipher.data.length
1842                                                 - auth_hdr_len;
1843                                         cf = build_cipher_auth_sg(op, ses);
1844                                         break;
1845                                 default:
1846                                         DPAA_SEC_DP_ERR("not supported ops");
1847                                         frames_to_send = loop;
1848                                         nb_ops = loop;
1849                                         goto send_pkts;
1850                                 }
1851                         }
1852                         if (unlikely(!cf)) {
1853                                 frames_to_send = loop;
1854                                 nb_ops = loop;
1855                                 goto send_pkts;
1856                         }
1857
1858                         fd = &fds[loop];
1859                         inq[loop] = ses->inq[rte_lcore_id() % MAX_DPAA_CORES];
1860                         fd->opaque_addr = 0;
1861                         fd->cmd = 0;
1862                         qm_fd_addr_set64(fd, rte_dpaa_mem_vtop(cf->sg));
1863                         fd->_format1 = qm_fd_compound;
1864                         fd->length29 = 2 * sizeof(struct qm_sg_entry);
1865
1866                         /* Auth_only_len is set as 0 in descriptor and it is
1867                          * overwritten here in the fd.cmd which will update
1868                          * the DPOVRD reg.
1869                          */
1870                         if (auth_hdr_len || auth_tail_len) {
1871                                 fd->cmd = 0x80000000;
1872                                 fd->cmd |=
1873                                         ((auth_tail_len << 16) | auth_hdr_len);
1874                         }
1875
1876 #ifdef RTE_LIBRTE_SECURITY
1877                         /* In case of PDCP, per packet HFN is stored in
1878                          * mbuf priv after sym_op.
1879                          */
1880                         if ((ses->ctxt == DPAA_SEC_PDCP) && ses->pdcp.hfn_ovd) {
1881                                 fd->cmd = 0x80000000 |
1882                                         *((uint32_t *)((uint8_t *)op +
1883                                         ses->pdcp.hfn_ovd_offset));
1884                                 DPAA_SEC_DP_DEBUG("Per packet HFN: %x, ovd:%u\n",
1885                                         *((uint32_t *)((uint8_t *)op +
1886                                         ses->pdcp.hfn_ovd_offset)),
1887                                         ses->pdcp.hfn_ovd);
1888                         }
1889 #endif
1890                 }
1891 send_pkts:
1892                 loop = 0;
1893                 while (loop < frames_to_send) {
1894                         loop += qman_enqueue_multi_fq(&inq[loop], &fds[loop],
1895                                         &flags[loop], frames_to_send - loop);
1896                 }
1897                 nb_ops -= frames_to_send;
1898                 num_tx += frames_to_send;
1899         }
1900
1901         dpaa_qp->tx_pkts += num_tx;
1902         dpaa_qp->tx_errs += nb_ops - num_tx;
1903
1904         return num_tx;
1905 }
1906
1907 static uint16_t
1908 dpaa_sec_dequeue_burst(void *qp, struct rte_crypto_op **ops,
1909                        uint16_t nb_ops)
1910 {
1911         uint16_t num_rx;
1912         struct dpaa_sec_qp *dpaa_qp = (struct dpaa_sec_qp *)qp;
1913
1914         num_rx = dpaa_sec_deq(dpaa_qp, ops, nb_ops);
1915
1916         dpaa_qp->rx_pkts += num_rx;
1917         dpaa_qp->rx_errs += nb_ops - num_rx;
1918
1919         DPAA_SEC_DP_DEBUG("SEC Received %d Packets\n", num_rx);
1920
1921         return num_rx;
1922 }
1923
1924 /** Release queue pair */
1925 static int
1926 dpaa_sec_queue_pair_release(struct rte_cryptodev *dev,
1927                             uint16_t qp_id)
1928 {
1929         struct dpaa_sec_dev_private *internals;
1930         struct dpaa_sec_qp *qp = NULL;
1931
1932         PMD_INIT_FUNC_TRACE();
1933
1934         DPAA_SEC_DEBUG("dev =%p, queue =%d", dev, qp_id);
1935
1936         internals = dev->data->dev_private;
1937         if (qp_id >= internals->max_nb_queue_pairs) {
1938                 DPAA_SEC_ERR("Max supported qpid %d",
1939                              internals->max_nb_queue_pairs);
1940                 return -EINVAL;
1941         }
1942
1943         qp = &internals->qps[qp_id];
1944         rte_mempool_free(qp->ctx_pool);
1945         qp->internals = NULL;
1946         dev->data->queue_pairs[qp_id] = NULL;
1947
1948         return 0;
1949 }
1950
1951 /** Setup a queue pair */
1952 static int
1953 dpaa_sec_queue_pair_setup(struct rte_cryptodev *dev, uint16_t qp_id,
1954                 __rte_unused const struct rte_cryptodev_qp_conf *qp_conf,
1955                 __rte_unused int socket_id)
1956 {
1957         struct dpaa_sec_dev_private *internals;
1958         struct dpaa_sec_qp *qp = NULL;
1959         char str[20];
1960
1961         DPAA_SEC_DEBUG("dev =%p, queue =%d, conf =%p", dev, qp_id, qp_conf);
1962
1963         internals = dev->data->dev_private;
1964         if (qp_id >= internals->max_nb_queue_pairs) {
1965                 DPAA_SEC_ERR("Max supported qpid %d",
1966                              internals->max_nb_queue_pairs);
1967                 return -EINVAL;
1968         }
1969
1970         qp = &internals->qps[qp_id];
1971         qp->internals = internals;
1972         snprintf(str, sizeof(str), "ctx_pool_d%d_qp%d",
1973                         dev->data->dev_id, qp_id);
1974         if (!qp->ctx_pool) {
1975                 qp->ctx_pool = rte_mempool_create((const char *)str,
1976                                                         CTX_POOL_NUM_BUFS,
1977                                                         CTX_POOL_BUF_SIZE,
1978                                                         CTX_POOL_CACHE_SIZE, 0,
1979                                                         NULL, NULL, NULL, NULL,
1980                                                         SOCKET_ID_ANY, 0);
1981                 if (!qp->ctx_pool) {
1982                         DPAA_SEC_ERR("%s create failed\n", str);
1983                         return -ENOMEM;
1984                 }
1985         } else
1986                 DPAA_SEC_INFO("mempool already created for dev_id : %d, qp: %d",
1987                                 dev->data->dev_id, qp_id);
1988         dev->data->queue_pairs[qp_id] = qp;
1989
1990         return 0;
1991 }
1992
1993 /** Return the number of allocated queue pairs */
1994 static uint32_t
1995 dpaa_sec_queue_pair_count(struct rte_cryptodev *dev)
1996 {
1997         PMD_INIT_FUNC_TRACE();
1998
1999         return dev->data->nb_queue_pairs;
2000 }
2001
2002 /** Returns the size of session structure */
2003 static unsigned int
2004 dpaa_sec_sym_session_get_size(struct rte_cryptodev *dev __rte_unused)
2005 {
2006         PMD_INIT_FUNC_TRACE();
2007
2008         return sizeof(dpaa_sec_session);
2009 }
2010
2011 static int
2012 dpaa_sec_cipher_init(struct rte_cryptodev *dev __rte_unused,
2013                      struct rte_crypto_sym_xform *xform,
2014                      dpaa_sec_session *session)
2015 {
2016         session->ctxt = DPAA_SEC_CIPHER;
2017         session->cipher_alg = xform->cipher.algo;
2018         session->iv.length = xform->cipher.iv.length;
2019         session->iv.offset = xform->cipher.iv.offset;
2020         session->cipher_key.data = rte_zmalloc(NULL, xform->cipher.key.length,
2021                                                RTE_CACHE_LINE_SIZE);
2022         if (session->cipher_key.data == NULL && xform->cipher.key.length > 0) {
2023                 DPAA_SEC_ERR("No Memory for cipher key");
2024                 return -ENOMEM;
2025         }
2026         session->cipher_key.length = xform->cipher.key.length;
2027
2028         memcpy(session->cipher_key.data, xform->cipher.key.data,
2029                xform->cipher.key.length);
2030         switch (xform->cipher.algo) {
2031         case RTE_CRYPTO_CIPHER_AES_CBC:
2032                 session->cipher_key.alg = OP_ALG_ALGSEL_AES;
2033                 session->cipher_key.algmode = OP_ALG_AAI_CBC;
2034                 break;
2035         case RTE_CRYPTO_CIPHER_3DES_CBC:
2036                 session->cipher_key.alg = OP_ALG_ALGSEL_3DES;
2037                 session->cipher_key.algmode = OP_ALG_AAI_CBC;
2038                 break;
2039         case RTE_CRYPTO_CIPHER_AES_CTR:
2040                 session->cipher_key.alg = OP_ALG_ALGSEL_AES;
2041                 session->cipher_key.algmode = OP_ALG_AAI_CTR;
2042                 break;
2043         case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
2044                 session->cipher_key.alg = OP_ALG_ALGSEL_SNOW_F8;
2045                 break;
2046         case RTE_CRYPTO_CIPHER_ZUC_EEA3:
2047                 session->cipher_key.alg = OP_ALG_ALGSEL_ZUCE;
2048                 break;
2049         default:
2050                 DPAA_SEC_ERR("Crypto: Undefined Cipher specified %u",
2051                               xform->cipher.algo);
2052                 rte_free(session->cipher_key.data);
2053                 return -1;
2054         }
2055         session->dir = (xform->cipher.op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
2056                         DIR_ENC : DIR_DEC;
2057
2058         return 0;
2059 }
2060
2061 static int
2062 dpaa_sec_auth_init(struct rte_cryptodev *dev __rte_unused,
2063                    struct rte_crypto_sym_xform *xform,
2064                    dpaa_sec_session *session)
2065 {
2066         session->ctxt = DPAA_SEC_AUTH;
2067         session->auth_alg = xform->auth.algo;
2068         session->auth_key.data = rte_zmalloc(NULL, xform->auth.key.length,
2069                                              RTE_CACHE_LINE_SIZE);
2070         if (session->auth_key.data == NULL && xform->auth.key.length > 0) {
2071                 DPAA_SEC_ERR("No Memory for auth key");
2072                 return -ENOMEM;
2073         }
2074         session->auth_key.length = xform->auth.key.length;
2075         session->digest_length = xform->auth.digest_length;
2076         if (session->cipher_alg == RTE_CRYPTO_CIPHER_NULL) {
2077                 session->iv.offset = xform->auth.iv.offset;
2078                 session->iv.length = xform->auth.iv.length;
2079         }
2080
2081         memcpy(session->auth_key.data, xform->auth.key.data,
2082                xform->auth.key.length);
2083
2084         switch (xform->auth.algo) {
2085         case RTE_CRYPTO_AUTH_SHA1_HMAC:
2086                 session->auth_key.alg = OP_ALG_ALGSEL_SHA1;
2087                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2088                 break;
2089         case RTE_CRYPTO_AUTH_MD5_HMAC:
2090                 session->auth_key.alg = OP_ALG_ALGSEL_MD5;
2091                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2092                 break;
2093         case RTE_CRYPTO_AUTH_SHA224_HMAC:
2094                 session->auth_key.alg = OP_ALG_ALGSEL_SHA224;
2095                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2096                 break;
2097         case RTE_CRYPTO_AUTH_SHA256_HMAC:
2098                 session->auth_key.alg = OP_ALG_ALGSEL_SHA256;
2099                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2100                 break;
2101         case RTE_CRYPTO_AUTH_SHA384_HMAC:
2102                 session->auth_key.alg = OP_ALG_ALGSEL_SHA384;
2103                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2104                 break;
2105         case RTE_CRYPTO_AUTH_SHA512_HMAC:
2106                 session->auth_key.alg = OP_ALG_ALGSEL_SHA512;
2107                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2108                 break;
2109         case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
2110                 session->auth_key.alg = OP_ALG_ALGSEL_SNOW_F9;
2111                 session->auth_key.algmode = OP_ALG_AAI_F9;
2112                 break;
2113         case RTE_CRYPTO_AUTH_ZUC_EIA3:
2114                 session->auth_key.alg = OP_ALG_ALGSEL_ZUCA;
2115                 session->auth_key.algmode = OP_ALG_AAI_F9;
2116                 break;
2117         default:
2118                 DPAA_SEC_ERR("Crypto: Unsupported Auth specified %u",
2119                               xform->auth.algo);
2120                 rte_free(session->auth_key.data);
2121                 return -1;
2122         }
2123
2124         session->dir = (xform->auth.op == RTE_CRYPTO_AUTH_OP_GENERATE) ?
2125                         DIR_ENC : DIR_DEC;
2126
2127         return 0;
2128 }
2129
2130 static int
2131 dpaa_sec_chain_init(struct rte_cryptodev *dev __rte_unused,
2132                    struct rte_crypto_sym_xform *xform,
2133                    dpaa_sec_session *session)
2134 {
2135
2136         struct rte_crypto_cipher_xform *cipher_xform;
2137         struct rte_crypto_auth_xform *auth_xform;
2138
2139         session->ctxt = DPAA_SEC_CIPHER_HASH;
2140         if (session->auth_cipher_text) {
2141                 cipher_xform = &xform->cipher;
2142                 auth_xform = &xform->next->auth;
2143         } else {
2144                 cipher_xform = &xform->next->cipher;
2145                 auth_xform = &xform->auth;
2146         }
2147
2148         /* Set IV parameters */
2149         session->iv.offset = cipher_xform->iv.offset;
2150         session->iv.length = cipher_xform->iv.length;
2151
2152         session->cipher_key.data = rte_zmalloc(NULL, cipher_xform->key.length,
2153                                                RTE_CACHE_LINE_SIZE);
2154         if (session->cipher_key.data == NULL && cipher_xform->key.length > 0) {
2155                 DPAA_SEC_ERR("No Memory for cipher key");
2156                 return -1;
2157         }
2158         session->cipher_key.length = cipher_xform->key.length;
2159         session->auth_key.data = rte_zmalloc(NULL, auth_xform->key.length,
2160                                              RTE_CACHE_LINE_SIZE);
2161         if (session->auth_key.data == NULL && auth_xform->key.length > 0) {
2162                 DPAA_SEC_ERR("No Memory for auth key");
2163                 rte_free(session->cipher_key.data);
2164                 return -ENOMEM;
2165         }
2166         session->auth_key.length = auth_xform->key.length;
2167         memcpy(session->cipher_key.data, cipher_xform->key.data,
2168                cipher_xform->key.length);
2169         memcpy(session->auth_key.data, auth_xform->key.data,
2170                auth_xform->key.length);
2171
2172         session->digest_length = auth_xform->digest_length;
2173         session->auth_alg = auth_xform->algo;
2174
2175         switch (auth_xform->algo) {
2176         case RTE_CRYPTO_AUTH_SHA1_HMAC:
2177                 session->auth_key.alg = OP_ALG_ALGSEL_SHA1;
2178                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2179                 break;
2180         case RTE_CRYPTO_AUTH_MD5_HMAC:
2181                 session->auth_key.alg = OP_ALG_ALGSEL_MD5;
2182                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2183                 break;
2184         case RTE_CRYPTO_AUTH_SHA224_HMAC:
2185                 session->auth_key.alg = OP_ALG_ALGSEL_SHA224;
2186                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2187                 break;
2188         case RTE_CRYPTO_AUTH_SHA256_HMAC:
2189                 session->auth_key.alg = OP_ALG_ALGSEL_SHA256;
2190                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2191                 break;
2192         case RTE_CRYPTO_AUTH_SHA384_HMAC:
2193                 session->auth_key.alg = OP_ALG_ALGSEL_SHA384;
2194                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2195                 break;
2196         case RTE_CRYPTO_AUTH_SHA512_HMAC:
2197                 session->auth_key.alg = OP_ALG_ALGSEL_SHA512;
2198                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2199                 break;
2200         default:
2201                 DPAA_SEC_ERR("Crypto: Unsupported Auth specified %u",
2202                               auth_xform->algo);
2203                 goto error_out;
2204         }
2205
2206         session->cipher_alg = cipher_xform->algo;
2207
2208         switch (cipher_xform->algo) {
2209         case RTE_CRYPTO_CIPHER_AES_CBC:
2210                 session->cipher_key.alg = OP_ALG_ALGSEL_AES;
2211                 session->cipher_key.algmode = OP_ALG_AAI_CBC;
2212                 break;
2213         case RTE_CRYPTO_CIPHER_3DES_CBC:
2214                 session->cipher_key.alg = OP_ALG_ALGSEL_3DES;
2215                 session->cipher_key.algmode = OP_ALG_AAI_CBC;
2216                 break;
2217         case RTE_CRYPTO_CIPHER_AES_CTR:
2218                 session->cipher_key.alg = OP_ALG_ALGSEL_AES;
2219                 session->cipher_key.algmode = OP_ALG_AAI_CTR;
2220                 break;
2221         default:
2222                 DPAA_SEC_ERR("Crypto: Undefined Cipher specified %u",
2223                               cipher_xform->algo);
2224                 goto error_out;
2225         }
2226         session->dir = (cipher_xform->op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
2227                                 DIR_ENC : DIR_DEC;
2228         return 0;
2229
2230 error_out:
2231         rte_free(session->cipher_key.data);
2232         rte_free(session->auth_key.data);
2233         return -1;
2234 }
2235
2236 static int
2237 dpaa_sec_aead_init(struct rte_cryptodev *dev __rte_unused,
2238                    struct rte_crypto_sym_xform *xform,
2239                    dpaa_sec_session *session)
2240 {
2241         session->aead_alg = xform->aead.algo;
2242         session->ctxt = DPAA_SEC_AEAD;
2243         session->iv.length = xform->aead.iv.length;
2244         session->iv.offset = xform->aead.iv.offset;
2245         session->auth_only_len = xform->aead.aad_length;
2246         session->aead_key.data = rte_zmalloc(NULL, xform->aead.key.length,
2247                                              RTE_CACHE_LINE_SIZE);
2248         if (session->aead_key.data == NULL && xform->aead.key.length > 0) {
2249                 DPAA_SEC_ERR("No Memory for aead key\n");
2250                 return -ENOMEM;
2251         }
2252         session->aead_key.length = xform->aead.key.length;
2253         session->digest_length = xform->aead.digest_length;
2254
2255         memcpy(session->aead_key.data, xform->aead.key.data,
2256                xform->aead.key.length);
2257
2258         switch (session->aead_alg) {
2259         case RTE_CRYPTO_AEAD_AES_GCM:
2260                 session->aead_key.alg = OP_ALG_ALGSEL_AES;
2261                 session->aead_key.algmode = OP_ALG_AAI_GCM;
2262                 break;
2263         default:
2264                 DPAA_SEC_ERR("unsupported AEAD alg %d", session->aead_alg);
2265                 rte_free(session->aead_key.data);
2266                 return -ENOMEM;
2267         }
2268
2269         session->dir = (xform->aead.op == RTE_CRYPTO_AEAD_OP_ENCRYPT) ?
2270                         DIR_ENC : DIR_DEC;
2271
2272         return 0;
2273 }
2274
2275 static struct qman_fq *
2276 dpaa_sec_attach_rxq(struct dpaa_sec_dev_private *qi)
2277 {
2278         unsigned int i;
2279
2280         for (i = 0; i < RTE_DPAA_MAX_RX_QUEUE; i++) {
2281                 if (qi->inq_attach[i] == 0) {
2282                         qi->inq_attach[i] = 1;
2283                         return &qi->inq[i];
2284                 }
2285         }
2286         DPAA_SEC_WARN("All session in use %u", qi->max_nb_sessions);
2287
2288         return NULL;
2289 }
2290
2291 static int
2292 dpaa_sec_detach_rxq(struct dpaa_sec_dev_private *qi, struct qman_fq *fq)
2293 {
2294         unsigned int i;
2295
2296         for (i = 0; i < RTE_DPAA_MAX_RX_QUEUE; i++) {
2297                 if (&qi->inq[i] == fq) {
2298                         if (qman_retire_fq(fq, NULL) != 0)
2299                                 DPAA_SEC_WARN("Queue is not retired\n");
2300                         qman_oos_fq(fq);
2301                         qi->inq_attach[i] = 0;
2302                         return 0;
2303                 }
2304         }
2305         return -1;
2306 }
2307
2308 static int
2309 dpaa_sec_attach_sess_q(struct dpaa_sec_qp *qp, dpaa_sec_session *sess)
2310 {
2311         int ret;
2312
2313         sess->qp[rte_lcore_id() % MAX_DPAA_CORES] = qp;
2314         ret = dpaa_sec_prep_cdb(sess);
2315         if (ret) {
2316                 DPAA_SEC_ERR("Unable to prepare sec cdb");
2317                 return -1;
2318         }
2319         if (unlikely(!RTE_PER_LCORE(dpaa_io))) {
2320                 ret = rte_dpaa_portal_init((void *)0);
2321                 if (ret) {
2322                         DPAA_SEC_ERR("Failure in affining portal");
2323                         return ret;
2324                 }
2325         }
2326         ret = dpaa_sec_init_rx(sess->inq[rte_lcore_id() % MAX_DPAA_CORES],
2327                                rte_dpaa_mem_vtop(&sess->cdb),
2328                                qman_fq_fqid(&qp->outq));
2329         if (ret)
2330                 DPAA_SEC_ERR("Unable to init sec queue");
2331
2332         return ret;
2333 }
2334
2335 static int
2336 dpaa_sec_set_session_parameters(struct rte_cryptodev *dev,
2337                             struct rte_crypto_sym_xform *xform, void *sess)
2338 {
2339         struct dpaa_sec_dev_private *internals = dev->data->dev_private;
2340         dpaa_sec_session *session = sess;
2341         uint32_t i;
2342         int ret;
2343
2344         PMD_INIT_FUNC_TRACE();
2345
2346         if (unlikely(sess == NULL)) {
2347                 DPAA_SEC_ERR("invalid session struct");
2348                 return -EINVAL;
2349         }
2350         memset(session, 0, sizeof(dpaa_sec_session));
2351
2352         /* Default IV length = 0 */
2353         session->iv.length = 0;
2354
2355         /* Cipher Only */
2356         if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER && xform->next == NULL) {
2357                 session->auth_alg = RTE_CRYPTO_AUTH_NULL;
2358                 ret = dpaa_sec_cipher_init(dev, xform, session);
2359
2360         /* Authentication Only */
2361         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AUTH &&
2362                    xform->next == NULL) {
2363                 session->cipher_alg = RTE_CRYPTO_CIPHER_NULL;
2364                 session->ctxt = DPAA_SEC_AUTH;
2365                 ret = dpaa_sec_auth_init(dev, xform, session);
2366
2367         /* Cipher then Authenticate */
2368         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER &&
2369                    xform->next->type == RTE_CRYPTO_SYM_XFORM_AUTH) {
2370                 if (xform->cipher.op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) {
2371                         session->auth_cipher_text = 1;
2372                         if (xform->cipher.algo == RTE_CRYPTO_CIPHER_NULL)
2373                                 ret = dpaa_sec_auth_init(dev, xform, session);
2374                         else if (xform->next->auth.algo == RTE_CRYPTO_AUTH_NULL)
2375                                 ret = dpaa_sec_cipher_init(dev, xform, session);
2376                         else
2377                                 ret = dpaa_sec_chain_init(dev, xform, session);
2378                 } else {
2379                         DPAA_SEC_ERR("Not supported: Auth then Cipher");
2380                         return -EINVAL;
2381                 }
2382         /* Authenticate then Cipher */
2383         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AUTH &&
2384                    xform->next->type == RTE_CRYPTO_SYM_XFORM_CIPHER) {
2385                 if (xform->next->cipher.op == RTE_CRYPTO_CIPHER_OP_DECRYPT) {
2386                         session->auth_cipher_text = 0;
2387                         if (xform->auth.algo == RTE_CRYPTO_AUTH_NULL)
2388                                 ret = dpaa_sec_cipher_init(dev, xform, session);
2389                         else if (xform->next->cipher.algo
2390                                         == RTE_CRYPTO_CIPHER_NULL)
2391                                 ret = dpaa_sec_auth_init(dev, xform, session);
2392                         else
2393                                 ret = dpaa_sec_chain_init(dev, xform, session);
2394                 } else {
2395                         DPAA_SEC_ERR("Not supported: Auth then Cipher");
2396                         return -EINVAL;
2397                 }
2398
2399         /* AEAD operation for AES-GCM kind of Algorithms */
2400         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AEAD &&
2401                    xform->next == NULL) {
2402                 ret = dpaa_sec_aead_init(dev, xform, session);
2403
2404         } else {
2405                 DPAA_SEC_ERR("Invalid crypto type");
2406                 return -EINVAL;
2407         }
2408         if (ret) {
2409                 DPAA_SEC_ERR("unable to init session");
2410                 goto err1;
2411         }
2412
2413         rte_spinlock_lock(&internals->lock);
2414         for (i = 0; i < MAX_DPAA_CORES; i++) {
2415                 session->inq[i] = dpaa_sec_attach_rxq(internals);
2416                 if (session->inq[i] == NULL) {
2417                         DPAA_SEC_ERR("unable to attach sec queue");
2418                         rte_spinlock_unlock(&internals->lock);
2419                         goto err1;
2420                 }
2421         }
2422         rte_spinlock_unlock(&internals->lock);
2423
2424         return 0;
2425
2426 err1:
2427         rte_free(session->cipher_key.data);
2428         rte_free(session->auth_key.data);
2429         memset(session, 0, sizeof(dpaa_sec_session));
2430
2431         return -EINVAL;
2432 }
2433
2434 static int
2435 dpaa_sec_sym_session_configure(struct rte_cryptodev *dev,
2436                 struct rte_crypto_sym_xform *xform,
2437                 struct rte_cryptodev_sym_session *sess,
2438                 struct rte_mempool *mempool)
2439 {
2440         void *sess_private_data;
2441         int ret;
2442
2443         PMD_INIT_FUNC_TRACE();
2444
2445         if (rte_mempool_get(mempool, &sess_private_data)) {
2446                 DPAA_SEC_ERR("Couldn't get object from session mempool");
2447                 return -ENOMEM;
2448         }
2449
2450         ret = dpaa_sec_set_session_parameters(dev, xform, sess_private_data);
2451         if (ret != 0) {
2452                 DPAA_SEC_ERR("failed to configure session parameters");
2453
2454                 /* Return session to mempool */
2455                 rte_mempool_put(mempool, sess_private_data);
2456                 return ret;
2457         }
2458
2459         set_sym_session_private_data(sess, dev->driver_id,
2460                         sess_private_data);
2461
2462
2463         return 0;
2464 }
2465
2466 static inline void
2467 free_session_memory(struct rte_cryptodev *dev, dpaa_sec_session *s)
2468 {
2469         struct dpaa_sec_dev_private *qi = dev->data->dev_private;
2470         struct rte_mempool *sess_mp = rte_mempool_from_obj((void *)s);
2471         uint8_t i;
2472
2473         for (i = 0; i < MAX_DPAA_CORES; i++) {
2474                 if (s->inq[i])
2475                         dpaa_sec_detach_rxq(qi, s->inq[i]);
2476                 s->inq[i] = NULL;
2477                 s->qp[i] = NULL;
2478         }
2479         rte_free(s->cipher_key.data);
2480         rte_free(s->auth_key.data);
2481         memset(s, 0, sizeof(dpaa_sec_session));
2482         rte_mempool_put(sess_mp, (void *)s);
2483 }
2484
2485 /** Clear the memory of session so it doesn't leave key material behind */
2486 static void
2487 dpaa_sec_sym_session_clear(struct rte_cryptodev *dev,
2488                 struct rte_cryptodev_sym_session *sess)
2489 {
2490         PMD_INIT_FUNC_TRACE();
2491         uint8_t index = dev->driver_id;
2492         void *sess_priv = get_sym_session_private_data(sess, index);
2493         dpaa_sec_session *s = (dpaa_sec_session *)sess_priv;
2494
2495         if (sess_priv) {
2496                 free_session_memory(dev, s);
2497                 set_sym_session_private_data(sess, index, NULL);
2498         }
2499 }
2500
2501 #ifdef RTE_LIBRTE_SECURITY
2502 static int
2503 dpaa_sec_ipsec_aead_init(struct rte_crypto_aead_xform *aead_xform,
2504                         struct rte_security_ipsec_xform *ipsec_xform,
2505                         dpaa_sec_session *session)
2506 {
2507         PMD_INIT_FUNC_TRACE();
2508
2509         session->aead_key.data = rte_zmalloc(NULL, aead_xform->key.length,
2510                                                RTE_CACHE_LINE_SIZE);
2511         if (session->aead_key.data == NULL && aead_xform->key.length > 0) {
2512                 DPAA_SEC_ERR("No Memory for aead key");
2513                 return -1;
2514         }
2515         memcpy(session->aead_key.data, aead_xform->key.data,
2516                aead_xform->key.length);
2517
2518         session->digest_length = aead_xform->digest_length;
2519         session->aead_key.length = aead_xform->key.length;
2520
2521         switch (aead_xform->algo) {
2522         case RTE_CRYPTO_AEAD_AES_GCM:
2523                 switch (session->digest_length) {
2524                 case 8:
2525                         session->aead_key.alg = OP_PCL_IPSEC_AES_GCM8;
2526                         break;
2527                 case 12:
2528                         session->aead_key.alg = OP_PCL_IPSEC_AES_GCM12;
2529                         break;
2530                 case 16:
2531                         session->aead_key.alg = OP_PCL_IPSEC_AES_GCM16;
2532                         break;
2533                 default:
2534                         DPAA_SEC_ERR("Crypto: Undefined GCM digest %d",
2535                                      session->digest_length);
2536                         return -1;
2537                 }
2538                 if (session->dir == DIR_ENC) {
2539                         memcpy(session->encap_pdb.gcm.salt,
2540                                 (uint8_t *)&(ipsec_xform->salt), 4);
2541                 } else {
2542                         memcpy(session->decap_pdb.gcm.salt,
2543                                 (uint8_t *)&(ipsec_xform->salt), 4);
2544                 }
2545                 session->aead_key.algmode = OP_ALG_AAI_GCM;
2546                 session->aead_alg = RTE_CRYPTO_AEAD_AES_GCM;
2547                 break;
2548         default:
2549                 DPAA_SEC_ERR("Crypto: Undefined AEAD specified %u",
2550                               aead_xform->algo);
2551                 return -1;
2552         }
2553         return 0;
2554 }
2555
2556 static int
2557 dpaa_sec_ipsec_proto_init(struct rte_crypto_cipher_xform *cipher_xform,
2558         struct rte_crypto_auth_xform *auth_xform,
2559         struct rte_security_ipsec_xform *ipsec_xform,
2560         dpaa_sec_session *session)
2561 {
2562         if (cipher_xform) {
2563                 session->cipher_key.data = rte_zmalloc(NULL,
2564                                                        cipher_xform->key.length,
2565                                                        RTE_CACHE_LINE_SIZE);
2566                 if (session->cipher_key.data == NULL &&
2567                                 cipher_xform->key.length > 0) {
2568                         DPAA_SEC_ERR("No Memory for cipher key");
2569                         return -ENOMEM;
2570                 }
2571
2572                 session->cipher_key.length = cipher_xform->key.length;
2573                 memcpy(session->cipher_key.data, cipher_xform->key.data,
2574                                 cipher_xform->key.length);
2575                 session->cipher_alg = cipher_xform->algo;
2576         } else {
2577                 session->cipher_key.data = NULL;
2578                 session->cipher_key.length = 0;
2579                 session->cipher_alg = RTE_CRYPTO_CIPHER_NULL;
2580         }
2581
2582         if (auth_xform) {
2583                 session->auth_key.data = rte_zmalloc(NULL,
2584                                                 auth_xform->key.length,
2585                                                 RTE_CACHE_LINE_SIZE);
2586                 if (session->auth_key.data == NULL &&
2587                                 auth_xform->key.length > 0) {
2588                         DPAA_SEC_ERR("No Memory for auth key");
2589                         return -ENOMEM;
2590                 }
2591                 session->auth_key.length = auth_xform->key.length;
2592                 memcpy(session->auth_key.data, auth_xform->key.data,
2593                                 auth_xform->key.length);
2594                 session->auth_alg = auth_xform->algo;
2595                 session->digest_length = auth_xform->digest_length;
2596         } else {
2597                 session->auth_key.data = NULL;
2598                 session->auth_key.length = 0;
2599                 session->auth_alg = RTE_CRYPTO_AUTH_NULL;
2600         }
2601
2602         switch (session->auth_alg) {
2603         case RTE_CRYPTO_AUTH_SHA1_HMAC:
2604                 session->auth_key.alg = OP_PCL_IPSEC_HMAC_SHA1_96;
2605                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2606                 break;
2607         case RTE_CRYPTO_AUTH_MD5_HMAC:
2608                 session->auth_key.alg = OP_PCL_IPSEC_HMAC_MD5_96;
2609                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2610                 break;
2611         case RTE_CRYPTO_AUTH_SHA256_HMAC:
2612                 session->auth_key.alg = OP_PCL_IPSEC_HMAC_SHA2_256_128;
2613                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2614                 if (session->digest_length != 16)
2615                         DPAA_SEC_WARN(
2616                         "+++Using sha256-hmac truncated len is non-standard,"
2617                         "it will not work with lookaside proto");
2618                 break;
2619         case RTE_CRYPTO_AUTH_SHA384_HMAC:
2620                 session->auth_key.alg = OP_PCL_IPSEC_HMAC_SHA2_384_192;
2621                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2622                 break;
2623         case RTE_CRYPTO_AUTH_SHA512_HMAC:
2624                 session->auth_key.alg = OP_PCL_IPSEC_HMAC_SHA2_512_256;
2625                 session->auth_key.algmode = OP_ALG_AAI_HMAC;
2626                 break;
2627         case RTE_CRYPTO_AUTH_AES_CMAC:
2628                 session->auth_key.alg = OP_PCL_IPSEC_AES_CMAC_96;
2629                 break;
2630         case RTE_CRYPTO_AUTH_NULL:
2631                 session->auth_key.alg = OP_PCL_IPSEC_HMAC_NULL;
2632                 break;
2633         case RTE_CRYPTO_AUTH_SHA224_HMAC:
2634         case RTE_CRYPTO_AUTH_AES_XCBC_MAC:
2635         case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
2636         case RTE_CRYPTO_AUTH_SHA1:
2637         case RTE_CRYPTO_AUTH_SHA256:
2638         case RTE_CRYPTO_AUTH_SHA512:
2639         case RTE_CRYPTO_AUTH_SHA224:
2640         case RTE_CRYPTO_AUTH_SHA384:
2641         case RTE_CRYPTO_AUTH_MD5:
2642         case RTE_CRYPTO_AUTH_AES_GMAC:
2643         case RTE_CRYPTO_AUTH_KASUMI_F9:
2644         case RTE_CRYPTO_AUTH_AES_CBC_MAC:
2645         case RTE_CRYPTO_AUTH_ZUC_EIA3:
2646                 DPAA_SEC_ERR("Crypto: Unsupported auth alg %u",
2647                               session->auth_alg);
2648                 return -1;
2649         default:
2650                 DPAA_SEC_ERR("Crypto: Undefined Auth specified %u",
2651                               session->auth_alg);
2652                 return -1;
2653         }
2654
2655         switch (session->cipher_alg) {
2656         case RTE_CRYPTO_CIPHER_AES_CBC:
2657                 session->cipher_key.alg = OP_PCL_IPSEC_AES_CBC;
2658                 session->cipher_key.algmode = OP_ALG_AAI_CBC;
2659                 break;
2660         case RTE_CRYPTO_CIPHER_3DES_CBC:
2661                 session->cipher_key.alg = OP_PCL_IPSEC_3DES;
2662                 session->cipher_key.algmode = OP_ALG_AAI_CBC;
2663                 break;
2664         case RTE_CRYPTO_CIPHER_AES_CTR:
2665                 session->cipher_key.alg = OP_PCL_IPSEC_AES_CTR;
2666                 session->cipher_key.algmode = OP_ALG_AAI_CTR;
2667                 if (session->dir == DIR_ENC) {
2668                         session->encap_pdb.ctr.ctr_initial = 0x00000001;
2669                         session->encap_pdb.ctr.ctr_nonce = ipsec_xform->salt;
2670                 } else {
2671                         session->decap_pdb.ctr.ctr_initial = 0x00000001;
2672                         session->decap_pdb.ctr.ctr_nonce = ipsec_xform->salt;
2673                 }
2674                 break;
2675         case RTE_CRYPTO_CIPHER_NULL:
2676                 session->cipher_key.alg = OP_PCL_IPSEC_NULL;
2677                 break;
2678         case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
2679         case RTE_CRYPTO_CIPHER_ZUC_EEA3:
2680         case RTE_CRYPTO_CIPHER_3DES_ECB:
2681         case RTE_CRYPTO_CIPHER_AES_ECB:
2682         case RTE_CRYPTO_CIPHER_KASUMI_F8:
2683                 DPAA_SEC_ERR("Crypto: Unsupported Cipher alg %u",
2684                               session->cipher_alg);
2685                 return -1;
2686         default:
2687                 DPAA_SEC_ERR("Crypto: Undefined Cipher specified %u",
2688                               session->cipher_alg);
2689                 return -1;
2690         }
2691
2692         return 0;
2693 }
2694
2695 static int
2696 dpaa_sec_set_ipsec_session(__rte_unused struct rte_cryptodev *dev,
2697                            struct rte_security_session_conf *conf,
2698                            void *sess)
2699 {
2700         struct dpaa_sec_dev_private *internals = dev->data->dev_private;
2701         struct rte_security_ipsec_xform *ipsec_xform = &conf->ipsec;
2702         struct rte_crypto_auth_xform *auth_xform = NULL;
2703         struct rte_crypto_cipher_xform *cipher_xform = NULL;
2704         struct rte_crypto_aead_xform *aead_xform = NULL;
2705         dpaa_sec_session *session = (dpaa_sec_session *)sess;
2706         uint32_t i;
2707         int ret;
2708
2709         PMD_INIT_FUNC_TRACE();
2710
2711         memset(session, 0, sizeof(dpaa_sec_session));
2712         session->proto_alg = conf->protocol;
2713         session->ctxt = DPAA_SEC_IPSEC;
2714
2715         if (ipsec_xform->direction == RTE_SECURITY_IPSEC_SA_DIR_EGRESS)
2716                 session->dir = DIR_ENC;
2717         else
2718                 session->dir = DIR_DEC;
2719
2720         if (conf->crypto_xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER) {
2721                 cipher_xform = &conf->crypto_xform->cipher;
2722                 if (conf->crypto_xform->next)
2723                         auth_xform = &conf->crypto_xform->next->auth;
2724                 ret = dpaa_sec_ipsec_proto_init(cipher_xform, auth_xform,
2725                                         ipsec_xform, session);
2726         } else if (conf->crypto_xform->type == RTE_CRYPTO_SYM_XFORM_AUTH) {
2727                 auth_xform = &conf->crypto_xform->auth;
2728                 if (conf->crypto_xform->next)
2729                         cipher_xform = &conf->crypto_xform->next->cipher;
2730                 ret = dpaa_sec_ipsec_proto_init(cipher_xform, auth_xform,
2731                                         ipsec_xform, session);
2732         } else if (conf->crypto_xform->type == RTE_CRYPTO_SYM_XFORM_AEAD) {
2733                 aead_xform = &conf->crypto_xform->aead;
2734                 ret = dpaa_sec_ipsec_aead_init(aead_xform,
2735                                         ipsec_xform, session);
2736         } else {
2737                 DPAA_SEC_ERR("XFORM not specified");
2738                 ret = -EINVAL;
2739                 goto out;
2740         }
2741         if (ret) {
2742                 DPAA_SEC_ERR("Failed to process xform");
2743                 goto out;
2744         }
2745
2746         if (ipsec_xform->direction == RTE_SECURITY_IPSEC_SA_DIR_EGRESS) {
2747                 if (ipsec_xform->tunnel.type ==
2748                                 RTE_SECURITY_IPSEC_TUNNEL_IPV4) {
2749                         session->ip4_hdr.ip_v = IPVERSION;
2750                         session->ip4_hdr.ip_hl = 5;
2751                         session->ip4_hdr.ip_len = rte_cpu_to_be_16(
2752                                                 sizeof(session->ip4_hdr));
2753                         session->ip4_hdr.ip_tos = ipsec_xform->tunnel.ipv4.dscp;
2754                         session->ip4_hdr.ip_id = 0;
2755                         session->ip4_hdr.ip_off = 0;
2756                         session->ip4_hdr.ip_ttl = ipsec_xform->tunnel.ipv4.ttl;
2757                         session->ip4_hdr.ip_p = (ipsec_xform->proto ==
2758                                         RTE_SECURITY_IPSEC_SA_PROTO_ESP) ?
2759                                         IPPROTO_ESP : IPPROTO_AH;
2760                         session->ip4_hdr.ip_sum = 0;
2761                         session->ip4_hdr.ip_src =
2762                                         ipsec_xform->tunnel.ipv4.src_ip;
2763                         session->ip4_hdr.ip_dst =
2764                                         ipsec_xform->tunnel.ipv4.dst_ip;
2765                         session->ip4_hdr.ip_sum = calc_chksum((uint16_t *)
2766                                                 (void *)&session->ip4_hdr,
2767                                                 sizeof(struct ip));
2768                         session->encap_pdb.ip_hdr_len = sizeof(struct ip);
2769                 } else if (ipsec_xform->tunnel.type ==
2770                                 RTE_SECURITY_IPSEC_TUNNEL_IPV6) {
2771                         session->ip6_hdr.vtc_flow = rte_cpu_to_be_32(
2772                                 DPAA_IPv6_DEFAULT_VTC_FLOW |
2773                                 ((ipsec_xform->tunnel.ipv6.dscp <<
2774                                         RTE_IPV6_HDR_TC_SHIFT) &
2775                                         RTE_IPV6_HDR_TC_MASK) |
2776                                 ((ipsec_xform->tunnel.ipv6.flabel <<
2777                                         RTE_IPV6_HDR_FL_SHIFT) &
2778                                         RTE_IPV6_HDR_FL_MASK));
2779                         /* Payload length will be updated by HW */
2780                         session->ip6_hdr.payload_len = 0;
2781                         session->ip6_hdr.hop_limits =
2782                                         ipsec_xform->tunnel.ipv6.hlimit;
2783                         session->ip6_hdr.proto = (ipsec_xform->proto ==
2784                                         RTE_SECURITY_IPSEC_SA_PROTO_ESP) ?
2785                                         IPPROTO_ESP : IPPROTO_AH;
2786                         memcpy(&session->ip6_hdr.src_addr,
2787                                         &ipsec_xform->tunnel.ipv6.src_addr, 16);
2788                         memcpy(&session->ip6_hdr.dst_addr,
2789                                         &ipsec_xform->tunnel.ipv6.dst_addr, 16);
2790                         session->encap_pdb.ip_hdr_len =
2791                                                 sizeof(struct rte_ipv6_hdr);
2792                 }
2793                 session->encap_pdb.options =
2794                         (IPVERSION << PDBNH_ESP_ENCAP_SHIFT) |
2795                         PDBOPTS_ESP_OIHI_PDB_INL |
2796                         PDBOPTS_ESP_IVSRC |
2797                         PDBHMO_ESP_ENCAP_DTTL |
2798                         PDBHMO_ESP_SNR;
2799                 if (ipsec_xform->options.esn)
2800                         session->encap_pdb.options |= PDBOPTS_ESP_ESN;
2801                 session->encap_pdb.spi = ipsec_xform->spi;
2802
2803         } else if (ipsec_xform->direction ==
2804                         RTE_SECURITY_IPSEC_SA_DIR_INGRESS) {
2805                 if (ipsec_xform->tunnel.type == RTE_SECURITY_IPSEC_TUNNEL_IPV4)
2806                         session->decap_pdb.options = sizeof(struct ip) << 16;
2807                 else
2808                         session->decap_pdb.options =
2809                                         sizeof(struct rte_ipv6_hdr) << 16;
2810                 if (ipsec_xform->options.esn)
2811                         session->decap_pdb.options |= PDBOPTS_ESP_ESN;
2812                 if (ipsec_xform->replay_win_sz) {
2813                         uint32_t win_sz;
2814                         win_sz = rte_align32pow2(ipsec_xform->replay_win_sz);
2815
2816                         switch (win_sz) {
2817                         case 1:
2818                         case 2:
2819                         case 4:
2820                         case 8:
2821                         case 16:
2822                         case 32:
2823                                 session->decap_pdb.options |= PDBOPTS_ESP_ARS32;
2824                                 break;
2825                         case 64:
2826                                 session->decap_pdb.options |= PDBOPTS_ESP_ARS64;
2827                                 break;
2828                         default:
2829                                 session->decap_pdb.options |=
2830                                                         PDBOPTS_ESP_ARS128;
2831                         }
2832                 }
2833         } else
2834                 goto out;
2835         rte_spinlock_lock(&internals->lock);
2836         for (i = 0; i < MAX_DPAA_CORES; i++) {
2837                 session->inq[i] = dpaa_sec_attach_rxq(internals);
2838                 if (session->inq[i] == NULL) {
2839                         DPAA_SEC_ERR("unable to attach sec queue");
2840                         rte_spinlock_unlock(&internals->lock);
2841                         goto out;
2842                 }
2843         }
2844         rte_spinlock_unlock(&internals->lock);
2845
2846         return 0;
2847 out:
2848         rte_free(session->auth_key.data);
2849         rte_free(session->cipher_key.data);
2850         memset(session, 0, sizeof(dpaa_sec_session));
2851         return -1;
2852 }
2853
2854 static int
2855 dpaa_sec_set_pdcp_session(struct rte_cryptodev *dev,
2856                           struct rte_security_session_conf *conf,
2857                           void *sess)
2858 {
2859         struct rte_security_pdcp_xform *pdcp_xform = &conf->pdcp;
2860         struct rte_crypto_sym_xform *xform = conf->crypto_xform;
2861         struct rte_crypto_auth_xform *auth_xform = NULL;
2862         struct rte_crypto_cipher_xform *cipher_xform = NULL;
2863         dpaa_sec_session *session = (dpaa_sec_session *)sess;
2864         struct dpaa_sec_dev_private *dev_priv = dev->data->dev_private;
2865         uint32_t i;
2866
2867         PMD_INIT_FUNC_TRACE();
2868
2869         memset(session, 0, sizeof(dpaa_sec_session));
2870
2871         /* find xfrm types */
2872         if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER) {
2873                 cipher_xform = &xform->cipher;
2874                 if (xform->next != NULL)
2875                         auth_xform = &xform->next->auth;
2876         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AUTH) {
2877                 auth_xform = &xform->auth;
2878                 if (xform->next != NULL)
2879                         cipher_xform = &xform->next->cipher;
2880         } else {
2881                 DPAA_SEC_ERR("Invalid crypto type");
2882                 return -EINVAL;
2883         }
2884
2885         session->proto_alg = conf->protocol;
2886         session->ctxt = DPAA_SEC_PDCP;
2887
2888         if (cipher_xform) {
2889                 switch (cipher_xform->algo) {
2890                 case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
2891                         session->cipher_key.alg = PDCP_CIPHER_TYPE_SNOW;
2892                         break;
2893                 case RTE_CRYPTO_CIPHER_ZUC_EEA3:
2894                         session->cipher_key.alg = PDCP_CIPHER_TYPE_ZUC;
2895                         break;
2896                 case RTE_CRYPTO_CIPHER_AES_CTR:
2897                         session->cipher_key.alg = PDCP_CIPHER_TYPE_AES;
2898                         break;
2899                 case RTE_CRYPTO_CIPHER_NULL:
2900                         session->cipher_key.alg = PDCP_CIPHER_TYPE_NULL;
2901                         break;
2902                 default:
2903                         DPAA_SEC_ERR("Crypto: Undefined Cipher specified %u",
2904                                       session->cipher_alg);
2905                         return -1;
2906                 }
2907
2908                 session->cipher_key.data = rte_zmalloc(NULL,
2909                                                cipher_xform->key.length,
2910                                                RTE_CACHE_LINE_SIZE);
2911                 if (session->cipher_key.data == NULL &&
2912                                 cipher_xform->key.length > 0) {
2913                         DPAA_SEC_ERR("No Memory for cipher key");
2914                         return -ENOMEM;
2915                 }
2916                 session->cipher_key.length = cipher_xform->key.length;
2917                 memcpy(session->cipher_key.data, cipher_xform->key.data,
2918                         cipher_xform->key.length);
2919                 session->dir = (cipher_xform->op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
2920                                         DIR_ENC : DIR_DEC;
2921                 session->cipher_alg = cipher_xform->algo;
2922         } else {
2923                 session->cipher_key.data = NULL;
2924                 session->cipher_key.length = 0;
2925                 session->cipher_alg = RTE_CRYPTO_CIPHER_NULL;
2926                 session->dir = DIR_ENC;
2927         }
2928
2929         if (pdcp_xform->domain == RTE_SECURITY_PDCP_MODE_CONTROL) {
2930                 if (pdcp_xform->sn_size != RTE_SECURITY_PDCP_SN_SIZE_5 &&
2931                     pdcp_xform->sn_size != RTE_SECURITY_PDCP_SN_SIZE_12) {
2932                         DPAA_SEC_ERR(
2933                                 "PDCP Seq Num size should be 5/12 bits for cmode");
2934                         goto out;
2935                 }
2936         }
2937
2938         if (auth_xform) {
2939                 switch (auth_xform->algo) {
2940                 case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
2941                         session->auth_key.alg = PDCP_AUTH_TYPE_SNOW;
2942                         break;
2943                 case RTE_CRYPTO_AUTH_ZUC_EIA3:
2944                         session->auth_key.alg = PDCP_AUTH_TYPE_ZUC;
2945                         break;
2946                 case RTE_CRYPTO_AUTH_AES_CMAC:
2947                         session->auth_key.alg = PDCP_AUTH_TYPE_AES;
2948                         break;
2949                 case RTE_CRYPTO_AUTH_NULL:
2950                         session->auth_key.alg = PDCP_AUTH_TYPE_NULL;
2951                         break;
2952                 default:
2953                         DPAA_SEC_ERR("Crypto: Unsupported auth alg %u",
2954                                       session->auth_alg);
2955                         rte_free(session->cipher_key.data);
2956                         return -1;
2957                 }
2958                 session->auth_key.data = rte_zmalloc(NULL,
2959                                                      auth_xform->key.length,
2960                                                      RTE_CACHE_LINE_SIZE);
2961                 if (!session->auth_key.data &&
2962                     auth_xform->key.length > 0) {
2963                         DPAA_SEC_ERR("No Memory for auth key");
2964                         rte_free(session->cipher_key.data);
2965                         return -ENOMEM;
2966                 }
2967                 session->auth_key.length = auth_xform->key.length;
2968                 memcpy(session->auth_key.data, auth_xform->key.data,
2969                        auth_xform->key.length);
2970                 session->auth_alg = auth_xform->algo;
2971         } else {
2972                 session->auth_key.data = NULL;
2973                 session->auth_key.length = 0;
2974                 session->auth_alg = 0;
2975         }
2976         session->pdcp.domain = pdcp_xform->domain;
2977         session->pdcp.bearer = pdcp_xform->bearer;
2978         session->pdcp.pkt_dir = pdcp_xform->pkt_dir;
2979         session->pdcp.sn_size = pdcp_xform->sn_size;
2980         session->pdcp.hfn = pdcp_xform->hfn;
2981         session->pdcp.hfn_threshold = pdcp_xform->hfn_threshold;
2982         session->pdcp.hfn_ovd = pdcp_xform->hfn_ovrd;
2983         session->pdcp.hfn_ovd_offset = cipher_xform->iv.offset;
2984
2985         rte_spinlock_lock(&dev_priv->lock);
2986         for (i = 0; i < MAX_DPAA_CORES; i++) {
2987                 session->inq[i] = dpaa_sec_attach_rxq(dev_priv);
2988                 if (session->inq[i] == NULL) {
2989                         DPAA_SEC_ERR("unable to attach sec queue");
2990                         rte_spinlock_unlock(&dev_priv->lock);
2991                         goto out;
2992                 }
2993         }
2994         rte_spinlock_unlock(&dev_priv->lock);
2995         return 0;
2996 out:
2997         rte_free(session->auth_key.data);
2998         rte_free(session->cipher_key.data);
2999         memset(session, 0, sizeof(dpaa_sec_session));
3000         return -1;
3001 }
3002
3003 static int
3004 dpaa_sec_security_session_create(void *dev,
3005                                  struct rte_security_session_conf *conf,
3006                                  struct rte_security_session *sess,
3007                                  struct rte_mempool *mempool)
3008 {
3009         void *sess_private_data;
3010         struct rte_cryptodev *cdev = (struct rte_cryptodev *)dev;
3011         int ret;
3012
3013         if (rte_mempool_get(mempool, &sess_private_data)) {
3014                 DPAA_SEC_ERR("Couldn't get object from session mempool");
3015                 return -ENOMEM;
3016         }
3017
3018         switch (conf->protocol) {
3019         case RTE_SECURITY_PROTOCOL_IPSEC:
3020                 ret = dpaa_sec_set_ipsec_session(cdev, conf,
3021                                 sess_private_data);
3022                 break;
3023         case RTE_SECURITY_PROTOCOL_PDCP:
3024                 ret = dpaa_sec_set_pdcp_session(cdev, conf,
3025                                 sess_private_data);
3026                 break;
3027         case RTE_SECURITY_PROTOCOL_MACSEC:
3028                 return -ENOTSUP;
3029         default:
3030                 return -EINVAL;
3031         }
3032         if (ret != 0) {
3033                 DPAA_SEC_ERR("failed to configure session parameters");
3034                 /* Return session to mempool */
3035                 rte_mempool_put(mempool, sess_private_data);
3036                 return ret;
3037         }
3038
3039         set_sec_session_private_data(sess, sess_private_data);
3040
3041         return ret;
3042 }
3043
3044 /** Clear the memory of session so it doesn't leave key material behind */
3045 static int
3046 dpaa_sec_security_session_destroy(void *dev __rte_unused,
3047                 struct rte_security_session *sess)
3048 {
3049         PMD_INIT_FUNC_TRACE();
3050         void *sess_priv = get_sec_session_private_data(sess);
3051         dpaa_sec_session *s = (dpaa_sec_session *)sess_priv;
3052
3053         if (sess_priv) {
3054                 free_session_memory((struct rte_cryptodev *)dev, s);
3055                 set_sec_session_private_data(sess, NULL);
3056         }
3057         return 0;
3058 }
3059 #endif
3060 static int
3061 dpaa_sec_dev_configure(struct rte_cryptodev *dev __rte_unused,
3062                        struct rte_cryptodev_config *config __rte_unused)
3063 {
3064         PMD_INIT_FUNC_TRACE();
3065
3066         return 0;
3067 }
3068
3069 static int
3070 dpaa_sec_dev_start(struct rte_cryptodev *dev __rte_unused)
3071 {
3072         PMD_INIT_FUNC_TRACE();
3073         return 0;
3074 }
3075
3076 static void
3077 dpaa_sec_dev_stop(struct rte_cryptodev *dev __rte_unused)
3078 {
3079         PMD_INIT_FUNC_TRACE();
3080 }
3081
3082 static int
3083 dpaa_sec_dev_close(struct rte_cryptodev *dev)
3084 {
3085         PMD_INIT_FUNC_TRACE();
3086
3087         if (dev == NULL)
3088                 return -ENOMEM;
3089
3090         return 0;
3091 }
3092
3093 static void
3094 dpaa_sec_dev_infos_get(struct rte_cryptodev *dev,
3095                        struct rte_cryptodev_info *info)
3096 {
3097         struct dpaa_sec_dev_private *internals = dev->data->dev_private;
3098
3099         PMD_INIT_FUNC_TRACE();
3100         if (info != NULL) {
3101                 info->max_nb_queue_pairs = internals->max_nb_queue_pairs;
3102                 info->feature_flags = dev->feature_flags;
3103                 info->capabilities = dpaa_sec_capabilities;
3104                 info->sym.max_nb_sessions = internals->max_nb_sessions;
3105                 info->driver_id = cryptodev_driver_id;
3106         }
3107 }
3108
3109 static enum qman_cb_dqrr_result
3110 dpaa_sec_process_parallel_event(void *event,
3111                         struct qman_portal *qm __always_unused,
3112                         struct qman_fq *outq,
3113                         const struct qm_dqrr_entry *dqrr,
3114                         void **bufs)
3115 {
3116         const struct qm_fd *fd;
3117         struct dpaa_sec_job *job;
3118         struct dpaa_sec_op_ctx *ctx;
3119         struct rte_event *ev = (struct rte_event *)event;
3120
3121         fd = &dqrr->fd;
3122
3123         /* sg is embedded in an op ctx,
3124          * sg[0] is for output
3125          * sg[1] for input
3126          */
3127         job = rte_dpaa_mem_ptov(qm_fd_addr_get64(fd));
3128
3129         ctx = container_of(job, struct dpaa_sec_op_ctx, job);
3130         ctx->fd_status = fd->status;
3131         if (ctx->op->sess_type == RTE_CRYPTO_OP_SECURITY_SESSION) {
3132                 struct qm_sg_entry *sg_out;
3133                 uint32_t len;
3134
3135                 sg_out = &job->sg[0];
3136                 hw_sg_to_cpu(sg_out);
3137                 len = sg_out->length;
3138                 ctx->op->sym->m_src->pkt_len = len;
3139                 ctx->op->sym->m_src->data_len = len;
3140         }
3141         if (!ctx->fd_status) {
3142                 ctx->op->status = RTE_CRYPTO_OP_STATUS_SUCCESS;
3143         } else {
3144                 DPAA_SEC_DP_WARN("SEC return err: 0x%x", ctx->fd_status);
3145                 ctx->op->status = RTE_CRYPTO_OP_STATUS_ERROR;
3146         }
3147         ev->event_ptr = (void *)ctx->op;
3148
3149         ev->flow_id = outq->ev.flow_id;
3150         ev->sub_event_type = outq->ev.sub_event_type;
3151         ev->event_type = RTE_EVENT_TYPE_CRYPTODEV;
3152         ev->op = RTE_EVENT_OP_NEW;
3153         ev->sched_type = outq->ev.sched_type;
3154         ev->queue_id = outq->ev.queue_id;
3155         ev->priority = outq->ev.priority;
3156         *bufs = (void *)ctx->op;
3157
3158         rte_mempool_put(ctx->ctx_pool, (void *)ctx);
3159
3160         return qman_cb_dqrr_consume;
3161 }
3162
3163 static enum qman_cb_dqrr_result
3164 dpaa_sec_process_atomic_event(void *event,
3165                         struct qman_portal *qm __rte_unused,
3166                         struct qman_fq *outq,
3167                         const struct qm_dqrr_entry *dqrr,
3168                         void **bufs)
3169 {
3170         u8 index;
3171         const struct qm_fd *fd;
3172         struct dpaa_sec_job *job;
3173         struct dpaa_sec_op_ctx *ctx;
3174         struct rte_event *ev = (struct rte_event *)event;
3175
3176         fd = &dqrr->fd;
3177
3178         /* sg is embedded in an op ctx,
3179          * sg[0] is for output
3180          * sg[1] for input
3181          */
3182         job = rte_dpaa_mem_ptov(qm_fd_addr_get64(fd));
3183
3184         ctx = container_of(job, struct dpaa_sec_op_ctx, job);
3185         ctx->fd_status = fd->status;
3186         if (ctx->op->sess_type == RTE_CRYPTO_OP_SECURITY_SESSION) {
3187                 struct qm_sg_entry *sg_out;
3188                 uint32_t len;
3189
3190                 sg_out = &job->sg[0];
3191                 hw_sg_to_cpu(sg_out);
3192                 len = sg_out->length;
3193                 ctx->op->sym->m_src->pkt_len = len;
3194                 ctx->op->sym->m_src->data_len = len;
3195         }
3196         if (!ctx->fd_status) {
3197                 ctx->op->status = RTE_CRYPTO_OP_STATUS_SUCCESS;
3198         } else {
3199                 DPAA_SEC_DP_WARN("SEC return err: 0x%x", ctx->fd_status);
3200                 ctx->op->status = RTE_CRYPTO_OP_STATUS_ERROR;
3201         }
3202         ev->event_ptr = (void *)ctx->op;
3203         ev->flow_id = outq->ev.flow_id;
3204         ev->sub_event_type = outq->ev.sub_event_type;
3205         ev->event_type = RTE_EVENT_TYPE_CRYPTODEV;
3206         ev->op = RTE_EVENT_OP_NEW;
3207         ev->sched_type = outq->ev.sched_type;
3208         ev->queue_id = outq->ev.queue_id;
3209         ev->priority = outq->ev.priority;
3210
3211         /* Save active dqrr entries */
3212         index = ((uintptr_t)dqrr >> 6) & (16/*QM_DQRR_SIZE*/ - 1);
3213         DPAA_PER_LCORE_DQRR_SIZE++;
3214         DPAA_PER_LCORE_DQRR_HELD |= 1 << index;
3215         DPAA_PER_LCORE_DQRR_MBUF(index) = ctx->op->sym->m_src;
3216         ev->impl_opaque = index + 1;
3217         ctx->op->sym->m_src->seqn = (uint32_t)index + 1;
3218         *bufs = (void *)ctx->op;
3219
3220         rte_mempool_put(ctx->ctx_pool, (void *)ctx);
3221
3222         return qman_cb_dqrr_defer;
3223 }
3224
3225 int
3226 dpaa_sec_eventq_attach(const struct rte_cryptodev *dev,
3227                 int qp_id,
3228                 uint16_t ch_id,
3229                 const struct rte_event *event)
3230 {
3231         struct dpaa_sec_qp *qp = dev->data->queue_pairs[qp_id];
3232         struct qm_mcc_initfq opts = {0};
3233
3234         int ret;
3235
3236         opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_FQCTRL |
3237                        QM_INITFQ_WE_CONTEXTA | QM_INITFQ_WE_CONTEXTB;
3238         opts.fqd.dest.channel = ch_id;
3239
3240         switch (event->sched_type) {
3241         case RTE_SCHED_TYPE_ATOMIC:
3242                 opts.fqd.fq_ctrl |= QM_FQCTRL_HOLDACTIVE;
3243                 /* Reset FQCTRL_AVOIDBLOCK bit as it is unnecessary
3244                  * configuration with HOLD_ACTIVE setting
3245                  */
3246                 opts.fqd.fq_ctrl &= (~QM_FQCTRL_AVOIDBLOCK);
3247                 qp->outq.cb.dqrr_dpdk_cb = dpaa_sec_process_atomic_event;
3248                 break;
3249         case RTE_SCHED_TYPE_ORDERED:
3250                 DPAA_SEC_ERR("Ordered queue schedule type is not supported\n");
3251                 return -1;
3252         default:
3253                 opts.fqd.fq_ctrl |= QM_FQCTRL_AVOIDBLOCK;
3254                 qp->outq.cb.dqrr_dpdk_cb = dpaa_sec_process_parallel_event;
3255                 break;
3256         }
3257
3258         ret = qman_init_fq(&qp->outq, QMAN_INITFQ_FLAG_SCHED, &opts);
3259         if (unlikely(ret)) {
3260                 DPAA_SEC_ERR("unable to init caam source fq!");
3261                 return ret;
3262         }
3263
3264         memcpy(&qp->outq.ev, event, sizeof(struct rte_event));
3265
3266         return 0;
3267 }
3268
3269 int
3270 dpaa_sec_eventq_detach(const struct rte_cryptodev *dev,
3271                         int qp_id)
3272 {
3273         struct qm_mcc_initfq opts = {0};
3274         int ret;
3275         struct dpaa_sec_qp *qp = dev->data->queue_pairs[qp_id];
3276
3277         opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_FQCTRL |
3278                        QM_INITFQ_WE_CONTEXTA | QM_INITFQ_WE_CONTEXTB;
3279         qp->outq.cb.dqrr = dqrr_out_fq_cb_rx;
3280         qp->outq.cb.ern  = ern_sec_fq_handler;
3281         qman_retire_fq(&qp->outq, NULL);
3282         qman_oos_fq(&qp->outq);
3283         ret = qman_init_fq(&qp->outq, 0, &opts);
3284         if (ret)
3285                 RTE_LOG(ERR, PMD, "Error in qman_init_fq: ret: %d\n", ret);
3286         qp->outq.cb.dqrr = NULL;
3287
3288         return ret;
3289 }
3290
3291 static struct rte_cryptodev_ops crypto_ops = {
3292         .dev_configure        = dpaa_sec_dev_configure,
3293         .dev_start            = dpaa_sec_dev_start,
3294         .dev_stop             = dpaa_sec_dev_stop,
3295         .dev_close            = dpaa_sec_dev_close,
3296         .dev_infos_get        = dpaa_sec_dev_infos_get,
3297         .queue_pair_setup     = dpaa_sec_queue_pair_setup,
3298         .queue_pair_release   = dpaa_sec_queue_pair_release,
3299         .queue_pair_count     = dpaa_sec_queue_pair_count,
3300         .sym_session_get_size     = dpaa_sec_sym_session_get_size,
3301         .sym_session_configure    = dpaa_sec_sym_session_configure,
3302         .sym_session_clear        = dpaa_sec_sym_session_clear
3303 };
3304
3305 #ifdef RTE_LIBRTE_SECURITY
3306 static const struct rte_security_capability *
3307 dpaa_sec_capabilities_get(void *device __rte_unused)
3308 {
3309         return dpaa_sec_security_cap;
3310 }
3311
3312 static const struct rte_security_ops dpaa_sec_security_ops = {
3313         .session_create = dpaa_sec_security_session_create,
3314         .session_update = NULL,
3315         .session_stats_get = NULL,
3316         .session_destroy = dpaa_sec_security_session_destroy,
3317         .set_pkt_metadata = NULL,
3318         .capabilities_get = dpaa_sec_capabilities_get
3319 };
3320 #endif
3321 static int
3322 dpaa_sec_uninit(struct rte_cryptodev *dev)
3323 {
3324         struct dpaa_sec_dev_private *internals;
3325
3326         if (dev == NULL)
3327                 return -ENODEV;
3328
3329         internals = dev->data->dev_private;
3330         rte_free(dev->security_ctx);
3331
3332         rte_free(internals);
3333
3334         DPAA_SEC_INFO("Closing DPAA_SEC device %s on numa socket %u",
3335                       dev->data->name, rte_socket_id());
3336
3337         return 0;
3338 }
3339
3340 static int
3341 dpaa_sec_dev_init(struct rte_cryptodev *cryptodev)
3342 {
3343         struct dpaa_sec_dev_private *internals;
3344 #ifdef RTE_LIBRTE_SECURITY
3345         struct rte_security_ctx *security_instance;
3346 #endif
3347         struct dpaa_sec_qp *qp;
3348         uint32_t i, flags;
3349         int ret;
3350
3351         PMD_INIT_FUNC_TRACE();
3352
3353         cryptodev->driver_id = cryptodev_driver_id;
3354         cryptodev->dev_ops = &crypto_ops;
3355
3356         cryptodev->enqueue_burst = dpaa_sec_enqueue_burst;
3357         cryptodev->dequeue_burst = dpaa_sec_dequeue_burst;
3358         cryptodev->feature_flags = RTE_CRYPTODEV_FF_SYMMETRIC_CRYPTO |
3359                         RTE_CRYPTODEV_FF_HW_ACCELERATED |
3360                         RTE_CRYPTODEV_FF_SYM_OPERATION_CHAINING |
3361                         RTE_CRYPTODEV_FF_SECURITY |
3362                         RTE_CRYPTODEV_FF_IN_PLACE_SGL |
3363                         RTE_CRYPTODEV_FF_OOP_SGL_IN_SGL_OUT |
3364                         RTE_CRYPTODEV_FF_OOP_SGL_IN_LB_OUT |
3365                         RTE_CRYPTODEV_FF_OOP_LB_IN_SGL_OUT |
3366                         RTE_CRYPTODEV_FF_OOP_LB_IN_LB_OUT;
3367
3368         internals = cryptodev->data->dev_private;
3369         internals->max_nb_queue_pairs = RTE_DPAA_MAX_NB_SEC_QPS;
3370         internals->max_nb_sessions = RTE_DPAA_SEC_PMD_MAX_NB_SESSIONS;
3371
3372         /*
3373          * For secondary processes, we don't initialise any further as primary
3374          * has already done this work. Only check we don't need a different
3375          * RX function
3376          */
3377         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
3378                 DPAA_SEC_WARN("Device already init by primary process");
3379                 return 0;
3380         }
3381 #ifdef RTE_LIBRTE_SECURITY
3382         /* Initialize security_ctx only for primary process*/
3383         security_instance = rte_malloc("rte_security_instances_ops",
3384                                 sizeof(struct rte_security_ctx), 0);
3385         if (security_instance == NULL)
3386                 return -ENOMEM;
3387         security_instance->device = (void *)cryptodev;
3388         security_instance->ops = &dpaa_sec_security_ops;
3389         security_instance->sess_cnt = 0;
3390         cryptodev->security_ctx = security_instance;
3391 #endif
3392         rte_spinlock_init(&internals->lock);
3393         for (i = 0; i < internals->max_nb_queue_pairs; i++) {
3394                 /* init qman fq for queue pair */
3395                 qp = &internals->qps[i];
3396                 ret = dpaa_sec_init_tx(&qp->outq);
3397                 if (ret) {
3398                         DPAA_SEC_ERR("config tx of queue pair  %d", i);
3399                         goto init_error;
3400                 }
3401         }
3402
3403         flags = QMAN_FQ_FLAG_LOCKED | QMAN_FQ_FLAG_DYNAMIC_FQID |
3404                 QMAN_FQ_FLAG_TO_DCPORTAL;
3405         for (i = 0; i < RTE_DPAA_MAX_RX_QUEUE; i++) {
3406                 /* create rx qman fq for sessions*/
3407                 ret = qman_create_fq(0, flags, &internals->inq[i]);
3408                 if (unlikely(ret != 0)) {
3409                         DPAA_SEC_ERR("sec qman_create_fq failed");
3410                         goto init_error;
3411                 }
3412         }
3413
3414         RTE_LOG(INFO, PMD, "%s cryptodev init\n", cryptodev->data->name);
3415         return 0;
3416
3417 init_error:
3418         DPAA_SEC_ERR("driver %s: create failed\n", cryptodev->data->name);
3419
3420         dpaa_sec_uninit(cryptodev);
3421         return -EFAULT;
3422 }
3423
3424 static int
3425 cryptodev_dpaa_sec_probe(struct rte_dpaa_driver *dpaa_drv __rte_unused,
3426                                 struct rte_dpaa_device *dpaa_dev)
3427 {
3428         struct rte_cryptodev *cryptodev;
3429         char cryptodev_name[RTE_CRYPTODEV_NAME_MAX_LEN];
3430
3431         int retval;
3432
3433         snprintf(cryptodev_name, sizeof(cryptodev_name), "%s", dpaa_dev->name);
3434
3435         cryptodev = rte_cryptodev_pmd_allocate(cryptodev_name, rte_socket_id());
3436         if (cryptodev == NULL)
3437                 return -ENOMEM;
3438
3439         if (rte_eal_process_type() == RTE_PROC_PRIMARY) {
3440                 cryptodev->data->dev_private = rte_zmalloc_socket(
3441                                         "cryptodev private structure",
3442                                         sizeof(struct dpaa_sec_dev_private),
3443                                         RTE_CACHE_LINE_SIZE,
3444                                         rte_socket_id());
3445
3446                 if (cryptodev->data->dev_private == NULL)
3447                         rte_panic("Cannot allocate memzone for private "
3448                                         "device data");
3449         }
3450
3451         dpaa_dev->crypto_dev = cryptodev;
3452         cryptodev->device = &dpaa_dev->device;
3453
3454         /* init user callbacks */
3455         TAILQ_INIT(&(cryptodev->link_intr_cbs));
3456
3457         /* if sec device version is not configured */
3458         if (!rta_get_sec_era()) {
3459                 const struct device_node *caam_node;
3460
3461                 for_each_compatible_node(caam_node, NULL, "fsl,sec-v4.0") {
3462                         const uint32_t *prop = of_get_property(caam_node,
3463                                         "fsl,sec-era",
3464                                         NULL);
3465                         if (prop) {
3466                                 rta_set_sec_era(
3467                                         INTL_SEC_ERA(rte_cpu_to_be_32(*prop)));
3468                                 break;
3469                         }
3470                 }
3471         }
3472
3473         if (unlikely(!RTE_PER_LCORE(dpaa_io))) {
3474                 retval = rte_dpaa_portal_init((void *)1);
3475                 if (retval) {
3476                         DPAA_SEC_ERR("Unable to initialize portal");
3477                         return retval;
3478                 }
3479         }
3480
3481         /* Invoke PMD device initialization function */
3482         retval = dpaa_sec_dev_init(cryptodev);
3483         if (retval == 0)
3484                 return 0;
3485
3486         /* In case of error, cleanup is done */
3487         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
3488                 rte_free(cryptodev->data->dev_private);
3489
3490         rte_cryptodev_pmd_release_device(cryptodev);
3491
3492         return -ENXIO;
3493 }
3494
3495 static int
3496 cryptodev_dpaa_sec_remove(struct rte_dpaa_device *dpaa_dev)
3497 {
3498         struct rte_cryptodev *cryptodev;
3499         int ret;
3500
3501         cryptodev = dpaa_dev->crypto_dev;
3502         if (cryptodev == NULL)
3503                 return -ENODEV;
3504
3505         ret = dpaa_sec_uninit(cryptodev);
3506         if (ret)
3507                 return ret;
3508
3509         return rte_cryptodev_pmd_destroy(cryptodev);
3510 }
3511
3512 static struct rte_dpaa_driver rte_dpaa_sec_driver = {
3513         .drv_type = FSL_DPAA_CRYPTO,
3514         .driver = {
3515                 .name = "DPAA SEC PMD"
3516         },
3517         .probe = cryptodev_dpaa_sec_probe,
3518         .remove = cryptodev_dpaa_sec_remove,
3519 };
3520
3521 static struct cryptodev_driver dpaa_sec_crypto_drv;
3522
3523 RTE_PMD_REGISTER_DPAA(CRYPTODEV_NAME_DPAA_SEC_PMD, rte_dpaa_sec_driver);
3524 RTE_PMD_REGISTER_CRYPTO_DRIVER(dpaa_sec_crypto_drv, rte_dpaa_sec_driver.driver,
3525                 cryptodev_driver_id);
3526
3527 RTE_INIT(dpaa_sec_init_log)
3528 {
3529         dpaa_logtype_sec = rte_log_register("pmd.crypto.dpaa");
3530         if (dpaa_logtype_sec >= 0)
3531                 rte_log_set_level(dpaa_logtype_sec, RTE_LOG_NOTICE);
3532 }