Quelle  chcr_algo.c   Sprache: C

/*
 * This file is part of the Chelsio T6 Crypto driver for Linux.
 *
 * Copyright (c) 2003-2016 Chelsio Communications, Inc. All rights reserved.
 *
 * This software is available to you under a choice of one of two
 * licenses.  You may choose to be licensed under the terms of the GNU
 * General Public License (GPL) Version 2, available from the file
 * COPYING in the main directory of this source tree, or the
 * OpenIB.org BSD license below:
 *
 *     Redistribution and use in source and binary forms, with or
 *     without modification, are permitted provided that the following
 *     conditions are met:
 *
 *      - Redistributions of source code must retain the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer.
 *
 *      - Redistributions in binary form must reproduce the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer in the documentation and/or other materials
 *        provided with the distribution.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 *
 * Written and Maintained by:
 * Manoj Malviya (manojmalviya@chelsio.com)
 * Atul Gupta (atul.gupta@chelsio.com)
 * Jitendra Lulla (jlulla@chelsio.com)
 * Yeshaswi M R Gowda (yeshaswi@chelsio.com)
 * Harsh Jain (harsh@chelsio.com)
 */

#define pr_fmt(fmt) "chcr:" fmt

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/crypto.h>
#include <linux/skbuff.h>
#include <linux/rtnetlink.h>
#include <linux/highmem.h>
#include <linux/scatterlist.h>

#include <crypto/aes.h>
#include <crypto/algapi.h>
#include <crypto/hash.h>
#include <crypto/gcm.h>
#include <crypto/sha1.h>
#include <crypto/sha2.h>
#include <crypto/authenc.h>
#include <crypto/ctr.h>
#include <crypto/gf128mul.h>
#include <crypto/internal/aead.h>
#include <crypto/null.h>
#include <crypto/internal/skcipher.h>
#include <crypto/aead.h>
#include <crypto/scatterwalk.h>
#include <crypto/internal/hash.h>

#include "t4fw_api.h"
#include "t4_msg.h"
#include "chcr_core.h"
#include "chcr_algo.h"
#include "chcr_crypto.h"

#define IV AES_BLOCK_SIZE

static unsigned int sgl_ent_len[] = {
 0, 0, 16, 24, 40, 48, 64, 72, 88,
 96, 112, 120, 136, 144, 160, 168, 184,
 192, 208, 216, 232, 240, 256, 264, 280,
 288, 304, 312, 328, 336, 352, 360, 376
};

static unsigned int dsgl_ent_len[] = {
 0, 32, 32, 48, 48, 64, 64, 80, 80,
 112, 112, 128, 128, 144, 144, 160, 160,
 192, 192, 208, 208, 224, 224, 240, 240,
 272, 272, 288, 288, 304, 304, 320, 320
};

static u32 round_constant[11] = {
 0x01000000, 0x02000000, 0x04000000, 0x08000000,
 0x10000000, 0x20000000, 0x40000000, 0x80000000,
 0x1B000000, 0x36000000, 0x6C000000
};

static int chcr_handle_cipher_resp(struct skcipher_request *req,
       unsigned char *input, int err);

static inline  struct chcr_aead_ctx *AEAD_CTX(struct chcr_context *ctx)
{
 return &ctx->crypto_ctx->aeadctx;
}

static inline struct ablk_ctx *ABLK_CTX(struct chcr_context *ctx)
{
 return &ctx->crypto_ctx->ablkctx;
}

static inline struct hmac_ctx *HMAC_CTX(struct chcr_context *ctx)
{
 return &ctx->crypto_ctx->hmacctx;
}

static inline struct chcr_gcm_ctx *GCM_CTX(struct chcr_aead_ctx *gctx)
{
 return gctx->ctx->gcm;
}

static inline struct chcr_authenc_ctx *AUTHENC_CTX(struct chcr_aead_ctx *gctx)
{
 return gctx->ctx->authenc;
}

static inline struct uld_ctx *ULD_CTX(struct chcr_context *ctx)
{
 return container_of(ctx->dev, struct uld_ctx, dev);
}

static inline void chcr_init_hctx_per_wr(struct chcr_ahash_req_ctx *reqctx)
{
 memset(&reqctx->hctx_wr, 0, sizeof(struct chcr_hctx_per_wr));
}

static int sg_nents_xlen(struct scatterlist *sg, unsigned int reqlen,
    unsigned int entlen,
    unsigned int skip)
{
 int nents = 0;
 unsigned int less;
 unsigned int skip_len = 0;

 while (sg && skip) {
  if (sg_dma_len(sg) <= skip) {
   skip -= sg_dma_len(sg);
   skip_len = 0;
   sg = sg_next(sg);
  } else {
   skip_len = skip;
   skip = 0;
  }
 }

 while (sg && reqlen) {
  less = min(reqlen, sg_dma_len(sg) - skip_len);
  nents += DIV_ROUND_UP(less, entlen);
  reqlen -= less;
  skip_len = 0;
  sg = sg_next(sg);
 }
 return nents;
}

static inline int get_aead_subtype(struct crypto_aead *aead)
{
 struct aead_alg *alg = crypto_aead_alg(aead);
 struct chcr_alg_template *chcr_crypto_alg =
  container_of(alg, struct chcr_alg_template, alg.aead);
 return chcr_crypto_alg->type & CRYPTO_ALG_SUB_TYPE_MASK;
}

void chcr_verify_tag(struct aead_request *req, u8 *input, int *err)
{
 u8 temp[SHA512_DIGEST_SIZE];
 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
 int authsize = crypto_aead_authsize(tfm);
 struct cpl_fw6_pld *fw6_pld;
 int cmp = 0;

 fw6_pld = (struct cpl_fw6_pld *)input;
 if ((get_aead_subtype(tfm) == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106) ||
     (get_aead_subtype(tfm) == CRYPTO_ALG_SUB_TYPE_AEAD_GCM)) {
  cmp = crypto_memneq(&fw6_pld->data[2], (fw6_pld + 1), authsize);
 } else {

  sg_pcopy_to_buffer(req->src, sg_nents(req->src), temp,
    authsize, req->assoclen +
    req->cryptlen - authsize);
  cmp = crypto_memneq(temp, (fw6_pld + 1), authsize);
 }
 if (cmp)
  *err = -EBADMSG;
 else
  *err = 0;
}

static int chcr_inc_wrcount(struct chcr_dev *dev)
{
 if (dev->state == CHCR_DETACH)
  return 1;
 atomic_inc(&dev->inflight);
 return 0;
}

static inline void chcr_dec_wrcount(struct chcr_dev *dev)
{
 atomic_dec(&dev->inflight);
}

static inline int chcr_handle_aead_resp(struct aead_request *req,
      unsigned char *input,
      int err)
{
 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
 struct chcr_dev *dev = a_ctx(tfm)->dev;

 chcr_aead_common_exit(req);
 if (reqctx->verify == VERIFY_SW) {
  chcr_verify_tag(req, input, &err);
  reqctx->verify = VERIFY_HW;
 }
 chcr_dec_wrcount(dev);
 aead_request_complete(req, err);

 return err;
}

static void get_aes_decrypt_key(unsigned char *dec_key,
           const unsigned char *key,
           unsigned int keylength)
{
 u32 temp;
 u32 w_ring[MAX_NK];
 int i, j, k;
 u8  nr, nk;

 switch (keylength) {
 case AES_KEYLENGTH_128BIT:
  nk = KEYLENGTH_4BYTES;
  nr = NUMBER_OF_ROUNDS_10;
  break;
 case AES_KEYLENGTH_192BIT:
  nk = KEYLENGTH_6BYTES;
  nr = NUMBER_OF_ROUNDS_12;
  break;
 case AES_KEYLENGTH_256BIT:
  nk = KEYLENGTH_8BYTES;
  nr = NUMBER_OF_ROUNDS_14;
  break;
 default:
  return;
 }
 for (i = 0; i < nk; i++)
  w_ring[i] = get_unaligned_be32(&key[i * 4]);

 i = 0;
 temp = w_ring[nk - 1];
 while (i + nk < (nr + 1) * 4) {
  if (!(i % nk)) {
   /* RotWord(temp) */
   temp = (temp << 8) | (temp >> 24);
   temp = aes_ks_subword(temp);
   temp ^= round_constant[i / nk];
  } else if (nk == 8 && (i % 4 == 0)) {
   temp = aes_ks_subword(temp);
  }
  w_ring[i % nk] ^= temp;
  temp = w_ring[i % nk];
  i++;
 }
 i--;
 for (k = 0, j = i % nk; k < nk; k++) {
  put_unaligned_be32(w_ring[j], &dec_key[k * 4]);
  j--;
  if (j < 0)
   j += nk;
 }
}

static struct crypto_shash *chcr_alloc_shash(unsigned int ds)
{
 struct crypto_shash *base_hash = ERR_PTR(-EINVAL);

 switch (ds) {
 case SHA1_DIGEST_SIZE:
  base_hash = crypto_alloc_shash("sha1", 0, 0);
  break;
 case SHA224_DIGEST_SIZE:
  base_hash = crypto_alloc_shash("sha224", 0, 0);
  break;
 case SHA256_DIGEST_SIZE:
  base_hash = crypto_alloc_shash("sha256", 0, 0);
  break;
 case SHA384_DIGEST_SIZE:
  base_hash = crypto_alloc_shash("sha384", 0, 0);
  break;
 case SHA512_DIGEST_SIZE:
  base_hash = crypto_alloc_shash("sha512", 0, 0);
  break;
 }

 return base_hash;
}

static int chcr_compute_partial_hash(struct shash_desc *desc,
         char *iopad, char *result_hash,
         int digest_size)
{
 struct sha1_state sha1_st;
 struct sha256_state sha256_st;
 struct sha512_state sha512_st;
 int error;

 if (digest_size == SHA1_DIGEST_SIZE) {
  error = crypto_shash_init(desc) ?:
   crypto_shash_update(desc, iopad, SHA1_BLOCK_SIZE) ?:
   crypto_shash_export_core(desc, &sha1_st);
  memcpy(result_hash, sha1_st.state, SHA1_DIGEST_SIZE);
 } else if (digest_size == SHA224_DIGEST_SIZE) {
  error = crypto_shash_init(desc) ?:
   crypto_shash_update(desc, iopad, SHA256_BLOCK_SIZE) ?:
   crypto_shash_export_core(desc, &sha256_st);
  memcpy(result_hash, sha256_st.state, SHA256_DIGEST_SIZE);

 } else if (digest_size == SHA256_DIGEST_SIZE) {
  error = crypto_shash_init(desc) ?:
   crypto_shash_update(desc, iopad, SHA256_BLOCK_SIZE) ?:
   crypto_shash_export_core(desc, &sha256_st);
  memcpy(result_hash, sha256_st.state, SHA256_DIGEST_SIZE);

 } else if (digest_size == SHA384_DIGEST_SIZE) {
  error = crypto_shash_init(desc) ?:
   crypto_shash_update(desc, iopad, SHA512_BLOCK_SIZE) ?:
   crypto_shash_export_core(desc, &sha512_st);
  memcpy(result_hash, sha512_st.state, SHA512_DIGEST_SIZE);

 } else if (digest_size == SHA512_DIGEST_SIZE) {
  error = crypto_shash_init(desc) ?:
   crypto_shash_update(desc, iopad, SHA512_BLOCK_SIZE) ?:
   crypto_shash_export_core(desc, &sha512_st);
  memcpy(result_hash, sha512_st.state, SHA512_DIGEST_SIZE);
 } else {
  error = -EINVAL;
  pr_err("Unknown digest size %d\n", digest_size);
 }
 return error;
}

