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-2018 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 #include <rte_security_driver.h>
  19 #include <rte_cycles.h>
  20 #include <rte_dev.h>
  21 #include <rte_kvargs.h>
  22 #include <rte_malloc.h>
  23 #include <rte_mbuf.h>
  24 #include <rte_memcpy.h>
  25 #include <rte_string_fns.h>
  26
  27 #include <fsl_usd.h>
  28 #include <fsl_qman.h>
  29 #include <of.h>
  30
  31 /* RTA header files */
  32 #include <hw/desc/common.h>
  33 #include <hw/desc/algo.h>
  34 #include <hw/desc/ipsec.h>
  35
  36 #include <rte_dpaa_bus.h>
  37 #include <dpaa_sec.h>
  38 #include <dpaa_sec_log.h>
  39
  40 enum rta_sec_era rta_sec_era;
  41
  42 int dpaa_logtype_sec;
  43
  44 static uint8_t cryptodev_driver_id;
  45
  46 static __thread struct rte_crypto_op **dpaa_sec_ops;
  47 static __thread int dpaa_sec_op_nb;
  48
  49 static int
  50 dpaa_sec_attach_sess_q(struct dpaa_sec_qp *qp, dpaa_sec_session *sess);
  51
  52 static inline void
  53 dpaa_sec_op_ending(struct dpaa_sec_op_ctx *ctx)
  54 {
  55         if (!ctx->fd_status) {
  56                 ctx->op->status = RTE_CRYPTO_OP_STATUS_SUCCESS;
  57         } else {
  58                 DPAA_SEC_DP_WARN("SEC return err: 0x%x", ctx->fd_status);
  59                 ctx->op->status = RTE_CRYPTO_OP_STATUS_ERROR;
  60         }
  61
  62         /* report op status to sym->op and then free the ctx memeory  */
  63         rte_mempool_put(ctx->ctx_pool, (void *)ctx);
  64 }
  65
  66 static inline struct dpaa_sec_op_ctx *
  67 dpaa_sec_alloc_ctx(dpaa_sec_session *ses)
  68 {
  69         struct dpaa_sec_op_ctx *ctx;
  70         int retval;
  71
  72         retval = rte_mempool_get(ses->ctx_pool, (void **)(&ctx));
  73         if (!ctx || retval) {
  74                 DPAA_SEC_DP_WARN("Alloc sec descriptor failed!");
  75                 return NULL;
  76         }
  77         /*
  78          * Clear SG memory. There are 16 SG entries of 16 Bytes each.
  79          * one call to dcbz_64() clear 64 bytes, hence calling it 4 times
  80          * to clear all the SG entries. dpaa_sec_alloc_ctx() is called for
  81          * each packet, memset is costlier than dcbz_64().
  82          */
  83         dcbz_64(&ctx->job.sg[SG_CACHELINE_0]);
  84         dcbz_64(&ctx->job.sg[SG_CACHELINE_1]);
  85         dcbz_64(&ctx->job.sg[SG_CACHELINE_2]);
  86         dcbz_64(&ctx->job.sg[SG_CACHELINE_3]);
  87
  88         ctx->ctx_pool = ses->ctx_pool;
  89         ctx->vtop_offset = (size_t) ctx
  90                                 - rte_mempool_virt2iova(ctx);
  91
  92         return ctx;
  93 }
  94
  95 static inline rte_iova_t
  96 dpaa_mem_vtop(void *vaddr)
  97 {
  98         const struct rte_memseg *ms;
  99
 100         ms = rte_mem_virt2memseg(vaddr, NULL);
 101         if (ms)
 102                 return ms->iova + RTE_PTR_DIFF(vaddr, ms->addr);
 103         return (size_t)NULL;
 104 }
 105
 106 static inline void *
 107 dpaa_mem_ptov(rte_iova_t paddr)
 108 {
 109         return rte_mem_iova2virt(paddr);
 110 }
 111
 112 static void
 113 ern_sec_fq_handler(struct qman_portal *qm __rte_unused,
 114                    struct qman_fq *fq,
 115                    const struct qm_mr_entry *msg)
 116 {
 117         DPAA_SEC_DP_ERR("sec fq %d error, RC = %x, seqnum = %x\n",
 118                         fq->fqid, msg->ern.rc, msg->ern.seqnum);
 119 }
 120
 121 /* initialize the queue with dest chan as caam chan so that
 122  * all the packets in this queue could be dispatched into caam
 123  */
 124 static int
 125 dpaa_sec_init_rx(struct qman_fq *fq_in, rte_iova_t hwdesc,
 126                  uint32_t fqid_out)
 127 {
 128         struct qm_mcc_initfq fq_opts;
 129         uint32_t flags;
 130         int ret = -1;
 131
 132         /* Clear FQ options */
 133         memset(&fq_opts, 0x00, sizeof(struct qm_mcc_initfq));
 134
 135         flags = QMAN_INITFQ_FLAG_SCHED;
 136         fq_opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_CONTEXTA |
 137                           QM_INITFQ_WE_CONTEXTB;
 138
 139         qm_fqd_context_a_set64(&fq_opts.fqd, hwdesc);
 140         fq_opts.fqd.context_b = fqid_out;
 141         fq_opts.fqd.dest.channel = qm_channel_caam;
 142         fq_opts.fqd.dest.wq = 0;
 143
 144         fq_in->cb.ern  = ern_sec_fq_handler;
 145
 146         DPAA_SEC_DEBUG("in-%x out-%x", fq_in->fqid, fqid_out);
 147
 148         ret = qman_init_fq(fq_in, flags, &fq_opts);
 149         if (unlikely(ret != 0))
 150                 DPAA_SEC_ERR("qman_init_fq failed %d", ret);
 151
 152         return ret;
 153 }
 154
 155 /* something is put into in_fq and caam put the crypto result into out_fq */
 156 static enum qman_cb_dqrr_result
 157 dqrr_out_fq_cb_rx(struct qman_portal *qm __always_unused,
 158                   struct qman_fq *fq __always_unused,
 159                   const struct qm_dqrr_entry *dqrr)
 160 {
 161         const struct qm_fd *fd;
 162         struct dpaa_sec_job *job;
 163         struct dpaa_sec_op_ctx *ctx;
 164
 165         if (dpaa_sec_op_nb >= DPAA_SEC_BURST)
 166                 return qman_cb_dqrr_defer;
 167
 168         if (!(dqrr->stat & QM_DQRR_STAT_FD_VALID))
 169                 return qman_cb_dqrr_consume;
 170
 171         fd = &dqrr->fd;
 172         /* sg is embedded in an op ctx,
 173          * sg[0] is for output
 174          * sg[1] for input
 175          */
 176         job = dpaa_mem_ptov(qm_fd_addr_get64(fd));
 177
 178         ctx = container_of(job, struct dpaa_sec_op_ctx, job);
 179         ctx->fd_status = fd->status;
 180         if (ctx->op->sess_type == RTE_CRYPTO_OP_SECURITY_SESSION) {
 181                 struct qm_sg_entry *sg_out;
 182                 uint32_t len;
 183
 184                 sg_out = &job->sg[0];
 185                 hw_sg_to_cpu(sg_out);
 186                 len = sg_out->length;
 187                 ctx->op->sym->m_src->pkt_len = len;
 188                 ctx->op->sym->m_src->data_len = len;
 189         }
 190         dpaa_sec_ops[dpaa_sec_op_nb++] = ctx->op;
 191         dpaa_sec_op_ending(ctx);
 192
 193         return qman_cb_dqrr_consume;
 194 }
 195
 196 /* caam result is put into this queue */
 197 static int
 198 dpaa_sec_init_tx(struct qman_fq *fq)
 199 {
 200         int ret;
 201         struct qm_mcc_initfq opts;
 202         uint32_t flags;
 203
 204         flags = QMAN_FQ_FLAG_NO_ENQUEUE | QMAN_FQ_FLAG_LOCKED |
 205                 QMAN_FQ_FLAG_DYNAMIC_FQID;
 206
 207         ret = qman_create_fq(0, flags, fq);
 208         if (unlikely(ret)) {
 209                 DPAA_SEC_ERR("qman_create_fq failed");
 210                 return ret;
 211         }
 212
 213         memset(&opts, 0, sizeof(opts));
 214         opts.we_mask = QM_INITFQ_WE_DESTWQ | QM_INITFQ_WE_FQCTRL |
 215                        QM_INITFQ_WE_CONTEXTA | QM_INITFQ_WE_CONTEXTB;
 216
 217         /* opts.fqd.dest.channel = dpaa_sec_pool_chan; */
 218
 219         fq->cb.dqrr = dqrr_out_fq_cb_rx;
 220         fq->cb.ern  = ern_sec_fq_handler;
 221
 222         ret = qman_init_fq(fq, 0, &opts);
 223         if (unlikely(ret)) {
 224                 DPAA_SEC_ERR("unable to init caam source fq!");
 225                 return ret;
 226         }
 227
 228         return ret;
 229 }
 230
 231 static inline int is_cipher_only(dpaa_sec_session *ses)
 232 {
 233         return ((ses->cipher_alg != RTE_CRYPTO_CIPHER_NULL) &&
 234                 (ses->auth_alg == RTE_CRYPTO_AUTH_NULL));
 235 }
 236
 237 static inline int is_auth_only(dpaa_sec_session *ses)
 238 {
 239         return ((ses->cipher_alg == RTE_CRYPTO_CIPHER_NULL) &&
 240                 (ses->auth_alg != RTE_CRYPTO_AUTH_NULL));
 241 }
 242
 243 static inline int is_aead(dpaa_sec_session *ses)
 244 {
 245         return ((ses->cipher_alg == 0) &&
 246                 (ses->auth_alg == 0) &&
 247                 (ses->aead_alg != 0));
 248 }
 249
 250 static inline int is_auth_cipher(dpaa_sec_session *ses)
 251 {
 252         return ((ses->cipher_alg != RTE_CRYPTO_CIPHER_NULL) &&
 253                 (ses->auth_alg != RTE_CRYPTO_AUTH_NULL) &&
 254                 (ses->proto_alg != RTE_SECURITY_PROTOCOL_IPSEC));
 255 }
 256
 257 static inline int is_proto_ipsec(dpaa_sec_session *ses)
 258 {
 259         return (ses->proto_alg == RTE_SECURITY_PROTOCOL_IPSEC);
 260 }
 261
 262 static inline int is_encode(dpaa_sec_session *ses)
 263 {
 264         return ses->dir == DIR_ENC;
 265 }
 266
 267 static inline int is_decode(dpaa_sec_session *ses)
 268 {
 269         return ses->dir == DIR_DEC;
 270 }
 271
 272 static inline void
 273 caam_auth_alg(dpaa_sec_session *ses, struct alginfo *alginfo_a)
 274 {
 275         switch (ses->auth_alg) {
 276         case RTE_CRYPTO_AUTH_NULL:
 277                 ses->digest_length = 0;
 278                 break;
 279         case RTE_CRYPTO_AUTH_MD5_HMAC:
 280                 alginfo_a->algtype =
 281                         (ses->proto_alg == RTE_SECURITY_PROTOCOL_IPSEC) ?
 282                         OP_PCL_IPSEC_HMAC_MD5_96 : OP_ALG_ALGSEL_MD5;
 283                 alginfo_a->algmode = OP_ALG_AAI_HMAC;
 284                 break;
 285         case RTE_CRYPTO_AUTH_SHA1_HMAC:
 286                 alginfo_a->algtype =
 287                         (ses->proto_alg == RTE_SECURITY_PROTOCOL_IPSEC) ?
 288                         OP_PCL_IPSEC_HMAC_SHA1_96 : OP_ALG_ALGSEL_SHA1;
 289                 alginfo_a->algmode = OP_ALG_AAI_HMAC;
 290                 break;
 291         case RTE_CRYPTO_AUTH_SHA224_HMAC:
 292                 alginfo_a->algtype =
 293                         (ses->proto_alg == RTE_SECURITY_PROTOCOL_IPSEC) ?
 294                         OP_PCL_IPSEC_HMAC_SHA1_160 : OP_ALG_ALGSEL_SHA224;
 295                 alginfo_a->algmode = OP_ALG_AAI_HMAC;
 296                 break;
 297         case RTE_CRYPTO_AUTH_SHA256_HMAC:
 298                 alginfo_a->algtype =
 299                         (ses->proto_alg == RTE_SECURITY_PROTOCOL_IPSEC) ?
 300                         OP_PCL_IPSEC_HMAC_SHA2_256_128 : OP_ALG_ALGSEL_SHA256;
 301                 alginfo_a->algmode = OP_ALG_AAI_HMAC;
 302                 break;
 303         case RTE_CRYPTO_AUTH_SHA384_HMAC:
 304                 alginfo_a->algtype =
 305                         (ses->proto_alg == RTE_SECURITY_PROTOCOL_IPSEC) ?
 306                         OP_PCL_IPSEC_HMAC_SHA2_384_192 : OP_ALG_ALGSEL_SHA384;
 307                 alginfo_a->algmode = OP_ALG_AAI_HMAC;
 308                 break;
 309         case RTE_CRYPTO_AUTH_SHA512_HMAC:
 310                 alginfo_a->algtype =
 311                         (ses->proto_alg == RTE_SECURITY_PROTOCOL_IPSEC) ?
 312                         OP_PCL_IPSEC_HMAC_SHA2_512_256 : OP_ALG_ALGSEL_SHA512;
 313                 alginfo_a->algmode = OP_ALG_AAI_HMAC;
 314                 break;
 315         default:
 316                 DPAA_SEC_ERR("unsupported auth alg %u", ses->auth_alg);
 317         }
 318 }
 319
 320 static inline void
 321 caam_cipher_alg(dpaa_sec_session *ses, struct alginfo *alginfo_c)
 322 {
 323         switch (ses->cipher_alg) {
 324         case RTE_CRYPTO_CIPHER_NULL:
 325                 break;
 326         case RTE_CRYPTO_CIPHER_AES_CBC:
 327                 alginfo_c->algtype =
 328                         (ses->proto_alg == RTE_SECURITY_PROTOCOL_IPSEC) ?
 329                         OP_PCL_IPSEC_AES_CBC : OP_ALG_ALGSEL_AES;
 330                 alginfo_c->algmode = OP_ALG_AAI_CBC;
 331                 break;
 332         case RTE_CRYPTO_CIPHER_3DES_CBC:
 333                 alginfo_c->algtype =
 334                         (ses->proto_alg == RTE_SECURITY_PROTOCOL_IPSEC) ?
 335                         OP_PCL_IPSEC_3DES : OP_ALG_ALGSEL_3DES;
 336                 alginfo_c->algmode = OP_ALG_AAI_CBC;
 337                 break;
 338         case RTE_CRYPTO_CIPHER_AES_CTR:
 339                 alginfo_c->algtype =
 340                         (ses->proto_alg == RTE_SECURITY_PROTOCOL_IPSEC) ?
 341                         OP_PCL_IPSEC_AES_CTR : OP_ALG_ALGSEL_AES;
 342                 alginfo_c->algmode = OP_ALG_AAI_CTR;
 343                 break;
 344         default:
 345                 DPAA_SEC_ERR("unsupported cipher alg %d", ses->cipher_alg);
 346         }
 347 }
 348
 349 static inline void
 350 caam_aead_alg(dpaa_sec_session *ses, struct alginfo *alginfo)
 351 {
 352         switch (ses->aead_alg) {
 353         case RTE_CRYPTO_AEAD_AES_GCM:
 354                 alginfo->algtype = OP_ALG_ALGSEL_AES;
 355                 alginfo->algmode = OP_ALG_AAI_GCM;
 356                 break;
 357         default:
 358                 DPAA_SEC_ERR("unsupported AEAD alg %d", ses->aead_alg);
 359         }
 360 }
 361
 362
 363 /* prepare command block of the session */
 364 static int
 365 dpaa_sec_prep_cdb(dpaa_sec_session *ses)
 366 {
 367         struct alginfo alginfo_c = {0}, alginfo_a = {0}, alginfo = {0};
 368         int32_t shared_desc_len = 0;
 369         struct sec_cdb *cdb = &ses->cdb;
 370         int err;
 371 #if RTE_BYTE_ORDER == RTE_BIG_ENDIAN
 372         int swap = false;
 373 #else
 374         int swap = true;
 375 #endif
 376
 377         memset(cdb, 0, sizeof(struct sec_cdb));
 378
 379         if (is_cipher_only(ses)) {
 380                 caam_cipher_alg(ses, &alginfo_c);
 381                 if (alginfo_c.algtype == (unsigned int)DPAA_SEC_ALG_UNSUPPORT) {
 382                         DPAA_SEC_ERR("not supported cipher alg");
 383                         return -ENOTSUP;
 384                 }
 385
 386                 alginfo_c.key = (size_t)ses->cipher_key.data;
 387                 alginfo_c.keylen = ses->cipher_key.length;
 388                 alginfo_c.key_enc_flags = 0;
 389                 alginfo_c.key_type = RTA_DATA_IMM;
 390
 391                 shared_desc_len = cnstr_shdsc_blkcipher(
 392                                                 cdb->sh_desc, true,
 393                                                 swap, &alginfo_c,
 394                                                 NULL,
 395                                                 ses->iv.length,
 396                                                 ses->dir);
 397         } else if (is_auth_only(ses)) {
 398                 caam_auth_alg(ses, &alginfo_a);
 399                 if (alginfo_a.algtype == (unsigned int)DPAA_SEC_ALG_UNSUPPORT) {
 400                         DPAA_SEC_ERR("not supported auth alg");
 401                         return -ENOTSUP;
 402                 }
 403
 404                 alginfo_a.key = (size_t)ses->auth_key.data;
 405                 alginfo_a.keylen = ses->auth_key.length;
 406                 alginfo_a.key_enc_flags = 0;
 407                 alginfo_a.key_type = RTA_DATA_IMM;
 408
 409                 shared_desc_len = cnstr_shdsc_hmac(cdb->sh_desc, true,
 410                                                    swap, &alginfo_a,
 411                                                    !ses->dir,
 412                                                    ses->digest_length);
 413         } else if (is_aead(ses)) {
 414                 caam_aead_alg(ses, &alginfo);
 415                 if (alginfo.algtype == (unsigned int)DPAA_SEC_ALG_UNSUPPORT) {
 416                         DPAA_SEC_ERR("not supported aead alg");
 417                         return -ENOTSUP;
 418                 }
 419                 alginfo.key = (size_t)ses->aead_key.data;
 420                 alginfo.keylen = ses->aead_key.length;
 421                 alginfo.key_enc_flags = 0;
 422                 alginfo.key_type = RTA_DATA_IMM;
 423
 424                 if (ses->dir == DIR_ENC)
 425                         shared_desc_len = cnstr_shdsc_gcm_encap(
 426                                         cdb->sh_desc, true, swap,
 427                                         &alginfo,
 428                                         ses->iv.length,
 429                                         ses->digest_length);
 430                 else
 431                         shared_desc_len = cnstr_shdsc_gcm_decap(
 432                                         cdb->sh_desc, true, swap,
 433                                         &alginfo,
 434                                         ses->iv.length,
 435                                         ses->digest_length);
 436         } else {
 437                 caam_cipher_alg(ses, &alginfo_c);
 438                 if (alginfo_c.algtype == (unsigned int)DPAA_SEC_ALG_UNSUPPORT) {
 439                         DPAA_SEC_ERR("not supported cipher alg");
 440                         return -ENOTSUP;
 441                 }
 442
 443                 alginfo_c.key = (size_t)ses->cipher_key.data;
 444                 alginfo_c.keylen = ses->cipher_key.length;
 445                 alginfo_c.key_enc_flags = 0;
 446                 alginfo_c.key_type = RTA_DATA_IMM;
 447
 448                 caam_auth_alg(ses, &alginfo_a);
 449                 if (alginfo_a.algtype == (unsigned int)DPAA_SEC_ALG_UNSUPPORT) {
 450                         DPAA_SEC_ERR("not supported auth alg");
 451                         return -ENOTSUP;
 452                 }
 453
 454                 alginfo_a.key = (size_t)ses->auth_key.data;
 455                 alginfo_a.keylen = ses->auth_key.length;
 456                 alginfo_a.key_enc_flags = 0;
 457                 alginfo_a.key_type = RTA_DATA_IMM;
 458
 459                 cdb->sh_desc[0] = alginfo_c.keylen;
 460                 cdb->sh_desc[1] = alginfo_a.keylen;
 461                 err = rta_inline_query(IPSEC_AUTH_VAR_AES_DEC_BASE_DESC_LEN,
 462                                        MIN_JOB_DESC_SIZE,
 463                                        (unsigned int *)cdb->sh_desc,
 464                                        &cdb->sh_desc[2], 2);
 465
 466                 if (err < 0) {
 467                         DPAA_SEC_ERR("Crypto: Incorrect key lengths");
 468                         return err;
 469                 }
 470                 if (cdb->sh_desc[2] & 1)
 471                         alginfo_c.key_type = RTA_DATA_IMM;
 472                 else {
 473                         alginfo_c.key = (size_t)dpaa_mem_vtop(
 474                                                 (void *)(size_t)alginfo_c.key);
 475                         alginfo_c.key_type = RTA_DATA_PTR;
 476                 }
 477                 if (cdb->sh_desc[2] & (1<<1))
 478                         alginfo_a.key_type = RTA_DATA_IMM;
 479                 else {
 480                         alginfo_a.key = (size_t)dpaa_mem_vtop(
 481                                                 (void *)(size_t)alginfo_a.key);
 482                         alginfo_a.key_type = RTA_DATA_PTR;
 483                 }
 484                 cdb->sh_desc[0] = 0;
 485                 cdb->sh_desc[1] = 0;
 486                 cdb->sh_desc[2] = 0;
 487                 if (is_proto_ipsec(ses)) {
 488                         if (ses->dir == DIR_ENC) {
 489                                 shared_desc_len = cnstr_shdsc_ipsec_new_encap(
 490                                                 cdb->sh_desc,
 491                                                 true, swap, &ses->encap_pdb,
 492                                                 (uint8_t *)&ses->ip4_hdr,
 493                                                 &alginfo_c, &alginfo_a);
 494                         } else if (ses->dir == DIR_DEC) {
 495                                 shared_desc_len = cnstr_shdsc_ipsec_new_decap(
 496                                                 cdb->sh_desc,
 497                                                 true, swap, &ses->decap_pdb,
 498                                                 &alginfo_c, &alginfo_a);
 499                         }
 500                 } else {
 501                         /* Auth_only_len is set as 0 here and it will be
 502                          * overwritten in fd for each packet.
 503                          */
 504                         shared_desc_len = cnstr_shdsc_authenc(cdb->sh_desc,
 505                                         true, swap, &alginfo_c, &alginfo_a,
 506                                         ses->iv.length, 0,
 507                                         ses->digest_length, ses->dir);
 508                 }
 509         }
 510
 511         if (shared_desc_len < 0) {
 512                 DPAA_SEC_ERR("error in preparing command block");
 513                 return shared_desc_len;
 514         }
 515
 516         cdb->sh_hdr.hi.field.idlen = shared_desc_len;
 517         cdb->sh_hdr.hi.word = rte_cpu_to_be_32(cdb->sh_hdr.hi.word);
 518         cdb->sh_hdr.lo.word = rte_cpu_to_be_32(cdb->sh_hdr.lo.word);
 519
 520         return 0;
 521 }
 522
 523 /* qp is lockless, should be accessed by only one thread */
 524 static int
 525 dpaa_sec_deq(struct dpaa_sec_qp *qp, struct rte_crypto_op **ops, int nb_ops)
 526 {
 527         struct qman_fq *fq;
 528         unsigned int pkts = 0;
 529         int ret;
 530         struct qm_dqrr_entry *dq;
 531
 532         fq = &qp->outq;
 533         ret = qman_set_vdq(fq, (nb_ops > DPAA_MAX_DEQUEUE_NUM_FRAMES) ?
 534                                 DPAA_MAX_DEQUEUE_NUM_FRAMES : nb_ops);
 535         if (ret)
 536                 return 0;
 537
 538         do {
 539                 const struct qm_fd *fd;
 540                 struct dpaa_sec_job *job;
 541                 struct dpaa_sec_op_ctx *ctx;
 542                 struct rte_crypto_op *op;
 543
 544                 dq = qman_dequeue(fq);
 545                 if (!dq)
 546                         continue;
 547
 548                 fd = &dq->fd;
 549                 /* sg is embedded in an op ctx,
 550                  * sg[0] is for output
 551                  * sg[1] for input
 552                  */
 553                 job = dpaa_mem_ptov(qm_fd_addr_get64(fd));
 554
 555                 ctx = container_of(job, struct dpaa_sec_op_ctx, job);
 556                 ctx->fd_status = fd->status;
 557                 op = ctx->op;
 558                 if (op->sess_type == RTE_CRYPTO_OP_SECURITY_SESSION) {
 559                         struct qm_sg_entry *sg_out;
 560                         uint32_t len;
 561
 562                         sg_out = &job->sg[0];
 563                         hw_sg_to_cpu(sg_out);
 564                         len = sg_out->length;
 565                         op->sym->m_src->pkt_len = len;
 566                         op->sym->m_src->data_len = len;
 567                 }
 568                 if (!ctx->fd_status) {
 569                         op->status = RTE_CRYPTO_OP_STATUS_SUCCESS;
 570                 } else {
 571                         DPAA_SEC_DP_WARN("SEC return err:0x%x", ctx->fd_status);
 572                         op->status = RTE_CRYPTO_OP_STATUS_ERROR;
 573                 }
 574                 ops[pkts++] = op;
 575
 576                 /* report op status to sym->op and then free the ctx memeory */
 577                 rte_mempool_put(ctx->ctx_pool, (void *)ctx);
 578
 579                 qman_dqrr_consume(fq, dq);
 580         } while (fq->flags & QMAN_FQ_STATE_VDQCR);
 581
 582         return pkts;
 583 }
 584
 585 static inline struct dpaa_sec_job *
 586 build_auth_only_sg(struct rte_crypto_op *op, dpaa_sec_session *ses)
 587 {
 588         struct rte_crypto_sym_op *sym = op->sym;
 589         struct rte_mbuf *mbuf = sym->m_src;
 590         struct dpaa_sec_job *cf;
 591         struct dpaa_sec_op_ctx *ctx;
 592         struct qm_sg_entry *sg, *out_sg, *in_sg;
 593         phys_addr_t start_addr;
 594         uint8_t *old_digest, extra_segs;
 595
 596         if (is_decode(ses))
 597                 extra_segs = 3;
 598         else
 599                 extra_segs = 2;
 600
 601         if ((mbuf->nb_segs + extra_segs) > MAX_SG_ENTRIES) {
 602                 DPAA_SEC_DP_ERR("Auth: Max sec segs supported is %d",
 603                                 MAX_SG_ENTRIES);
 604                 return NULL;
 605         }
 606         ctx = dpaa_sec_alloc_ctx(ses);
 607         if (!ctx)
 608                 return NULL;
 609
 610         cf = &ctx->job;
 611         ctx->op = op;
 612         old_digest = ctx->digest;
 613
 614         /* output */
 615         out_sg = &cf->sg[0];
 616         qm_sg_entry_set64(out_sg, sym->auth.digest.phys_addr);
 617         out_sg->length = ses->digest_length;
 618         cpu_to_hw_sg(out_sg);
 619
 620         /* input */
 621         in_sg = &cf->sg[1];
 622         /* need to extend the input to a compound frame */
 623         in_sg->extension = 1;
 624         in_sg->final = 1;
 625         in_sg->length = sym->auth.data.length;
 626         qm_sg_entry_set64(in_sg, dpaa_mem_vtop(&cf->sg[2]));
 627
 628         /* 1st seg */
 629         sg = in_sg + 1;
 630         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 631         sg->length = mbuf->data_len - sym->auth.data.offset;
 632         sg->offset = sym->auth.data.offset;
 633
 634         /* Successive segs */
 635         mbuf = mbuf->next;
 636         while (mbuf) {
 637                 cpu_to_hw_sg(sg);
 638                 sg++;
 639                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 640                 sg->length = mbuf->data_len;
 641                 mbuf = mbuf->next;
 642         }
 643
 644         if (is_decode(ses)) {
 645                 /* Digest verification case */
 646                 cpu_to_hw_sg(sg);
 647                 sg++;
 648                 rte_memcpy(old_digest, sym->auth.digest.data,
 649                                 ses->digest_length);
 650                 start_addr = dpaa_mem_vtop(old_digest);
 651                 qm_sg_entry_set64(sg, start_addr);
 652                 sg->length = ses->digest_length;
 653                 in_sg->length += ses->digest_length;
 654         } else {
 655                 /* Digest calculation case */
 656                 sg->length -= ses->digest_length;
 657         }
 658         sg->final = 1;
 659         cpu_to_hw_sg(sg);
 660         cpu_to_hw_sg(in_sg);
 661
 662         return cf;
 663 }
 664
 665 /**
 666  * packet looks like:
 667  *              |<----data_len------->|
 668  *    |ip_header|ah_header|icv|payload|
 669  *              ^
 670  *              |
 671  *         mbuf->pkt.data
 672  */
 673 static inline struct dpaa_sec_job *
 674 build_auth_only(struct rte_crypto_op *op, dpaa_sec_session *ses)
 675 {
 676         struct rte_crypto_sym_op *sym = op->sym;
 677         struct rte_mbuf *mbuf = sym->m_src;
 678         struct dpaa_sec_job *cf;
 679         struct dpaa_sec_op_ctx *ctx;
 680         struct qm_sg_entry *sg;
 681         rte_iova_t start_addr;
 682         uint8_t *old_digest;
 683
 684         ctx = dpaa_sec_alloc_ctx(ses);
 685         if (!ctx)
 686                 return NULL;
 687
 688         cf = &ctx->job;
 689         ctx->op = op;
 690         old_digest = ctx->digest;
 691
 692         start_addr = rte_pktmbuf_iova(mbuf);
 693         /* output */
 694         sg = &cf->sg[0];
 695         qm_sg_entry_set64(sg, sym->auth.digest.phys_addr);
 696         sg->length = ses->digest_length;
 697         cpu_to_hw_sg(sg);
 698
 699         /* input */
 700         sg = &cf->sg[1];
 701         if (is_decode(ses)) {
 702                 /* need to extend the input to a compound frame */
 703                 sg->extension = 1;
 704                 qm_sg_entry_set64(sg, dpaa_mem_vtop(&cf->sg[2]));
 705                 sg->length = sym->auth.data.length + ses->digest_length;
 706                 sg->final = 1;
 707                 cpu_to_hw_sg(sg);
 708
 709                 sg = &cf->sg[2];
 710                 /* hash result or digest, save digest first */
 711                 rte_memcpy(old_digest, sym->auth.digest.data,
 712                            ses->digest_length);
 713                 qm_sg_entry_set64(sg, start_addr + sym->auth.data.offset);
 714                 sg->length = sym->auth.data.length;
 715                 cpu_to_hw_sg(sg);
 716
 717                 /* let's check digest by hw */
 718                 start_addr = dpaa_mem_vtop(old_digest);
 719                 sg++;
 720                 qm_sg_entry_set64(sg, start_addr);
 721                 sg->length = ses->digest_length;
 722                 sg->final = 1;
 723                 cpu_to_hw_sg(sg);
 724         } else {
 725                 qm_sg_entry_set64(sg, start_addr + sym->auth.data.offset);
 726                 sg->length = sym->auth.data.length;
 727                 sg->final = 1;
 728                 cpu_to_hw_sg(sg);
 729         }
 730
 731         return cf;
 732 }
 733
 734 static inline struct dpaa_sec_job *
 735 build_cipher_only_sg(struct rte_crypto_op *op, dpaa_sec_session *ses)
 736 {
 737         struct rte_crypto_sym_op *sym = op->sym;
 738         struct dpaa_sec_job *cf;
 739         struct dpaa_sec_op_ctx *ctx;
 740         struct qm_sg_entry *sg, *out_sg, *in_sg;
 741         struct rte_mbuf *mbuf;
 742         uint8_t req_segs;
 743         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 744                         ses->iv.offset);
 745
 746         if (sym->m_dst) {
 747                 mbuf = sym->m_dst;
 748                 req_segs = mbuf->nb_segs + sym->m_src->nb_segs + 3;
 749         } else {
 750                 mbuf = sym->m_src;
 751                 req_segs = mbuf->nb_segs * 2 + 3;
 752         }
 753
 754         if (req_segs > MAX_SG_ENTRIES) {
 755                 DPAA_SEC_DP_ERR("Cipher: Max sec segs supported is %d",
 756                                 MAX_SG_ENTRIES);
 757                 return NULL;
 758         }
 759
 760         ctx = dpaa_sec_alloc_ctx(ses);
 761         if (!ctx)
 762                 return NULL;
 763
 764         cf = &ctx->job;
 765         ctx->op = op;
 766
 767         /* output */
 768         out_sg = &cf->sg[0];
 769         out_sg->extension = 1;
 770         out_sg->length = sym->cipher.data.length;
 771         qm_sg_entry_set64(out_sg, dpaa_mem_vtop(&cf->sg[2]));
 772         cpu_to_hw_sg(out_sg);
 773
 774         /* 1st seg */
 775         sg = &cf->sg[2];
 776         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 777         sg->length = mbuf->data_len - sym->cipher.data.offset;
 778         sg->offset = sym->cipher.data.offset;
 779
 780         /* Successive segs */
 781         mbuf = mbuf->next;
 782         while (mbuf) {
 783                 cpu_to_hw_sg(sg);
 784                 sg++;
 785                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 786                 sg->length = mbuf->data_len;
 787                 mbuf = mbuf->next;
 788         }
 789         sg->final = 1;
 790         cpu_to_hw_sg(sg);
 791
 792         /* input */
 793         mbuf = sym->m_src;
 794         in_sg = &cf->sg[1];
 795         in_sg->extension = 1;
 796         in_sg->final = 1;
 797         in_sg->length = sym->cipher.data.length + ses->iv.length;
 798
 799         sg++;
 800         qm_sg_entry_set64(in_sg, dpaa_mem_vtop(sg));
 801         cpu_to_hw_sg(in_sg);
 802
 803         /* IV */
 804         qm_sg_entry_set64(sg, dpaa_mem_vtop(IV_ptr));
 805         sg->length = ses->iv.length;
 806         cpu_to_hw_sg(sg);
 807
 808         /* 1st seg */
 809         sg++;
 810         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 811         sg->length = mbuf->data_len - sym->cipher.data.offset;
 812         sg->offset = sym->cipher.data.offset;
 813
 814         /* Successive segs */
 815         mbuf = mbuf->next;
 816         while (mbuf) {
 817                 cpu_to_hw_sg(sg);
 818                 sg++;
 819                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 820                 sg->length = mbuf->data_len;
 821                 mbuf = mbuf->next;
 822         }
 823         sg->final = 1;
 824         cpu_to_hw_sg(sg);
 825
 826         return cf;
 827 }
 828
 829 static inline struct dpaa_sec_job *
 830 build_cipher_only(struct rte_crypto_op *op, dpaa_sec_session *ses)
 831 {
 832         struct rte_crypto_sym_op *sym = op->sym;
 833         struct dpaa_sec_job *cf;
 834         struct dpaa_sec_op_ctx *ctx;
 835         struct qm_sg_entry *sg;
 836         rte_iova_t src_start_addr, dst_start_addr;
 837         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 838                         ses->iv.offset);
 839
 840         ctx = dpaa_sec_alloc_ctx(ses);
 841         if (!ctx)
 842                 return NULL;
 843
 844         cf = &ctx->job;
 845         ctx->op = op;
 846
 847         src_start_addr = rte_pktmbuf_iova(sym->m_src);
 848
 849         if (sym->m_dst)
 850                 dst_start_addr = rte_pktmbuf_iova(sym->m_dst);
 851         else
 852                 dst_start_addr = src_start_addr;
 853
 854         /* output */
 855         sg = &cf->sg[0];
 856         qm_sg_entry_set64(sg, dst_start_addr + sym->cipher.data.offset);
 857         sg->length = sym->cipher.data.length + ses->iv.length;
 858         cpu_to_hw_sg(sg);
 859
 860         /* input */
 861         sg = &cf->sg[1];
 862
 863         /* need to extend the input to a compound frame */
 864         sg->extension = 1;
 865         sg->final = 1;
 866         sg->length = sym->cipher.data.length + ses->iv.length;
 867         qm_sg_entry_set64(sg, dpaa_mem_vtop(&cf->sg[2]));
 868         cpu_to_hw_sg(sg);
 869
 870         sg = &cf->sg[2];
 871         qm_sg_entry_set64(sg, dpaa_mem_vtop(IV_ptr));
 872         sg->length = ses->iv.length;
 873         cpu_to_hw_sg(sg);
 874
 875         sg++;
 876         qm_sg_entry_set64(sg, src_start_addr + sym->cipher.data.offset);
 877         sg->length = sym->cipher.data.length;
 878         sg->final = 1;
 879         cpu_to_hw_sg(sg);
 880
 881         return cf;
 882 }
 883
 884 static inline struct dpaa_sec_job *
 885 build_cipher_auth_gcm_sg(struct rte_crypto_op *op, dpaa_sec_session *ses)
 886 {
 887         struct rte_crypto_sym_op *sym = op->sym;
 888         struct dpaa_sec_job *cf;
 889         struct dpaa_sec_op_ctx *ctx;
 890         struct qm_sg_entry *sg, *out_sg, *in_sg;
 891         struct rte_mbuf *mbuf;
 892         uint8_t req_segs;
 893         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
 894                         ses->iv.offset);
 895
 896         if (sym->m_dst) {
 897                 mbuf = sym->m_dst;
 898                 req_segs = mbuf->nb_segs + sym->m_src->nb_segs + 4;
 899         } else {
 900                 mbuf = sym->m_src;
 901                 req_segs = mbuf->nb_segs * 2 + 4;
 902         }
 903
 904         if (ses->auth_only_len)
 905                 req_segs++;
 906
 907         if (req_segs > MAX_SG_ENTRIES) {
 908                 DPAA_SEC_DP_ERR("AEAD: Max sec segs supported is %d",
 909                                 MAX_SG_ENTRIES);
 910                 return NULL;
 911         }
 912
 913         ctx = dpaa_sec_alloc_ctx(ses);
 914         if (!ctx)
 915                 return NULL;
 916
 917         cf = &ctx->job;
 918         ctx->op = op;
 919
 920         rte_prefetch0(cf->sg);
 921
 922         /* output */
 923         out_sg = &cf->sg[0];
 924         out_sg->extension = 1;
 925         if (is_encode(ses))
 926                 out_sg->length = sym->aead.data.length + ses->auth_only_len
 927                                                 + ses->digest_length;
 928         else
 929                 out_sg->length = sym->aead.data.length + ses->auth_only_len;
 930
 931         /* output sg entries */
 932         sg = &cf->sg[2];
 933         qm_sg_entry_set64(out_sg, dpaa_mem_vtop(sg));
 934         cpu_to_hw_sg(out_sg);
 935
 936         /* 1st seg */
 937         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 938         sg->length = mbuf->data_len - sym->aead.data.offset +
 939                                         ses->auth_only_len;
 940         sg->offset = sym->aead.data.offset - ses->auth_only_len;
 941
 942         /* Successive segs */
 943         mbuf = mbuf->next;
 944         while (mbuf) {
 945                 cpu_to_hw_sg(sg);
 946                 sg++;
 947                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 948                 sg->length = mbuf->data_len;
 949                 mbuf = mbuf->next;
 950         }
 951         sg->length -= ses->digest_length;
 952
 953         if (is_encode(ses)) {
 954                 cpu_to_hw_sg(sg);
 955                 /* set auth output */
 956                 sg++;
 957                 qm_sg_entry_set64(sg, sym->aead.digest.phys_addr);
 958                 sg->length = ses->digest_length;
 959         }
 960         sg->final = 1;
 961         cpu_to_hw_sg(sg);
 962
 963         /* input */
 964         mbuf = sym->m_src;
 965         in_sg = &cf->sg[1];
 966         in_sg->extension = 1;
 967         in_sg->final = 1;
 968         if (is_encode(ses))
 969                 in_sg->length = ses->iv.length + sym->aead.data.length
 970                                                         + ses->auth_only_len;
 971         else
 972                 in_sg->length = ses->iv.length + sym->aead.data.length
 973                                 + ses->auth_only_len + ses->digest_length;
 974
 975         /* input sg entries */
 976         sg++;
 977         qm_sg_entry_set64(in_sg, dpaa_mem_vtop(sg));
 978         cpu_to_hw_sg(in_sg);
 979
 980         /* 1st seg IV */
 981         qm_sg_entry_set64(sg, dpaa_mem_vtop(IV_ptr));
 982         sg->length = ses->iv.length;
 983         cpu_to_hw_sg(sg);
 984
 985         /* 2nd seg auth only */
 986         if (ses->auth_only_len) {
 987                 sg++;
 988                 qm_sg_entry_set64(sg, dpaa_mem_vtop(sym->aead.aad.data));
 989                 sg->length = ses->auth_only_len;
 990                 cpu_to_hw_sg(sg);
 991         }
 992
 993         /* 3rd seg */
 994         sg++;
 995         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
 996         sg->length = mbuf->data_len - sym->aead.data.offset;
 997         sg->offset = sym->aead.data.offset;
 998
 999         /* Successive segs */