static void chcr_change_order(char *buf, int ds)
{
 int i;

 if (ds == SHA512_DIGEST_SIZE) {
  for (i = 0; i < (ds / sizeof(u64)); i++)
   *((__be64 *)buf + i) =
    cpu_to_be64(*((u64 *)buf + i));
 } else {
  for (i = 0; i < (ds / sizeof(u32)); i++)
   *((__be32 *)buf + i) =
    cpu_to_be32(*((u32 *)buf + i));
 }
}

static inline int is_hmac(struct crypto_tfm *tfm)
{
 struct crypto_alg *alg = tfm->__crt_alg;
 struct chcr_alg_template *chcr_crypto_alg =
  container_of(__crypto_ahash_alg(alg), struct chcr_alg_template,
        alg.hash);
 if (chcr_crypto_alg->type == CRYPTO_ALG_TYPE_HMAC)
  return 1;
 return 0;
}

static inline void dsgl_walk_init(struct dsgl_walk *walk,
       struct cpl_rx_phys_dsgl *dsgl)
{
 walk->dsgl = dsgl;
 walk->nents = 0;
 walk->to = (struct phys_sge_pairs *)(dsgl + 1);
}

static inline void dsgl_walk_end(struct dsgl_walk *walk, unsigned short qid,
     int pci_chan_id)
{
 struct cpl_rx_phys_dsgl *phys_cpl;

 phys_cpl = walk->dsgl;

 phys_cpl->op_to_tid = htonl(CPL_RX_PHYS_DSGL_OPCODE_V(CPL_RX_PHYS_DSGL)
        | CPL_RX_PHYS_DSGL_ISRDMA_V(0));
 phys_cpl->pcirlxorder_to_noofsgentr =
  htonl(CPL_RX_PHYS_DSGL_PCIRLXORDER_V(0) |
        CPL_RX_PHYS_DSGL_PCINOSNOOP_V(0) |
        CPL_RX_PHYS_DSGL_PCITPHNTENB_V(0) |
        CPL_RX_PHYS_DSGL_PCITPHNT_V(0) |
        CPL_RX_PHYS_DSGL_DCAID_V(0) |
        CPL_RX_PHYS_DSGL_NOOFSGENTR_V(walk->nents));
 phys_cpl->rss_hdr_int.opcode = CPL_RX_PHYS_ADDR;
 phys_cpl->rss_hdr_int.qid = htons(qid);
 phys_cpl->rss_hdr_int.hash_val = 0;
 phys_cpl->rss_hdr_int.channel = pci_chan_id;
}

static inline void dsgl_walk_add_page(struct dsgl_walk *walk,
     size_t size,
     dma_addr_t addr)
{
 int j;

 if (!size)
  return;
 j = walk->nents;
 walk->to->len[j % 8] = htons(size);
 walk->to->addr[j % 8] = cpu_to_be64(addr);
 j++;
 if ((j % 8) == 0)
  walk->to++;
 walk->nents = j;
}

static void  dsgl_walk_add_sg(struct dsgl_walk *walk,
      struct scatterlist *sg,
         unsigned int slen,
         unsigned int skip)
{
 int skip_len = 0;
 unsigned int left_size = slen, len = 0;
 unsigned int j = walk->nents;
 int offset, ent_len;

 if (!slen)
  return;
 while (sg && skip) {
  if (sg_dma_len(sg) <= skip) {
   skip -= sg_dma_len(sg);
   skip_len = 0;
   sg = sg_next(sg);
  } else {
   skip_len = skip;
   skip = 0;
  }
 }

 while (left_size && sg) {
  len = min_t(u32, left_size, sg_dma_len(sg) - skip_len);
  offset = 0;
  while (len) {
   ent_len =  min_t(u32, len, CHCR_DST_SG_SIZE);
   walk->to->len[j % 8] = htons(ent_len);
   walk->to->addr[j % 8] = cpu_to_be64(sg_dma_address(sg) +
            offset + skip_len);
   offset += ent_len;
   len -= ent_len;
   j++;
   if ((j % 8) == 0)
    walk->to++;
  }
  walk->last_sg = sg;
  walk->last_sg_len = min_t(u32, left_size, sg_dma_len(sg) -
       skip_len) + skip_len;
  left_size -= min_t(u32, left_size, sg_dma_len(sg) - skip_len);
  skip_len = 0;
  sg = sg_next(sg);
 }
 walk->nents = j;
}

static inline void ulptx_walk_init(struct ulptx_walk *walk,
       struct ulptx_sgl *ulp)
{
 walk->sgl = ulp;
 walk->nents = 0;
 walk->pair_idx = 0;
 walk->pair = ulp->sge;
 walk->last_sg = NULL;
 walk->last_sg_len = 0;
}

static inline void ulptx_walk_end(struct ulptx_walk *walk)
{
 walk->sgl->cmd_nsge = htonl(ULPTX_CMD_V(ULP_TX_SC_DSGL) |
         ULPTX_NSGE_V(walk->nents));
}


static inline void ulptx_walk_add_page(struct ulptx_walk *walk,
     size_t size,
     dma_addr_t addr)
{
 if (!size)
  return;

 if (walk->nents == 0) {
  walk->sgl->len0 = cpu_to_be32(size);
  walk->sgl->addr0 = cpu_to_be64(addr);
 } else {
  walk->pair->addr[walk->pair_idx] = cpu_to_be64(addr);
  walk->pair->len[walk->pair_idx] = cpu_to_be32(size);
  walk->pair_idx = !walk->pair_idx;
  if (!walk->pair_idx)
   walk->pair++;
 }
 walk->nents++;
}

static void  ulptx_walk_add_sg(struct ulptx_walk *walk,
     struct scatterlist *sg,
          unsigned int len,
          unsigned int skip)
{
 int small;
 int skip_len = 0;
 unsigned int sgmin;

 if (!len)
  return;
 while (sg && skip) {
  if (sg_dma_len(sg) <= skip) {
   skip -= sg_dma_len(sg);
   skip_len = 0;
   sg = sg_next(sg);
  } else {
   skip_len = skip;
   skip = 0;
  }
 }
 WARN(!sg, "SG should not be null here\n");
 if (sg && (walk->nents == 0)) {
  small = min_t(unsigned int, sg_dma_len(sg) - skip_len, len);
  sgmin = min_t(unsigned int, small, CHCR_SRC_SG_SIZE);
  walk->sgl->len0 = cpu_to_be32(sgmin);
  walk->sgl->addr0 = cpu_to_be64(sg_dma_address(sg) + skip_len);
  walk->nents++;
  len -= sgmin;
  walk->last_sg = sg;
  walk->last_sg_len = sgmin + skip_len;
  skip_len += sgmin;
  if (sg_dma_len(sg) == skip_len) {
   sg = sg_next(sg);
   skip_len = 0;
  }
 }

 while (sg && len) {
  small = min(sg_dma_len(sg) - skip_len, len);
  sgmin = min_t(unsigned int, small, CHCR_SRC_SG_SIZE);
  walk->pair->len[walk->pair_idx] = cpu_to_be32(sgmin);
  walk->pair->addr[walk->pair_idx] =
   cpu_to_be64(sg_dma_address(sg) + skip_len);
  walk->pair_idx = !walk->pair_idx;
  walk->nents++;
  if (!walk->pair_idx)
   walk->pair++;
  len -= sgmin;
  skip_len += sgmin;
  walk->last_sg = sg;
  walk->last_sg_len = skip_len;
  if (sg_dma_len(sg) == skip_len) {
   sg = sg_next(sg);
   skip_len = 0;
  }
 }
}

static inline int get_cryptoalg_subtype(struct crypto_skcipher *tfm)
{
 struct skcipher_alg *alg = crypto_skcipher_alg(tfm);
 struct chcr_alg_template *chcr_crypto_alg =
  container_of(alg, struct chcr_alg_template, alg.skcipher);

 return chcr_crypto_alg->type & CRYPTO_ALG_SUB_TYPE_MASK;
}

static int cxgb4_is_crypto_q_full(struct net_device *dev, unsigned int idx)
{
 struct adapter *adap = netdev2adap(dev);
 struct sge_uld_txq_info *txq_info =
  adap->sge.uld_txq_info[CXGB4_TX_CRYPTO];
 struct sge_uld_txq *txq;
 int ret = 0;

 local_bh_disable();
 txq = &txq_info->uldtxq[idx];
 spin_lock(&txq->sendq.lock);
 if (txq->full)
  ret = -1;
 spin_unlock(&txq->sendq.lock);
 local_bh_enable();
 return ret;
}

static int generate_copy_rrkey(struct ablk_ctx *ablkctx,
          struct _key_ctx *key_ctx)
{
 if (ablkctx->ciph_mode == CHCR_SCMD_CIPHER_MODE_AES_CBC) {
  memcpy(key_ctx->key, ablkctx->rrkey, ablkctx->enckey_len);
 } else {
  memcpy(key_ctx->key,
         ablkctx->key + (ablkctx->enckey_len >> 1),
         ablkctx->enckey_len >> 1);
  memcpy(key_ctx->key + (ablkctx->enckey_len >> 1),
         ablkctx->rrkey, ablkctx->enckey_len >> 1);
 }
 return 0;
}

static int chcr_hash_ent_in_wr(struct scatterlist *src,
        unsigned int minsg,
        unsigned int space,
        unsigned int srcskip)
{
 int srclen = 0;
 int srcsg = minsg;
 int soffset = 0, sless;

 if (sg_dma_len(src) == srcskip) {
  src = sg_next(src);
  srcskip = 0;
 }
 while (src && space > (sgl_ent_len[srcsg + 1])) {
  sless = min_t(unsigned int, sg_dma_len(src) - soffset - srcskip,
       CHCR_SRC_SG_SIZE);
  srclen += sless;
  soffset += sless;
  srcsg++;
  if (sg_dma_len(src) == (soffset + srcskip)) {
   src = sg_next(src);
   soffset = 0;
   srcskip = 0;
  }
 }
 return srclen;
}

static int chcr_sg_ent_in_wr(struct scatterlist *src,
        struct scatterlist *dst,
        unsigned int minsg,
        unsigned int space,
        unsigned int srcskip,
        unsigned int dstskip)
{
 int srclen = 0, dstlen = 0;
 int srcsg = minsg, dstsg = minsg;
 int offset = 0, soffset = 0, less, sless = 0;

 if (sg_dma_len(src) == srcskip) {
  src = sg_next(src);
  srcskip = 0;
 }
 if (sg_dma_len(dst) == dstskip) {
  dst = sg_next(dst);
  dstskip = 0;
 }

 while (src && dst &&
        space > (sgl_ent_len[srcsg + 1] + dsgl_ent_len[dstsg])) {
  sless = min_t(unsigned int, sg_dma_len(src) - srcskip - soffset,
    CHCR_SRC_SG_SIZE);
  srclen += sless;
  srcsg++;
  offset = 0;
  while (dst && ((dstsg + 1) <= MAX_DSGL_ENT) &&
         space > (sgl_ent_len[srcsg] + dsgl_ent_len[dstsg + 1])) {
   if (srclen <= dstlen)
    break;
   less = min_t(unsigned int, sg_dma_len(dst) - offset -
         dstskip, CHCR_DST_SG_SIZE);
   dstlen += less;
   offset += less;
   if ((offset + dstskip) == sg_dma_len(dst)) {
    dst = sg_next(dst);
    offset = 0;
   }
   dstsg++;
   dstskip = 0;
  }
  soffset += sless;
  if ((soffset + srcskip) == sg_dma_len(src)) {
   src = sg_next(src);
   srcskip = 0;
   soffset = 0;
  }

 }
 return min(srclen, dstlen);
}

static int chcr_cipher_fallback(struct crypto_skcipher *cipher,
    struct skcipher_request *req,
    u8 *iv,
    unsigned short op_type)
{
 struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
 int err;

 skcipher_request_set_tfm(&reqctx->fallback_req, cipher);
 skcipher_request_set_callback(&reqctx->fallback_req, req->base.flags,
          req->base.complete, req->base.data);
 skcipher_request_set_crypt(&reqctx->fallback_req, req->src, req->dst,
       req->cryptlen, iv);

 err = op_type ? crypto_skcipher_decrypt(&reqctx->fallback_req) :
   crypto_skcipher_encrypt(&reqctx->fallback_req);

 return err;

}

static inline int get_qidxs(struct crypto_async_request *req,
       unsigned int *txqidx, unsigned int *rxqidx)
{
 struct crypto_tfm *tfm = req->tfm;
 int ret = 0;

 switch (tfm->__crt_alg->cra_flags & CRYPTO_ALG_TYPE_MASK) {
 case CRYPTO_ALG_TYPE_AEAD:
 {
  struct aead_request *aead_req =
   container_of(req, struct aead_request, base);
  struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(aead_req);
  *txqidx = reqctx->txqidx;
  *rxqidx = reqctx->rxqidx;
  break;
 }
 case CRYPTO_ALG_TYPE_SKCIPHER:
 {
  struct skcipher_request *sk_req =
   container_of(req, struct skcipher_request, base);
  struct chcr_skcipher_req_ctx *reqctx =
   skcipher_request_ctx(sk_req);
  *txqidx = reqctx->txqidx;
  *rxqidx = reqctx->rxqidx;
  break;
 }
 case CRYPTO_ALG_TYPE_AHASH:
 {
  struct ahash_request *ahash_req =
   container_of(req, struct ahash_request, base);
  struct chcr_ahash_req_ctx *reqctx =
   ahash_request_ctx(ahash_req);
  *txqidx = reqctx->txqidx;
  *rxqidx = reqctx->rxqidx;
  break;
 }
 default:
  ret = -EINVAL;
  /* should never get here */
  BUG();
  break;
 }
 return ret;
}

static inline void create_wreq(struct chcr_context *ctx,
          struct chcr_wr *chcr_req,
          struct crypto_async_request *req,
          unsigned int imm,
          int hash_sz,
          unsigned int len16,
          unsigned int sc_len,
          unsigned int lcb)
{
 struct uld_ctx *u_ctx = ULD_CTX(ctx);
 unsigned int tx_channel_id, rx_channel_id;
 unsigned int txqidx = 0, rxqidx = 0;
 unsigned int qid, fid, portno;

 get_qidxs(req, &txqidx, &rxqidx);
 qid = u_ctx->lldi.rxq_ids[rxqidx];
 fid = u_ctx->lldi.rxq_ids[0];
 portno = rxqidx / ctx->rxq_perchan;
 tx_channel_id = txqidx / ctx->txq_perchan;
 rx_channel_id = cxgb4_port_e2cchan(u_ctx->lldi.ports[portno]);


 chcr_req->wreq.op_to_cctx_size = FILL_WR_OP_CCTX_SIZE;
 chcr_req->wreq.pld_size_hash_size =
  htonl(FW_CRYPTO_LOOKASIDE_WR_HASH_SIZE_V(hash_sz));
 chcr_req->wreq.len16_pkd =
  htonl(FW_CRYPTO_LOOKASIDE_WR_LEN16_V(DIV_ROUND_UP(len16, 16)));
 chcr_req->wreq.cookie = cpu_to_be64((uintptr_t)req);
 chcr_req->wreq.rx_chid_to_rx_q_id = FILL_WR_RX_Q_ID(rx_channel_id, qid,
           !!lcb, txqidx);

 chcr_req->ulptx.cmd_dest = FILL_ULPTX_CMD_DEST(tx_channel_id, fid);
 chcr_req->ulptx.len = htonl((DIV_ROUND_UP(len16, 16) -
    ((sizeof(chcr_req->wreq)) >> 4)));
 chcr_req->sc_imm.cmd_more = FILL_CMD_MORE(!imm);
 chcr_req->sc_imm.len = cpu_to_be32(sizeof(struct cpl_tx_sec_pdu) +
        sizeof(chcr_req->key_ctx) + sc_len);
}

/**
 * create_cipher_wr - form the WR for cipher operations
 * @wrparam: Container for create_cipher_wr()'s parameters
 */
static struct sk_buff *create_cipher_wr(struct cipher_wr_param *wrparam)
{
 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(wrparam->req);
 struct chcr_context *ctx = c_ctx(tfm);
 struct uld_ctx *u_ctx = ULD_CTX(ctx);
 struct ablk_ctx *ablkctx = ABLK_CTX(ctx);
 struct sk_buff *skb = NULL;
 struct chcr_wr *chcr_req;
 struct cpl_rx_phys_dsgl *phys_cpl;
 struct ulptx_sgl *ulptx;
 struct chcr_skcipher_req_ctx *reqctx =
  skcipher_request_ctx(wrparam->req);
 unsigned int temp = 0, transhdr_len, dst_size;
 int error;
 int nents;
 unsigned int kctx_len;
 gfp_t flags = wrparam->req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP ?
   GFP_KERNEL : GFP_ATOMIC;
 struct adapter *adap = padap(ctx->dev);
 unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;

 rx_channel_id = cxgb4_port_e2cchan(u_ctx->lldi.ports[rx_channel_id]);
 nents = sg_nents_xlen(reqctx->dstsg,  wrparam->bytes, CHCR_DST_SG_SIZE,
         reqctx->dst_ofst);
 dst_size = get_space_for_phys_dsgl(nents);
 kctx_len = roundup(ablkctx->enckey_len, 16);
 transhdr_len = CIPHER_TRANSHDR_SIZE(kctx_len, dst_size);
 nents = sg_nents_xlen(reqctx->srcsg, wrparam->bytes,
      CHCR_SRC_SG_SIZE, reqctx->src_ofst);
 temp = reqctx->imm ? roundup(wrparam->bytes, 16) :
         (sgl_len(nents) * 8);
 transhdr_len += temp;
 transhdr_len = roundup(transhdr_len, 16);
 skb = alloc_skb(SGE_MAX_WR_LEN, flags);
 if (!skb) {
  error = -ENOMEM;
  goto err;
 }
 chcr_req = __skb_put_zero(skb, transhdr_len);
 chcr_req->sec_cpl.op_ivinsrtofst =
   FILL_SEC_CPL_OP_IVINSR(rx_channel_id, 2, 1);

 chcr_req->sec_cpl.pldlen = htonl(IV + wrparam->bytes);
 chcr_req->sec_cpl.aadstart_cipherstop_hi =
   FILL_SEC_CPL_CIPHERSTOP_HI(0, 0, IV + 1, 0);

 chcr_req->sec_cpl.cipherstop_lo_authinsert =
   FILL_SEC_CPL_AUTHINSERT(0, 0, 0, 0);
 chcr_req->sec_cpl.seqno_numivs = FILL_SEC_CPL_SCMD0_SEQNO(reqctx->op, 0,
        ablkctx->ciph_mode,
        0, 0, IV >> 1);
 chcr_req->sec_cpl.ivgen_hdrlen = FILL_SEC_CPL_IVGEN_HDRLEN(0, 0, 0,
         0, 1, dst_size);

 chcr_req->key_ctx.ctx_hdr = ablkctx->key_ctx_hdr;
 if ((reqctx->op == CHCR_DECRYPT_OP) &&
     (!(get_cryptoalg_subtype(tfm) ==
        CRYPTO_ALG_SUB_TYPE_CTR)) &&
     (!(get_cryptoalg_subtype(tfm) ==
        CRYPTO_ALG_SUB_TYPE_CTR_RFC3686))) {
  generate_copy_rrkey(ablkctx, &chcr_req->key_ctx);
 } else {
  if ((ablkctx->ciph_mode == CHCR_SCMD_CIPHER_MODE_AES_CBC) ||
      (ablkctx->ciph_mode == CHCR_SCMD_CIPHER_MODE_AES_CTR)) {
   memcpy(chcr_req->key_ctx.key, ablkctx->key,
          ablkctx->enckey_len);
  } else {
   memcpy(chcr_req->key_ctx.key, ablkctx->key +
          (ablkctx->enckey_len >> 1),
          ablkctx->enckey_len >> 1);
   memcpy(chcr_req->key_ctx.key +
          (ablkctx->enckey_len >> 1),
          ablkctx->key,
          ablkctx->enckey_len >> 1);
  }
 }
 phys_cpl = (struct cpl_rx_phys_dsgl *)((u8 *)(chcr_req + 1) + kctx_len);
 ulptx = (struct ulptx_sgl *)((u8 *)(phys_cpl + 1) + dst_size);
 chcr_add_cipher_src_ent(wrparam->req, ulptx, wrparam);
 chcr_add_cipher_dst_ent(wrparam->req, phys_cpl, wrparam, wrparam->qid);

 atomic_inc(&adap->chcr_stats.cipher_rqst);
 temp = sizeof(struct cpl_rx_phys_dsgl) + dst_size + kctx_len + IV
  + (reqctx->imm ? (wrparam->bytes) : 0);
 create_wreq(c_ctx(tfm), chcr_req, &(wrparam->req->base), reqctx->imm, 0,
      transhdr_len, temp,
   ablkctx->ciph_mode == CHCR_SCMD_CIPHER_MODE_AES_CBC);
 reqctx->skb = skb;