1000         mbuf = mbuf->next;
1001         while (mbuf) {
1002                 cpu_to_hw_sg(sg);
1003                 sg++;
1004                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1005                 sg->length = mbuf->data_len;
1006                 mbuf = mbuf->next;
1007         }
1008
1009         if (is_decode(ses)) {
1010                 cpu_to_hw_sg(sg);
1011                 sg++;
1012                 memcpy(ctx->digest, sym->aead.digest.data,
1013                         ses->digest_length);
1014                 qm_sg_entry_set64(sg, dpaa_mem_vtop(ctx->digest));
1015                 sg->length = ses->digest_length;
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_auth_gcm(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         uint32_t length = 0;
1031         rte_iova_t src_start_addr, dst_start_addr;
1032         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1033                         ses->iv.offset);
1034
1035         src_start_addr = sym->m_src->buf_iova + sym->m_src->data_off;
1036
1037         if (sym->m_dst)
1038                 dst_start_addr = sym->m_dst->buf_iova + sym->m_dst->data_off;
1039         else
1040                 dst_start_addr = src_start_addr;
1041
1042         ctx = dpaa_sec_alloc_ctx(ses);
1043         if (!ctx)
1044                 return NULL;
1045
1046         cf = &ctx->job;
1047         ctx->op = op;
1048
1049         /* input */
1050         rte_prefetch0(cf->sg);
1051         sg = &cf->sg[2];
1052         qm_sg_entry_set64(&cf->sg[1], dpaa_mem_vtop(sg));
1053         if (is_encode(ses)) {
1054                 qm_sg_entry_set64(sg, dpaa_mem_vtop(IV_ptr));
1055                 sg->length = ses->iv.length;
1056                 length += sg->length;
1057                 cpu_to_hw_sg(sg);
1058
1059                 sg++;
1060                 if (ses->auth_only_len) {
1061                         qm_sg_entry_set64(sg,
1062                                           dpaa_mem_vtop(sym->aead.aad.data));
1063                         sg->length = ses->auth_only_len;
1064                         length += sg->length;
1065                         cpu_to_hw_sg(sg);
1066                         sg++;
1067                 }
1068                 qm_sg_entry_set64(sg, src_start_addr + sym->aead.data.offset);
1069                 sg->length = sym->aead.data.length;
1070                 length += sg->length;
1071                 sg->final = 1;
1072                 cpu_to_hw_sg(sg);
1073         } else {
1074                 qm_sg_entry_set64(sg, dpaa_mem_vtop(IV_ptr));
1075                 sg->length = ses->iv.length;
1076                 length += sg->length;
1077                 cpu_to_hw_sg(sg);
1078
1079                 sg++;
1080                 if (ses->auth_only_len) {
1081                         qm_sg_entry_set64(sg,
1082                                           dpaa_mem_vtop(sym->aead.aad.data));
1083                         sg->length = ses->auth_only_len;
1084                         length += sg->length;
1085                         cpu_to_hw_sg(sg);
1086                         sg++;
1087                 }
1088                 qm_sg_entry_set64(sg, src_start_addr + sym->aead.data.offset);
1089                 sg->length = sym->aead.data.length;
1090                 length += sg->length;
1091                 cpu_to_hw_sg(sg);
1092
1093                 memcpy(ctx->digest, sym->aead.digest.data,
1094                        ses->digest_length);
1095                 sg++;
1096
1097                 qm_sg_entry_set64(sg, dpaa_mem_vtop(ctx->digest));
1098                 sg->length = ses->digest_length;
1099                 length += sg->length;
1100                 sg->final = 1;
1101                 cpu_to_hw_sg(sg);
1102         }
1103         /* input compound frame */
1104         cf->sg[1].length = length;
1105         cf->sg[1].extension = 1;
1106         cf->sg[1].final = 1;
1107         cpu_to_hw_sg(&cf->sg[1]);
1108
1109         /* output */
1110         sg++;
1111         qm_sg_entry_set64(&cf->sg[0], dpaa_mem_vtop(sg));
1112         qm_sg_entry_set64(sg,
1113                 dst_start_addr + sym->aead.data.offset - ses->auth_only_len);
1114         sg->length = sym->aead.data.length + ses->auth_only_len;
1115         length = sg->length;
1116         if (is_encode(ses)) {
1117                 cpu_to_hw_sg(sg);
1118                 /* set auth output */
1119                 sg++;
1120                 qm_sg_entry_set64(sg, sym->aead.digest.phys_addr);
1121                 sg->length = ses->digest_length;
1122                 length += sg->length;
1123         }
1124         sg->final = 1;
1125         cpu_to_hw_sg(sg);
1126
1127         /* output compound frame */
1128         cf->sg[0].length = length;
1129         cf->sg[0].extension = 1;
1130         cpu_to_hw_sg(&cf->sg[0]);
1131
1132         return cf;
1133 }
1134
1135 static inline struct dpaa_sec_job *
1136 build_cipher_auth_sg(struct rte_crypto_op *op, dpaa_sec_session *ses)
1137 {
1138         struct rte_crypto_sym_op *sym = op->sym;
1139         struct dpaa_sec_job *cf;
1140         struct dpaa_sec_op_ctx *ctx;
1141         struct qm_sg_entry *sg, *out_sg, *in_sg;
1142         struct rte_mbuf *mbuf;
1143         uint8_t req_segs;
1144         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1145                         ses->iv.offset);
1146
1147         if (sym->m_dst) {
1148                 mbuf = sym->m_dst;
1149                 req_segs = mbuf->nb_segs + sym->m_src->nb_segs + 4;
1150         } else {
1151                 mbuf = sym->m_src;
1152                 req_segs = mbuf->nb_segs * 2 + 4;
1153         }
1154
1155         if (req_segs > MAX_SG_ENTRIES) {
1156                 DPAA_SEC_DP_ERR("Cipher-Auth: Max sec segs supported is %d",
1157                                 MAX_SG_ENTRIES);
1158                 return NULL;
1159         }
1160
1161         ctx = dpaa_sec_alloc_ctx(ses);
1162         if (!ctx)
1163                 return NULL;
1164
1165         cf = &ctx->job;
1166         ctx->op = op;
1167
1168         rte_prefetch0(cf->sg);
1169
1170         /* output */
1171         out_sg = &cf->sg[0];
1172         out_sg->extension = 1;
1173         if (is_encode(ses))
1174                 out_sg->length = sym->auth.data.length + ses->digest_length;
1175         else
1176                 out_sg->length = sym->auth.data.length;
1177
1178         /* output sg entries */
1179         sg = &cf->sg[2];
1180         qm_sg_entry_set64(out_sg, dpaa_mem_vtop(sg));
1181         cpu_to_hw_sg(out_sg);
1182
1183         /* 1st seg */
1184         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1185         sg->length = mbuf->data_len - sym->auth.data.offset;
1186         sg->offset = sym->auth.data.offset;
1187
1188         /* Successive segs */
1189         mbuf = mbuf->next;
1190         while (mbuf) {
1191                 cpu_to_hw_sg(sg);
1192                 sg++;
1193                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1194                 sg->length = mbuf->data_len;
1195                 mbuf = mbuf->next;
1196         }
1197         sg->length -= ses->digest_length;
1198
1199         if (is_encode(ses)) {
1200                 cpu_to_hw_sg(sg);
1201                 /* set auth output */
1202                 sg++;
1203                 qm_sg_entry_set64(sg, sym->auth.digest.phys_addr);
1204                 sg->length = ses->digest_length;
1205         }
1206         sg->final = 1;
1207         cpu_to_hw_sg(sg);
1208
1209         /* input */
1210         mbuf = sym->m_src;
1211         in_sg = &cf->sg[1];
1212         in_sg->extension = 1;
1213         in_sg->final = 1;
1214         if (is_encode(ses))
1215                 in_sg->length = ses->iv.length + sym->auth.data.length;
1216         else
1217                 in_sg->length = ses->iv.length + sym->auth.data.length
1218                                                 + ses->digest_length;
1219
1220         /* input sg entries */
1221         sg++;
1222         qm_sg_entry_set64(in_sg, dpaa_mem_vtop(sg));
1223         cpu_to_hw_sg(in_sg);
1224
1225         /* 1st seg IV */
1226         qm_sg_entry_set64(sg, dpaa_mem_vtop(IV_ptr));
1227         sg->length = ses->iv.length;
1228         cpu_to_hw_sg(sg);
1229
1230         /* 2nd seg */
1231         sg++;
1232         qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1233         sg->length = mbuf->data_len - sym->auth.data.offset;
1234         sg->offset = sym->auth.data.offset;
1235
1236         /* Successive segs */
1237         mbuf = mbuf->next;
1238         while (mbuf) {
1239                 cpu_to_hw_sg(sg);
1240                 sg++;
1241                 qm_sg_entry_set64(sg, rte_pktmbuf_mtophys(mbuf));
1242                 sg->length = mbuf->data_len;
1243                 mbuf = mbuf->next;
1244         }
1245
1246         sg->length -= ses->digest_length;
1247         if (is_decode(ses)) {
1248                 cpu_to_hw_sg(sg);
1249                 sg++;
1250                 memcpy(ctx->digest, sym->auth.digest.data,
1251                         ses->digest_length);
1252                 qm_sg_entry_set64(sg, dpaa_mem_vtop(ctx->digest));
1253                 sg->length = ses->digest_length;
1254         }
1255         sg->final = 1;
1256         cpu_to_hw_sg(sg);
1257
1258         return cf;
1259 }
1260
1261 static inline struct dpaa_sec_job *
1262 build_cipher_auth(struct rte_crypto_op *op, dpaa_sec_session *ses)
1263 {
1264         struct rte_crypto_sym_op *sym = op->sym;
1265         struct dpaa_sec_job *cf;
1266         struct dpaa_sec_op_ctx *ctx;
1267         struct qm_sg_entry *sg;
1268         rte_iova_t src_start_addr, dst_start_addr;
1269         uint32_t length = 0;
1270         uint8_t *IV_ptr = rte_crypto_op_ctod_offset(op, uint8_t *,
1271                         ses->iv.offset);
1272
1273         src_start_addr = sym->m_src->buf_iova + sym->m_src->data_off;
1274         if (sym->m_dst)
1275                 dst_start_addr = sym->m_dst->buf_iova + sym->m_dst->data_off;
1276         else
1277                 dst_start_addr = src_start_addr;
1278
1279         ctx = dpaa_sec_alloc_ctx(ses);
1280         if (!ctx)
1281                 return NULL;
1282
1283         cf = &ctx->job;
1284         ctx->op = op;
1285
1286         /* input */
1287         rte_prefetch0(cf->sg);
1288         sg = &cf->sg[2];
1289         qm_sg_entry_set64(&cf->sg[1], dpaa_mem_vtop(sg));
1290         if (is_encode(ses)) {
1291                 qm_sg_entry_set64(sg, dpaa_mem_vtop(IV_ptr));
1292                 sg->length = ses->iv.length;
1293                 length += sg->length;
1294                 cpu_to_hw_sg(sg);
1295
1296                 sg++;
1297                 qm_sg_entry_set64(sg, src_start_addr + sym->auth.data.offset);
1298                 sg->length = sym->auth.data.length;
1299                 length += sg->length;
1300                 sg->final = 1;
1301                 cpu_to_hw_sg(sg);
1302         } else {
1303                 qm_sg_entry_set64(sg, dpaa_mem_vtop(IV_ptr));
1304                 sg->length = ses->iv.length;
1305                 length += sg->length;
1306                 cpu_to_hw_sg(sg);
1307
1308                 sg++;
1309
1310                 qm_sg_entry_set64(sg, src_start_addr + sym->auth.data.offset);
1311                 sg->length = sym->auth.data.length;
1312                 length += sg->length;
1313                 cpu_to_hw_sg(sg);
1314
1315                 memcpy(ctx->digest, sym->auth.digest.data,
1316                        ses->digest_length);
1317                 sg++;
1318
1319                 qm_sg_entry_set64(sg, dpaa_mem_vtop(ctx->digest));
1320                 sg->length = ses->digest_length;
1321                 length += sg->length;
1322                 sg->final = 1;
1323                 cpu_to_hw_sg(sg);
1324         }
1325         /* input compound frame */
1326         cf->sg[1].length = length;
1327         cf->sg[1].extension = 1;
1328         cf->sg[1].final = 1;
1329         cpu_to_hw_sg(&cf->sg[1]);
1330
1331         /* output */
1332         sg++;
1333         qm_sg_entry_set64(&cf->sg[0], dpaa_mem_vtop(sg));
1334         qm_sg_entry_set64(sg, dst_start_addr + sym->cipher.data.offset);
1335         sg->length = sym->cipher.data.length;
1336         length = sg->length;
1337         if (is_encode(ses)) {
1338                 cpu_to_hw_sg(sg);
1339                 /* set auth output */
1340                 sg++;
1341                 qm_sg_entry_set64(sg, sym->auth.digest.phys_addr);
1342                 sg->length = ses->digest_length;
1343                 length += sg->length;
1344         }
1345         sg->final = 1;
1346         cpu_to_hw_sg(sg);
1347
1348         /* output compound frame */
1349         cf->sg[0].length = length;
1350         cf->sg[0].extension = 1;
1351         cpu_to_hw_sg(&cf->sg[0]);
1352
1353         return cf;
1354 }
1355
1356 static inline struct dpaa_sec_job *
1357 build_proto(struct rte_crypto_op *op, dpaa_sec_session *ses)
1358 {
1359         struct rte_crypto_sym_op *sym = op->sym;
1360         struct dpaa_sec_job *cf;
1361         struct dpaa_sec_op_ctx *ctx;
1362         struct qm_sg_entry *sg;
1363         phys_addr_t src_start_addr, dst_start_addr;
1364
1365         ctx = dpaa_sec_alloc_ctx(ses);
1366         if (!ctx)
1367                 return NULL;
1368         cf = &ctx->job;
1369         ctx->op = op;
1370
1371         src_start_addr = rte_pktmbuf_mtophys(sym->m_src);
1372
1373         if (sym->m_dst)
1374                 dst_start_addr = rte_pktmbuf_mtophys(sym->m_dst);
1375         else
1376                 dst_start_addr = src_start_addr;
1377
1378         /* input */
1379         sg = &cf->sg[1];
1380         qm_sg_entry_set64(sg, src_start_addr);
1381         sg->length = sym->m_src->pkt_len;
1382         sg->final = 1;
1383         cpu_to_hw_sg(sg);
1384
1385         sym->m_src->packet_type &= ~RTE_PTYPE_L4_MASK;
1386         /* output */
1387         sg = &cf->sg[0];
1388         qm_sg_entry_set64(sg, dst_start_addr);
1389         sg->length = sym->m_src->buf_len - sym->m_src->data_off;
1390         cpu_to_hw_sg(sg);
1391
1392         return cf;
1393 }
1394
1395 static uint16_t
1396 dpaa_sec_enqueue_burst(void *qp, struct rte_crypto_op **ops,
1397                        uint16_t nb_ops)
1398 {
1399         /* Function to transmit the frames to given device and queuepair */
1400         uint32_t loop;
1401         struct dpaa_sec_qp *dpaa_qp = (struct dpaa_sec_qp *)qp;
1402         uint16_t num_tx = 0;
1403         struct qm_fd fds[DPAA_SEC_BURST], *fd;
1404         uint32_t frames_to_send;
1405         struct rte_crypto_op *op;
1406         struct dpaa_sec_job *cf;
1407         dpaa_sec_session *ses;
1408         uint32_t auth_only_len;
1409         struct qman_fq *inq[DPAA_SEC_BURST];
1410
1411         while (nb_ops) {
1412                 frames_to_send = (nb_ops > DPAA_SEC_BURST) ?
1413                                 DPAA_SEC_BURST : nb_ops;
1414                 for (loop = 0; loop < frames_to_send; loop++) {
1415                         op = *(ops++);
1416                         switch (op->sess_type) {
1417                         case RTE_CRYPTO_OP_WITH_SESSION:
1418                                 ses = (dpaa_sec_session *)
1419                                         get_session_private_data(
1420                                                         op->sym->session,
1421                                                         cryptodev_driver_id);
1422                                 break;
1423                         case RTE_CRYPTO_OP_SECURITY_SESSION:
1424                                 ses = (dpaa_sec_session *)
1425                                         get_sec_session_private_data(
1426                                                         op->sym->sec_session);
1427                                 break;
1428                         default:
1429                                 DPAA_SEC_DP_ERR(
1430                                         "sessionless crypto op not supported");
1431                                 frames_to_send = loop;
1432                                 nb_ops = loop;
1433                                 goto send_pkts;
1434                         }
1435                         if (unlikely(!ses->qp || ses->qp != qp)) {
1436                                 DPAA_SEC_DP_ERR("sess->qp - %p qp %p",
1437                                              ses->qp, qp);
1438                                 if (dpaa_sec_attach_sess_q(qp, ses)) {
1439                                         frames_to_send = loop;
1440                                         nb_ops = loop;
1441                                         goto send_pkts;
1442                                 }
1443                         }
1444
1445                         auth_only_len = op->sym->auth.data.length -
1446                                                 op->sym->cipher.data.length;
1447                         if (rte_pktmbuf_is_contiguous(op->sym->m_src)) {
1448                                 if (is_auth_only(ses)) {
1449                                         cf = build_auth_only(op, ses);
1450                                 } else if (is_cipher_only(ses)) {
1451                                         cf = build_cipher_only(op, ses);
1452                                 } else if (is_aead(ses)) {
1453                                         cf = build_cipher_auth_gcm(op, ses);
1454                                         auth_only_len = ses->auth_only_len;
1455                                 } else if (is_auth_cipher(ses)) {
1456                                         cf = build_cipher_auth(op, ses);
1457                                 } else if (is_proto_ipsec(ses)) {
1458                                         cf = build_proto(op, ses);
1459                                 } else {
1460                                         DPAA_SEC_DP_ERR("not supported ops");
1461                                         frames_to_send = loop;
1462                                         nb_ops = loop;
1463                                         goto send_pkts;
1464                                 }
1465                         } else {
1466                                 if (is_auth_only(ses)) {
1467                                         cf = build_auth_only_sg(op, ses);
1468                                 } else if (is_cipher_only(ses)) {
1469                                         cf = build_cipher_only_sg(op, ses);
1470                                 } else if (is_aead(ses)) {
1471                                         cf = build_cipher_auth_gcm_sg(op, ses);
1472                                         auth_only_len = ses->auth_only_len;
1473                                 } else if (is_auth_cipher(ses)) {
1474                                         cf = build_cipher_auth_sg(op, ses);
1475                                 } else {
1476                                         DPAA_SEC_DP_ERR("not supported ops");
1477                                         frames_to_send = loop;
1478                                         nb_ops = loop;
1479                                         goto send_pkts;
1480                                 }
1481                         }
1482                         if (unlikely(!cf)) {
1483                                 frames_to_send = loop;
1484                                 nb_ops = loop;
1485                                 goto send_pkts;
1486                         }
1487
1488                         fd = &fds[loop];
1489                         inq[loop] = ses->inq;
1490                         fd->opaque_addr = 0;
1491                         fd->cmd = 0;
1492                         qm_fd_addr_set64(fd, dpaa_mem_vtop(cf->sg));
1493                         fd->_format1 = qm_fd_compound;
1494                         fd->length29 = 2 * sizeof(struct qm_sg_entry);
1495                         /* Auth_only_len is set as 0 in descriptor and it is
1496                          * overwritten here in the fd.cmd which will update
1497                          * the DPOVRD reg.
1498                          */
1499                         if (auth_only_len)
1500                                 fd->cmd = 0x80000000 | auth_only_len;
1501
1502                 }
1503 send_pkts:
1504                 loop = 0;
1505                 while (loop < frames_to_send) {
1506                         loop += qman_enqueue_multi_fq(&inq[loop], &fds[loop],
1507                                         frames_to_send - loop);
1508                 }
1509                 nb_ops -= frames_to_send;
1510                 num_tx += frames_to_send;
1511         }
1512
1513         dpaa_qp->tx_pkts += num_tx;
1514         dpaa_qp->tx_errs += nb_ops - num_tx;
1515
1516         return num_tx;
1517 }
1518
1519 static uint16_t
1520 dpaa_sec_dequeue_burst(void *qp, struct rte_crypto_op **ops,
1521                        uint16_t nb_ops)
1522 {
1523         uint16_t num_rx;
1524         struct dpaa_sec_qp *dpaa_qp = (struct dpaa_sec_qp *)qp;
1525
1526         num_rx = dpaa_sec_deq(dpaa_qp, ops, nb_ops);
1527
1528         dpaa_qp->rx_pkts += num_rx;
1529         dpaa_qp->rx_errs += nb_ops - num_rx;
1530
1531         DPAA_SEC_DP_DEBUG("SEC Received %d Packets\n", num_rx);
1532
1533         return num_rx;
1534 }
1535
1536 /** Release queue pair */
1537 static int
1538 dpaa_sec_queue_pair_release(struct rte_cryptodev *dev,
1539                             uint16_t qp_id)
1540 {
1541         struct dpaa_sec_dev_private *internals;
1542         struct dpaa_sec_qp *qp = NULL;
1543
1544         PMD_INIT_FUNC_TRACE();
1545
1546         DPAA_SEC_DEBUG("dev =%p, queue =%d", dev, qp_id);
1547
1548         internals = dev->data->dev_private;
1549         if (qp_id >= internals->max_nb_queue_pairs) {
1550                 DPAA_SEC_ERR("Max supported qpid %d",
1551                              internals->max_nb_queue_pairs);
1552                 return -EINVAL;
1553         }
1554
1555         qp = &internals->qps[qp_id];
1556         qp->internals = NULL;
1557         dev->data->queue_pairs[qp_id] = NULL;
1558
1559         return 0;
1560 }
1561
1562 /** Setup a queue pair */
1563 static int
1564 dpaa_sec_queue_pair_setup(struct rte_cryptodev *dev, uint16_t qp_id,
1565                 __rte_unused const struct rte_cryptodev_qp_conf *qp_conf,
1566                 __rte_unused int socket_id,
1567                 __rte_unused struct rte_mempool *session_pool)
1568 {
1569         struct dpaa_sec_dev_private *internals;
1570         struct dpaa_sec_qp *qp = NULL;
1571
1572         DPAA_SEC_DEBUG("dev =%p, queue =%d, conf =%p", dev, qp_id, qp_conf);
1573
1574         internals = dev->data->dev_private;
1575         if (qp_id >= internals->max_nb_queue_pairs) {
1576                 DPAA_SEC_ERR("Max supported qpid %d",
1577                              internals->max_nb_queue_pairs);
1578                 return -EINVAL;
1579         }
1580
1581         qp = &internals->qps[qp_id];
1582         qp->internals = internals;
1583         dev->data->queue_pairs[qp_id] = qp;
1584
1585         return 0;
1586 }
1587
1588 /** Return the number of allocated queue pairs */
1589 static uint32_t
1590 dpaa_sec_queue_pair_count(struct rte_cryptodev *dev)
1591 {
1592         PMD_INIT_FUNC_TRACE();
1593
1594         return dev->data->nb_queue_pairs;
1595 }
1596
1597 /** Returns the size of session structure */
1598 static unsigned int
1599 dpaa_sec_session_get_size(struct rte_cryptodev *dev __rte_unused)
1600 {
1601         PMD_INIT_FUNC_TRACE();
1602
1603         return sizeof(dpaa_sec_session);
1604 }
1605
1606 static int
1607 dpaa_sec_cipher_init(struct rte_cryptodev *dev __rte_unused,
1608                      struct rte_crypto_sym_xform *xform,
1609                      dpaa_sec_session *session)
1610 {
1611         session->cipher_alg = xform->cipher.algo;
1612         session->iv.length = xform->cipher.iv.length;
1613         session->iv.offset = xform->cipher.iv.offset;
1614         session->cipher_key.data = rte_zmalloc(NULL, xform->cipher.key.length,
1615                                                RTE_CACHE_LINE_SIZE);
1616         if (session->cipher_key.data == NULL && xform->cipher.key.length > 0) {
1617                 DPAA_SEC_ERR("No Memory for cipher key");
1618                 return -ENOMEM;
1619         }
1620         session->cipher_key.length = xform->cipher.key.length;
1621
1622         memcpy(session->cipher_key.data, xform->cipher.key.data,
1623                xform->cipher.key.length);
1624         session->dir = (xform->cipher.op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) ?
1625                         DIR_ENC : DIR_DEC;
1626
1627         return 0;
1628 }
1629
1630 static int
1631 dpaa_sec_auth_init(struct rte_cryptodev *dev __rte_unused,
1632                    struct rte_crypto_sym_xform *xform,
1633                    dpaa_sec_session *session)
1634 {
1635         session->auth_alg = xform->auth.algo;
1636         session->auth_key.data = rte_zmalloc(NULL, xform->auth.key.length,
1637                                              RTE_CACHE_LINE_SIZE);
1638         if (session->auth_key.data == NULL && xform->auth.key.length > 0) {
1639                 DPAA_SEC_ERR("No Memory for auth key");
1640                 return -ENOMEM;
1641         }
1642         session->auth_key.length = xform->auth.key.length;
1643         session->digest_length = xform->auth.digest_length;
1644
1645         memcpy(session->auth_key.data, xform->auth.key.data,
1646                xform->auth.key.length);
1647         session->dir = (xform->auth.op == RTE_CRYPTO_AUTH_OP_GENERATE) ?
1648                         DIR_ENC : DIR_DEC;
1649
1650         return 0;
1651 }
1652
1653 static int
1654 dpaa_sec_aead_init(struct rte_cryptodev *dev __rte_unused,
1655                    struct rte_crypto_sym_xform *xform,
1656                    dpaa_sec_session *session)
1657 {
1658         session->aead_alg = xform->aead.algo;
1659         session->iv.length = xform->aead.iv.length;
1660         session->iv.offset = xform->aead.iv.offset;
1661         session->auth_only_len = xform->aead.aad_length;
1662         session->aead_key.data = rte_zmalloc(NULL, xform->aead.key.length,
1663                                              RTE_CACHE_LINE_SIZE);
1664         if (session->aead_key.data == NULL && xform->aead.key.length > 0) {
1665                 DPAA_SEC_ERR("No Memory for aead key\n");
1666                 return -ENOMEM;
1667         }
1668         session->aead_key.length = xform->aead.key.length;
1669         session->digest_length = xform->aead.digest_length;
1670
1671         memcpy(session->aead_key.data, xform->aead.key.data,
1672                xform->aead.key.length);
1673         session->dir = (xform->aead.op == RTE_CRYPTO_AEAD_OP_ENCRYPT) ?
1674                         DIR_ENC : DIR_DEC;
1675
1676         return 0;
1677 }
1678
1679 static struct qman_fq *
1680 dpaa_sec_attach_rxq(struct dpaa_sec_dev_private *qi)
1681 {
1682         unsigned int i;
1683
1684         for (i = 0; i < qi->max_nb_sessions; i++) {
1685                 if (qi->inq_attach[i] == 0) {
1686                         qi->inq_attach[i] = 1;
1687                         return &qi->inq[i];
1688                 }
1689         }
1690         DPAA_SEC_WARN("All ses session in use %x", qi->max_nb_sessions);
1691
1692         return NULL;
1693 }
1694
1695 static int
1696 dpaa_sec_detach_rxq(struct dpaa_sec_dev_private *qi, struct qman_fq *fq)
1697 {
1698         unsigned int i;
1699
1700         for (i = 0; i < qi->max_nb_sessions; i++) {
1701                 if (&qi->inq[i] == fq) {
1702                         qman_retire_fq(fq, NULL);
1703                         qman_oos_fq(fq);
1704                         qi->inq_attach[i] = 0;
1705                         return 0;
1706                 }
1707         }
1708         return -1;
1709 }
1710
1711 static int
1712 dpaa_sec_attach_sess_q(struct dpaa_sec_qp *qp, dpaa_sec_session *sess)
1713 {
1714         int ret;
1715
1716         sess->qp = qp;
1717         ret = dpaa_sec_prep_cdb(sess);
1718         if (ret) {
1719                 DPAA_SEC_ERR("Unable to prepare sec cdb");
1720                 return -1;
1721         }
1722         if (unlikely(!RTE_PER_LCORE(dpaa_io))) {
1723                 ret = rte_dpaa_portal_init((void *)0);
1724                 if (ret) {
1725                         DPAA_SEC_ERR("Failure in affining portal");
1726                         return ret;
1727                 }
1728         }
1729         ret = dpaa_sec_init_rx(sess->inq, dpaa_mem_vtop(&sess->cdb),
1730                                qman_fq_fqid(&qp->outq));
1731         if (ret)
1732                 DPAA_SEC_ERR("Unable to init sec queue");
1733
1734         return ret;
1735 }
1736
1737 static int
1738 dpaa_sec_qp_attach_sess(struct rte_cryptodev *dev __rte_unused,
1739                         uint16_t qp_id __rte_unused,
1740                         void *ses __rte_unused)
1741 {
1742         PMD_INIT_FUNC_TRACE();
1743         return 0;
1744 }
1745
1746 static int
1747 dpaa_sec_qp_detach_sess(struct rte_cryptodev *dev,
1748                         uint16_t qp_id  __rte_unused,
1749                         void *ses)
1750 {
1751         dpaa_sec_session *sess = ses;
1752         struct dpaa_sec_dev_private *qi = dev->data->dev_private;
1753
1754         PMD_INIT_FUNC_TRACE();
1755
1756         if (sess->inq)
1757                 dpaa_sec_detach_rxq(qi, sess->inq);
1758         sess->inq = NULL;
1759
1760         sess->qp = NULL;
1761
1762         return 0;
1763 }
1764
1765 static int
1766 dpaa_sec_set_session_parameters(struct rte_cryptodev *dev,
1767                             struct rte_crypto_sym_xform *xform, void *sess)
1768 {
1769         struct dpaa_sec_dev_private *internals = dev->data->dev_private;
1770         dpaa_sec_session *session = sess;
1771
1772         PMD_INIT_FUNC_TRACE();
1773
1774         if (unlikely(sess == NULL)) {
1775                 DPAA_SEC_ERR("invalid session struct");
1776                 return -EINVAL;
1777         }
1778
1779         /* Default IV length = 0 */
1780         session->iv.length = 0;
1781
1782         /* Cipher Only */
1783         if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER && xform->next == NULL) {
1784                 session->auth_alg = RTE_CRYPTO_AUTH_NULL;
1785                 dpaa_sec_cipher_init(dev, xform, session);
1786
1787         /* Authentication Only */
1788         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AUTH &&
1789                    xform->next == NULL) {
1790                 session->cipher_alg = RTE_CRYPTO_CIPHER_NULL;
1791                 dpaa_sec_auth_init(dev, xform, session);
1792
1793         /* Cipher then Authenticate */
1794         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_CIPHER &&
1795                    xform->next->type == RTE_CRYPTO_SYM_XFORM_AUTH) {
1796                 if (xform->cipher.op == RTE_CRYPTO_CIPHER_OP_ENCRYPT) {
1797                         dpaa_sec_cipher_init(dev, xform, session);
1798                         dpaa_sec_auth_init(dev, xform->next, session);
1799                 } else {
1800                         DPAA_SEC_ERR("Not supported: Auth then Cipher");
1801                         return -EINVAL;
1802                 }
1803
1804         /* Authenticate then Cipher */
1805         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AUTH &&
1806                    xform->next->type == RTE_CRYPTO_SYM_XFORM_CIPHER) {
1807                 if (xform->next->cipher.op == RTE_CRYPTO_CIPHER_OP_DECRYPT) {
1808                         dpaa_sec_auth_init(dev, xform, session);
1809                         dpaa_sec_cipher_init(dev, xform->next, session);
1810                 } else {
1811                         DPAA_SEC_ERR("Not supported: Auth then Cipher");
1812                         return -EINVAL;
1813                 }
1814
1815         /* AEAD operation for AES-GCM kind of Algorithms */
1816         } else if (xform->type == RTE_CRYPTO_SYM_XFORM_AEAD &&
1817                    xform->next == NULL) {
1818                 dpaa_sec_aead_init(dev, xform, session);
1819
1820         } else {
1821                 DPAA_SEC_ERR("Invalid crypto type");
1822                 return -EINVAL;
1823         }
1824         session->ctx_pool = internals->ctx_pool;
1825         session->inq = dpaa_sec_attach_rxq(internals);
1826         if (session->inq == NULL) {
1827                 DPAA_SEC_ERR("unable to attach sec queue");
1828                 goto err1;
1829         }
1830
1831         return 0;
1832
1833 err1:
1834         rte_free(session->cipher_key.data);
1835         rte_free(session->auth_key.data);
1836         memset(session, 0, sizeof(dpaa_sec_session));
1837
1838         return -EINVAL;
1839 }
1840
1841 static int
1842 dpaa_sec_session_configure(struct rte_cryptodev *dev,
1843                 struct rte_crypto_sym_xform *xform,
1844                 struct rte_cryptodev_sym_session *sess,
1845                 struct rte_mempool *mempool)
1846 {
1847         void *sess_private_data;
1848         int ret;
1849
1850         PMD_INIT_FUNC_TRACE();
1851
1852         if (rte_mempool_get(mempool, &sess_private_data)) {
1853                 DPAA_SEC_ERR("Couldn't get object from session mempool");
1854                 return -ENOMEM;
1855         }
1856
1857         ret = dpaa_sec_set_session_parameters(dev, xform, sess_private_data);
1858         if (ret != 0) {
1859                 DPAA_SEC_ERR("failed to configure session parameters");
1860
1861                 /* Return session to mempool */
1862                 rte_mempool_put(mempool, sess_private_data);
1863                 return ret;
1864         }
1865
1866         set_session_private_data(sess, dev->driver_id,
1867                         sess_private_data);
1868
1869
1870         return 0;
1871 }
1872
1873 /** Clear the memory of session so it doesn't leave key material behind */
1874 static void
1875 dpaa_sec_session_clear(struct rte_cryptodev *dev,
1876                 struct rte_cryptodev_sym_session *sess)
1877 {
1878         struct dpaa_sec_dev_private *qi = dev->data->dev_private;
1879         uint8_t index = dev->driver_id;
1880         void *sess_priv = get_session_private_data(sess, index);
1881
1882         PMD_INIT_FUNC_TRACE();
1883
1884         dpaa_sec_session *s = (dpaa_sec_session *)sess_priv;
1885
1886         if (sess_priv) {
1887                 struct rte_mempool *sess_mp = rte_mempool_from_obj(sess_priv);
1888
1889                 if (s->inq)
1890                         dpaa_sec_detach_rxq(qi, s->inq);
1891                 rte_free(s->cipher_key.data);
1892                 rte_free(s->auth_key.data);
1893                 memset(s, 0, sizeof(dpaa_sec_session));
1894                 set_session_private_data(sess, index, NULL);
1895                 rte_mempool_put(sess_mp, sess_priv);
1896         }
1897 }
1898
1899 static int
1900 dpaa_sec_set_ipsec_session(__rte_unused struct rte_cryptodev *dev,
1901                            struct rte_security_session_conf *conf,
1902                            void *sess)
1903 {
1904         struct dpaa_sec_dev_private *internals = dev->data->dev_private;
1905         struct rte_security_ipsec_xform *ipsec_xform = &conf->ipsec;
1906         struct rte_crypto_auth_xform *auth_xform;
1907         struct rte_crypto_cipher_xform *cipher_xform;
1908         dpaa_sec_session *session = (dpaa_sec_session *)sess;
1909
1910         PMD_INIT_FUNC_TRACE();
1911
1912         if (ipsec_xform->direction == RTE_SECURITY_IPSEC_SA_DIR_EGRESS) {
1913                 cipher_xform = &conf->crypto_xform->cipher;
1914                 auth_xform = &conf->crypto_xform->next->auth;
1915         } else {
1916                 auth_xform = &conf->crypto_xform->auth;
1917                 cipher_xform = &conf->crypto_xform->next->cipher;
1918         }
1919         session->proto_alg = conf->protocol;
1920         session->cipher_key.data = rte_zmalloc(NULL,
1921                                                cipher_xform->key.length,
1922                                                RTE_CACHE_LINE_SIZE);
1923         if (session->cipher_key.data == NULL &&
1924                         cipher_xform->key.length > 0) {
1925                 DPAA_SEC_ERR("No Memory for cipher key");
1926                 return -ENOMEM;
1927         }
1928
1929         session->cipher_key.length = cipher_xform->key.length;
1930         session->auth_key.data = rte_zmalloc(NULL,
1931                                         auth_xform->key.length,
1932                                         RTE_CACHE_LINE_SIZE);
1933         if (session->auth_key.data == NULL &&
1934                         auth_xform->key.length > 0) {
1935                 DPAA_SEC_ERR("No Memory for auth key");
1936                 rte_free(session->cipher_key.data);
1937                 return -ENOMEM;
1938         }
1939         session->auth_key.length = auth_xform->key.length;
1940         memcpy(session->cipher_key.data, cipher_xform->key.data,
1941                         cipher_xform->key.length);
1942         memcpy(session->auth_key.data, auth_xform->key.data,
1943                         auth_xform->key.length);
1944
1945         switch (auth_xform->algo) {
1946         case RTE_CRYPTO_AUTH_SHA1_HMAC:
1947                 session->auth_alg = RTE_CRYPTO_AUTH_SHA1_HMAC;
1948                 break;
1949         case RTE_CRYPTO_AUTH_MD5_HMAC:
1950                 session->auth_alg = RTE_CRYPTO_AUTH_MD5_HMAC;
1951                 break;
1952         case RTE_CRYPTO_AUTH_SHA256_HMAC:
1953                 session->auth_alg = RTE_CRYPTO_AUTH_SHA256_HMAC;
1954                 break;
1955         case RTE_CRYPTO_AUTH_SHA384_HMAC:
1956                 session->auth_alg = RTE_CRYPTO_AUTH_SHA384_HMAC;
1957                 break;
1958         case RTE_CRYPTO_AUTH_SHA512_HMAC:
1959                 session->auth_alg = RTE_CRYPTO_AUTH_SHA512_HMAC;
1960                 break;
1961         case RTE_CRYPTO_AUTH_AES_CMAC:
1962                 session->auth_alg = RTE_CRYPTO_AUTH_AES_CMAC;
1963                 break;
1964         case RTE_CRYPTO_AUTH_NULL:
1965                 session->auth_alg = RTE_CRYPTO_AUTH_NULL;
1966                 break;
1967         case RTE_CRYPTO_AUTH_SHA224_HMAC:
1968         case RTE_CRYPTO_AUTH_AES_XCBC_MAC:
1969         case RTE_CRYPTO_AUTH_SNOW3G_UIA2:
1970         case RTE_CRYPTO_AUTH_SHA1:
1971         case RTE_CRYPTO_AUTH_SHA256:
1972         case RTE_CRYPTO_AUTH_SHA512:
1973         case RTE_CRYPTO_AUTH_SHA224:
1974         case RTE_CRYPTO_AUTH_SHA384:
1975         case RTE_CRYPTO_AUTH_MD5:
1976         case RTE_CRYPTO_AUTH_AES_GMAC:
1977         case RTE_CRYPTO_AUTH_KASUMI_F9:
1978         case RTE_CRYPTO_AUTH_AES_CBC_MAC:
1979         case RTE_CRYPTO_AUTH_ZUC_EIA3:
1980                 DPAA_SEC_ERR("Crypto: Unsupported auth alg %u",
1981                         auth_xform->algo);
1982                 goto out;
1983         default:
1984                 DPAA_SEC_ERR("Crypto: Undefined Auth specified %u",
1985                         auth_xform->algo);
1986                 goto out;
1987         }
1988
1989         switch (cipher_xform->algo) {
1990         case RTE_CRYPTO_CIPHER_AES_CBC:
1991                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CBC;
1992                 break;
1993         case RTE_CRYPTO_CIPHER_3DES_CBC:
1994                 session->cipher_alg = RTE_CRYPTO_CIPHER_3DES_CBC;
1995                 break;
1996         case RTE_CRYPTO_CIPHER_AES_CTR:
1997                 session->cipher_alg = RTE_CRYPTO_CIPHER_AES_CTR;
1998                 break;
1999         case RTE_CRYPTO_CIPHER_NULL:
2000         case RTE_CRYPTO_CIPHER_SNOW3G_UEA2:
2001         case RTE_CRYPTO_CIPHER_3DES_ECB:
2002         case RTE_CRYPTO_CIPHER_AES_ECB:
2003         case RTE_CRYPTO_CIPHER_KASUMI_F8:
2004                 DPAA_SEC_ERR("Crypto: Unsupported Cipher alg %u",
2005                         cipher_xform->algo);
2006                 goto out;
2007         default:
2008                 DPAA_SEC_ERR("Crypto: Undefined Cipher specified %u",
2009                         cipher_xform->algo);
2010                 goto out;
2011         }
2012
2013         if (ipsec_xform->direction == RTE_SECURITY_IPSEC_SA_DIR_EGRESS) {
2014                 memset(&session->encap_pdb, 0, sizeof(struct ipsec_encap_pdb) +
2015                                 sizeof(session->ip4_hdr));
2016                 session->ip4_hdr.ip_v = IPVERSION;
2017                 session->ip4_hdr.ip_hl = 5;
2018                 session->ip4_hdr.ip_len = rte_cpu_to_be_16(
2019                                                 sizeof(session->ip4_hdr));
2020                 session->ip4_hdr.ip_tos = ipsec_xform->tunnel.ipv4.dscp;
2021                 session->ip4_hdr.ip_id = 0;
2022                 session->ip4_hdr.ip_off = 0;
2023                 session->ip4_hdr.ip_ttl = ipsec_xform->tunnel.ipv4.ttl;
2024                 session->ip4_hdr.ip_p = (ipsec_xform->proto ==
2025                                 RTE_SECURITY_IPSEC_SA_PROTO_ESP) ? IPPROTO_ESP
2026                                 : IPPROTO_AH;
2027                 session->ip4_hdr.ip_sum = 0;
2028                 session->ip4_hdr.ip_src = ipsec_xform->tunnel.ipv4.src_ip;
2029                 session->ip4_hdr.ip_dst = ipsec_xform->tunnel.ipv4.dst_ip;
2030                 session->ip4_hdr.ip_sum = calc_chksum((uint16_t *)
2031                                                 (void *)&session->ip4_hdr,
2032                                                 sizeof(struct ip));
2033
2034                 session->encap_pdb.options =
2035                         (IPVERSION << PDBNH_ESP_ENCAP_SHIFT) |
2036                         PDBOPTS_ESP_OIHI_PDB_INL |
2037                         PDBOPTS_ESP_IVSRC |
2038                         PDBHMO_ESP_ENCAP_DTTL;
2039                 session->encap_pdb.spi = ipsec_xform->spi;
2040                 session->encap_pdb.ip_hdr_len = sizeof(struct ip);
2041
2042                 session->dir = DIR_ENC;
2043         } else if (ipsec_xform->direction ==
2044                         RTE_SECURITY_IPSEC_SA_DIR_INGRESS) {
2045                 memset(&session->decap_pdb, 0, sizeof(struct ipsec_decap_pdb));
2046                 session->decap_pdb.options = sizeof(struct ip) << 16;
2047                 session->dir = DIR_DEC;
2048         } else
2049                 goto out;
2050         session->ctx_pool = internals->ctx_pool;
2051         session->inq = dpaa_sec_attach_rxq(internals);
2052         if (session->inq == NULL) {
2053                 DPAA_SEC_ERR("unable to attach sec queue");
2054                 goto out;
2055         }
2056
2057
2058         return 0;
2059 out:
2060         rte_free(session->auth_key.data);
2061         rte_free(session->cipher_key.data);
2062         memset(session, 0, sizeof(dpaa_sec_session));
2063         return -1;
2064 }
2065
2066 static int
2067 dpaa_sec_security_session_create(void *dev,
2068                                  struct rte_security_session_conf *conf,
2069                                  struct rte_security_session *sess,
2070                                  struct rte_mempool *mempool)
2071 {
2072         void *sess_private_data;
2073         struct rte_cryptodev *cdev = (struct rte_cryptodev *)dev;
2074         int ret;
2075
2076         if (rte_mempool_get(mempool, &sess_private_data)) {
2077                 DPAA_SEC_ERR("Couldn't get object from session mempool");
2078                 return -ENOMEM;
2079         }
2080
2081         switch (conf->protocol) {
2082         case RTE_SECURITY_PROTOCOL_IPSEC:
2083                 ret = dpaa_sec_set_ipsec_session(cdev, conf,
2084                                 sess_private_data);
2085                 break;
2086         case RTE_SECURITY_PROTOCOL_MACSEC:
2087                 return -ENOTSUP;
2088         default:
2089                 return -EINVAL;
2090         }
2091         if (ret != 0) {
2092                 DPAA_SEC_ERR("failed to configure session parameters");
2093                 /* Return session to mempool */
2094                 rte_mempool_put(mempool, sess_private_data);
2095                 return ret;
2096         }
2097
2098         set_sec_session_private_data(sess, sess_private_data);
2099
2100         return ret;
2101 }
2102
2103 /** Clear the memory of session so it doesn't leave key material behind */
2104 static int
2105 dpaa_sec_security_session_destroy(void *dev __rte_unused,
2106                 struct rte_security_session *sess)
2107 {
2108         PMD_INIT_FUNC_TRACE();
2109         void *sess_priv = get_sec_session_private_data(sess);
2110
2111         dpaa_sec_session *s = (dpaa_sec_session *)sess_priv;
2112
2113         if (sess_priv) {
2114                 struct rte_mempool *sess_mp = rte_mempool_from_obj(sess_priv);
2115
2116                 rte_free(s->cipher_key.data);
2117                 rte_free(s->auth_key.data);
2118                 memset(sess, 0, sizeof(dpaa_sec_session));
2119                 set_sec_session_private_data(sess, NULL);
2120                 rte_mempool_put(sess_mp, sess_priv);
2121         }
2122         return 0;
2123 }
2124
2125
2126 static int
2127 dpaa_sec_dev_configure(struct rte_cryptodev *dev,
2128                        struct rte_cryptodev_config *config __rte_unused)
2129 {
2130
2131         char str[20];
2132         struct dpaa_sec_dev_private *internals;
2133
2134         PMD_INIT_FUNC_TRACE();
2135
2136         internals = dev->data->dev_private;
2137         sprintf(str, "ctx_pool_%d", dev->data->dev_id);
2138         if (!internals->ctx_pool) {
2139                 internals->ctx_pool = rte_mempool_create((const char *)str,
2140                                                         CTX_POOL_NUM_BUFS,
2141                                                         CTX_POOL_BUF_SIZE,
2142                                                         CTX_POOL_CACHE_SIZE, 0,
2143                                                         NULL, NULL, NULL, NULL,
2144                                                         SOCKET_ID_ANY, 0);
2145                 if (!internals->ctx_pool) {
2146                         DPAA_SEC_ERR("%s create failed\n", str);
2147                         return -ENOMEM;
2148                 }
2149         } else
2150                 DPAA_SEC_INFO("mempool already created for dev_id : %d",
2151                                 dev->data->dev_id);
2152
2153         return 0;
2154 }
2155
2156 static int
2157 dpaa_sec_dev_start(struct rte_cryptodev *dev __rte_unused)
2158 {
2159         PMD_INIT_FUNC_TRACE();
2160         return 0;
2161 }
2162
2163 static void
2164 dpaa_sec_dev_stop(struct rte_cryptodev *dev __rte_unused)
2165 {
2166         PMD_INIT_FUNC_TRACE();
2167 }
2168
2169 static int
2170 dpaa_sec_dev_close(struct rte_cryptodev *dev)
2171 {
2172         struct dpaa_sec_dev_private *internals;
2173
2174         PMD_INIT_FUNC_TRACE();
2175
2176         if (dev == NULL)
2177                 return -ENOMEM;
2178
2179         internals = dev->data->dev_private;
2180         rte_mempool_free(internals->ctx_pool);
2181         internals->ctx_pool = NULL;
2182
2183         return 0;
2184 }
2185
2186 static void
2187 dpaa_sec_dev_infos_get(struct rte_cryptodev *dev,
2188                        struct rte_cryptodev_info *info)
2189 {
2190         struct dpaa_sec_dev_private *internals = dev->data->dev_private;
2191
2192         PMD_INIT_FUNC_TRACE();
2193         if (info != NULL) {
2194                 info->max_nb_queue_pairs = internals->max_nb_queue_pairs;
2195                 info->feature_flags = dev->feature_flags;
2196                 info->capabilities = dpaa_sec_capabilities;
2197                 info->sym.max_nb_sessions = internals->max_nb_sessions;
2198                 info->driver_id = cryptodev_driver_id;
2199         }
2200 }
2201
2202 static struct rte_cryptodev_ops crypto_ops = {
2203         .dev_configure        = dpaa_sec_dev_configure,
2204         .dev_start            = dpaa_sec_dev_start,
2205         .dev_stop             = dpaa_sec_dev_stop,
2206         .dev_close            = dpaa_sec_dev_close,
2207         .dev_infos_get        = dpaa_sec_dev_infos_get,
2208         .queue_pair_setup     = dpaa_sec_queue_pair_setup,
2209         .queue_pair_release   = dpaa_sec_queue_pair_release,
2210         .queue_pair_count     = dpaa_sec_queue_pair_count,
2211         .session_get_size     = dpaa_sec_session_get_size,
2212         .session_configure    = dpaa_sec_session_configure,
2213         .session_clear        = dpaa_sec_session_clear,
2214         .qp_attach_session    = dpaa_sec_qp_attach_sess,
2215         .qp_detach_session    = dpaa_sec_qp_detach_sess,
2216 };
2217
2218 static const struct rte_security_capability *
2219 dpaa_sec_capabilities_get(void *device __rte_unused)
2220 {
2221         return dpaa_sec_security_cap;
2222 }
2223
2224 struct rte_security_ops dpaa_sec_security_ops = {
2225         .session_create = dpaa_sec_security_session_create,
2226         .session_update = NULL,
2227         .session_stats_get = NULL,
2228         .session_destroy = dpaa_sec_security_session_destroy,
2229         .set_pkt_metadata = NULL,
2230         .capabilities_get = dpaa_sec_capabilities_get
2231 };
2232
2233 static int
2234 dpaa_sec_uninit(struct rte_cryptodev *dev)
2235 {
2236         struct dpaa_sec_dev_private *internals;
2237
2238         if (dev == NULL)
2239                 return -ENODEV;
2240
2241         internals = dev->data->dev_private;
2242         rte_free(dev->security_ctx);
2243
2244         /* In case close has been called, internals->ctx_pool would be NULL */
2245         rte_mempool_free(internals->ctx_pool);
2246         rte_free(internals);
2247
2248         DPAA_SEC_INFO("Closing DPAA_SEC device %s on numa socket %u",
2249                       dev->data->name, rte_socket_id());
2250
2251         return 0;
2252 }
2253
2254 static int
2255 dpaa_sec_dev_init(struct rte_cryptodev *cryptodev)
2256 {
2257         struct dpaa_sec_dev_private *internals;
2258         struct rte_security_ctx *security_instance;
2259         struct dpaa_sec_qp *qp;
2260         uint32_t i, flags;
2261         int ret;
2262
2263         PMD_INIT_FUNC_TRACE();
2264
2265         cryptodev->driver_id = cryptodev_driver_id;
2266         cryptodev->dev_ops = &crypto_ops;
2267
2268         cryptodev->enqueue_burst = dpaa_sec_enqueue_burst;
2269         cryptodev->dequeue_burst = dpaa_sec_dequeue_burst;
2270         cryptodev->feature_flags = RTE_CRYPTODEV_FF_SYMMETRIC_CRYPTO |
2271                         RTE_CRYPTODEV_FF_HW_ACCELERATED |
2272                         RTE_CRYPTODEV_FF_SYM_OPERATION_CHAINING |
2273                         RTE_CRYPTODEV_FF_SECURITY |
2274                         RTE_CRYPTODEV_FF_MBUF_SCATTER_GATHER;
2275
2276         internals = cryptodev->data->dev_private;
2277         internals->max_nb_queue_pairs = RTE_DPAA_MAX_NB_SEC_QPS;
2278         internals->max_nb_sessions = RTE_DPAA_SEC_PMD_MAX_NB_SESSIONS;
2279
2280         /*
2281          * For secondary processes, we don't initialise any further as primary
2282          * has already done this work. Only check we don't need a different
2283          * RX function
2284          */
2285         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
2286                 DPAA_SEC_WARN("Device already init by primary process");
2287                 return 0;
2288         }
2289
2290         /* Initialize security_ctx only for primary process*/
2291         security_instance = rte_malloc("rte_security_instances_ops",
2292                                 sizeof(struct rte_security_ctx), 0);
2293         if (security_instance == NULL)
2294                 return -ENOMEM;
2295         security_instance->device = (void *)cryptodev;
2296         security_instance->ops = &dpaa_sec_security_ops;
2297         security_instance->sess_cnt = 0;
2298         cryptodev->security_ctx = security_instance;
2299
2300         for (i = 0; i < internals->max_nb_queue_pairs; i++) {
2301                 /* init qman fq for queue pair */
2302                 qp = &internals->qps[i];
2303                 ret = dpaa_sec_init_tx(&qp->outq);
2304                 if (ret) {
2305                         DPAA_SEC_ERR("config tx of queue pair  %d", i);
2306                         goto init_error;
2307                 }
2308         }
2309
2310         flags = QMAN_FQ_FLAG_LOCKED | QMAN_FQ_FLAG_DYNAMIC_FQID |
2311                 QMAN_FQ_FLAG_TO_DCPORTAL;
2312         for (i = 0; i < internals->max_nb_sessions; i++) {
2313                 /* create rx qman fq for sessions*/
2314                 ret = qman_create_fq(0, flags, &internals->inq[i]);
2315                 if (unlikely(ret != 0)) {
2316                         DPAA_SEC_ERR("sec qman_create_fq failed");
2317                         goto init_error;
2318                 }
2319         }
2320
2321         RTE_LOG(INFO, PMD, "%s cryptodev init\n", cryptodev->data->name);
2322         return 0;
2323
2324 init_error:
2325         DPAA_SEC_ERR("driver %s: create failed\n", cryptodev->data->name);
2326
2327         dpaa_sec_uninit(cryptodev);
2328         return -EFAULT;
2329 }
2330
2331 static int
2332 cryptodev_dpaa_sec_probe(struct rte_dpaa_driver *dpaa_drv,
2333                                 struct rte_dpaa_device *dpaa_dev)
2334 {
2335         struct rte_cryptodev *cryptodev;
2336         char cryptodev_name[RTE_CRYPTODEV_NAME_MAX_LEN];
2337
2338         int retval;
2339
2340         sprintf(cryptodev_name, "dpaa_sec-%d", dpaa_dev->id.dev_id);
2341
2342         cryptodev = rte_cryptodev_pmd_allocate(cryptodev_name, rte_socket_id());
2343         if (cryptodev == NULL)
2344                 return -ENOMEM;
2345
2346         if (rte_eal_process_type() == RTE_PROC_PRIMARY) {
2347                 cryptodev->data->dev_private = rte_zmalloc_socket(
2348                                         "cryptodev private structure",
2349                                         sizeof(struct dpaa_sec_dev_private),
2350                                         RTE_CACHE_LINE_SIZE,
2351                                         rte_socket_id());
2352
2353                 if (cryptodev->data->dev_private == NULL)
2354                         rte_panic("Cannot allocate memzone for private "
2355                                         "device data");
2356         }
2357
2358         dpaa_dev->crypto_dev = cryptodev;
2359         cryptodev->device = &dpaa_dev->device;
2360         cryptodev->device->driver = &dpaa_drv->driver;
2361
2362         /* init user callbacks */
2363         TAILQ_INIT(&(cryptodev->link_intr_cbs));
2364
2365         /* if sec device version is not configured */
2366         if (!rta_get_sec_era()) {
2367                 const struct device_node *caam_node;
2368
2369                 for_each_compatible_node(caam_node, NULL, "fsl,sec-v4.0") {
2370                         const uint32_t *prop = of_get_property(caam_node,
2371                                         "fsl,sec-era",
2372                                         NULL);
2373                         if (prop) {
2374                                 rta_set_sec_era(
2375                                         INTL_SEC_ERA(rte_cpu_to_be_32(*prop)));
2376                                 break;
2377                         }
2378                 }
2379         }
2380
2381         /* Invoke PMD device initialization function */
2382         retval = dpaa_sec_dev_init(cryptodev);
2383         if (retval == 0)
2384                 return 0;
2385
2386         /* In case of error, cleanup is done */
2387         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
2388                 rte_free(cryptodev->data->dev_private);
2389
2390         rte_cryptodev_pmd_release_device(cryptodev);
2391
2392         return -ENXIO;
2393 }
2394
2395 static int
2396 cryptodev_dpaa_sec_remove(struct rte_dpaa_device *dpaa_dev)
2397 {
2398         struct rte_cryptodev *cryptodev;
2399         int ret;
2400
2401         cryptodev = dpaa_dev->crypto_dev;
2402         if (cryptodev == NULL)
2403                 return -ENODEV;
2404
2405         ret = dpaa_sec_uninit(cryptodev);
2406         if (ret)
2407                 return ret;
2408
2409         return rte_cryptodev_pmd_destroy(cryptodev);
2410 }
2411
2412 static struct rte_dpaa_driver rte_dpaa_sec_driver = {
2413         .drv_type = FSL_DPAA_CRYPTO,
2414         .driver = {
2415                 .name = "DPAA SEC PMD"
2416         },
2417         .probe = cryptodev_dpaa_sec_probe,
2418         .remove = cryptodev_dpaa_sec_remove,
2419 };
2420
2421 static struct cryptodev_driver dpaa_sec_crypto_drv;
2422
2423 RTE_PMD_REGISTER_DPAA(CRYPTODEV_NAME_DPAA_SEC_PMD, rte_dpaa_sec_driver);
2424 RTE_PMD_REGISTER_CRYPTO_DRIVER(dpaa_sec_crypto_drv, rte_dpaa_sec_driver.driver,
2425                 cryptodev_driver_id);
2426
2427 RTE_INIT(dpaa_sec_init_log);
2428 static void
2429 dpaa_sec_init_log(void)
2430 {
2431         dpaa_logtype_sec = rte_log_register("pmd.crypto.dpaa");
2432         if (dpaa_logtype_sec >= 0)
2433                 rte_log_set_level(dpaa_logtype_sec, RTE_LOG_NOTICE);
2434 }