 if (reqctx->op && (ablkctx->ciph_mode ==
      CHCR_SCMD_CIPHER_MODE_AES_CBC))
  sg_pcopy_to_buffer(wrparam->req->src,
   sg_nents(wrparam->req->src), wrparam->req->iv, 16,
   reqctx->processed + wrparam->bytes - AES_BLOCK_SIZE);

 return skb;
err:
 return ERR_PTR(error);
}

static inline int chcr_keyctx_ck_size(unsigned int keylen)
{
 int ck_size = 0;

 if (keylen == AES_KEYSIZE_128)
  ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_128;
 else if (keylen == AES_KEYSIZE_192)
  ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_192;
 else if (keylen == AES_KEYSIZE_256)
  ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_256;
 else
  ck_size = 0;

 return ck_size;
}
static int chcr_cipher_fallback_setkey(struct crypto_skcipher *cipher,
           const u8 *key,
           unsigned int keylen)
{
 struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));

 crypto_skcipher_clear_flags(ablkctx->sw_cipher,
    CRYPTO_TFM_REQ_MASK);
 crypto_skcipher_set_flags(ablkctx->sw_cipher,
    cipher->base.crt_flags & CRYPTO_TFM_REQ_MASK);
 return crypto_skcipher_setkey(ablkctx->sw_cipher, key, keylen);
}

static int chcr_aes_cbc_setkey(struct crypto_skcipher *cipher,
          const u8 *key,
          unsigned int keylen)
{
 struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));
 unsigned int ck_size, context_size;
 u16 alignment = 0;
 int err;

 err = chcr_cipher_fallback_setkey(cipher, key, keylen);
 if (err)
  goto badkey_err;

 ck_size = chcr_keyctx_ck_size(keylen);
 alignment = ck_size == CHCR_KEYCTX_CIPHER_KEY_SIZE_192 ? 8 : 0;
 memcpy(ablkctx->key, key, keylen);
 ablkctx->enckey_len = keylen;
 get_aes_decrypt_key(ablkctx->rrkey, ablkctx->key, keylen << 3);
 context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD +
   keylen + alignment) >> 4;

 ablkctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, CHCR_KEYCTX_NO_KEY,
      0, 0, context_size);
 ablkctx->ciph_mode = CHCR_SCMD_CIPHER_MODE_AES_CBC;
 return 0;
badkey_err:
 ablkctx->enckey_len = 0;

 return err;
}

static int chcr_aes_ctr_setkey(struct crypto_skcipher *cipher,
       const u8 *key,
       unsigned int keylen)
{
 struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));
 unsigned int ck_size, context_size;
 u16 alignment = 0;
 int err;

 err = chcr_cipher_fallback_setkey(cipher, key, keylen);
 if (err)
  goto badkey_err;
 ck_size = chcr_keyctx_ck_size(keylen);
 alignment = (ck_size == CHCR_KEYCTX_CIPHER_KEY_SIZE_192) ? 8 : 0;
 memcpy(ablkctx->key, key, keylen);
 ablkctx->enckey_len = keylen;
 context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD +
   keylen + alignment) >> 4;

 ablkctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, CHCR_KEYCTX_NO_KEY,
      0, 0, context_size);
 ablkctx->ciph_mode = CHCR_SCMD_CIPHER_MODE_AES_CTR;

 return 0;
badkey_err:
 ablkctx->enckey_len = 0;

 return err;
}

static int chcr_aes_rfc3686_setkey(struct crypto_skcipher *cipher,
       const u8 *key,
       unsigned int keylen)
{
 struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));
 unsigned int ck_size, context_size;
 u16 alignment = 0;
 int err;

 if (keylen < CTR_RFC3686_NONCE_SIZE)
  return -EINVAL;
 memcpy(ablkctx->nonce, key + (keylen - CTR_RFC3686_NONCE_SIZE),
        CTR_RFC3686_NONCE_SIZE);

 keylen -= CTR_RFC3686_NONCE_SIZE;
 err = chcr_cipher_fallback_setkey(cipher, key, keylen);
 if (err)
  goto badkey_err;

 ck_size = chcr_keyctx_ck_size(keylen);
 alignment = (ck_size == CHCR_KEYCTX_CIPHER_KEY_SIZE_192) ? 8 : 0;
 memcpy(ablkctx->key, key, keylen);
 ablkctx->enckey_len = keylen;
 context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD +
   keylen + alignment) >> 4;

 ablkctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, CHCR_KEYCTX_NO_KEY,
      0, 0, context_size);
 ablkctx->ciph_mode = CHCR_SCMD_CIPHER_MODE_AES_CTR;

 return 0;
badkey_err:
 ablkctx->enckey_len = 0;

 return err;
}
static void ctr_add_iv(u8 *dstiv, u8 *srciv, u32 add)
{
 unsigned int size = AES_BLOCK_SIZE;
 __be32 *b = (__be32 *)(dstiv + size);
 u32 c, prev;

 memcpy(dstiv, srciv, AES_BLOCK_SIZE);
 for (; size >= 4; size -= 4) {
  prev = be32_to_cpu(*--b);
  c = prev + add;
  *b = cpu_to_be32(c);
  if (prev < c)
   break;
  add = 1;
 }

}

static unsigned int adjust_ctr_overflow(u8 *iv, u32 bytes)
{
 __be32 *b = (__be32 *)(iv + AES_BLOCK_SIZE);
 u64 c;
 u32 temp = be32_to_cpu(*--b);

 temp = ~temp;
 c = (u64)temp +  1; // No of block can processed without overflow
 if ((bytes / AES_BLOCK_SIZE) >= c)
  bytes = c * AES_BLOCK_SIZE;
 return bytes;
}

static int chcr_update_tweak(struct skcipher_request *req, u8 *iv,
        u32 isfinal)
{
 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
 struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(tfm));
 struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
 struct crypto_aes_ctx aes;
 int ret, i;
 u8 *key;
 unsigned int keylen;
 int round = reqctx->last_req_len / AES_BLOCK_SIZE;
 int round8 = round / 8;

 memcpy(iv, reqctx->iv, AES_BLOCK_SIZE);

 keylen = ablkctx->enckey_len / 2;
 key = ablkctx->key + keylen;
 /* For a 192 bit key remove the padded zeroes which was
 * added in chcr_xts_setkey
 */
 if (KEY_CONTEXT_CK_SIZE_G(ntohl(ablkctx->key_ctx_hdr))
   == CHCR_KEYCTX_CIPHER_KEY_SIZE_192)
  ret = aes_expandkey(&aes, key, keylen - 8);
 else
  ret = aes_expandkey(&aes, key, keylen);
 if (ret)
  return ret;
 aes_encrypt(&aes, iv, iv);
 for (i = 0; i < round8; i++)
  gf128mul_x8_ble((le128 *)iv, (le128 *)iv);

 for (i = 0; i < (round % 8); i++)
  gf128mul_x_ble((le128 *)iv, (le128 *)iv);

 if (!isfinal)
  aes_decrypt(&aes, iv, iv);

 memzero_explicit(&aes, sizeof(aes));
 return 0;
}

static int chcr_update_cipher_iv(struct skcipher_request *req,
       struct cpl_fw6_pld *fw6_pld, u8 *iv)
{
 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
 struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
 int subtype = get_cryptoalg_subtype(tfm);
 int ret = 0;

 if (subtype == CRYPTO_ALG_SUB_TYPE_CTR)
  ctr_add_iv(iv, req->iv, (reqctx->processed /
      AES_BLOCK_SIZE));
 else if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_RFC3686)
  *(__be32 *)(reqctx->iv + CTR_RFC3686_NONCE_SIZE +
   CTR_RFC3686_IV_SIZE) = cpu_to_be32((reqctx->processed /
      AES_BLOCK_SIZE) + 1);
 else if (subtype == CRYPTO_ALG_SUB_TYPE_XTS)
  ret = chcr_update_tweak(req, iv, 0);
 else if (subtype == CRYPTO_ALG_SUB_TYPE_CBC) {
  if (reqctx->op)
   /*Updated before sending last WR*/
   memcpy(iv, req->iv, AES_BLOCK_SIZE);
  else
   memcpy(iv, &fw6_pld->data[2], AES_BLOCK_SIZE);
 }

 return ret;

}

/* We need separate function for final iv because in rfc3686  Initial counter
 * starts from 1 and buffer size of iv is 8 byte only which remains constant
 * for subsequent update requests
 */

static int chcr_final_cipher_iv(struct skcipher_request *req,
       struct cpl_fw6_pld *fw6_pld, u8 *iv)
{
 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
 struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
 int subtype = get_cryptoalg_subtype(tfm);
 int ret = 0;

 if (subtype == CRYPTO_ALG_SUB_TYPE_CTR)
  ctr_add_iv(iv, req->iv, DIV_ROUND_UP(reqctx->processed,
             AES_BLOCK_SIZE));
 else if (subtype == CRYPTO_ALG_SUB_TYPE_XTS) {
  if (!reqctx->partial_req)
   memcpy(iv, reqctx->iv, AES_BLOCK_SIZE);
  else
   ret = chcr_update_tweak(req, iv, 1);
 }
 else if (subtype == CRYPTO_ALG_SUB_TYPE_CBC) {
  /*Already updated for Decrypt*/
  if (!reqctx->op)
   memcpy(iv, &fw6_pld->data[2], AES_BLOCK_SIZE);

 }
 return ret;

}

static int chcr_handle_cipher_resp(struct skcipher_request *req,
       unsigned char *input, int err)
{
 struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
 struct cpl_fw6_pld *fw6_pld = (struct cpl_fw6_pld *)input;
 struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(tfm));
 struct uld_ctx *u_ctx = ULD_CTX(c_ctx(tfm));
 struct chcr_dev *dev = c_ctx(tfm)->dev;
 struct chcr_context *ctx = c_ctx(tfm);
 struct adapter *adap = padap(ctx->dev);
 struct cipher_wr_param wrparam;
 struct sk_buff *skb;
 int bytes;

 if (err)
  goto unmap;
 if (req->cryptlen == reqctx->processed) {
  chcr_cipher_dma_unmap(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev,
          req);
  err = chcr_final_cipher_iv(req, fw6_pld, req->iv);
  goto complete;
 }

 if (!reqctx->imm) {
  bytes = chcr_sg_ent_in_wr(reqctx->srcsg, reqctx->dstsg, 0,
       CIP_SPACE_LEFT(ablkctx->enckey_len),
       reqctx->src_ofst, reqctx->dst_ofst);
  if ((bytes + reqctx->processed) >= req->cryptlen)
   bytes  = req->cryptlen - reqctx->processed;
  else
   bytes = rounddown(bytes, 16);
 } else {
  /*CTR mode counter overflow*/
  bytes  = req->cryptlen - reqctx->processed;
 }
 err = chcr_update_cipher_iv(req, fw6_pld, reqctx->iv);
 if (err)
  goto unmap;

 if (unlikely(bytes == 0)) {
  chcr_cipher_dma_unmap(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev,
          req);
  memcpy(req->iv, reqctx->init_iv, IV);
  atomic_inc(&adap->chcr_stats.fallback);
  err = chcr_cipher_fallback(ablkctx->sw_cipher, req, req->iv,
        reqctx->op);
  goto complete;
 }

 if (get_cryptoalg_subtype(tfm) ==
     CRYPTO_ALG_SUB_TYPE_CTR)
  bytes = adjust_ctr_overflow(reqctx->iv, bytes);
 wrparam.qid = u_ctx->lldi.rxq_ids[reqctx->rxqidx];
 wrparam.req = req;
 wrparam.bytes = bytes;
 skb = create_cipher_wr(&wrparam);
 if (IS_ERR(skb)) {
  pr_err("%s : Failed to form WR. No memory\n", __func__);
  err = PTR_ERR(skb);
  goto unmap;
 }
 skb->dev = u_ctx->lldi.ports[0];
 set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
 chcr_send_wr(skb);
 reqctx->last_req_len = bytes;
 reqctx->processed += bytes;
 if (get_cryptoalg_subtype(tfm) ==
  CRYPTO_ALG_SUB_TYPE_CBC && req->base.flags ==
   CRYPTO_TFM_REQ_MAY_SLEEP ) {
  complete(&ctx->cbc_aes_aio_done);
 }
 return 0;
unmap:
 chcr_cipher_dma_unmap(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev, req);
complete:
 if (get_cryptoalg_subtype(tfm) ==
  CRYPTO_ALG_SUB_TYPE_CBC && req->base.flags ==
   CRYPTO_TFM_REQ_MAY_SLEEP ) {
  complete(&ctx->cbc_aes_aio_done);
 }
 chcr_dec_wrcount(dev);
 skcipher_request_complete(req, err);
 return err;
}

static int process_cipher(struct skcipher_request *req,
      unsigned short qid,
      struct sk_buff **skb,
      unsigned short op_type)
{
 struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
 unsigned int ivsize = crypto_skcipher_ivsize(tfm);
 struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(tfm));
 struct adapter *adap = padap(c_ctx(tfm)->dev);
 struct cipher_wr_param wrparam;
 int bytes, err = -EINVAL;
 int subtype;

 reqctx->processed = 0;
 reqctx->partial_req = 0;
 if (!req->iv)
  goto error;
 subtype = get_cryptoalg_subtype(tfm);
 if ((ablkctx->enckey_len == 0) || (ivsize > AES_BLOCK_SIZE) ||
     (req->cryptlen == 0) ||
     (req->cryptlen % crypto_skcipher_blocksize(tfm))) {
  if (req->cryptlen == 0 && subtype != CRYPTO_ALG_SUB_TYPE_XTS)
   goto fallback;
  else if (req->cryptlen % crypto_skcipher_blocksize(tfm) &&
    subtype == CRYPTO_ALG_SUB_TYPE_XTS)
   goto fallback;
  pr_err("AES: Invalid value of Key Len %d nbytes %d IV Len %d\n",
         ablkctx->enckey_len, req->cryptlen, ivsize);
  goto error;
 }

 err = chcr_cipher_dma_map(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev, req);
 if (err)
  goto error;
 if (req->cryptlen < (SGE_MAX_WR_LEN - (sizeof(struct chcr_wr) +
         AES_MIN_KEY_SIZE +
         sizeof(struct cpl_rx_phys_dsgl) +
     /*Min dsgl size*/
         32))) {
  /* Can be sent as Imm*/
  unsigned int dnents = 0, transhdr_len, phys_dsgl, kctx_len;

  dnents = sg_nents_xlen(req->dst, req->cryptlen,
           CHCR_DST_SG_SIZE, 0);
  phys_dsgl = get_space_for_phys_dsgl(dnents);
  kctx_len = roundup(ablkctx->enckey_len, 16);
  transhdr_len = CIPHER_TRANSHDR_SIZE(kctx_len, phys_dsgl);
  reqctx->imm = (transhdr_len + IV + req->cryptlen) <=
   SGE_MAX_WR_LEN;
  bytes = IV + req->cryptlen;

 } else {
  reqctx->imm = 0;
 }

 if (!reqctx->imm) {
  bytes = chcr_sg_ent_in_wr(req->src, req->dst, 0,
       CIP_SPACE_LEFT(ablkctx->enckey_len),
       0, 0);
  if ((bytes + reqctx->processed) >= req->cryptlen)
   bytes  = req->cryptlen - reqctx->processed;
  else
   bytes = rounddown(bytes, 16);
 } else {
  bytes = req->cryptlen;
 }
 if (subtype == CRYPTO_ALG_SUB_TYPE_CTR) {
  bytes = adjust_ctr_overflow(req->iv, bytes);
 }
 if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_RFC3686) {
  memcpy(reqctx->iv, ablkctx->nonce, CTR_RFC3686_NONCE_SIZE);
  memcpy(reqctx->iv + CTR_RFC3686_NONCE_SIZE, req->iv,
    CTR_RFC3686_IV_SIZE);

  /* initialize counter portion of counter block */
  *(__be32 *)(reqctx->iv + CTR_RFC3686_NONCE_SIZE +
   CTR_RFC3686_IV_SIZE) = cpu_to_be32(1);
  memcpy(reqctx->init_iv, reqctx->iv, IV);

 } else {

  memcpy(reqctx->iv, req->iv, IV);
  memcpy(reqctx->init_iv, req->iv, IV);
 }
 if (unlikely(bytes == 0)) {
  chcr_cipher_dma_unmap(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev,
          req);
fallback:       atomic_inc(&adap->chcr_stats.fallback);
  err = chcr_cipher_fallback(ablkctx->sw_cipher, req,
        subtype ==
        CRYPTO_ALG_SUB_TYPE_CTR_RFC3686 ?
        reqctx->iv : req->iv,
        op_type);
  goto error;
 }
 reqctx->op = op_type;
 reqctx->srcsg = req->src;
 reqctx->dstsg = req->dst;
 reqctx->src_ofst = 0;
 reqctx->dst_ofst = 0;
 wrparam.qid = qid;
 wrparam.req = req;
 wrparam.bytes = bytes;
 *skb = create_cipher_wr(&wrparam);
 if (IS_ERR(*skb)) {
  err = PTR_ERR(*skb);
  goto unmap;
 }
 reqctx->processed = bytes;
 reqctx->last_req_len = bytes;
 reqctx->partial_req = !!(req->cryptlen - reqctx->processed);

 return 0;
unmap:
 chcr_cipher_dma_unmap(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev, req);
error:
 return err;
}

static int chcr_aes_encrypt(struct skcipher_request *req)
{
 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
 struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
 struct chcr_dev *dev = c_ctx(tfm)->dev;
 struct sk_buff *skb = NULL;
 int err;
 struct uld_ctx *u_ctx = ULD_CTX(c_ctx(tfm));
 struct chcr_context *ctx = c_ctx(tfm);
 unsigned int cpu;

 cpu = get_cpu();
 reqctx->txqidx = cpu % ctx->ntxq;
 reqctx->rxqidx = cpu % ctx->nrxq;
 put_cpu();

 err = chcr_inc_wrcount(dev);
 if (err)
  return -ENXIO;
 if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
      reqctx->txqidx) &&
  (!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG)))) {
   err = -ENOSPC;
   goto error;
 }

 err = process_cipher(req, u_ctx->lldi.rxq_ids[reqctx->rxqidx],
        &skb, CHCR_ENCRYPT_OP);
 if (err || !skb)
  return  err;
 skb->dev = u_ctx->lldi.ports[0];
 set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
 chcr_send_wr(skb);
 if (get_cryptoalg_subtype(tfm) ==
  CRYPTO_ALG_SUB_TYPE_CBC && req->base.flags ==
   CRYPTO_TFM_REQ_MAY_SLEEP ) {
   reqctx->partial_req = 1;
   wait_for_completion(&ctx->cbc_aes_aio_done);
        }
 return -EINPROGRESS;
error:
 chcr_dec_wrcount(dev);
 return err;
}

static int chcr_aes_decrypt(struct skcipher_request *req)
{
 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
 struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
 struct uld_ctx *u_ctx = ULD_CTX(c_ctx(tfm));
 struct chcr_dev *dev = c_ctx(tfm)->dev;
 struct sk_buff *skb = NULL;
 int err;
 struct chcr_context *ctx = c_ctx(tfm);
 unsigned int cpu;

 cpu = get_cpu();
 reqctx->txqidx = cpu % ctx->ntxq;
 reqctx->rxqidx = cpu % ctx->nrxq;
 put_cpu();

 err = chcr_inc_wrcount(dev);
 if (err)
  return -ENXIO;

 if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
      reqctx->txqidx) &&
  (!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG))))
   return -ENOSPC;
 err = process_cipher(req, u_ctx->lldi.rxq_ids[reqctx->rxqidx],
        &skb, CHCR_DECRYPT_OP);
 if (err || !skb)
  return err;
 skb->dev = u_ctx->lldi.ports[0];
 set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
 chcr_send_wr(skb);
 return -EINPROGRESS;
}
static int chcr_device_init(struct chcr_context *ctx)
{
 struct uld_ctx *u_ctx = NULL;
 int txq_perchan, ntxq;
 int err = 0, rxq_perchan;

 if (!ctx->dev) {
  u_ctx = assign_chcr_device();
  if (!u_ctx) {
   err = -ENXIO;
   pr_err("chcr device assignment fails\n");
   goto out;
  }
  ctx->dev = &u_ctx->dev;
  ntxq = u_ctx->lldi.ntxq;
  rxq_perchan = u_ctx->lldi.nrxq / u_ctx->lldi.nchan;
  txq_perchan = ntxq / u_ctx->lldi.nchan;
  ctx->ntxq = ntxq;
  ctx->nrxq = u_ctx->lldi.nrxq;
  ctx->rxq_perchan = rxq_perchan;
  ctx->txq_perchan = txq_perchan;
 }
out:
 return err;
}

static int chcr_init_tfm(struct crypto_skcipher *tfm)
{
 struct skcipher_alg *alg = crypto_skcipher_alg(tfm);
 struct chcr_context *ctx = crypto_skcipher_ctx(tfm);
 struct ablk_ctx *ablkctx = ABLK_CTX(ctx);

 ablkctx->sw_cipher = crypto_alloc_skcipher(alg->base.cra_name, 0,
    CRYPTO_ALG_NEED_FALLBACK);
 if (IS_ERR(ablkctx->sw_cipher)) {
  pr_err("failed to allocate fallback for %s\n", alg->base.cra_name);
  return PTR_ERR(ablkctx->sw_cipher);
 }
 init_completion(&ctx->cbc_aes_aio_done);
 crypto_skcipher_set_reqsize(tfm, sizeof(struct chcr_skcipher_req_ctx) +
      crypto_skcipher_reqsize(ablkctx->sw_cipher));

 return chcr_device_init(ctx);
}

static int chcr_rfc3686_init(struct crypto_skcipher *tfm)
{
 struct skcipher_alg *alg = crypto_skcipher_alg(tfm);
 struct chcr_context *ctx = crypto_skcipher_ctx(tfm);
 struct ablk_ctx *ablkctx = ABLK_CTX(ctx);

 /*RFC3686 initialises IV counter value to 1, rfc3686(ctr(aes))
 * cannot be used as fallback in chcr_handle_cipher_response
 */
 ablkctx->sw_cipher = crypto_alloc_skcipher("ctr(aes)", 0,
    CRYPTO_ALG_NEED_FALLBACK);
 if (IS_ERR(ablkctx->sw_cipher)) {
  pr_err("failed to allocate fallback for %s\n", alg->base.cra_name);
  return PTR_ERR(ablkctx->sw_cipher);
 }
 crypto_skcipher_set_reqsize(tfm, sizeof(struct chcr_skcipher_req_ctx) +
        crypto_skcipher_reqsize(ablkctx->sw_cipher));
 return chcr_device_init(ctx);
}


static void chcr_exit_tfm(struct crypto_skcipher *tfm)
{
 struct chcr_context *ctx = crypto_skcipher_ctx(tfm);
 struct ablk_ctx *ablkctx = ABLK_CTX(ctx);

 crypto_free_skcipher(ablkctx->sw_cipher);
}

static int get_alg_config(struct algo_param *params,
     unsigned int auth_size)
{
 switch (auth_size) {
 case SHA1_DIGEST_SIZE:
  params->mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_160;
  params->auth_mode = CHCR_SCMD_AUTH_MODE_SHA1;
  params->result_size = SHA1_DIGEST_SIZE;
  break;
 case SHA224_DIGEST_SIZE:
  params->mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_256;
  params->auth_mode = CHCR_SCMD_AUTH_MODE_SHA224;
  params->result_size = SHA256_DIGEST_SIZE;
  break;
 case SHA256_DIGEST_SIZE:
  params->mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_256;
  params->auth_mode = CHCR_SCMD_AUTH_MODE_SHA256;
  params->result_size = SHA256_DIGEST_SIZE;
  break;
 case SHA384_DIGEST_SIZE:
  params->mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_512;
  params->auth_mode = CHCR_SCMD_AUTH_MODE_SHA512_384;
  params->result_size = SHA512_DIGEST_SIZE;
  break;
 case SHA512_DIGEST_SIZE:
  params->mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_512;
  params->auth_mode = CHCR_SCMD_AUTH_MODE_SHA512_512;
  params->result_size = SHA512_DIGEST_SIZE;
  break;
 default:
  pr_err("ERROR, unsupported digest size\n");
  return -EINVAL;
 }
 return 0;
}

static inline void chcr_free_shash(struct crypto_shash *base_hash)
{
  crypto_free_shash(base_hash);
}

/**
 * create_hash_wr - Create hash work request
 * @req: Cipher req base
 * @param: Container for create_hash_wr()'s parameters
 */
static struct sk_buff *create_hash_wr(struct ahash_request *req,
          struct hash_wr_param *param)
{
 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
 struct crypto_ahash *tfm = crypto_ahash_reqtfm(req);
 struct chcr_context *ctx = h_ctx(tfm);
 struct hmac_ctx *hmacctx = HMAC_CTX(ctx);
 struct sk_buff *skb = NULL;
 struct uld_ctx *u_ctx = ULD_CTX(ctx);
 struct chcr_wr *chcr_req;
 struct ulptx_sgl *ulptx;
 unsigned int nents = 0, transhdr_len;
 unsigned int temp = 0;
 gfp_t flags = req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP ? GFP_KERNEL :
  GFP_ATOMIC;
 struct adapter *adap = padap(h_ctx(tfm)->dev);
 int error = 0;
 unsigned int rx_channel_id = req_ctx->rxqidx / ctx->rxq_perchan;

 rx_channel_id = cxgb4_port_e2cchan(u_ctx->lldi.ports[rx_channel_id]);
 transhdr_len = HASH_TRANSHDR_SIZE(param->kctx_len);
 req_ctx->hctx_wr.imm = (transhdr_len + param->bfr_len +
    param->sg_len) <= SGE_MAX_WR_LEN;
 nents = sg_nents_xlen(req_ctx->hctx_wr.srcsg, param->sg_len,
        CHCR_SRC_SG_SIZE, req_ctx->hctx_wr.src_ofst);
 nents += param->bfr_len ? 1 : 0;
 transhdr_len += req_ctx->hctx_wr.imm ? roundup(param->bfr_len +
    param->sg_len, 16) : (sgl_len(nents) * 8);
 transhdr_len = roundup(transhdr_len, 16);

 skb = alloc_skb(transhdr_len, flags);
 if (!skb)
  return ERR_PTR(-ENOMEM);
 chcr_req = __skb_put_zero(skb, transhdr_len);

 chcr_req->sec_cpl.op_ivinsrtofst =
  FILL_SEC_CPL_OP_IVINSR(rx_channel_id, 2, 0);

 chcr_req->sec_cpl.pldlen = htonl(param->bfr_len + param->sg_len);

 chcr_req->sec_cpl.aadstart_cipherstop_hi =
  FILL_SEC_CPL_CIPHERSTOP_HI(0, 0, 0, 0);
 chcr_req->sec_cpl.cipherstop_lo_authinsert =
  FILL_SEC_CPL_AUTHINSERT(0, 1, 0, 0);
 chcr_req->sec_cpl.seqno_numivs =
  FILL_SEC_CPL_SCMD0_SEQNO(0, 0, 0, param->alg_prm.auth_mode,
      param->opad_needed, 0);

 chcr_req->sec_cpl.ivgen_hdrlen =
  FILL_SEC_CPL_IVGEN_HDRLEN(param->last, param->more, 0, 1, 0, 0);

 memcpy(chcr_req->key_ctx.key, req_ctx->partial_hash,
        param->alg_prm.result_size);

 if (param->opad_needed)
  memcpy(chcr_req->key_ctx.key +
         ((param->alg_prm.result_size <= 32) ? 32 :
   CHCR_HASH_MAX_DIGEST_SIZE),
         hmacctx->opad, param->alg_prm.result_size);

 chcr_req->key_ctx.ctx_hdr = FILL_KEY_CTX_HDR(CHCR_KEYCTX_NO_KEY,
         param->alg_prm.mk_size, 0,
         param->opad_needed,
         ((param->kctx_len +
          sizeof(chcr_req->key_ctx)) >> 4));
 chcr_req->sec_cpl.scmd1 = cpu_to_be64((u64)param->scmd1);
 ulptx = (struct ulptx_sgl *)((u8 *)(chcr_req + 1) + param->kctx_len +
         DUMMY_BYTES);
 if (param->bfr_len != 0) {
  req_ctx->hctx_wr.dma_addr =
   dma_map_single(&u_ctx->lldi.pdev->dev, req_ctx->reqbfr,
           param->bfr_len, DMA_TO_DEVICE);
  if (dma_mapping_error(&u_ctx->lldi.pdev->dev,
           req_ctx->hctx_wr. dma_addr)) {
   error = -ENOMEM;
   goto err;
  }
  req_ctx->hctx_wr.dma_len = param->bfr_len;
 } else {
  req_ctx->hctx_wr.dma_addr = 0;
 }
 chcr_add_hash_src_ent(req, ulptx, param);
 /* Request upto max wr size */
 temp = param->kctx_len + DUMMY_BYTES + (req_ctx->hctx_wr.imm ?
    (param->sg_len + param->bfr_len) : 0);
 atomic_inc(&adap->chcr_stats.digest_rqst);
 create_wreq(h_ctx(tfm), chcr_req, &req->base, req_ctx->hctx_wr.imm,
      param->hash_size, transhdr_len,
      temp,  0);
 req_ctx->hctx_wr.skb = skb;
 return skb;
err:
 kfree_skb(skb);
 return  ERR_PTR(error);
}

static int chcr_ahash_update(struct ahash_request *req)
{
 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
 struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
 struct uld_ctx *u_ctx = ULD_CTX(h_ctx(rtfm));
 struct chcr_context *ctx = h_ctx(rtfm);
 struct chcr_dev *dev = h_ctx(rtfm)->dev;
 struct sk_buff *skb;
 u8 remainder = 0, bs;
 unsigned int nbytes = req->nbytes;
 struct hash_wr_param params;
 int error;
 unsigned int cpu;

 cpu = get_cpu();
 req_ctx->txqidx = cpu % ctx->ntxq;
 req_ctx->rxqidx = cpu % ctx->nrxq;
 put_cpu();

 bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));

 if (nbytes + req_ctx->reqlen >= bs) {
  remainder = (nbytes + req_ctx->reqlen) % bs;
  nbytes = nbytes + req_ctx->reqlen - remainder;
 } else {
  sg_pcopy_to_buffer(req->src, sg_nents(req->src), req_ctx->reqbfr
       + req_ctx->reqlen, nbytes, 0);
  req_ctx->reqlen += nbytes;
  return 0;
 }
 error = chcr_inc_wrcount(dev);
 if (error)
  return -ENXIO;
 /* Detach state for CHCR means lldi or padap is freed. Increasing
 * inflight count for dev guarantees that lldi and padap is valid
 */
 if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
      req_ctx->txqidx) &&
  (!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG)))) {
   error = -ENOSPC;
   goto err;
 }

 chcr_init_hctx_per_wr(req_ctx);
 error = chcr_hash_dma_map(&u_ctx->lldi.pdev->dev, req);
 if (error) {
  error = -ENOMEM;
  goto err;
 }
 get_alg_config(¶ms.alg_prm, crypto_ahash_digestsize(rtfm));
 params.kctx_len = roundup(params.alg_prm.result_size, 16);
 params.sg_len = chcr_hash_ent_in_wr(req->src, !!req_ctx->reqlen,
         HASH_SPACE_LEFT(params.kctx_len), 0);
 if (params.sg_len > req->nbytes)
  params.sg_len = req->nbytes;
 params.sg_len = rounddown(params.sg_len + req_ctx->reqlen, bs) -
   req_ctx->reqlen;
 params.opad_needed = 0;
 params.more = 1;
 params.last = 0;
 params.bfr_len = req_ctx->reqlen;
 params.scmd1 = 0;
 req_ctx->hctx_wr.srcsg = req->src;

 params.hash_size = params.alg_prm.result_size;
 req_ctx->data_len += params.sg_len + params.bfr_len;
 skb = create_hash_wr(req, ¶ms);
 if (IS_ERR(skb)) {
  error = PTR_ERR(skb);
  goto unmap;
 }

 req_ctx->hctx_wr.processed += params.sg_len;
 if (remainder) {
  /* Swap buffers */
  swap(req_ctx->reqbfr, req_ctx->skbfr);
  sg_pcopy_to_buffer(req->src, sg_nents(req->src),
       req_ctx->reqbfr, remainder, req->nbytes -
       remainder);
 }
 req_ctx->reqlen = remainder;
 skb->dev = u_ctx->lldi.ports[0];
 set_wr_txq(skb, CPL_PRIORITY_DATA, req_ctx->txqidx);
 chcr_send_wr(skb);
 return -EINPROGRESS;
unmap:
 chcr_hash_dma_unmap(&u_ctx->lldi.pdev->dev, req);
err:
 chcr_dec_wrcount(dev);
 return error;
}

static void create_last_hash_block(char *bfr_ptr, unsigned int bs, u64 scmd1)
{
 memset(bfr_ptr, 0, bs);
 *bfr_ptr = 0x80;
 if (bs == 64)
  *(__be64 *)(bfr_ptr + 56) = cpu_to_be64(scmd1  << 3);
 else
  *(__be64 *)(bfr_ptr + 120) =  cpu_to_be64(scmd1  << 3);
}

static int chcr_ahash_final(struct ahash_request *req)
{
 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
 struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
 struct chcr_dev *dev = h_ctx(rtfm)->dev;
 struct hash_wr_param params;
 struct sk_buff *skb;
 struct uld_ctx *u_ctx = ULD_CTX(h_ctx(rtfm));
 struct chcr_context *ctx = h_ctx(rtfm);
 u8 bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
 int error;
 unsigned int cpu;

 cpu = get_cpu();
 req_ctx->txqidx = cpu % ctx->ntxq;
 req_ctx->rxqidx = cpu % ctx->nrxq;
 put_cpu();

 error = chcr_inc_wrcount(dev);
 if (error)
  return -ENXIO;

 chcr_init_hctx_per_wr(req_ctx);
 if (is_hmac(crypto_ahash_tfm(rtfm)))
  params.opad_needed = 1;
 else
  params.opad_needed = 0;
 params.sg_len = 0;
 req_ctx->hctx_wr.isfinal = 1;
 get_alg_config(¶ms.alg_prm, crypto_ahash_digestsize(rtfm));
 params.kctx_len = roundup(params.alg_prm.result_size, 16);
 if (is_hmac(crypto_ahash_tfm(rtfm))) {
  params.opad_needed = 1;
  params.kctx_len *= 2;
 } else {
  params.opad_needed = 0;
 }

 req_ctx->hctx_wr.result = 1;
 params.bfr_len = req_ctx->reqlen;
 req_ctx->data_len += params.bfr_len + params.sg_len;
 req_ctx->hctx_wr.srcsg = req->src;
 if (req_ctx->reqlen == 0) {
  create_last_hash_block(req_ctx->reqbfr, bs, req_ctx->data_len);
  params.last = 0;
  params.more = 1;
  params.scmd1 = 0;
  params.bfr_len = bs;

 } else {
  params.scmd1 = req_ctx->data_len;
  params.last = 1;
  params.more = 0;
 }
 params.hash_size = crypto_ahash_digestsize(rtfm);
 skb = create_hash_wr(req, ¶ms);
 if (IS_ERR(skb)) {
  error = PTR_ERR(skb);
  goto err;
 }
 req_ctx->reqlen = 0;
 skb->dev = u_ctx->lldi.ports[0];
 set_wr_txq(skb, CPL_PRIORITY_DATA, req_ctx->txqidx);
 chcr_send_wr(skb);
 return -EINPROGRESS;
err:
 chcr_dec_wrcount(dev);
 return error;
}

static int chcr_ahash_finup(struct ahash_request *req)
{
 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
 struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
 struct chcr_dev *dev = h_ctx(rtfm)->dev;
 struct uld_ctx *u_ctx = ULD_CTX(h_ctx(rtfm));
 struct chcr_context *ctx = h_ctx(rtfm);
 struct sk_buff *skb;
 struct hash_wr_param params;
 u8  bs;
 int error;
 unsigned int cpu;

 cpu = get_cpu();
 req_ctx->txqidx = cpu % ctx->ntxq;
 req_ctx->rxqidx = cpu % ctx->nrxq;
 put_cpu();

 bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
 error = chcr_inc_wrcount(dev);
 if (error)
  return -ENXIO;

 if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
      req_ctx->txqidx) &&
  (!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG)))) {
   error = -ENOSPC;
   goto err;
 }
 chcr_init_hctx_per_wr(req_ctx);
 error = chcr_hash_dma_map(&u_ctx->lldi.pdev->dev, req);
 if (error) {
  error = -ENOMEM;
  goto err;
 }

 get_alg_config(¶ms.alg_prm, crypto_ahash_digestsize(rtfm));
 params.kctx_len = roundup(params.alg_prm.result_size, 16);
 if (is_hmac(crypto_ahash_tfm(rtfm))) {
  params.kctx_len *= 2;
  params.opad_needed = 1;
 } else {
  params.opad_needed = 0;
 }

 params.sg_len = chcr_hash_ent_in_wr(req->src, !!req_ctx->reqlen,
        HASH_SPACE_LEFT(params.kctx_len), 0);
 if (params.sg_len < req->nbytes) {
  if (is_hmac(crypto_ahash_tfm(rtfm))) {
   params.kctx_len /= 2;
   params.opad_needed = 0;
  }
  params.last = 0;
  params.more = 1;
  params.sg_len = rounddown(params.sg_len + req_ctx->reqlen, bs)
     - req_ctx->reqlen;
  params.hash_size = params.alg_prm.result_size;
  params.scmd1 = 0;
 } else {
  params.last = 1;
  params.more = 0;
  params.sg_len = req->nbytes;
  params.hash_size = crypto_ahash_digestsize(rtfm);
  params.scmd1 = req_ctx->data_len + req_ctx->reqlen +
    params.sg_len;
 }
 params.bfr_len = req_ctx->reqlen;
 req_ctx->data_len += params.bfr_len + params.sg_len;
 req_ctx->hctx_wr.result = 1;
 req_ctx->hctx_wr.srcsg = req->src;
 if ((req_ctx->reqlen + req->nbytes) == 0) {
  create_last_hash_block(req_ctx->reqbfr, bs, req_ctx->data_len);
  params.last = 0;
  params.more = 1;
  params.scmd1 = 0;
  params.bfr_len = bs;
 }
 skb = create_hash_wr(req, ¶ms);
 if (IS_ERR(skb)) {
  error = PTR_ERR(skb);
  goto unmap;
 }
 req_ctx->reqlen = 0;
 req_ctx->hctx_wr.processed += params.sg_len;
 skb->dev = u_ctx->lldi.ports[0];
 set_wr_txq(skb, CPL_PRIORITY_DATA, req_ctx->txqidx);
 chcr_send_wr(skb);
 return -EINPROGRESS;
unmap:
 chcr_hash_dma_unmap(&u_ctx->lldi.pdev->dev, req);
err:
 chcr_dec_wrcount(dev);
 return error;
}

static int chcr_hmac_init(struct ahash_request *areq);
static int chcr_sha_init(struct ahash_request *areq);

static int chcr_ahash_digest(struct ahash_request *req)
{
 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
 struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
 struct chcr_dev *dev = h_ctx(rtfm)->dev;
 struct uld_ctx *u_ctx = ULD_CTX(h_ctx(rtfm));
 struct chcr_context *ctx = h_ctx(rtfm);
 struct sk_buff *skb;
 struct hash_wr_param params;
 u8  bs;
 int error;
 unsigned int cpu;

 cpu = get_cpu();
 req_ctx->txqidx = cpu % ctx->ntxq;
 req_ctx->rxqidx = cpu % ctx->nrxq;
 put_cpu();

 if (is_hmac(crypto_ahash_tfm(rtfm)))
  chcr_hmac_init(req);
 else
  chcr_sha_init(req);

 bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
 error = chcr_inc_wrcount(dev);
 if (error)
  return -ENXIO;

 if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
      req_ctx->txqidx) &&
  (!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG)))) {
   error = -ENOSPC;
   goto err;
 }

 chcr_init_hctx_per_wr(req_ctx);
 error = chcr_hash_dma_map(&u_ctx->lldi.pdev->dev, req);
 if (error) {
  error = -ENOMEM;
  goto err;
 }

 get_alg_config(¶ms.alg_prm, crypto_ahash_digestsize(rtfm));
 params.kctx_len = roundup(params.alg_prm.result_size, 16);
 if (is_hmac(crypto_ahash_tfm(rtfm))) {
  params.kctx_len *= 2;
  params.opad_needed = 1;
 } else {
  params.opad_needed = 0;
 }
 params.sg_len = chcr_hash_ent_in_wr(req->src, !!req_ctx->reqlen,
    HASH_SPACE_LEFT(params.kctx_len), 0);
 if (params.sg_len < req->nbytes) {
  if (is_hmac(crypto_ahash_tfm(rtfm))) {
   params.kctx_len /= 2;
   params.opad_needed = 0;
  }
  params.last = 0;
  params.more = 1;
  params.scmd1 = 0;
  params.sg_len = rounddown(params.sg_len, bs);
  params.hash_size = params.alg_prm.result_size;
 } else {
  params.sg_len = req->nbytes;
  params.hash_size = crypto_ahash_digestsize(rtfm);
  params.last = 1;
  params.more = 0;
  params.scmd1 = req->nbytes + req_ctx->data_len;

 }
 params.bfr_len = 0;
 req_ctx->hctx_wr.result = 1;
 req_ctx->hctx_wr.srcsg = req->src;
 req_ctx->data_len += params.bfr_len + params.sg_len;

 if (req->nbytes == 0) {
  create_last_hash_block(req_ctx->reqbfr, bs, req_ctx->data_len);
  params.more = 1;
  params.bfr_len = bs;
 }

 skb = create_hash_wr(req, ¶ms);
 if (IS_ERR(skb)) {
  error = PTR_ERR(skb);
  goto unmap;
 }
 req_ctx->hctx_wr.processed += params.sg_len;
 skb->dev = u_ctx->lldi.ports[0];
 set_wr_txq(skb, CPL_PRIORITY_DATA, req_ctx->txqidx);
 chcr_send_wr(skb);
 return -EINPROGRESS;
unmap:
 chcr_hash_dma_unmap(&u_ctx->lldi.pdev->dev, req);
err:
 chcr_dec_wrcount(dev);
 return error;
}

static int chcr_ahash_continue(struct ahash_request *req)
{
 struct chcr_ahash_req_ctx *reqctx = ahash_request_ctx(req);
 struct chcr_hctx_per_wr *hctx_wr = &reqctx->hctx_wr;
 struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
 struct chcr_context *ctx = h_ctx(rtfm);
 struct uld_ctx *u_ctx = ULD_CTX(ctx);
 struct sk_buff *skb;
 struct hash_wr_param params;
 u8  bs;
 int error;
 unsigned int cpu;

 cpu = get_cpu();
 reqctx->txqidx = cpu % ctx->ntxq;
 reqctx->rxqidx = cpu % ctx->nrxq;
 put_cpu();

 bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
 get_alg_config(¶ms.alg_prm, crypto_ahash_digestsize(rtfm));
 params.kctx_len = roundup(params.alg_prm.result_size, 16);
 if (is_hmac(crypto_ahash_tfm(rtfm))) {
  params.kctx_len *= 2;
  params.opad_needed = 1;
 } else {
  params.opad_needed = 0;
 }
 params.sg_len = chcr_hash_ent_in_wr(hctx_wr->srcsg, 0,
         HASH_SPACE_LEFT(params.kctx_len),
         hctx_wr->src_ofst);
 if ((params.sg_len + hctx_wr->processed) > req->nbytes)
  params.sg_len = req->nbytes - hctx_wr->processed;
 if (!hctx_wr->result ||
     ((params.sg_len + hctx_wr->processed) < req->nbytes)) {
  if (is_hmac(crypto_ahash_tfm(rtfm))) {
   params.kctx_len /= 2;
   params.opad_needed = 0;
  }
  params.last = 0;
  params.more = 1;
  params.sg_len = rounddown(params.sg_len, bs);
  params.hash_size = params.alg_prm.result_size;
  params.scmd1 = 0;
 } else {
  params.last = 1;
  params.more = 0;
  params.hash_size = crypto_ahash_digestsize(rtfm);
  params.scmd1 = reqctx->data_len + params.sg_len;
 }
 params.bfr_len = 0;
 reqctx->data_len += params.sg_len;
 skb = create_hash_wr(req, ¶ms);
 if (IS_ERR(skb)) {
  error = PTR_ERR(skb);
  goto err;
 }
 hctx_wr->processed += params.sg_len;
 skb->dev = u_ctx->lldi.ports[0];
 set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
 chcr_send_wr(skb);
 return 0;
err:
 return error;
}

static inline void chcr_handle_ahash_resp(struct ahash_request *req,
       unsigned char *input,
       int err)
{
 struct chcr_ahash_req_ctx *reqctx = ahash_request_ctx(req);
 struct chcr_hctx_per_wr *hctx_wr = &reqctx->hctx_wr;
 int digestsize, updated_digestsize;
 struct crypto_ahash *tfm = crypto_ahash_reqtfm(req);
 struct uld_ctx *u_ctx = ULD_CTX(h_ctx(tfm));
 struct chcr_dev *dev = h_ctx(tfm)->dev;

 if (input == NULL)
  goto out;
 digestsize = crypto_ahash_digestsize(crypto_ahash_reqtfm(req));
 updated_digestsize = digestsize;
 if (digestsize == SHA224_DIGEST_SIZE)
  updated_digestsize = SHA256_DIGEST_SIZE;
 else if (digestsize == SHA384_DIGEST_SIZE)
  updated_digestsize = SHA512_DIGEST_SIZE;

 if (hctx_wr->dma_addr) {
  dma_unmap_single(&u_ctx->lldi.pdev->dev, hctx_wr->dma_addr,
     hctx_wr->dma_len, DMA_TO_DEVICE);
  hctx_wr->dma_addr = 0;
 }
 if (hctx_wr->isfinal || ((hctx_wr->processed + reqctx->reqlen) ==
     req->nbytes)) {
  if (hctx_wr->result == 1) {
   hctx_wr->result = 0;
   memcpy(req->result, input + sizeof(struct cpl_fw6_pld),
          digestsize);
  } else {
   memcpy(reqctx->partial_hash,
          input + sizeof(struct cpl_fw6_pld),
          updated_digestsize);

  }
  goto unmap;
 }
 memcpy(reqctx->partial_hash, input + sizeof(struct cpl_fw6_pld),
        updated_digestsize);

 err = chcr_ahash_continue(req);
 if (err)
  goto unmap;
 return;
unmap:
 if (hctx_wr->is_sg_map)
  chcr_hash_dma_unmap(&u_ctx->lldi.pdev->dev, req);


out:
 chcr_dec_wrcount(dev);
 ahash_request_complete(req, err);
}

/*
 * chcr_handle_resp - Unmap the DMA buffers associated with the request
 * @req: crypto request
 */
int chcr_handle_resp(struct crypto_async_request *req, unsigned char *input,
    int err)
{
 struct crypto_tfm *tfm = req->tfm;
 struct chcr_context *ctx = crypto_tfm_ctx(tfm);
 struct adapter *adap = padap(ctx->dev);

 switch (tfm->__crt_alg->cra_flags & CRYPTO_ALG_TYPE_MASK) {
 case CRYPTO_ALG_TYPE_AEAD:
  err = chcr_handle_aead_resp(aead_request_cast(req), input, err);
  break;

 case CRYPTO_ALG_TYPE_SKCIPHER:
   chcr_handle_cipher_resp(skcipher_request_cast(req),
            input, err);
  break;
 case CRYPTO_ALG_TYPE_AHASH:
  chcr_handle_ahash_resp(ahash_request_cast(req), input, err);
  }
 atomic_inc(&adap->chcr_stats.complete);
 return err;
}
static int chcr_ahash_export(struct ahash_request *areq, void *out)
{
 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
 struct chcr_ahash_req_ctx *state = out;

 state->reqlen = req_ctx->reqlen;
 state->data_len = req_ctx->data_len;
 memcpy(state->bfr1, req_ctx->reqbfr, req_ctx->reqlen);
 memcpy(state->partial_hash, req_ctx->partial_hash,
        CHCR_HASH_MAX_DIGEST_SIZE);
 chcr_init_hctx_per_wr(state);
 return 0;
}

static int chcr_ahash_import(struct ahash_request *areq, const void *in)
{
 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
 struct chcr_ahash_req_ctx *state = (struct chcr_ahash_req_ctx *)in;

 req_ctx->reqlen = state->reqlen;
 req_ctx->data_len = state->data_len;
 req_ctx->reqbfr = req_ctx->bfr1;
 req_ctx->skbfr = req_ctx->bfr2;
 memcpy(req_ctx->bfr1, state->bfr1, CHCR_HASH_MAX_BLOCK_SIZE_128);
 memcpy(req_ctx->partial_hash, state->partial_hash,
        CHCR_HASH_MAX_DIGEST_SIZE);
 chcr_init_hctx_per_wr(req_ctx);
 return 0;
}

static int chcr_ahash_setkey(struct crypto_ahash *tfm, const u8 *key,
        unsigned int keylen)
{
 struct hmac_ctx *hmacctx = HMAC_CTX(h_ctx(tfm));
 unsigned int digestsize = crypto_ahash_digestsize(tfm);
 unsigned int bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(tfm));
 unsigned int i, err = 0, updated_digestsize;

 SHASH_DESC_ON_STACK(shash, hmacctx->base_hash);

 /* use the key to calculate the ipad and opad. ipad will sent with the
 * first request's data. opad will be sent with the final hash result
 * ipad in hmacctx->ipad and opad in hmacctx->opad location
 */
 shash->tfm = hmacctx->base_hash;
 if (keylen > bs) {
  err = crypto_shash_digest(shash, key, keylen,
       hmacctx->ipad);
  if (err)
   goto out;
  keylen = digestsize;
 } else {
  memcpy(hmacctx->ipad, key, keylen);
 }
 memset(hmacctx->ipad + keylen, 0, bs - keylen);
 unsafe_memcpy(hmacctx->opad, hmacctx->ipad, bs,
        "fortified memcpy causes -Wrestrict warning");

 for (i = 0; i < bs / sizeof(int); i++) {
  *((unsigned int *)(&hmacctx->ipad) + i) ^= IPAD_DATA;
  *((unsigned int *)(&hmacctx->opad) + i) ^= OPAD_DATA;
 }

 updated_digestsize = digestsize;
 if (digestsize == SHA224_DIGEST_SIZE)
  updated_digestsize = SHA256_DIGEST_SIZE;
 else if (digestsize == SHA384_DIGEST_SIZE)
  updated_digestsize = SHA512_DIGEST_SIZE;
 err = chcr_compute_partial_hash(shash, hmacctx->ipad,
     hmacctx->ipad, digestsize);
 if (err)
  goto out;
 chcr_change_order(hmacctx->ipad, updated_digestsize);

 err = chcr_compute_partial_hash(shash, hmacctx->opad,
     hmacctx->opad, digestsize);
 if (err)
  goto out;
 chcr_change_order(hmacctx->opad, updated_digestsize);
out:
 return err;
}

static int chcr_aes_xts_setkey(struct crypto_skcipher *cipher, const u8 *key,
          unsigned int key_len)
{
 struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));
 unsigned short context_size = 0;
 int err;

 err = chcr_cipher_fallback_setkey(cipher, key, key_len);
 if (err)
  goto badkey_err;

 memcpy(ablkctx->key, key, key_len);
 ablkctx->enckey_len = key_len;
 get_aes_decrypt_key(ablkctx->rrkey, ablkctx->key, key_len << 2);
 context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD + key_len) >> 4;
 /* Both keys for xts must be aligned to 16 byte boundary
 * by padding with zeros. So for 24 byte keys padding 8 zeroes.
 */
 if (key_len == 48) {
  context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD + key_len
    + 16) >> 4;
  memmove(ablkctx->key + 32, ablkctx->key + 24, 24);
  memset(ablkctx->key + 24, 0, 8);
  memset(ablkctx->key + 56, 0, 8);
  ablkctx->enckey_len = 64;
  ablkctx->key_ctx_hdr =
   FILL_KEY_CTX_HDR(CHCR_KEYCTX_CIPHER_KEY_SIZE_192,
      CHCR_KEYCTX_NO_KEY, 1,
      0, context_size);
 } else {
  ablkctx->key_ctx_hdr =
  FILL_KEY_CTX_HDR((key_len == AES_KEYSIZE_256) ?
     CHCR_KEYCTX_CIPHER_KEY_SIZE_128 :
     CHCR_KEYCTX_CIPHER_KEY_SIZE_256,
     CHCR_KEYCTX_NO_KEY, 1,
     0, context_size);
 }
 ablkctx->ciph_mode = CHCR_SCMD_CIPHER_MODE_AES_XTS;
 return 0;
badkey_err:
 ablkctx->enckey_len = 0;

 return err;
}

static int chcr_sha_init(struct ahash_request *areq)
{
 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
 struct crypto_ahash *tfm = crypto_ahash_reqtfm(areq);
 int digestsize =  crypto_ahash_digestsize(tfm);

 req_ctx->data_len = 0;
 req_ctx->reqlen = 0;
 req_ctx->reqbfr = req_ctx->bfr1;
 req_ctx->skbfr = req_ctx->bfr2;
 copy_hash_init_values(req_ctx->partial_hash, digestsize);

 return 0;
}

static int chcr_sha_cra_init(struct crypto_tfm *tfm)
{
 crypto_ahash_set_reqsize(__crypto_ahash_cast(tfm),
--> --------------------

--> maximum size reached

--> --------------------