1 /*
2  * This file is part of the Chelsio T6 Crypto driver for Linux.
3  *
4  * Copyright (c) 2003-2016 Chelsio Communications, Inc. All rights reserved.
5  *
6  * This software is available to you under a choice of one of two
7  * licenses.  You may choose to be licensed under the terms of the GNU
8  * General Public License (GPL) Version 2, available from the file
9  * COPYING in the main directory of this source tree, or the
10  * OpenIB.org BSD license below:
11  *
12  *     Redistribution and use in source and binary forms, with or
13  *     without modification, are permitted provided that the following
14  *     conditions are met:
15  *
16  *      - Redistributions of source code must retain the above
17  *        copyright notice, this list of conditions and the following
18  *        disclaimer.
19  *
20  *      - Redistributions in binary form must reproduce the above
21  *        copyright notice, this list of conditions and the following
22  *        disclaimer in the documentation and/or other materials
23  *        provided with the distribution.
24  *
25  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
26  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
27  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
28  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
29  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
30  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
31  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
32  * SOFTWARE.
33  *
34  * Written and Maintained by:
35  *	Manoj Malviya (manojmalviya@chelsio.com)
36  *	Atul Gupta (atul.gupta@chelsio.com)
37  *	Jitendra Lulla (jlulla@chelsio.com)
38  *	Yeshaswi M R Gowda (yeshaswi@chelsio.com)
39  *	Harsh Jain (harsh@chelsio.com)
40  */
41 
42 #define pr_fmt(fmt) "chcr:" fmt
43 
44 #include <linux/kernel.h>
45 #include <linux/module.h>
46 #include <linux/crypto.h>
47 #include <linux/skbuff.h>
48 #include <linux/rtnetlink.h>
49 #include <linux/highmem.h>
50 #include <linux/scatterlist.h>
51 
52 #include <crypto/aes.h>
53 #include <crypto/algapi.h>
54 #include <crypto/hash.h>
55 #include <crypto/gcm.h>
56 #include <crypto/sha.h>
57 #include <crypto/authenc.h>
58 #include <crypto/ctr.h>
59 #include <crypto/gf128mul.h>
60 #include <crypto/internal/aead.h>
61 #include <crypto/null.h>
62 #include <crypto/internal/skcipher.h>
63 #include <crypto/aead.h>
64 #include <crypto/scatterwalk.h>
65 #include <crypto/internal/hash.h>
66 
67 #include "t4fw_api.h"
68 #include "t4_msg.h"
69 #include "chcr_core.h"
70 #include "chcr_algo.h"
71 #include "chcr_crypto.h"
72 
73 #define IV AES_BLOCK_SIZE
74 
75 static unsigned int sgl_ent_len[] = {
76 	0, 0, 16, 24, 40, 48, 64, 72, 88,
77 	96, 112, 120, 136, 144, 160, 168, 184,
78 	192, 208, 216, 232, 240, 256, 264, 280,
79 	288, 304, 312, 328, 336, 352, 360, 376
80 };
81 
82 static unsigned int dsgl_ent_len[] = {
83 	0, 32, 32, 48, 48, 64, 64, 80, 80,
84 	112, 112, 128, 128, 144, 144, 160, 160,
85 	192, 192, 208, 208, 224, 224, 240, 240,
86 	272, 272, 288, 288, 304, 304, 320, 320
87 };
88 
89 static u32 round_constant[11] = {
90 	0x01000000, 0x02000000, 0x04000000, 0x08000000,
91 	0x10000000, 0x20000000, 0x40000000, 0x80000000,
92 	0x1B000000, 0x36000000, 0x6C000000
93 };
94 
95 static int chcr_handle_cipher_resp(struct skcipher_request *req,
96 				   unsigned char *input, int err);
97 
98 static inline  struct chcr_aead_ctx *AEAD_CTX(struct chcr_context *ctx)
99 {
100 	return ctx->crypto_ctx->aeadctx;
101 }
102 
103 static inline struct ablk_ctx *ABLK_CTX(struct chcr_context *ctx)
104 {
105 	return ctx->crypto_ctx->ablkctx;
106 }
107 
108 static inline struct hmac_ctx *HMAC_CTX(struct chcr_context *ctx)
109 {
110 	return ctx->crypto_ctx->hmacctx;
111 }
112 
113 static inline struct chcr_gcm_ctx *GCM_CTX(struct chcr_aead_ctx *gctx)
114 {
115 	return gctx->ctx->gcm;
116 }
117 
118 static inline struct chcr_authenc_ctx *AUTHENC_CTX(struct chcr_aead_ctx *gctx)
119 {
120 	return gctx->ctx->authenc;
121 }
122 
123 static inline struct uld_ctx *ULD_CTX(struct chcr_context *ctx)
124 {
125 	return container_of(ctx->dev, struct uld_ctx, dev);
126 }
127 
128 static inline int is_ofld_imm(const struct sk_buff *skb)
129 {
130 	return (skb->len <= SGE_MAX_WR_LEN);
131 }
132 
133 static inline void chcr_init_hctx_per_wr(struct chcr_ahash_req_ctx *reqctx)
134 {
135 	memset(&reqctx->hctx_wr, 0, sizeof(struct chcr_hctx_per_wr));
136 }
137 
138 static int sg_nents_xlen(struct scatterlist *sg, unsigned int reqlen,
139 			 unsigned int entlen,
140 			 unsigned int skip)
141 {
142 	int nents = 0;
143 	unsigned int less;
144 	unsigned int skip_len = 0;
145 
146 	while (sg && skip) {
147 		if (sg_dma_len(sg) <= skip) {
148 			skip -= sg_dma_len(sg);
149 			skip_len = 0;
150 			sg = sg_next(sg);
151 		} else {
152 			skip_len = skip;
153 			skip = 0;
154 		}
155 	}
156 
157 	while (sg && reqlen) {
158 		less = min(reqlen, sg_dma_len(sg) - skip_len);
159 		nents += DIV_ROUND_UP(less, entlen);
160 		reqlen -= less;
161 		skip_len = 0;
162 		sg = sg_next(sg);
163 	}
164 	return nents;
165 }
166 
167 static inline int get_aead_subtype(struct crypto_aead *aead)
168 {
169 	struct aead_alg *alg = crypto_aead_alg(aead);
170 	struct chcr_alg_template *chcr_crypto_alg =
171 		container_of(alg, struct chcr_alg_template, alg.aead);
172 	return chcr_crypto_alg->type & CRYPTO_ALG_SUB_TYPE_MASK;
173 }
174 
175 void chcr_verify_tag(struct aead_request *req, u8 *input, int *err)
176 {
177 	u8 temp[SHA512_DIGEST_SIZE];
178 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
179 	int authsize = crypto_aead_authsize(tfm);
180 	struct cpl_fw6_pld *fw6_pld;
181 	int cmp = 0;
182 
183 	fw6_pld = (struct cpl_fw6_pld *)input;
184 	if ((get_aead_subtype(tfm) == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106) ||
185 	    (get_aead_subtype(tfm) == CRYPTO_ALG_SUB_TYPE_AEAD_GCM)) {
186 		cmp = crypto_memneq(&fw6_pld->data[2], (fw6_pld + 1), authsize);
187 	} else {
188 
189 		sg_pcopy_to_buffer(req->src, sg_nents(req->src), temp,
190 				authsize, req->assoclen +
191 				req->cryptlen - authsize);
192 		cmp = crypto_memneq(temp, (fw6_pld + 1), authsize);
193 	}
194 	if (cmp)
195 		*err = -EBADMSG;
196 	else
197 		*err = 0;
198 }
199 
200 static int chcr_inc_wrcount(struct chcr_dev *dev)
201 {
202 	if (dev->state == CHCR_DETACH)
203 		return 1;
204 	atomic_inc(&dev->inflight);
205 	return 0;
206 }
207 
208 static inline void chcr_dec_wrcount(struct chcr_dev *dev)
209 {
210 	atomic_dec(&dev->inflight);
211 }
212 
213 static inline int chcr_handle_aead_resp(struct aead_request *req,
214 					 unsigned char *input,
215 					 int err)
216 {
217 	struct chcr_aead_reqctx *reqctx = aead_request_ctx(req);
218 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
219 	struct chcr_dev *dev = a_ctx(tfm)->dev;
220 
221 	chcr_aead_common_exit(req);
222 	if (reqctx->verify == VERIFY_SW) {
223 		chcr_verify_tag(req, input, &err);
224 		reqctx->verify = VERIFY_HW;
225 	}
226 	chcr_dec_wrcount(dev);
227 	req->base.complete(&req->base, err);
228 
229 	return err;
230 }
231 
232 static void get_aes_decrypt_key(unsigned char *dec_key,
233 				       const unsigned char *key,
234 				       unsigned int keylength)
235 {
236 	u32 temp;
237 	u32 w_ring[MAX_NK];
238 	int i, j, k;
239 	u8  nr, nk;
240 
241 	switch (keylength) {
242 	case AES_KEYLENGTH_128BIT:
243 		nk = KEYLENGTH_4BYTES;
244 		nr = NUMBER_OF_ROUNDS_10;
245 		break;
246 	case AES_KEYLENGTH_192BIT:
247 		nk = KEYLENGTH_6BYTES;
248 		nr = NUMBER_OF_ROUNDS_12;
249 		break;
250 	case AES_KEYLENGTH_256BIT:
251 		nk = KEYLENGTH_8BYTES;
252 		nr = NUMBER_OF_ROUNDS_14;
253 		break;
254 	default:
255 		return;
256 	}
257 	for (i = 0; i < nk; i++)
258 		w_ring[i] = get_unaligned_be32(&key[i * 4]);
259 
260 	i = 0;
261 	temp = w_ring[nk - 1];
262 	while (i + nk < (nr + 1) * 4) {
263 		if (!(i % nk)) {
264 			/* RotWord(temp) */
265 			temp = (temp << 8) | (temp >> 24);
266 			temp = aes_ks_subword(temp);
267 			temp ^= round_constant[i / nk];
268 		} else if (nk == 8 && (i % 4 == 0)) {
269 			temp = aes_ks_subword(temp);
270 		}
271 		w_ring[i % nk] ^= temp;
272 		temp = w_ring[i % nk];
273 		i++;
274 	}
275 	i--;
276 	for (k = 0, j = i % nk; k < nk; k++) {
277 		put_unaligned_be32(w_ring[j], &dec_key[k * 4]);
278 		j--;
279 		if (j < 0)
280 			j += nk;
281 	}
282 }
283 
284 static struct crypto_shash *chcr_alloc_shash(unsigned int ds)
285 {
286 	struct crypto_shash *base_hash = ERR_PTR(-EINVAL);
287 
288 	switch (ds) {
289 	case SHA1_DIGEST_SIZE:
290 		base_hash = crypto_alloc_shash("sha1", 0, 0);
291 		break;
292 	case SHA224_DIGEST_SIZE:
293 		base_hash = crypto_alloc_shash("sha224", 0, 0);
294 		break;
295 	case SHA256_DIGEST_SIZE:
296 		base_hash = crypto_alloc_shash("sha256", 0, 0);
297 		break;
298 	case SHA384_DIGEST_SIZE:
299 		base_hash = crypto_alloc_shash("sha384", 0, 0);
300 		break;
301 	case SHA512_DIGEST_SIZE:
302 		base_hash = crypto_alloc_shash("sha512", 0, 0);
303 		break;
304 	}
305 
306 	return base_hash;
307 }
308 
309 static int chcr_compute_partial_hash(struct shash_desc *desc,
310 				     char *iopad, char *result_hash,
311 				     int digest_size)
312 {
313 	struct sha1_state sha1_st;
314 	struct sha256_state sha256_st;
315 	struct sha512_state sha512_st;
316 	int error;
317 
318 	if (digest_size == SHA1_DIGEST_SIZE) {
319 		error = crypto_shash_init(desc) ?:
320 			crypto_shash_update(desc, iopad, SHA1_BLOCK_SIZE) ?:
321 			crypto_shash_export(desc, (void *)&sha1_st);
322 		memcpy(result_hash, sha1_st.state, SHA1_DIGEST_SIZE);
323 	} else if (digest_size == SHA224_DIGEST_SIZE) {
324 		error = crypto_shash_init(desc) ?:
325 			crypto_shash_update(desc, iopad, SHA256_BLOCK_SIZE) ?:
326 			crypto_shash_export(desc, (void *)&sha256_st);
327 		memcpy(result_hash, sha256_st.state, SHA256_DIGEST_SIZE);
328 
329 	} else if (digest_size == SHA256_DIGEST_SIZE) {
330 		error = crypto_shash_init(desc) ?:
331 			crypto_shash_update(desc, iopad, SHA256_BLOCK_SIZE) ?:
332 			crypto_shash_export(desc, (void *)&sha256_st);
333 		memcpy(result_hash, sha256_st.state, SHA256_DIGEST_SIZE);
334 
335 	} else if (digest_size == SHA384_DIGEST_SIZE) {
336 		error = crypto_shash_init(desc) ?:
337 			crypto_shash_update(desc, iopad, SHA512_BLOCK_SIZE) ?:
338 			crypto_shash_export(desc, (void *)&sha512_st);
339 		memcpy(result_hash, sha512_st.state, SHA512_DIGEST_SIZE);
340 
341 	} else if (digest_size == SHA512_DIGEST_SIZE) {
342 		error = crypto_shash_init(desc) ?:
343 			crypto_shash_update(desc, iopad, SHA512_BLOCK_SIZE) ?:
344 			crypto_shash_export(desc, (void *)&sha512_st);
345 		memcpy(result_hash, sha512_st.state, SHA512_DIGEST_SIZE);
346 	} else {
347 		error = -EINVAL;
348 		pr_err("Unknown digest size %d\n", digest_size);
349 	}
350 	return error;
351 }
352 
353 static void chcr_change_order(char *buf, int ds)
354 {
355 	int i;
356 
357 	if (ds == SHA512_DIGEST_SIZE) {
358 		for (i = 0; i < (ds / sizeof(u64)); i++)
359 			*((__be64 *)buf + i) =
360 				cpu_to_be64(*((u64 *)buf + i));
361 	} else {
362 		for (i = 0; i < (ds / sizeof(u32)); i++)
363 			*((__be32 *)buf + i) =
364 				cpu_to_be32(*((u32 *)buf + i));
365 	}
366 }
367 
368 static inline int is_hmac(struct crypto_tfm *tfm)
369 {
370 	struct crypto_alg *alg = tfm->__crt_alg;
371 	struct chcr_alg_template *chcr_crypto_alg =
372 		container_of(__crypto_ahash_alg(alg), struct chcr_alg_template,
373 			     alg.hash);
374 	if (chcr_crypto_alg->type == CRYPTO_ALG_TYPE_HMAC)
375 		return 1;
376 	return 0;
377 }
378 
379 static inline void dsgl_walk_init(struct dsgl_walk *walk,
380 				   struct cpl_rx_phys_dsgl *dsgl)
381 {
382 	walk->dsgl = dsgl;
383 	walk->nents = 0;
384 	walk->to = (struct phys_sge_pairs *)(dsgl + 1);
385 }
386 
387 static inline void dsgl_walk_end(struct dsgl_walk *walk, unsigned short qid,
388 				 int pci_chan_id)
389 {
390 	struct cpl_rx_phys_dsgl *phys_cpl;
391 
392 	phys_cpl = walk->dsgl;
393 
394 	phys_cpl->op_to_tid = htonl(CPL_RX_PHYS_DSGL_OPCODE_V(CPL_RX_PHYS_DSGL)
395 				    | CPL_RX_PHYS_DSGL_ISRDMA_V(0));
396 	phys_cpl->pcirlxorder_to_noofsgentr =
397 		htonl(CPL_RX_PHYS_DSGL_PCIRLXORDER_V(0) |
398 		      CPL_RX_PHYS_DSGL_PCINOSNOOP_V(0) |
399 		      CPL_RX_PHYS_DSGL_PCITPHNTENB_V(0) |
400 		      CPL_RX_PHYS_DSGL_PCITPHNT_V(0) |
401 		      CPL_RX_PHYS_DSGL_DCAID_V(0) |
402 		      CPL_RX_PHYS_DSGL_NOOFSGENTR_V(walk->nents));
403 	phys_cpl->rss_hdr_int.opcode = CPL_RX_PHYS_ADDR;
404 	phys_cpl->rss_hdr_int.qid = htons(qid);
405 	phys_cpl->rss_hdr_int.hash_val = 0;
406 	phys_cpl->rss_hdr_int.channel = pci_chan_id;
407 }
408 
409 static inline void dsgl_walk_add_page(struct dsgl_walk *walk,
410 					size_t size,
411 					dma_addr_t addr)
412 {
413 	int j;
414 
415 	if (!size)
416 		return;
417 	j = walk->nents;
418 	walk->to->len[j % 8] = htons(size);
419 	walk->to->addr[j % 8] = cpu_to_be64(addr);
420 	j++;
421 	if ((j % 8) == 0)
422 		walk->to++;
423 	walk->nents = j;
424 }
425 
426 static void  dsgl_walk_add_sg(struct dsgl_walk *walk,
427 			   struct scatterlist *sg,
428 			      unsigned int slen,
429 			      unsigned int skip)
430 {
431 	int skip_len = 0;
432 	unsigned int left_size = slen, len = 0;
433 	unsigned int j = walk->nents;
434 	int offset, ent_len;
435 
436 	if (!slen)
437 		return;
438 	while (sg && skip) {
439 		if (sg_dma_len(sg) <= skip) {
440 			skip -= sg_dma_len(sg);
441 			skip_len = 0;
442 			sg = sg_next(sg);
443 		} else {
444 			skip_len = skip;
445 			skip = 0;
446 		}
447 	}
448 
449 	while (left_size && sg) {
450 		len = min_t(u32, left_size, sg_dma_len(sg) - skip_len);
451 		offset = 0;
452 		while (len) {
453 			ent_len =  min_t(u32, len, CHCR_DST_SG_SIZE);
454 			walk->to->len[j % 8] = htons(ent_len);
455 			walk->to->addr[j % 8] = cpu_to_be64(sg_dma_address(sg) +
456 						      offset + skip_len);
457 			offset += ent_len;
458 			len -= ent_len;
459 			j++;
460 			if ((j % 8) == 0)
461 				walk->to++;
462 		}
463 		walk->last_sg = sg;
464 		walk->last_sg_len = min_t(u32, left_size, sg_dma_len(sg) -
465 					  skip_len) + skip_len;
466 		left_size -= min_t(u32, left_size, sg_dma_len(sg) - skip_len);
467 		skip_len = 0;
468 		sg = sg_next(sg);
469 	}
470 	walk->nents = j;
471 }
472 
473 static inline void ulptx_walk_init(struct ulptx_walk *walk,
474 				   struct ulptx_sgl *ulp)
475 {
476 	walk->sgl = ulp;
477 	walk->nents = 0;
478 	walk->pair_idx = 0;
479 	walk->pair = ulp->sge;
480 	walk->last_sg = NULL;
481 	walk->last_sg_len = 0;
482 }
483 
484 static inline void ulptx_walk_end(struct ulptx_walk *walk)
485 {
486 	walk->sgl->cmd_nsge = htonl(ULPTX_CMD_V(ULP_TX_SC_DSGL) |
487 			      ULPTX_NSGE_V(walk->nents));
488 }
489 
490 
491 static inline void ulptx_walk_add_page(struct ulptx_walk *walk,
492 					size_t size,
493 					dma_addr_t addr)
494 {
495 	if (!size)
496 		return;
497 
498 	if (walk->nents == 0) {
499 		walk->sgl->len0 = cpu_to_be32(size);
500 		walk->sgl->addr0 = cpu_to_be64(addr);
501 	} else {
502 		walk->pair->addr[walk->pair_idx] = cpu_to_be64(addr);
503 		walk->pair->len[walk->pair_idx] = cpu_to_be32(size);
504 		walk->pair_idx = !walk->pair_idx;
505 		if (!walk->pair_idx)
506 			walk->pair++;
507 	}
508 	walk->nents++;
509 }
510 
511 static void  ulptx_walk_add_sg(struct ulptx_walk *walk,
512 					struct scatterlist *sg,
513 			       unsigned int len,
514 			       unsigned int skip)
515 {
516 	int small;
517 	int skip_len = 0;
518 	unsigned int sgmin;
519 
520 	if (!len)
521 		return;
522 	while (sg && skip) {
523 		if (sg_dma_len(sg) <= skip) {
524 			skip -= sg_dma_len(sg);
525 			skip_len = 0;
526 			sg = sg_next(sg);
527 		} else {
528 			skip_len = skip;
529 			skip = 0;
530 		}
531 	}
532 	WARN(!sg, "SG should not be null here\n");
533 	if (sg && (walk->nents == 0)) {
534 		small = min_t(unsigned int, sg_dma_len(sg) - skip_len, len);
535 		sgmin = min_t(unsigned int, small, CHCR_SRC_SG_SIZE);
536 		walk->sgl->len0 = cpu_to_be32(sgmin);
537 		walk->sgl->addr0 = cpu_to_be64(sg_dma_address(sg) + skip_len);
538 		walk->nents++;
539 		len -= sgmin;
540 		walk->last_sg = sg;
541 		walk->last_sg_len = sgmin + skip_len;
542 		skip_len += sgmin;
543 		if (sg_dma_len(sg) == skip_len) {
544 			sg = sg_next(sg);
545 			skip_len = 0;
546 		}
547 	}
548 
549 	while (sg && len) {
550 		small = min(sg_dma_len(sg) - skip_len, len);
551 		sgmin = min_t(unsigned int, small, CHCR_SRC_SG_SIZE);
552 		walk->pair->len[walk->pair_idx] = cpu_to_be32(sgmin);
553 		walk->pair->addr[walk->pair_idx] =
554 			cpu_to_be64(sg_dma_address(sg) + skip_len);
555 		walk->pair_idx = !walk->pair_idx;
556 		walk->nents++;
557 		if (!walk->pair_idx)
558 			walk->pair++;
559 		len -= sgmin;
560 		skip_len += sgmin;
561 		walk->last_sg = sg;
562 		walk->last_sg_len = skip_len;
563 		if (sg_dma_len(sg) == skip_len) {
564 			sg = sg_next(sg);
565 			skip_len = 0;
566 		}
567 	}
568 }
569 
570 static inline int get_cryptoalg_subtype(struct crypto_skcipher *tfm)
571 {
572 	struct skcipher_alg *alg = crypto_skcipher_alg(tfm);
573 	struct chcr_alg_template *chcr_crypto_alg =
574 		container_of(alg, struct chcr_alg_template, alg.skcipher);
575 
576 	return chcr_crypto_alg->type & CRYPTO_ALG_SUB_TYPE_MASK;
577 }
578 
579 static int cxgb4_is_crypto_q_full(struct net_device *dev, unsigned int idx)
580 {
581 	struct adapter *adap = netdev2adap(dev);
582 	struct sge_uld_txq_info *txq_info =
583 		adap->sge.uld_txq_info[CXGB4_TX_CRYPTO];
584 	struct sge_uld_txq *txq;
585 	int ret = 0;
586 
587 	local_bh_disable();
588 	txq = &txq_info->uldtxq[idx];
589 	spin_lock(&txq->sendq.lock);
590 	if (txq->full)
591 		ret = -1;
592 	spin_unlock(&txq->sendq.lock);
593 	local_bh_enable();
594 	return ret;
595 }
596 
597 static int generate_copy_rrkey(struct ablk_ctx *ablkctx,
598 			       struct _key_ctx *key_ctx)
599 {
600 	if (ablkctx->ciph_mode == CHCR_SCMD_CIPHER_MODE_AES_CBC) {
601 		memcpy(key_ctx->key, ablkctx->rrkey, ablkctx->enckey_len);
602 	} else {
603 		memcpy(key_ctx->key,
604 		       ablkctx->key + (ablkctx->enckey_len >> 1),
605 		       ablkctx->enckey_len >> 1);
606 		memcpy(key_ctx->key + (ablkctx->enckey_len >> 1),
607 		       ablkctx->rrkey, ablkctx->enckey_len >> 1);
608 	}
609 	return 0;
610 }
611 
612 static int chcr_hash_ent_in_wr(struct scatterlist *src,
613 			     unsigned int minsg,
614 			     unsigned int space,
615 			     unsigned int srcskip)
616 {
617 	int srclen = 0;
618 	int srcsg = minsg;
619 	int soffset = 0, sless;
620 
621 	if (sg_dma_len(src) == srcskip) {
622 		src = sg_next(src);
623 		srcskip = 0;
624 	}
625 	while (src && space > (sgl_ent_len[srcsg + 1])) {
626 		sless = min_t(unsigned int, sg_dma_len(src) - soffset -	srcskip,
627 							CHCR_SRC_SG_SIZE);
628 		srclen += sless;
629 		soffset += sless;
630 		srcsg++;
631 		if (sg_dma_len(src) == (soffset + srcskip)) {
632 			src = sg_next(src);
633 			soffset = 0;
634 			srcskip = 0;
635 		}
636 	}
637 	return srclen;
638 }
639 
640 static int chcr_sg_ent_in_wr(struct scatterlist *src,
641 			     struct scatterlist *dst,
642 			     unsigned int minsg,
643 			     unsigned int space,
644 			     unsigned int srcskip,
645 			     unsigned int dstskip)
646 {
647 	int srclen = 0, dstlen = 0;
648 	int srcsg = minsg, dstsg = minsg;
649 	int offset = 0, soffset = 0, less, sless = 0;
650 
651 	if (sg_dma_len(src) == srcskip) {
652 		src = sg_next(src);
653 		srcskip = 0;
654 	}
655 	if (sg_dma_len(dst) == dstskip) {
656 		dst = sg_next(dst);
657 		dstskip = 0;
658 	}
659 
660 	while (src && dst &&
661 	       space > (sgl_ent_len[srcsg + 1] + dsgl_ent_len[dstsg])) {
662 		sless = min_t(unsigned int, sg_dma_len(src) - srcskip - soffset,
663 				CHCR_SRC_SG_SIZE);
664 		srclen += sless;
665 		srcsg++;
666 		offset = 0;
667 		while (dst && ((dstsg + 1) <= MAX_DSGL_ENT) &&
668 		       space > (sgl_ent_len[srcsg] + dsgl_ent_len[dstsg + 1])) {
669 			if (srclen <= dstlen)
670 				break;
671 			less = min_t(unsigned int, sg_dma_len(dst) - offset -
672 				     dstskip, CHCR_DST_SG_SIZE);
673 			dstlen += less;
674 			offset += less;
675 			if ((offset + dstskip) == sg_dma_len(dst)) {
676 				dst = sg_next(dst);
677 				offset = 0;
678 			}
679 			dstsg++;
680 			dstskip = 0;
681 		}
682 		soffset += sless;
683 		if ((soffset + srcskip) == sg_dma_len(src)) {
684 			src = sg_next(src);
685 			srcskip = 0;
686 			soffset = 0;
687 		}
688 
689 	}
690 	return min(srclen, dstlen);
691 }
692 
693 static int chcr_cipher_fallback(struct crypto_skcipher *cipher,
694 				struct skcipher_request *req,
695 				u8 *iv,
696 				unsigned short op_type)
697 {
698 	struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
699 	int err;
700 
701 	skcipher_request_set_tfm(&reqctx->fallback_req, cipher);
702 	skcipher_request_set_callback(&reqctx->fallback_req, req->base.flags,
703 				      req->base.complete, req->base.data);
704 	skcipher_request_set_crypt(&reqctx->fallback_req, req->src, req->dst,
705 				   req->cryptlen, iv);
706 
707 	err = op_type ? crypto_skcipher_decrypt(&reqctx->fallback_req) :
708 			crypto_skcipher_encrypt(&reqctx->fallback_req);
709 
710 	return err;
711 
712 }
713 
714 static inline int get_qidxs(struct crypto_async_request *req,
715 			    unsigned int *txqidx, unsigned int *rxqidx)
716 {
717 	struct crypto_tfm *tfm = req->tfm;
718 	int ret = 0;
719 
720 	switch (tfm->__crt_alg->cra_flags & CRYPTO_ALG_TYPE_MASK) {
721 	case CRYPTO_ALG_TYPE_AEAD:
722 	{
723 		struct aead_request *aead_req =
724 			container_of(req, struct aead_request, base);
725 		struct chcr_aead_reqctx *reqctx = aead_request_ctx(aead_req);
726 		*txqidx = reqctx->txqidx;
727 		*rxqidx = reqctx->rxqidx;
728 		break;
729 	}
730 	case CRYPTO_ALG_TYPE_SKCIPHER:
731 	{
732 		struct skcipher_request *sk_req =
733 			container_of(req, struct skcipher_request, base);
734 		struct chcr_skcipher_req_ctx *reqctx =
735 			skcipher_request_ctx(sk_req);
736 		*txqidx = reqctx->txqidx;
737 		*rxqidx = reqctx->rxqidx;
738 		break;
739 	}
740 	case CRYPTO_ALG_TYPE_AHASH:
741 	{
742 		struct ahash_request *ahash_req =
743 			container_of(req, struct ahash_request, base);
744 		struct chcr_ahash_req_ctx *reqctx =
745 			ahash_request_ctx(ahash_req);
746 		*txqidx = reqctx->txqidx;
747 		*rxqidx = reqctx->rxqidx;
748 		break;
749 	}
750 	default:
751 		ret = -EINVAL;
752 		/* should never get here */
753 		BUG();
754 		break;
755 	}
756 	return ret;
757 }
758 
759 static inline void create_wreq(struct chcr_context *ctx,
760 			       struct chcr_wr *chcr_req,
761 			       struct crypto_async_request *req,
762 			       unsigned int imm,
763 			       int hash_sz,
764 			       unsigned int len16,
765 			       unsigned int sc_len,
766 			       unsigned int lcb)
767 {
768 	struct uld_ctx *u_ctx = ULD_CTX(ctx);
769 	unsigned int tx_channel_id, rx_channel_id;
770 	unsigned int txqidx = 0, rxqidx = 0;
771 	unsigned int qid, fid;
772 
773 	get_qidxs(req, &txqidx, &rxqidx);
774 	qid = u_ctx->lldi.rxq_ids[rxqidx];
775 	fid = u_ctx->lldi.rxq_ids[0];
776 	tx_channel_id = txqidx / ctx->txq_perchan;
777 	rx_channel_id = rxqidx / ctx->rxq_perchan;
778 
779 
780 	chcr_req->wreq.op_to_cctx_size = FILL_WR_OP_CCTX_SIZE;
781 	chcr_req->wreq.pld_size_hash_size =
782 		htonl(FW_CRYPTO_LOOKASIDE_WR_HASH_SIZE_V(hash_sz));
783 	chcr_req->wreq.len16_pkd =
784 		htonl(FW_CRYPTO_LOOKASIDE_WR_LEN16_V(DIV_ROUND_UP(len16, 16)));
785 	chcr_req->wreq.cookie = cpu_to_be64((uintptr_t)req);
786 	chcr_req->wreq.rx_chid_to_rx_q_id = FILL_WR_RX_Q_ID(rx_channel_id, qid,
787 							    !!lcb, txqidx);
788 
789 	chcr_req->ulptx.cmd_dest = FILL_ULPTX_CMD_DEST(tx_channel_id, fid);
790 	chcr_req->ulptx.len = htonl((DIV_ROUND_UP(len16, 16) -
791 				((sizeof(chcr_req->wreq)) >> 4)));
792 	chcr_req->sc_imm.cmd_more = FILL_CMD_MORE(!imm);
793 	chcr_req->sc_imm.len = cpu_to_be32(sizeof(struct cpl_tx_sec_pdu) +
794 					   sizeof(chcr_req->key_ctx) + sc_len);
795 }
796 
797 /**
798  *	create_cipher_wr - form the WR for cipher operations
799  *	@req: cipher req.
800  *	@ctx: crypto driver context of the request.
801  *	@qid: ingress qid where response of this WR should be received.
802  *	@op_type:	encryption or decryption
803  */
804 static struct sk_buff *create_cipher_wr(struct cipher_wr_param *wrparam)
805 {
806 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(wrparam->req);
807 	struct chcr_context *ctx = c_ctx(tfm);
808 	struct ablk_ctx *ablkctx = ABLK_CTX(ctx);
809 	struct sk_buff *skb = NULL;
810 	struct chcr_wr *chcr_req;
811 	struct cpl_rx_phys_dsgl *phys_cpl;
812 	struct ulptx_sgl *ulptx;
813 	struct chcr_skcipher_req_ctx *reqctx =
814 		skcipher_request_ctx(wrparam->req);
815 	unsigned int temp = 0, transhdr_len, dst_size;
816 	int error;
817 	int nents;
818 	unsigned int kctx_len;
819 	gfp_t flags = wrparam->req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP ?
820 			GFP_KERNEL : GFP_ATOMIC;
821 	struct adapter *adap = padap(ctx->dev);
822 	unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
823 
824 	nents = sg_nents_xlen(reqctx->dstsg,  wrparam->bytes, CHCR_DST_SG_SIZE,
825 			      reqctx->dst_ofst);
826 	dst_size = get_space_for_phys_dsgl(nents);
827 	kctx_len = roundup(ablkctx->enckey_len, 16);
828 	transhdr_len = CIPHER_TRANSHDR_SIZE(kctx_len, dst_size);
829 	nents = sg_nents_xlen(reqctx->srcsg, wrparam->bytes,
830 				  CHCR_SRC_SG_SIZE, reqctx->src_ofst);
831 	temp = reqctx->imm ? roundup(wrparam->bytes, 16) :
832 				     (sgl_len(nents) * 8);
833 	transhdr_len += temp;
834 	transhdr_len = roundup(transhdr_len, 16);
835 	skb = alloc_skb(SGE_MAX_WR_LEN, flags);
836 	if (!skb) {
837 		error = -ENOMEM;
838 		goto err;
839 	}
840 	chcr_req = __skb_put_zero(skb, transhdr_len);
841 	chcr_req->sec_cpl.op_ivinsrtofst =
842 			FILL_SEC_CPL_OP_IVINSR(rx_channel_id, 2, 1);
843 
844 	chcr_req->sec_cpl.pldlen = htonl(IV + wrparam->bytes);
845 	chcr_req->sec_cpl.aadstart_cipherstop_hi =
846 			FILL_SEC_CPL_CIPHERSTOP_HI(0, 0, IV + 1, 0);
847 
848 	chcr_req->sec_cpl.cipherstop_lo_authinsert =
849 			FILL_SEC_CPL_AUTHINSERT(0, 0, 0, 0);
850 	chcr_req->sec_cpl.seqno_numivs = FILL_SEC_CPL_SCMD0_SEQNO(reqctx->op, 0,
851 							 ablkctx->ciph_mode,
852 							 0, 0, IV >> 1);
853 	chcr_req->sec_cpl.ivgen_hdrlen = FILL_SEC_CPL_IVGEN_HDRLEN(0, 0, 0,
854 							  0, 1, dst_size);
855 
856 	chcr_req->key_ctx.ctx_hdr = ablkctx->key_ctx_hdr;
857 	if ((reqctx->op == CHCR_DECRYPT_OP) &&
858 	    (!(get_cryptoalg_subtype(tfm) ==
859 	       CRYPTO_ALG_SUB_TYPE_CTR)) &&
860 	    (!(get_cryptoalg_subtype(tfm) ==
861 	       CRYPTO_ALG_SUB_TYPE_CTR_RFC3686))) {
862 		generate_copy_rrkey(ablkctx, &chcr_req->key_ctx);
863 	} else {
864 		if ((ablkctx->ciph_mode == CHCR_SCMD_CIPHER_MODE_AES_CBC) ||
865 		    (ablkctx->ciph_mode == CHCR_SCMD_CIPHER_MODE_AES_CTR)) {
866 			memcpy(chcr_req->key_ctx.key, ablkctx->key,
867 			       ablkctx->enckey_len);
868 		} else {
869 			memcpy(chcr_req->key_ctx.key, ablkctx->key +
870 			       (ablkctx->enckey_len >> 1),
871 			       ablkctx->enckey_len >> 1);
872 			memcpy(chcr_req->key_ctx.key +
873 			       (ablkctx->enckey_len >> 1),
874 			       ablkctx->key,
875 			       ablkctx->enckey_len >> 1);
876 		}
877 	}
878 	phys_cpl = (struct cpl_rx_phys_dsgl *)((u8 *)(chcr_req + 1) + kctx_len);
879 	ulptx = (struct ulptx_sgl *)((u8 *)(phys_cpl + 1) + dst_size);
880 	chcr_add_cipher_src_ent(wrparam->req, ulptx, wrparam);
881 	chcr_add_cipher_dst_ent(wrparam->req, phys_cpl, wrparam, wrparam->qid);
882 
883 	atomic_inc(&adap->chcr_stats.cipher_rqst);
884 	temp = sizeof(struct cpl_rx_phys_dsgl) + dst_size + kctx_len + IV
885 		+ (reqctx->imm ? (wrparam->bytes) : 0);
886 	create_wreq(c_ctx(tfm), chcr_req, &(wrparam->req->base), reqctx->imm, 0,
887 		    transhdr_len, temp,
888 			ablkctx->ciph_mode == CHCR_SCMD_CIPHER_MODE_AES_CBC);
889 	reqctx->skb = skb;
890 
891 	if (reqctx->op && (ablkctx->ciph_mode ==
892 			   CHCR_SCMD_CIPHER_MODE_AES_CBC))
893 		sg_pcopy_to_buffer(wrparam->req->src,
894 			sg_nents(wrparam->req->src), wrparam->req->iv, 16,
895 			reqctx->processed + wrparam->bytes - AES_BLOCK_SIZE);
896 
897 	return skb;
898 err:
899 	return ERR_PTR(error);
900 }
901 
902 static inline int chcr_keyctx_ck_size(unsigned int keylen)
903 {
904 	int ck_size = 0;
905 
906 	if (keylen == AES_KEYSIZE_128)
907 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_128;
908 	else if (keylen == AES_KEYSIZE_192)
909 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_192;
910 	else if (keylen == AES_KEYSIZE_256)
911 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_256;
912 	else
913 		ck_size = 0;
914 
915 	return ck_size;
916 }
917 static int chcr_cipher_fallback_setkey(struct crypto_skcipher *cipher,
918 				       const u8 *key,
919 				       unsigned int keylen)
920 {
921 	struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));
922 
923 	crypto_skcipher_clear_flags(ablkctx->sw_cipher,
924 				CRYPTO_TFM_REQ_MASK);
925 	crypto_skcipher_set_flags(ablkctx->sw_cipher,
926 				cipher->base.crt_flags & CRYPTO_TFM_REQ_MASK);
927 	return crypto_skcipher_setkey(ablkctx->sw_cipher, key, keylen);
928 }
929 
930 static int chcr_aes_cbc_setkey(struct crypto_skcipher *cipher,
931 			       const u8 *key,
932 			       unsigned int keylen)
933 {
934 	struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));
935 	unsigned int ck_size, context_size;
936 	u16 alignment = 0;
937 	int err;
938 
939 	err = chcr_cipher_fallback_setkey(cipher, key, keylen);
940 	if (err)
941 		goto badkey_err;
942 
943 	ck_size = chcr_keyctx_ck_size(keylen);
944 	alignment = ck_size == CHCR_KEYCTX_CIPHER_KEY_SIZE_192 ? 8 : 0;
945 	memcpy(ablkctx->key, key, keylen);
946 	ablkctx->enckey_len = keylen;
947 	get_aes_decrypt_key(ablkctx->rrkey, ablkctx->key, keylen << 3);
948 	context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD +
949 			keylen + alignment) >> 4;
950 
951 	ablkctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, CHCR_KEYCTX_NO_KEY,
952 						0, 0, context_size);
953 	ablkctx->ciph_mode = CHCR_SCMD_CIPHER_MODE_AES_CBC;
954 	return 0;
955 badkey_err:
956 	ablkctx->enckey_len = 0;
957 
958 	return err;
959 }
960 
961 static int chcr_aes_ctr_setkey(struct crypto_skcipher *cipher,
962 				   const u8 *key,
963 				   unsigned int keylen)
964 {
965 	struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));
966 	unsigned int ck_size, context_size;
967 	u16 alignment = 0;
968 	int err;
969 
970 	err = chcr_cipher_fallback_setkey(cipher, key, keylen);
971 	if (err)
972 		goto badkey_err;
973 	ck_size = chcr_keyctx_ck_size(keylen);
974 	alignment = (ck_size == CHCR_KEYCTX_CIPHER_KEY_SIZE_192) ? 8 : 0;
975 	memcpy(ablkctx->key, key, keylen);
976 	ablkctx->enckey_len = keylen;
977 	context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD +
978 			keylen + alignment) >> 4;
979 
980 	ablkctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, CHCR_KEYCTX_NO_KEY,
981 						0, 0, context_size);
982 	ablkctx->ciph_mode = CHCR_SCMD_CIPHER_MODE_AES_CTR;
983 
984 	return 0;
985 badkey_err:
986 	ablkctx->enckey_len = 0;
987 
988 	return err;
989 }
990 
991 static int chcr_aes_rfc3686_setkey(struct crypto_skcipher *cipher,
992 				   const u8 *key,
993 				   unsigned int keylen)
994 {
995 	struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));
996 	unsigned int ck_size, context_size;
997 	u16 alignment = 0;
998 	int err;
999 
1000 	if (keylen < CTR_RFC3686_NONCE_SIZE)
1001 		return -EINVAL;
1002 	memcpy(ablkctx->nonce, key + (keylen - CTR_RFC3686_NONCE_SIZE),
1003 	       CTR_RFC3686_NONCE_SIZE);
1004 
1005 	keylen -= CTR_RFC3686_NONCE_SIZE;
1006 	err = chcr_cipher_fallback_setkey(cipher, key, keylen);
1007 	if (err)
1008 		goto badkey_err;
1009 
1010 	ck_size = chcr_keyctx_ck_size(keylen);
1011 	alignment = (ck_size == CHCR_KEYCTX_CIPHER_KEY_SIZE_192) ? 8 : 0;
1012 	memcpy(ablkctx->key, key, keylen);
1013 	ablkctx->enckey_len = keylen;
1014 	context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD +
1015 			keylen + alignment) >> 4;
1016 
1017 	ablkctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, CHCR_KEYCTX_NO_KEY,
1018 						0, 0, context_size);
1019 	ablkctx->ciph_mode = CHCR_SCMD_CIPHER_MODE_AES_CTR;
1020 
1021 	return 0;
1022 badkey_err:
1023 	ablkctx->enckey_len = 0;
1024 
1025 	return err;
1026 }
1027 static void ctr_add_iv(u8 *dstiv, u8 *srciv, u32 add)
1028 {
1029 	unsigned int size = AES_BLOCK_SIZE;
1030 	__be32 *b = (__be32 *)(dstiv + size);
1031 	u32 c, prev;
1032 
1033 	memcpy(dstiv, srciv, AES_BLOCK_SIZE);
1034 	for (; size >= 4; size -= 4) {
1035 		prev = be32_to_cpu(*--b);
1036 		c = prev + add;
1037 		*b = cpu_to_be32(c);
1038 		if (prev < c)
1039 			break;
1040 		add = 1;
1041 	}
1042 
1043 }
1044 
1045 static unsigned int adjust_ctr_overflow(u8 *iv, u32 bytes)
1046 {
1047 	__be32 *b = (__be32 *)(iv + AES_BLOCK_SIZE);
1048 	u64 c;
1049 	u32 temp = be32_to_cpu(*--b);
1050 
1051 	temp = ~temp;
1052 	c = (u64)temp +  1; // No of block can processed without overflow
1053 	if ((bytes / AES_BLOCK_SIZE) >= c)
1054 		bytes = c * AES_BLOCK_SIZE;
1055 	return bytes;
1056 }
1057 
1058 static int chcr_update_tweak(struct skcipher_request *req, u8 *iv,
1059 			     u32 isfinal)
1060 {
1061 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
1062 	struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(tfm));
1063 	struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
1064 	struct crypto_aes_ctx aes;
1065 	int ret, i;
1066 	u8 *key;
1067 	unsigned int keylen;
1068 	int round = reqctx->last_req_len / AES_BLOCK_SIZE;
1069 	int round8 = round / 8;
1070 
1071 	memcpy(iv, reqctx->iv, AES_BLOCK_SIZE);
1072 
1073 	keylen = ablkctx->enckey_len / 2;
1074 	key = ablkctx->key + keylen;
1075 	/* For a 192 bit key remove the padded zeroes which was
1076 	 * added in chcr_xts_setkey
1077 	 */
1078 	if (KEY_CONTEXT_CK_SIZE_G(ntohl(ablkctx->key_ctx_hdr))
1079 			== CHCR_KEYCTX_CIPHER_KEY_SIZE_192)
1080 		ret = aes_expandkey(&aes, key, keylen - 8);
1081 	else
1082 		ret = aes_expandkey(&aes, key, keylen);
1083 	if (ret)
1084 		return ret;
1085 	aes_encrypt(&aes, iv, iv);
1086 	for (i = 0; i < round8; i++)
1087 		gf128mul_x8_ble((le128 *)iv, (le128 *)iv);
1088 
1089 	for (i = 0; i < (round % 8); i++)
1090 		gf128mul_x_ble((le128 *)iv, (le128 *)iv);
1091 
1092 	if (!isfinal)
1093 		aes_decrypt(&aes, iv, iv);
1094 
1095 	memzero_explicit(&aes, sizeof(aes));
1096 	return 0;
1097 }
1098 
1099 static int chcr_update_cipher_iv(struct skcipher_request *req,
1100 				   struct cpl_fw6_pld *fw6_pld, u8 *iv)
1101 {
1102 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
1103 	struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
1104 	int subtype = get_cryptoalg_subtype(tfm);
1105 	int ret = 0;
1106 
1107 	if (subtype == CRYPTO_ALG_SUB_TYPE_CTR)
1108 		ctr_add_iv(iv, req->iv, (reqctx->processed /
1109 			   AES_BLOCK_SIZE));
1110 	else if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_RFC3686)
1111 		*(__be32 *)(reqctx->iv + CTR_RFC3686_NONCE_SIZE +
1112 			CTR_RFC3686_IV_SIZE) = cpu_to_be32((reqctx->processed /
1113 						AES_BLOCK_SIZE) + 1);
1114 	else if (subtype == CRYPTO_ALG_SUB_TYPE_XTS)
1115 		ret = chcr_update_tweak(req, iv, 0);
1116 	else if (subtype == CRYPTO_ALG_SUB_TYPE_CBC) {
1117 		if (reqctx->op)
1118 			/*Updated before sending last WR*/
1119 			memcpy(iv, req->iv, AES_BLOCK_SIZE);
1120 		else
1121 			memcpy(iv, &fw6_pld->data[2], AES_BLOCK_SIZE);
1122 	}
1123 
1124 	return ret;
1125 
1126 }
1127 
1128 /* We need separate function for final iv because in rfc3686  Initial counter
1129  * starts from 1 and buffer size of iv is 8 byte only which remains constant
1130  * for subsequent update requests
1131  */
1132 
1133 static int chcr_final_cipher_iv(struct skcipher_request *req,
1134 				   struct cpl_fw6_pld *fw6_pld, u8 *iv)
1135 {
1136 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
1137 	struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
1138 	int subtype = get_cryptoalg_subtype(tfm);
1139 	int ret = 0;
1140 
1141 	if (subtype == CRYPTO_ALG_SUB_TYPE_CTR)
1142 		ctr_add_iv(iv, req->iv, DIV_ROUND_UP(reqctx->processed,
1143 						       AES_BLOCK_SIZE));
1144 	else if (subtype == CRYPTO_ALG_SUB_TYPE_XTS) {
1145 		if (!reqctx->partial_req)
1146 			memcpy(iv, reqctx->iv, AES_BLOCK_SIZE);
1147 		else
1148 			ret = chcr_update_tweak(req, iv, 1);
1149 	}
1150 	else if (subtype == CRYPTO_ALG_SUB_TYPE_CBC) {
1151 		/*Already updated for Decrypt*/
1152 		if (!reqctx->op)
1153 			memcpy(iv, &fw6_pld->data[2], AES_BLOCK_SIZE);
1154 
1155 	}
1156 	return ret;
1157 
1158 }
1159 
1160 static int chcr_handle_cipher_resp(struct skcipher_request *req,
1161 				   unsigned char *input, int err)
1162 {
1163 	struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
1164 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
1165 	struct cpl_fw6_pld *fw6_pld = (struct cpl_fw6_pld *)input;
1166 	struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(tfm));
1167 	struct uld_ctx *u_ctx = ULD_CTX(c_ctx(tfm));
1168 	struct chcr_dev *dev = c_ctx(tfm)->dev;
1169 	struct chcr_context *ctx = c_ctx(tfm);
1170 	struct adapter *adap = padap(ctx->dev);
1171 	struct cipher_wr_param wrparam;
1172 	struct sk_buff *skb;
1173 	int bytes;
1174 
1175 	if (err)
1176 		goto unmap;
1177 	if (req->cryptlen == reqctx->processed) {
1178 		chcr_cipher_dma_unmap(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev,
1179 				      req);
1180 		err = chcr_final_cipher_iv(req, fw6_pld, req->iv);
1181 		goto complete;
1182 	}
1183 
1184 	if (!reqctx->imm) {
1185 		bytes = chcr_sg_ent_in_wr(reqctx->srcsg, reqctx->dstsg, 0,
1186 					  CIP_SPACE_LEFT(ablkctx->enckey_len),
1187 					  reqctx->src_ofst, reqctx->dst_ofst);
1188 		if ((bytes + reqctx->processed) >= req->cryptlen)
1189 			bytes  = req->cryptlen - reqctx->processed;
1190 		else
1191 			bytes = rounddown(bytes, 16);
1192 	} else {
1193 		/*CTR mode counter overfloa*/
1194 		bytes  = req->cryptlen - reqctx->processed;
1195 	}
1196 	err = chcr_update_cipher_iv(req, fw6_pld, reqctx->iv);
1197 	if (err)
1198 		goto unmap;
1199 
1200 	if (unlikely(bytes == 0)) {
1201 		chcr_cipher_dma_unmap(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev,
1202 				      req);
1203 		memcpy(req->iv, reqctx->init_iv, IV);
1204 		atomic_inc(&adap->chcr_stats.fallback);
1205 		err = chcr_cipher_fallback(ablkctx->sw_cipher, req, req->iv,
1206 					   reqctx->op);
1207 		goto complete;
1208 	}
1209 
1210 	if (get_cryptoalg_subtype(tfm) ==
1211 	    CRYPTO_ALG_SUB_TYPE_CTR)
1212 		bytes = adjust_ctr_overflow(reqctx->iv, bytes);
1213 	wrparam.qid = u_ctx->lldi.rxq_ids[reqctx->rxqidx];
1214 	wrparam.req = req;
1215 	wrparam.bytes = bytes;
1216 	skb = create_cipher_wr(&wrparam);
1217 	if (IS_ERR(skb)) {
1218 		pr_err("%s : Failed to form WR. No memory\n", __func__);
1219 		err = PTR_ERR(skb);
1220 		goto unmap;
1221 	}
1222 	skb->dev = u_ctx->lldi.ports[0];
1223 	set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
1224 	chcr_send_wr(skb);
1225 	reqctx->last_req_len = bytes;
1226 	reqctx->processed += bytes;
1227 	if (get_cryptoalg_subtype(tfm) ==
1228 		CRYPTO_ALG_SUB_TYPE_CBC && req->base.flags ==
1229 			CRYPTO_TFM_REQ_MAY_SLEEP ) {
1230 		complete(&ctx->cbc_aes_aio_done);
1231 	}
1232 	return 0;
1233 unmap:
1234 	chcr_cipher_dma_unmap(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev, req);
1235 complete:
1236 	if (get_cryptoalg_subtype(tfm) ==
1237 		CRYPTO_ALG_SUB_TYPE_CBC && req->base.flags ==
1238 			CRYPTO_TFM_REQ_MAY_SLEEP ) {
1239 		complete(&ctx->cbc_aes_aio_done);
1240 	}
1241 	chcr_dec_wrcount(dev);
1242 	req->base.complete(&req->base, err);
1243 	return err;
1244 }
1245 
1246 static int process_cipher(struct skcipher_request *req,
1247 				  unsigned short qid,
1248 				  struct sk_buff **skb,
1249 				  unsigned short op_type)
1250 {
1251 	struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
1252 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
1253 	unsigned int ivsize = crypto_skcipher_ivsize(tfm);
1254 	struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(tfm));
1255 	struct adapter *adap = padap(c_ctx(tfm)->dev);
1256 	struct	cipher_wr_param wrparam;
1257 	int bytes, err = -EINVAL;
1258 	int subtype;
1259 
1260 	reqctx->processed = 0;
1261 	reqctx->partial_req = 0;
1262 	if (!req->iv)
1263 		goto error;
1264 	subtype = get_cryptoalg_subtype(tfm);
1265 	if ((ablkctx->enckey_len == 0) || (ivsize > AES_BLOCK_SIZE) ||
1266 	    (req->cryptlen == 0) ||
1267 	    (req->cryptlen % crypto_skcipher_blocksize(tfm))) {
1268 		if (req->cryptlen == 0 && subtype != CRYPTO_ALG_SUB_TYPE_XTS)
1269 			goto fallback;
1270 		else if (req->cryptlen % crypto_skcipher_blocksize(tfm) &&
1271 			 subtype == CRYPTO_ALG_SUB_TYPE_XTS)
1272 			goto fallback;
1273 		pr_err("AES: Invalid value of Key Len %d nbytes %d IV Len %d\n",
1274 		       ablkctx->enckey_len, req->cryptlen, ivsize);
1275 		goto error;
1276 	}
1277 
1278 	err = chcr_cipher_dma_map(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev, req);
1279 	if (err)
1280 		goto error;
1281 	if (req->cryptlen < (SGE_MAX_WR_LEN - (sizeof(struct chcr_wr) +
1282 					    AES_MIN_KEY_SIZE +
1283 					    sizeof(struct cpl_rx_phys_dsgl) +
1284 					/*Min dsgl size*/
1285 					    32))) {
1286 		/* Can be sent as Imm*/
1287 		unsigned int dnents = 0, transhdr_len, phys_dsgl, kctx_len;
1288 
1289 		dnents = sg_nents_xlen(req->dst, req->cryptlen,
1290 				       CHCR_DST_SG_SIZE, 0);
1291 		phys_dsgl = get_space_for_phys_dsgl(dnents);
1292 		kctx_len = roundup(ablkctx->enckey_len, 16);
1293 		transhdr_len = CIPHER_TRANSHDR_SIZE(kctx_len, phys_dsgl);
1294 		reqctx->imm = (transhdr_len + IV + req->cryptlen) <=
1295 			SGE_MAX_WR_LEN;
1296 		bytes = IV + req->cryptlen;
1297 
1298 	} else {
1299 		reqctx->imm = 0;
1300 	}
1301 
1302 	if (!reqctx->imm) {
1303 		bytes = chcr_sg_ent_in_wr(req->src, req->dst, 0,
1304 					  CIP_SPACE_LEFT(ablkctx->enckey_len),
1305 					  0, 0);
1306 		if ((bytes + reqctx->processed) >= req->cryptlen)
1307 			bytes  = req->cryptlen - reqctx->processed;
1308 		else
1309 			bytes = rounddown(bytes, 16);
1310 	} else {
1311 		bytes = req->cryptlen;
1312 	}
1313 	if (subtype == CRYPTO_ALG_SUB_TYPE_CTR) {
1314 		bytes = adjust_ctr_overflow(req->iv, bytes);
1315 	}
1316 	if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_RFC3686) {
1317 		memcpy(reqctx->iv, ablkctx->nonce, CTR_RFC3686_NONCE_SIZE);
1318 		memcpy(reqctx->iv + CTR_RFC3686_NONCE_SIZE, req->iv,
1319 				CTR_RFC3686_IV_SIZE);
1320 
1321 		/* initialize counter portion of counter block */
1322 		*(__be32 *)(reqctx->iv + CTR_RFC3686_NONCE_SIZE +
1323 			CTR_RFC3686_IV_SIZE) = cpu_to_be32(1);
1324 		memcpy(reqctx->init_iv, reqctx->iv, IV);
1325 
1326 	} else {
1327 
1328 		memcpy(reqctx->iv, req->iv, IV);
1329 		memcpy(reqctx->init_iv, req->iv, IV);
1330 	}
1331 	if (unlikely(bytes == 0)) {
1332 		chcr_cipher_dma_unmap(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev,
1333 				      req);
1334 fallback:       atomic_inc(&adap->chcr_stats.fallback);
1335 		err = chcr_cipher_fallback(ablkctx->sw_cipher, req,
1336 					   subtype ==
1337 					   CRYPTO_ALG_SUB_TYPE_CTR_RFC3686 ?
1338 					   reqctx->iv : req->iv,
1339 					   op_type);
1340 		goto error;
1341 	}
1342 	reqctx->op = op_type;
1343 	reqctx->srcsg = req->src;
1344 	reqctx->dstsg = req->dst;
1345 	reqctx->src_ofst = 0;
1346 	reqctx->dst_ofst = 0;
1347 	wrparam.qid = qid;
1348 	wrparam.req = req;
1349 	wrparam.bytes = bytes;
1350 	*skb = create_cipher_wr(&wrparam);
1351 	if (IS_ERR(*skb)) {
1352 		err = PTR_ERR(*skb);
1353 		goto unmap;
1354 	}
1355 	reqctx->processed = bytes;
1356 	reqctx->last_req_len = bytes;
1357 	reqctx->partial_req = !!(req->cryptlen - reqctx->processed);
1358 
1359 	return 0;
1360 unmap:
1361 	chcr_cipher_dma_unmap(&ULD_CTX(c_ctx(tfm))->lldi.pdev->dev, req);
1362 error:
1363 	return err;
1364 }
1365 
1366 static int chcr_aes_encrypt(struct skcipher_request *req)
1367 {
1368 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
1369 	struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
1370 	struct chcr_dev *dev = c_ctx(tfm)->dev;
1371 	struct sk_buff *skb = NULL;
1372 	int err;
1373 	struct uld_ctx *u_ctx = ULD_CTX(c_ctx(tfm));
1374 	struct chcr_context *ctx = c_ctx(tfm);
1375 	unsigned int cpu;
1376 
1377 	cpu = get_cpu();
1378 	reqctx->txqidx = cpu % ctx->ntxq;
1379 	reqctx->rxqidx = cpu % ctx->nrxq;
1380 	put_cpu();
1381 
1382 	err = chcr_inc_wrcount(dev);
1383 	if (err)
1384 		return -ENXIO;
1385 	if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
1386 						reqctx->txqidx) &&
1387 		(!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG)))) {
1388 			err = -ENOSPC;
1389 			goto error;
1390 	}
1391 
1392 	err = process_cipher(req, u_ctx->lldi.rxq_ids[reqctx->rxqidx],
1393 			     &skb, CHCR_ENCRYPT_OP);
1394 	if (err || !skb)
1395 		return  err;
1396 	skb->dev = u_ctx->lldi.ports[0];
1397 	set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
1398 	chcr_send_wr(skb);
1399 	if (get_cryptoalg_subtype(tfm) ==
1400 		CRYPTO_ALG_SUB_TYPE_CBC && req->base.flags ==
1401 			CRYPTO_TFM_REQ_MAY_SLEEP ) {
1402 			reqctx->partial_req = 1;
1403 			wait_for_completion(&ctx->cbc_aes_aio_done);
1404         }
1405 	return -EINPROGRESS;
1406 error:
1407 	chcr_dec_wrcount(dev);
1408 	return err;
1409 }
1410 
1411 static int chcr_aes_decrypt(struct skcipher_request *req)
1412 {
1413 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
1414 	struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
1415 	struct uld_ctx *u_ctx = ULD_CTX(c_ctx(tfm));
1416 	struct chcr_dev *dev = c_ctx(tfm)->dev;
1417 	struct sk_buff *skb = NULL;
1418 	int err;
1419 	struct chcr_context *ctx = c_ctx(tfm);
1420 	unsigned int cpu;
1421 
1422 	cpu = get_cpu();
1423 	reqctx->txqidx = cpu % ctx->ntxq;
1424 	reqctx->rxqidx = cpu % ctx->nrxq;
1425 	put_cpu();
1426 
1427 	err = chcr_inc_wrcount(dev);
1428 	if (err)
1429 		return -ENXIO;
1430 
1431 	if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
1432 						reqctx->txqidx) &&
1433 		(!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG))))
1434 			return -ENOSPC;
1435 	err = process_cipher(req, u_ctx->lldi.rxq_ids[reqctx->rxqidx],
1436 			     &skb, CHCR_DECRYPT_OP);
1437 	if (err || !skb)
1438 		return err;
1439 	skb->dev = u_ctx->lldi.ports[0];
1440 	set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
1441 	chcr_send_wr(skb);
1442 	return -EINPROGRESS;
1443 }
1444 static int chcr_device_init(struct chcr_context *ctx)
1445 {
1446 	struct uld_ctx *u_ctx = NULL;
1447 	int txq_perchan, ntxq;
1448 	int err = 0, rxq_perchan;
1449 
1450 	if (!ctx->dev) {
1451 		u_ctx = assign_chcr_device();
1452 		if (!u_ctx) {
1453 			err = -ENXIO;
1454 			pr_err("chcr device assignment fails\n");
1455 			goto out;
1456 		}
1457 		ctx->dev = &u_ctx->dev;
1458 		ntxq = u_ctx->lldi.ntxq;
1459 		rxq_perchan = u_ctx->lldi.nrxq / u_ctx->lldi.nchan;
1460 		txq_perchan = ntxq / u_ctx->lldi.nchan;
1461 		ctx->ntxq = ntxq;
1462 		ctx->nrxq = u_ctx->lldi.nrxq;
1463 		ctx->rxq_perchan = rxq_perchan;
1464 		ctx->txq_perchan = txq_perchan;
1465 	}
1466 out:
1467 	return err;
1468 }
1469 
1470 static int chcr_init_tfm(struct crypto_skcipher *tfm)
1471 {
1472 	struct skcipher_alg *alg = crypto_skcipher_alg(tfm);
1473 	struct chcr_context *ctx = crypto_skcipher_ctx(tfm);
1474 	struct ablk_ctx *ablkctx = ABLK_CTX(ctx);
1475 
1476 	ablkctx->sw_cipher = crypto_alloc_skcipher(alg->base.cra_name, 0,
1477 				CRYPTO_ALG_NEED_FALLBACK);
1478 	if (IS_ERR(ablkctx->sw_cipher)) {
1479 		pr_err("failed to allocate fallback for %s\n", alg->base.cra_name);
1480 		return PTR_ERR(ablkctx->sw_cipher);
1481 	}
1482 	init_completion(&ctx->cbc_aes_aio_done);
1483 	crypto_skcipher_set_reqsize(tfm, sizeof(struct chcr_skcipher_req_ctx) +
1484 					 crypto_skcipher_reqsize(ablkctx->sw_cipher));
1485 
1486 	return chcr_device_init(ctx);
1487 }
1488 
1489 static int chcr_rfc3686_init(struct crypto_skcipher *tfm)
1490 {
1491 	struct skcipher_alg *alg = crypto_skcipher_alg(tfm);
1492 	struct chcr_context *ctx = crypto_skcipher_ctx(tfm);
1493 	struct ablk_ctx *ablkctx = ABLK_CTX(ctx);
1494 
1495 	/*RFC3686 initialises IV counter value to 1, rfc3686(ctr(aes))
1496 	 * cannot be used as fallback in chcr_handle_cipher_response
1497 	 */
1498 	ablkctx->sw_cipher = crypto_alloc_skcipher("ctr(aes)", 0,
1499 				CRYPTO_ALG_NEED_FALLBACK);
1500 	if (IS_ERR(ablkctx->sw_cipher)) {
1501 		pr_err("failed to allocate fallback for %s\n", alg->base.cra_name);
1502 		return PTR_ERR(ablkctx->sw_cipher);
1503 	}
1504 	crypto_skcipher_set_reqsize(tfm, sizeof(struct chcr_skcipher_req_ctx) +
1505 				    crypto_skcipher_reqsize(ablkctx->sw_cipher));
1506 	return chcr_device_init(ctx);
1507 }
1508 
1509 
1510 static void chcr_exit_tfm(struct crypto_skcipher *tfm)
1511 {
1512 	struct chcr_context *ctx = crypto_skcipher_ctx(tfm);
1513 	struct ablk_ctx *ablkctx = ABLK_CTX(ctx);
1514 
1515 	crypto_free_skcipher(ablkctx->sw_cipher);
1516 }
1517 
1518 static int get_alg_config(struct algo_param *params,
1519 			  unsigned int auth_size)
1520 {
1521 	switch (auth_size) {
1522 	case SHA1_DIGEST_SIZE:
1523 		params->mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_160;
1524 		params->auth_mode = CHCR_SCMD_AUTH_MODE_SHA1;
1525 		params->result_size = SHA1_DIGEST_SIZE;
1526 		break;
1527 	case SHA224_DIGEST_SIZE:
1528 		params->mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_256;
1529 		params->auth_mode = CHCR_SCMD_AUTH_MODE_SHA224;
1530 		params->result_size = SHA256_DIGEST_SIZE;
1531 		break;
1532 	case SHA256_DIGEST_SIZE:
1533 		params->mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_256;
1534 		params->auth_mode = CHCR_SCMD_AUTH_MODE_SHA256;
1535 		params->result_size = SHA256_DIGEST_SIZE;
1536 		break;
1537 	case SHA384_DIGEST_SIZE:
1538 		params->mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_512;
1539 		params->auth_mode = CHCR_SCMD_AUTH_MODE_SHA512_384;
1540 		params->result_size = SHA512_DIGEST_SIZE;
1541 		break;
1542 	case SHA512_DIGEST_SIZE:
1543 		params->mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_512;
1544 		params->auth_mode = CHCR_SCMD_AUTH_MODE_SHA512_512;
1545 		params->result_size = SHA512_DIGEST_SIZE;
1546 		break;
1547 	default:
1548 		pr_err("ERROR, unsupported digest size\n");
1549 		return -EINVAL;
1550 	}
1551 	return 0;
1552 }
1553 
1554 static inline void chcr_free_shash(struct crypto_shash *base_hash)
1555 {
1556 		crypto_free_shash(base_hash);
1557 }
1558 
1559 /**
1560  *	create_hash_wr - Create hash work request
1561  *	@req - Cipher req base
1562  */
1563 static struct sk_buff *create_hash_wr(struct ahash_request *req,
1564 				      struct hash_wr_param *param)
1565 {
1566 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
1567 	struct crypto_ahash *tfm = crypto_ahash_reqtfm(req);
1568 	struct chcr_context *ctx = h_ctx(tfm);
1569 	struct hmac_ctx *hmacctx = HMAC_CTX(ctx);
1570 	struct sk_buff *skb = NULL;
1571 	struct uld_ctx *u_ctx = ULD_CTX(ctx);
1572 	struct chcr_wr *chcr_req;
1573 	struct ulptx_sgl *ulptx;
1574 	unsigned int nents = 0, transhdr_len;
1575 	unsigned int temp = 0;
1576 	gfp_t flags = req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP ? GFP_KERNEL :
1577 		GFP_ATOMIC;
1578 	struct adapter *adap = padap(h_ctx(tfm)->dev);
1579 	int error = 0;
1580 	unsigned int rx_channel_id = req_ctx->rxqidx / ctx->rxq_perchan;
1581 
1582 	transhdr_len = HASH_TRANSHDR_SIZE(param->kctx_len);
1583 	req_ctx->hctx_wr.imm = (transhdr_len + param->bfr_len +
1584 				param->sg_len) <= SGE_MAX_WR_LEN;
1585 	nents = sg_nents_xlen(req_ctx->hctx_wr.srcsg, param->sg_len,
1586 		      CHCR_SRC_SG_SIZE, req_ctx->hctx_wr.src_ofst);
1587 	nents += param->bfr_len ? 1 : 0;
1588 	transhdr_len += req_ctx->hctx_wr.imm ? roundup(param->bfr_len +
1589 				param->sg_len, 16) : (sgl_len(nents) * 8);
1590 	transhdr_len = roundup(transhdr_len, 16);
1591 
1592 	skb = alloc_skb(transhdr_len, flags);
1593 	if (!skb)
1594 		return ERR_PTR(-ENOMEM);
1595 	chcr_req = __skb_put_zero(skb, transhdr_len);
1596 
1597 	chcr_req->sec_cpl.op_ivinsrtofst =
1598 		FILL_SEC_CPL_OP_IVINSR(rx_channel_id, 2, 0);
1599 
1600 	chcr_req->sec_cpl.pldlen = htonl(param->bfr_len + param->sg_len);
1601 
1602 	chcr_req->sec_cpl.aadstart_cipherstop_hi =
1603 		FILL_SEC_CPL_CIPHERSTOP_HI(0, 0, 0, 0);
1604 	chcr_req->sec_cpl.cipherstop_lo_authinsert =
1605 		FILL_SEC_CPL_AUTHINSERT(0, 1, 0, 0);
1606 	chcr_req->sec_cpl.seqno_numivs =
1607 		FILL_SEC_CPL_SCMD0_SEQNO(0, 0, 0, param->alg_prm.auth_mode,
1608 					 param->opad_needed, 0);
1609 
1610 	chcr_req->sec_cpl.ivgen_hdrlen =
1611 		FILL_SEC_CPL_IVGEN_HDRLEN(param->last, param->more, 0, 1, 0, 0);
1612 
1613 	memcpy(chcr_req->key_ctx.key, req_ctx->partial_hash,
1614 	       param->alg_prm.result_size);
1615 
1616 	if (param->opad_needed)
1617 		memcpy(chcr_req->key_ctx.key +
1618 		       ((param->alg_prm.result_size <= 32) ? 32 :
1619 			CHCR_HASH_MAX_DIGEST_SIZE),
1620 		       hmacctx->opad, param->alg_prm.result_size);
1621 
1622 	chcr_req->key_ctx.ctx_hdr = FILL_KEY_CTX_HDR(CHCR_KEYCTX_NO_KEY,
1623 					    param->alg_prm.mk_size, 0,
1624 					    param->opad_needed,
1625 					    ((param->kctx_len +
1626 					     sizeof(chcr_req->key_ctx)) >> 4));
1627 	chcr_req->sec_cpl.scmd1 = cpu_to_be64((u64)param->scmd1);
1628 	ulptx = (struct ulptx_sgl *)((u8 *)(chcr_req + 1) + param->kctx_len +
1629 				     DUMMY_BYTES);
1630 	if (param->bfr_len != 0) {
1631 		req_ctx->hctx_wr.dma_addr =
1632 			dma_map_single(&u_ctx->lldi.pdev->dev, req_ctx->reqbfr,
1633 				       param->bfr_len, DMA_TO_DEVICE);
1634 		if (dma_mapping_error(&u_ctx->lldi.pdev->dev,
1635 				       req_ctx->hctx_wr. dma_addr)) {
1636 			error = -ENOMEM;
1637 			goto err;
1638 		}
1639 		req_ctx->hctx_wr.dma_len = param->bfr_len;
1640 	} else {
1641 		req_ctx->hctx_wr.dma_addr = 0;
1642 	}
1643 	chcr_add_hash_src_ent(req, ulptx, param);
1644 	/* Request upto max wr size */
1645 	temp = param->kctx_len + DUMMY_BYTES + (req_ctx->hctx_wr.imm ?
1646 				(param->sg_len + param->bfr_len) : 0);
1647 	atomic_inc(&adap->chcr_stats.digest_rqst);
1648 	create_wreq(h_ctx(tfm), chcr_req, &req->base, req_ctx->hctx_wr.imm,
1649 		    param->hash_size, transhdr_len,
1650 		    temp,  0);
1651 	req_ctx->hctx_wr.skb = skb;
1652 	return skb;
1653 err:
1654 	kfree_skb(skb);
1655 	return  ERR_PTR(error);
1656 }
1657 
1658 static int chcr_ahash_update(struct ahash_request *req)
1659 {
1660 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
1661 	struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
1662 	struct uld_ctx *u_ctx = ULD_CTX(h_ctx(rtfm));
1663 	struct chcr_context *ctx = h_ctx(rtfm);
1664 	struct chcr_dev *dev = h_ctx(rtfm)->dev;
1665 	struct sk_buff *skb;
1666 	u8 remainder = 0, bs;
1667 	unsigned int nbytes = req->nbytes;
1668 	struct hash_wr_param params;
1669 	int error;
1670 	unsigned int cpu;
1671 
1672 	cpu = get_cpu();
1673 	req_ctx->txqidx = cpu % ctx->ntxq;
1674 	req_ctx->rxqidx = cpu % ctx->nrxq;
1675 	put_cpu();
1676 
1677 	bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
1678 
1679 	if (nbytes + req_ctx->reqlen >= bs) {
1680 		remainder = (nbytes + req_ctx->reqlen) % bs;
1681 		nbytes = nbytes + req_ctx->reqlen - remainder;
1682 	} else {
1683 		sg_pcopy_to_buffer(req->src, sg_nents(req->src), req_ctx->reqbfr
1684 				   + req_ctx->reqlen, nbytes, 0);
1685 		req_ctx->reqlen += nbytes;
1686 		return 0;
1687 	}
1688 	error = chcr_inc_wrcount(dev);
1689 	if (error)
1690 		return -ENXIO;
1691 	/* Detach state for CHCR means lldi or padap is freed. Increasing
1692 	 * inflight count for dev guarantees that lldi and padap is valid
1693 	 */
1694 	if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
1695 						req_ctx->txqidx) &&
1696 		(!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG)))) {
1697 			error = -ENOSPC;
1698 			goto err;
1699 	}
1700 
1701 	chcr_init_hctx_per_wr(req_ctx);
1702 	error = chcr_hash_dma_map(&u_ctx->lldi.pdev->dev, req);
1703 	if (error) {
1704 		error = -ENOMEM;
1705 		goto err;
1706 	}
1707 	get_alg_config(&params.alg_prm, crypto_ahash_digestsize(rtfm));
1708 	params.kctx_len = roundup(params.alg_prm.result_size, 16);
1709 	params.sg_len = chcr_hash_ent_in_wr(req->src, !!req_ctx->reqlen,
1710 				     HASH_SPACE_LEFT(params.kctx_len), 0);
1711 	if (params.sg_len > req->nbytes)
1712 		params.sg_len = req->nbytes;
1713 	params.sg_len = rounddown(params.sg_len + req_ctx->reqlen, bs) -
1714 			req_ctx->reqlen;
1715 	params.opad_needed = 0;
1716 	params.more = 1;
1717 	params.last = 0;
1718 	params.bfr_len = req_ctx->reqlen;
1719 	params.scmd1 = 0;
1720 	req_ctx->hctx_wr.srcsg = req->src;
1721 
1722 	params.hash_size = params.alg_prm.result_size;
1723 	req_ctx->data_len += params.sg_len + params.bfr_len;
1724 	skb = create_hash_wr(req, &params);
1725 	if (IS_ERR(skb)) {
1726 		error = PTR_ERR(skb);
1727 		goto unmap;
1728 	}
1729 
1730 	req_ctx->hctx_wr.processed += params.sg_len;
1731 	if (remainder) {
1732 		/* Swap buffers */
1733 		swap(req_ctx->reqbfr, req_ctx->skbfr);
1734 		sg_pcopy_to_buffer(req->src, sg_nents(req->src),
1735 				   req_ctx->reqbfr, remainder, req->nbytes -
1736 				   remainder);
1737 	}
1738 	req_ctx->reqlen = remainder;
1739 	skb->dev = u_ctx->lldi.ports[0];
1740 	set_wr_txq(skb, CPL_PRIORITY_DATA, req_ctx->txqidx);
1741 	chcr_send_wr(skb);
1742 	return -EINPROGRESS;
1743 unmap:
1744 	chcr_hash_dma_unmap(&u_ctx->lldi.pdev->dev, req);
1745 err:
1746 	chcr_dec_wrcount(dev);
1747 	return error;
1748 }
1749 
1750 static void create_last_hash_block(char *bfr_ptr, unsigned int bs, u64 scmd1)
1751 {
1752 	memset(bfr_ptr, 0, bs);
1753 	*bfr_ptr = 0x80;
1754 	if (bs == 64)
1755 		*(__be64 *)(bfr_ptr + 56) = cpu_to_be64(scmd1  << 3);
1756 	else
1757 		*(__be64 *)(bfr_ptr + 120) =  cpu_to_be64(scmd1  << 3);
1758 }
1759 
1760 static int chcr_ahash_final(struct ahash_request *req)
1761 {
1762 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
1763 	struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
1764 	struct chcr_dev *dev = h_ctx(rtfm)->dev;
1765 	struct hash_wr_param params;
1766 	struct sk_buff *skb;
1767 	struct uld_ctx *u_ctx = ULD_CTX(h_ctx(rtfm));
1768 	struct chcr_context *ctx = h_ctx(rtfm);
1769 	u8 bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
1770 	int error;
1771 	unsigned int cpu;
1772 
1773 	cpu = get_cpu();
1774 	req_ctx->txqidx = cpu % ctx->ntxq;
1775 	req_ctx->rxqidx = cpu % ctx->nrxq;
1776 	put_cpu();
1777 
1778 	error = chcr_inc_wrcount(dev);
1779 	if (error)
1780 		return -ENXIO;
1781 
1782 	chcr_init_hctx_per_wr(req_ctx);
1783 	if (is_hmac(crypto_ahash_tfm(rtfm)))
1784 		params.opad_needed = 1;
1785 	else
1786 		params.opad_needed = 0;
1787 	params.sg_len = 0;
1788 	req_ctx->hctx_wr.isfinal = 1;
1789 	get_alg_config(&params.alg_prm, crypto_ahash_digestsize(rtfm));
1790 	params.kctx_len = roundup(params.alg_prm.result_size, 16);
1791 	if (is_hmac(crypto_ahash_tfm(rtfm))) {
1792 		params.opad_needed = 1;
1793 		params.kctx_len *= 2;
1794 	} else {
1795 		params.opad_needed = 0;
1796 	}
1797 
1798 	req_ctx->hctx_wr.result = 1;
1799 	params.bfr_len = req_ctx->reqlen;
1800 	req_ctx->data_len += params.bfr_len + params.sg_len;
1801 	req_ctx->hctx_wr.srcsg = req->src;
1802 	if (req_ctx->reqlen == 0) {
1803 		create_last_hash_block(req_ctx->reqbfr, bs, req_ctx->data_len);
1804 		params.last = 0;
1805 		params.more = 1;
1806 		params.scmd1 = 0;
1807 		params.bfr_len = bs;
1808 
1809 	} else {
1810 		params.scmd1 = req_ctx->data_len;
1811 		params.last = 1;
1812 		params.more = 0;
1813 	}
1814 	params.hash_size = crypto_ahash_digestsize(rtfm);
1815 	skb = create_hash_wr(req, &params);
1816 	if (IS_ERR(skb)) {
1817 		error = PTR_ERR(skb);
1818 		goto err;
1819 	}
1820 	req_ctx->reqlen = 0;
1821 	skb->dev = u_ctx->lldi.ports[0];
1822 	set_wr_txq(skb, CPL_PRIORITY_DATA, req_ctx->txqidx);
1823 	chcr_send_wr(skb);
1824 	return -EINPROGRESS;
1825 err:
1826 	chcr_dec_wrcount(dev);
1827 	return error;
1828 }
1829 
1830 static int chcr_ahash_finup(struct ahash_request *req)
1831 {
1832 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
1833 	struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
1834 	struct chcr_dev *dev = h_ctx(rtfm)->dev;
1835 	struct uld_ctx *u_ctx = ULD_CTX(h_ctx(rtfm));
1836 	struct chcr_context *ctx = h_ctx(rtfm);
1837 	struct sk_buff *skb;
1838 	struct hash_wr_param params;
1839 	u8  bs;
1840 	int error;
1841 	unsigned int cpu;
1842 
1843 	cpu = get_cpu();
1844 	req_ctx->txqidx = cpu % ctx->ntxq;
1845 	req_ctx->rxqidx = cpu % ctx->nrxq;
1846 	put_cpu();
1847 
1848 	bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
1849 	error = chcr_inc_wrcount(dev);
1850 	if (error)
1851 		return -ENXIO;
1852 
1853 	if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
1854 						req_ctx->txqidx) &&
1855 		(!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG)))) {
1856 			error = -ENOSPC;
1857 			goto err;
1858 	}
1859 	chcr_init_hctx_per_wr(req_ctx);
1860 	error = chcr_hash_dma_map(&u_ctx->lldi.pdev->dev, req);
1861 	if (error) {
1862 		error = -ENOMEM;
1863 		goto err;
1864 	}
1865 
1866 	get_alg_config(&params.alg_prm, crypto_ahash_digestsize(rtfm));
1867 	params.kctx_len = roundup(params.alg_prm.result_size, 16);
1868 	if (is_hmac(crypto_ahash_tfm(rtfm))) {
1869 		params.kctx_len *= 2;
1870 		params.opad_needed = 1;
1871 	} else {
1872 		params.opad_needed = 0;
1873 	}
1874 
1875 	params.sg_len = chcr_hash_ent_in_wr(req->src, !!req_ctx->reqlen,
1876 				    HASH_SPACE_LEFT(params.kctx_len), 0);
1877 	if (params.sg_len < req->nbytes) {
1878 		if (is_hmac(crypto_ahash_tfm(rtfm))) {
1879 			params.kctx_len /= 2;
1880 			params.opad_needed = 0;
1881 		}
1882 		params.last = 0;
1883 		params.more = 1;
1884 		params.sg_len = rounddown(params.sg_len + req_ctx->reqlen, bs)
1885 					- req_ctx->reqlen;
1886 		params.hash_size = params.alg_prm.result_size;
1887 		params.scmd1 = 0;
1888 	} else {
1889 		params.last = 1;
1890 		params.more = 0;
1891 		params.sg_len = req->nbytes;
1892 		params.hash_size = crypto_ahash_digestsize(rtfm);
1893 		params.scmd1 = req_ctx->data_len + req_ctx->reqlen +
1894 				params.sg_len;
1895 	}
1896 	params.bfr_len = req_ctx->reqlen;
1897 	req_ctx->data_len += params.bfr_len + params.sg_len;
1898 	req_ctx->hctx_wr.result = 1;
1899 	req_ctx->hctx_wr.srcsg = req->src;
1900 	if ((req_ctx->reqlen + req->nbytes) == 0) {
1901 		create_last_hash_block(req_ctx->reqbfr, bs, req_ctx->data_len);
1902 		params.last = 0;
1903 		params.more = 1;
1904 		params.scmd1 = 0;
1905 		params.bfr_len = bs;
1906 	}
1907 	skb = create_hash_wr(req, &params);
1908 	if (IS_ERR(skb)) {
1909 		error = PTR_ERR(skb);
1910 		goto unmap;
1911 	}
1912 	req_ctx->reqlen = 0;
1913 	req_ctx->hctx_wr.processed += params.sg_len;
1914 	skb->dev = u_ctx->lldi.ports[0];
1915 	set_wr_txq(skb, CPL_PRIORITY_DATA, req_ctx->txqidx);
1916 	chcr_send_wr(skb);
1917 	return -EINPROGRESS;
1918 unmap:
1919 	chcr_hash_dma_unmap(&u_ctx->lldi.pdev->dev, req);
1920 err:
1921 	chcr_dec_wrcount(dev);
1922 	return error;
1923 }
1924 
1925 static int chcr_ahash_digest(struct ahash_request *req)
1926 {
1927 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
1928 	struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
1929 	struct chcr_dev *dev = h_ctx(rtfm)->dev;
1930 	struct uld_ctx *u_ctx = ULD_CTX(h_ctx(rtfm));
1931 	struct chcr_context *ctx = h_ctx(rtfm);
1932 	struct sk_buff *skb;
1933 	struct hash_wr_param params;
1934 	u8  bs;
1935 	int error;
1936 	unsigned int cpu;
1937 
1938 	cpu = get_cpu();
1939 	req_ctx->txqidx = cpu % ctx->ntxq;
1940 	req_ctx->rxqidx = cpu % ctx->nrxq;
1941 	put_cpu();
1942 
1943 	rtfm->init(req);
1944 	bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
1945 	error = chcr_inc_wrcount(dev);
1946 	if (error)
1947 		return -ENXIO;
1948 
1949 	if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
1950 						req_ctx->txqidx) &&
1951 		(!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG)))) {
1952 			error = -ENOSPC;
1953 			goto err;
1954 	}
1955 
1956 	chcr_init_hctx_per_wr(req_ctx);
1957 	error = chcr_hash_dma_map(&u_ctx->lldi.pdev->dev, req);
1958 	if (error) {
1959 		error = -ENOMEM;
1960 		goto err;
1961 	}
1962 
1963 	get_alg_config(&params.alg_prm, crypto_ahash_digestsize(rtfm));
1964 	params.kctx_len = roundup(params.alg_prm.result_size, 16);
1965 	if (is_hmac(crypto_ahash_tfm(rtfm))) {
1966 		params.kctx_len *= 2;
1967 		params.opad_needed = 1;
1968 	} else {
1969 		params.opad_needed = 0;
1970 	}
1971 	params.sg_len = chcr_hash_ent_in_wr(req->src, !!req_ctx->reqlen,
1972 				HASH_SPACE_LEFT(params.kctx_len), 0);
1973 	if (params.sg_len < req->nbytes) {
1974 		if (is_hmac(crypto_ahash_tfm(rtfm))) {
1975 			params.kctx_len /= 2;
1976 			params.opad_needed = 0;
1977 		}
1978 		params.last = 0;
1979 		params.more = 1;
1980 		params.scmd1 = 0;
1981 		params.sg_len = rounddown(params.sg_len, bs);
1982 		params.hash_size = params.alg_prm.result_size;
1983 	} else {
1984 		params.sg_len = req->nbytes;
1985 		params.hash_size = crypto_ahash_digestsize(rtfm);
1986 		params.last = 1;
1987 		params.more = 0;
1988 		params.scmd1 = req->nbytes + req_ctx->data_len;
1989 
1990 	}
1991 	params.bfr_len = 0;
1992 	req_ctx->hctx_wr.result = 1;
1993 	req_ctx->hctx_wr.srcsg = req->src;
1994 	req_ctx->data_len += params.bfr_len + params.sg_len;
1995 
1996 	if (req->nbytes == 0) {
1997 		create_last_hash_block(req_ctx->reqbfr, bs, req_ctx->data_len);
1998 		params.more = 1;
1999 		params.bfr_len = bs;
2000 	}
2001 
2002 	skb = create_hash_wr(req, &params);
2003 	if (IS_ERR(skb)) {
2004 		error = PTR_ERR(skb);
2005 		goto unmap;
2006 	}
2007 	req_ctx->hctx_wr.processed += params.sg_len;
2008 	skb->dev = u_ctx->lldi.ports[0];
2009 	set_wr_txq(skb, CPL_PRIORITY_DATA, req_ctx->txqidx);
2010 	chcr_send_wr(skb);
2011 	return -EINPROGRESS;
2012 unmap:
2013 	chcr_hash_dma_unmap(&u_ctx->lldi.pdev->dev, req);
2014 err:
2015 	chcr_dec_wrcount(dev);
2016 	return error;
2017 }
2018 
2019 static int chcr_ahash_continue(struct ahash_request *req)
2020 {
2021 	struct chcr_ahash_req_ctx *reqctx = ahash_request_ctx(req);
2022 	struct chcr_hctx_per_wr *hctx_wr = &reqctx->hctx_wr;
2023 	struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
2024 	struct chcr_context *ctx = h_ctx(rtfm);
2025 	struct uld_ctx *u_ctx = ULD_CTX(ctx);
2026 	struct sk_buff *skb;
2027 	struct hash_wr_param params;
2028 	u8  bs;
2029 	int error;
2030 	unsigned int cpu;
2031 
2032 	cpu = get_cpu();
2033 	reqctx->txqidx = cpu % ctx->ntxq;
2034 	reqctx->rxqidx = cpu % ctx->nrxq;
2035 	put_cpu();
2036 
2037 	bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
2038 	get_alg_config(&params.alg_prm, crypto_ahash_digestsize(rtfm));
2039 	params.kctx_len = roundup(params.alg_prm.result_size, 16);
2040 	if (is_hmac(crypto_ahash_tfm(rtfm))) {
2041 		params.kctx_len *= 2;
2042 		params.opad_needed = 1;
2043 	} else {
2044 		params.opad_needed = 0;
2045 	}
2046 	params.sg_len = chcr_hash_ent_in_wr(hctx_wr->srcsg, 0,
2047 					    HASH_SPACE_LEFT(params.kctx_len),
2048 					    hctx_wr->src_ofst);
2049 	if ((params.sg_len + hctx_wr->processed) > req->nbytes)
2050 		params.sg_len = req->nbytes - hctx_wr->processed;
2051 	if (!hctx_wr->result ||
2052 	    ((params.sg_len + hctx_wr->processed) < req->nbytes)) {
2053 		if (is_hmac(crypto_ahash_tfm(rtfm))) {
2054 			params.kctx_len /= 2;
2055 			params.opad_needed = 0;
2056 		}
2057 		params.last = 0;
2058 		params.more = 1;
2059 		params.sg_len = rounddown(params.sg_len, bs);
2060 		params.hash_size = params.alg_prm.result_size;
2061 		params.scmd1 = 0;
2062 	} else {
2063 		params.last = 1;
2064 		params.more = 0;
2065 		params.hash_size = crypto_ahash_digestsize(rtfm);
2066 		params.scmd1 = reqctx->data_len + params.sg_len;
2067 	}
2068 	params.bfr_len = 0;
2069 	reqctx->data_len += params.sg_len;
2070 	skb = create_hash_wr(req, &params);
2071 	if (IS_ERR(skb)) {
2072 		error = PTR_ERR(skb);
2073 		goto err;
2074 	}
2075 	hctx_wr->processed += params.sg_len;
2076 	skb->dev = u_ctx->lldi.ports[0];
2077 	set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
2078 	chcr_send_wr(skb);
2079 	return 0;
2080 err:
2081 	return error;
2082 }
2083 
2084 static inline void chcr_handle_ahash_resp(struct ahash_request *req,
2085 					  unsigned char *input,
2086 					  int err)
2087 {
2088 	struct chcr_ahash_req_ctx *reqctx = ahash_request_ctx(req);
2089 	struct chcr_hctx_per_wr *hctx_wr = &reqctx->hctx_wr;
2090 	int digestsize, updated_digestsize;
2091 	struct crypto_ahash *tfm = crypto_ahash_reqtfm(req);
2092 	struct uld_ctx *u_ctx = ULD_CTX(h_ctx(tfm));
2093 	struct chcr_dev *dev = h_ctx(tfm)->dev;
2094 
2095 	if (input == NULL)
2096 		goto out;
2097 	digestsize = crypto_ahash_digestsize(crypto_ahash_reqtfm(req));
2098 	updated_digestsize = digestsize;
2099 	if (digestsize == SHA224_DIGEST_SIZE)
2100 		updated_digestsize = SHA256_DIGEST_SIZE;
2101 	else if (digestsize == SHA384_DIGEST_SIZE)
2102 		updated_digestsize = SHA512_DIGEST_SIZE;
2103 
2104 	if (hctx_wr->dma_addr) {
2105 		dma_unmap_single(&u_ctx->lldi.pdev->dev, hctx_wr->dma_addr,
2106 				 hctx_wr->dma_len, DMA_TO_DEVICE);
2107 		hctx_wr->dma_addr = 0;
2108 	}
2109 	if (hctx_wr->isfinal || ((hctx_wr->processed + reqctx->reqlen) ==
2110 				 req->nbytes)) {
2111 		if (hctx_wr->result == 1) {
2112 			hctx_wr->result = 0;
2113 			memcpy(req->result, input + sizeof(struct cpl_fw6_pld),
2114 			       digestsize);
2115 		} else {
2116 			memcpy(reqctx->partial_hash,
2117 			       input + sizeof(struct cpl_fw6_pld),
2118 			       updated_digestsize);
2119 
2120 		}
2121 		goto unmap;
2122 	}
2123 	memcpy(reqctx->partial_hash, input + sizeof(struct cpl_fw6_pld),
2124 	       updated_digestsize);
2125 
2126 	err = chcr_ahash_continue(req);
2127 	if (err)
2128 		goto unmap;
2129 	return;
2130 unmap:
2131 	if (hctx_wr->is_sg_map)
2132 		chcr_hash_dma_unmap(&u_ctx->lldi.pdev->dev, req);
2133 
2134 
2135 out:
2136 	chcr_dec_wrcount(dev);
2137 	req->base.complete(&req->base, err);
2138 }
2139 
2140 /*
2141  *	chcr_handle_resp - Unmap the DMA buffers associated with the request
2142  *	@req: crypto request
2143  */
2144 int chcr_handle_resp(struct crypto_async_request *req, unsigned char *input,
2145 			 int err)
2146 {
2147 	struct crypto_tfm *tfm = req->tfm;
2148 	struct chcr_context *ctx = crypto_tfm_ctx(tfm);
2149 	struct adapter *adap = padap(ctx->dev);
2150 
2151 	switch (tfm->__crt_alg->cra_flags & CRYPTO_ALG_TYPE_MASK) {
2152 	case CRYPTO_ALG_TYPE_AEAD:
2153 		err = chcr_handle_aead_resp(aead_request_cast(req), input, err);
2154 		break;
2155 
2156 	case CRYPTO_ALG_TYPE_SKCIPHER:
2157 		 chcr_handle_cipher_resp(skcipher_request_cast(req),
2158 					       input, err);
2159 		break;
2160 	case CRYPTO_ALG_TYPE_AHASH:
2161 		chcr_handle_ahash_resp(ahash_request_cast(req), input, err);
2162 		}
2163 	atomic_inc(&adap->chcr_stats.complete);
2164 	return err;
2165 }
2166 static int chcr_ahash_export(struct ahash_request *areq, void *out)
2167 {
2168 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
2169 	struct chcr_ahash_req_ctx *state = out;
2170 
2171 	state->reqlen = req_ctx->reqlen;
2172 	state->data_len = req_ctx->data_len;
2173 	memcpy(state->bfr1, req_ctx->reqbfr, req_ctx->reqlen);
2174 	memcpy(state->partial_hash, req_ctx->partial_hash,
2175 	       CHCR_HASH_MAX_DIGEST_SIZE);
2176 	chcr_init_hctx_per_wr(state);
2177 	return 0;
2178 }
2179 
2180 static int chcr_ahash_import(struct ahash_request *areq, const void *in)
2181 {
2182 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
2183 	struct chcr_ahash_req_ctx *state = (struct chcr_ahash_req_ctx *)in;
2184 
2185 	req_ctx->reqlen = state->reqlen;
2186 	req_ctx->data_len = state->data_len;
2187 	req_ctx->reqbfr = req_ctx->bfr1;
2188 	req_ctx->skbfr = req_ctx->bfr2;
2189 	memcpy(req_ctx->bfr1, state->bfr1, CHCR_HASH_MAX_BLOCK_SIZE_128);
2190 	memcpy(req_ctx->partial_hash, state->partial_hash,
2191 	       CHCR_HASH_MAX_DIGEST_SIZE);
2192 	chcr_init_hctx_per_wr(req_ctx);
2193 	return 0;
2194 }
2195 
2196 static int chcr_ahash_setkey(struct crypto_ahash *tfm, const u8 *key,
2197 			     unsigned int keylen)
2198 {
2199 	struct hmac_ctx *hmacctx = HMAC_CTX(h_ctx(tfm));
2200 	unsigned int digestsize = crypto_ahash_digestsize(tfm);
2201 	unsigned int bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(tfm));
2202 	unsigned int i, err = 0, updated_digestsize;
2203 
2204 	SHASH_DESC_ON_STACK(shash, hmacctx->base_hash);
2205 
2206 	/* use the key to calculate the ipad and opad. ipad will sent with the
2207 	 * first request's data. opad will be sent with the final hash result
2208 	 * ipad in hmacctx->ipad and opad in hmacctx->opad location
2209 	 */
2210 	shash->tfm = hmacctx->base_hash;
2211 	if (keylen > bs) {
2212 		err = crypto_shash_digest(shash, key, keylen,
2213 					  hmacctx->ipad);
2214 		if (err)
2215 			goto out;
2216 		keylen = digestsize;
2217 	} else {
2218 		memcpy(hmacctx->ipad, key, keylen);
2219 	}
2220 	memset(hmacctx->ipad + keylen, 0, bs - keylen);
2221 	memcpy(hmacctx->opad, hmacctx->ipad, bs);
2222 
2223 	for (i = 0; i < bs / sizeof(int); i++) {
2224 		*((unsigned int *)(&hmacctx->ipad) + i) ^= IPAD_DATA;
2225 		*((unsigned int *)(&hmacctx->opad) + i) ^= OPAD_DATA;
2226 	}
2227 
2228 	updated_digestsize = digestsize;
2229 	if (digestsize == SHA224_DIGEST_SIZE)
2230 		updated_digestsize = SHA256_DIGEST_SIZE;
2231 	else if (digestsize == SHA384_DIGEST_SIZE)
2232 		updated_digestsize = SHA512_DIGEST_SIZE;
2233 	err = chcr_compute_partial_hash(shash, hmacctx->ipad,
2234 					hmacctx->ipad, digestsize);
2235 	if (err)
2236 		goto out;
2237 	chcr_change_order(hmacctx->ipad, updated_digestsize);
2238 
2239 	err = chcr_compute_partial_hash(shash, hmacctx->opad,
2240 					hmacctx->opad, digestsize);
2241 	if (err)
2242 		goto out;
2243 	chcr_change_order(hmacctx->opad, updated_digestsize);
2244 out:
2245 	return err;
2246 }
2247 
2248 static int chcr_aes_xts_setkey(struct crypto_skcipher *cipher, const u8 *key,
2249 			       unsigned int key_len)
2250 {
2251 	struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));
2252 	unsigned short context_size = 0;
2253 	int err;
2254 
2255 	err = chcr_cipher_fallback_setkey(cipher, key, key_len);
2256 	if (err)
2257 		goto badkey_err;
2258 
2259 	memcpy(ablkctx->key, key, key_len);
2260 	ablkctx->enckey_len = key_len;
2261 	get_aes_decrypt_key(ablkctx->rrkey, ablkctx->key, key_len << 2);
2262 	context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD + key_len) >> 4;
2263 	/* Both keys for xts must be aligned to 16 byte boundary
2264 	 * by padding with zeros. So for 24 byte keys padding 8 zeroes.
2265 	 */
2266 	if (key_len == 48) {
2267 		context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD + key_len
2268 				+ 16) >> 4;
2269 		memmove(ablkctx->key + 32, ablkctx->key + 24, 24);
2270 		memset(ablkctx->key + 24, 0, 8);
2271 		memset(ablkctx->key + 56, 0, 8);
2272 		ablkctx->enckey_len = 64;
2273 		ablkctx->key_ctx_hdr =
2274 			FILL_KEY_CTX_HDR(CHCR_KEYCTX_CIPHER_KEY_SIZE_192,
2275 					 CHCR_KEYCTX_NO_KEY, 1,
2276 					 0, context_size);
2277 	} else {
2278 		ablkctx->key_ctx_hdr =
2279 		FILL_KEY_CTX_HDR((key_len == AES_KEYSIZE_256) ?
2280 				 CHCR_KEYCTX_CIPHER_KEY_SIZE_128 :
2281 				 CHCR_KEYCTX_CIPHER_KEY_SIZE_256,
2282 				 CHCR_KEYCTX_NO_KEY, 1,
2283 				 0, context_size);
2284 	}
2285 	ablkctx->ciph_mode = CHCR_SCMD_CIPHER_MODE_AES_XTS;
2286 	return 0;
2287 badkey_err:
2288 	ablkctx->enckey_len = 0;
2289 
2290 	return err;
2291 }
2292 
2293 static int chcr_sha_init(struct ahash_request *areq)
2294 {
2295 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
2296 	struct crypto_ahash *tfm = crypto_ahash_reqtfm(areq);
2297 	int digestsize =  crypto_ahash_digestsize(tfm);
2298 
2299 	req_ctx->data_len = 0;
2300 	req_ctx->reqlen = 0;
2301 	req_ctx->reqbfr = req_ctx->bfr1;
2302 	req_ctx->skbfr = req_ctx->bfr2;
2303 	copy_hash_init_values(req_ctx->partial_hash, digestsize);
2304 
2305 	return 0;
2306 }
2307 
2308 static int chcr_sha_cra_init(struct crypto_tfm *tfm)
2309 {
2310 	crypto_ahash_set_reqsize(__crypto_ahash_cast(tfm),
2311 				 sizeof(struct chcr_ahash_req_ctx));
2312 	return chcr_device_init(crypto_tfm_ctx(tfm));
2313 }
2314 
2315 static int chcr_hmac_init(struct ahash_request *areq)
2316 {
2317 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
2318 	struct crypto_ahash *rtfm = crypto_ahash_reqtfm(areq);
2319 	struct hmac_ctx *hmacctx = HMAC_CTX(h_ctx(rtfm));
2320 	unsigned int digestsize = crypto_ahash_digestsize(rtfm);
2321 	unsigned int bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
2322 
2323 	chcr_sha_init(areq);
2324 	req_ctx->data_len = bs;
2325 	if (is_hmac(crypto_ahash_tfm(rtfm))) {
2326 		if (digestsize == SHA224_DIGEST_SIZE)
2327 			memcpy(req_ctx->partial_hash, hmacctx->ipad,
2328 			       SHA256_DIGEST_SIZE);
2329 		else if (digestsize == SHA384_DIGEST_SIZE)
2330 			memcpy(req_ctx->partial_hash, hmacctx->ipad,
2331 			       SHA512_DIGEST_SIZE);
2332 		else
2333 			memcpy(req_ctx->partial_hash, hmacctx->ipad,
2334 			       digestsize);
2335 	}
2336 	return 0;
2337 }
2338 
2339 static int chcr_hmac_cra_init(struct crypto_tfm *tfm)
2340 {
2341 	struct chcr_context *ctx = crypto_tfm_ctx(tfm);
2342 	struct hmac_ctx *hmacctx = HMAC_CTX(ctx);
2343 	unsigned int digestsize =
2344 		crypto_ahash_digestsize(__crypto_ahash_cast(tfm));
2345 
2346 	crypto_ahash_set_reqsize(__crypto_ahash_cast(tfm),
2347 				 sizeof(struct chcr_ahash_req_ctx));
2348 	hmacctx->base_hash = chcr_alloc_shash(digestsize);
2349 	if (IS_ERR(hmacctx->base_hash))
2350 		return PTR_ERR(hmacctx->base_hash);
2351 	return chcr_device_init(crypto_tfm_ctx(tfm));
2352 }
2353 
2354 static void chcr_hmac_cra_exit(struct crypto_tfm *tfm)
2355 {
2356 	struct chcr_context *ctx = crypto_tfm_ctx(tfm);
2357 	struct hmac_ctx *hmacctx = HMAC_CTX(ctx);
2358 
2359 	if (hmacctx->base_hash) {
2360 		chcr_free_shash(hmacctx->base_hash);
2361 		hmacctx->base_hash = NULL;
2362 	}
2363 }
2364 
2365 inline void chcr_aead_common_exit(struct aead_request *req)
2366 {
2367 	struct chcr_aead_reqctx  *reqctx = aead_request_ctx(req);
2368 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2369 	struct uld_ctx *u_ctx = ULD_CTX(a_ctx(tfm));
2370 
2371 	chcr_aead_dma_unmap(&u_ctx->lldi.pdev->dev, req, reqctx->op);
2372 }
2373 
2374 static int chcr_aead_common_init(struct aead_request *req)
2375 {
2376 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2377 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
2378 	struct chcr_aead_reqctx  *reqctx = aead_request_ctx(req);
2379 	unsigned int authsize = crypto_aead_authsize(tfm);
2380 	int error = -EINVAL;
2381 
2382 	/* validate key size */
2383 	if (aeadctx->enckey_len == 0)
2384 		goto err;
2385 	if (reqctx->op && req->cryptlen < authsize)
2386 		goto err;
2387 	if (reqctx->b0_len)
2388 		reqctx->scratch_pad = reqctx->iv + IV;
2389 	else
2390 		reqctx->scratch_pad = NULL;
2391 
2392 	error = chcr_aead_dma_map(&ULD_CTX(a_ctx(tfm))->lldi.pdev->dev, req,
2393 				  reqctx->op);
2394 	if (error) {
2395 		error = -ENOMEM;
2396 		goto err;
2397 	}
2398 
2399 	return 0;
2400 err:
2401 	return error;
2402 }
2403 
2404 static int chcr_aead_need_fallback(struct aead_request *req, int dst_nents,
2405 				   int aadmax, int wrlen,
2406 				   unsigned short op_type)
2407 {
2408 	unsigned int authsize = crypto_aead_authsize(crypto_aead_reqtfm(req));
2409 
2410 	if (((req->cryptlen - (op_type ? authsize : 0)) == 0) ||
2411 	    dst_nents > MAX_DSGL_ENT ||
2412 	    (req->assoclen > aadmax) ||
2413 	    (wrlen > SGE_MAX_WR_LEN))
2414 		return 1;
2415 	return 0;
2416 }
2417 
2418 static int chcr_aead_fallback(struct aead_request *req, unsigned short op_type)
2419 {
2420 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2421 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
2422 	struct aead_request *subreq = aead_request_ctx(req);
2423 
2424 	aead_request_set_tfm(subreq, aeadctx->sw_cipher);
2425 	aead_request_set_callback(subreq, req->base.flags,
2426 				  req->base.complete, req->base.data);
2427 	aead_request_set_crypt(subreq, req->src, req->dst, req->cryptlen,
2428 				 req->iv);
2429 	aead_request_set_ad(subreq, req->assoclen);
2430 	return op_type ? crypto_aead_decrypt(subreq) :
2431 		crypto_aead_encrypt(subreq);
2432 }
2433 
2434 static struct sk_buff *create_authenc_wr(struct aead_request *req,
2435 					 unsigned short qid,
2436 					 int size)
2437 {
2438 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2439 	struct chcr_context *ctx = a_ctx(tfm);
2440 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(ctx);
2441 	struct chcr_authenc_ctx *actx = AUTHENC_CTX(aeadctx);
2442 	struct chcr_aead_reqctx *reqctx = aead_request_ctx(req);
2443 	struct sk_buff *skb = NULL;
2444 	struct chcr_wr *chcr_req;
2445 	struct cpl_rx_phys_dsgl *phys_cpl;
2446 	struct ulptx_sgl *ulptx;
2447 	unsigned int transhdr_len;
2448 	unsigned int dst_size = 0, temp, subtype = get_aead_subtype(tfm);
2449 	unsigned int   kctx_len = 0, dnents, snents;
2450 	unsigned int  authsize = crypto_aead_authsize(tfm);
2451 	int error = -EINVAL;
2452 	u8 *ivptr;
2453 	int null = 0;
2454 	gfp_t flags = req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP ? GFP_KERNEL :
2455 		GFP_ATOMIC;
2456 	struct adapter *adap = padap(ctx->dev);
2457 	unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
2458 
2459 	if (req->cryptlen == 0)
2460 		return NULL;
2461 
2462 	reqctx->b0_len = 0;
2463 	error = chcr_aead_common_init(req);
2464 	if (error)
2465 		return ERR_PTR(error);
2466 
2467 	if (subtype == CRYPTO_ALG_SUB_TYPE_CBC_NULL ||
2468 		subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL) {
2469 		null = 1;
2470 	}
2471 	dnents = sg_nents_xlen(req->dst, req->assoclen + req->cryptlen +
2472 		(reqctx->op ? -authsize : authsize), CHCR_DST_SG_SIZE, 0);
2473 	dnents += MIN_AUTH_SG; // For IV
2474 	snents = sg_nents_xlen(req->src, req->assoclen + req->cryptlen,
2475 			       CHCR_SRC_SG_SIZE, 0);
2476 	dst_size = get_space_for_phys_dsgl(dnents);
2477 	kctx_len = (KEY_CONTEXT_CTX_LEN_G(ntohl(aeadctx->key_ctx_hdr)) << 4)
2478 		- sizeof(chcr_req->key_ctx);
2479 	transhdr_len = CIPHER_TRANSHDR_SIZE(kctx_len, dst_size);
2480 	reqctx->imm = (transhdr_len + req->assoclen + req->cryptlen) <
2481 			SGE_MAX_WR_LEN;
2482 	temp = reqctx->imm ? roundup(req->assoclen + req->cryptlen, 16)
2483 			: (sgl_len(snents) * 8);
2484 	transhdr_len += temp;
2485 	transhdr_len = roundup(transhdr_len, 16);
2486 
2487 	if (chcr_aead_need_fallback(req, dnents, T6_MAX_AAD_SIZE,
2488 				    transhdr_len, reqctx->op)) {
2489 		atomic_inc(&adap->chcr_stats.fallback);
2490 		chcr_aead_common_exit(req);
2491 		return ERR_PTR(chcr_aead_fallback(req, reqctx->op));
2492 	}
2493 	skb = alloc_skb(transhdr_len, flags);
2494 	if (!skb) {
2495 		error = -ENOMEM;
2496 		goto err;
2497 	}
2498 
2499 	chcr_req = __skb_put_zero(skb, transhdr_len);
2500 
2501 	temp  = (reqctx->op == CHCR_ENCRYPT_OP) ? 0 : authsize;
2502 
2503 	/*
2504 	 * Input order	is AAD,IV and Payload. where IV should be included as
2505 	 * the part of authdata. All other fields should be filled according
2506 	 * to the hardware spec
2507 	 */
2508 	chcr_req->sec_cpl.op_ivinsrtofst =
2509 				FILL_SEC_CPL_OP_IVINSR(rx_channel_id, 2, 1);
2510 	chcr_req->sec_cpl.pldlen = htonl(req->assoclen + IV + req->cryptlen);
2511 	chcr_req->sec_cpl.aadstart_cipherstop_hi = FILL_SEC_CPL_CIPHERSTOP_HI(
2512 					null ? 0 : 1 + IV,
2513 					null ? 0 : IV + req->assoclen,
2514 					req->assoclen + IV + 1,
2515 					(temp & 0x1F0) >> 4);
2516 	chcr_req->sec_cpl.cipherstop_lo_authinsert = FILL_SEC_CPL_AUTHINSERT(
2517 					temp & 0xF,
2518 					null ? 0 : req->assoclen + IV + 1,
2519 					temp, temp);
2520 	if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL ||
2521 	    subtype == CRYPTO_ALG_SUB_TYPE_CTR_SHA)
2522 		temp = CHCR_SCMD_CIPHER_MODE_AES_CTR;
2523 	else
2524 		temp = CHCR_SCMD_CIPHER_MODE_AES_CBC;
2525 	chcr_req->sec_cpl.seqno_numivs = FILL_SEC_CPL_SCMD0_SEQNO(reqctx->op,
2526 					(reqctx->op == CHCR_ENCRYPT_OP) ? 1 : 0,
2527 					temp,
2528 					actx->auth_mode, aeadctx->hmac_ctrl,
2529 					IV >> 1);
2530 	chcr_req->sec_cpl.ivgen_hdrlen =  FILL_SEC_CPL_IVGEN_HDRLEN(0, 0, 1,
2531 					 0, 0, dst_size);
2532 
2533 	chcr_req->key_ctx.ctx_hdr = aeadctx->key_ctx_hdr;
2534 	if (reqctx->op == CHCR_ENCRYPT_OP ||
2535 		subtype == CRYPTO_ALG_SUB_TYPE_CTR_SHA ||
2536 		subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL)
2537 		memcpy(chcr_req->key_ctx.key, aeadctx->key,
2538 		       aeadctx->enckey_len);
2539 	else
2540 		memcpy(chcr_req->key_ctx.key, actx->dec_rrkey,
2541 		       aeadctx->enckey_len);
2542 
2543 	memcpy(chcr_req->key_ctx.key + roundup(aeadctx->enckey_len, 16),
2544 	       actx->h_iopad, kctx_len - roundup(aeadctx->enckey_len, 16));
2545 	phys_cpl = (struct cpl_rx_phys_dsgl *)((u8 *)(chcr_req + 1) + kctx_len);
2546 	ivptr = (u8 *)(phys_cpl + 1) + dst_size;
2547 	ulptx = (struct ulptx_sgl *)(ivptr + IV);
2548 	if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_SHA ||
2549 	    subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL) {
2550 		memcpy(ivptr, aeadctx->nonce, CTR_RFC3686_NONCE_SIZE);
2551 		memcpy(ivptr + CTR_RFC3686_NONCE_SIZE, req->iv,
2552 				CTR_RFC3686_IV_SIZE);
2553 		*(__be32 *)(ivptr + CTR_RFC3686_NONCE_SIZE +
2554 			CTR_RFC3686_IV_SIZE) = cpu_to_be32(1);
2555 	} else {
2556 		memcpy(ivptr, req->iv, IV);
2557 	}
2558 	chcr_add_aead_dst_ent(req, phys_cpl, qid);
2559 	chcr_add_aead_src_ent(req, ulptx);
2560 	atomic_inc(&adap->chcr_stats.cipher_rqst);
2561 	temp = sizeof(struct cpl_rx_phys_dsgl) + dst_size + IV +
2562 		kctx_len + (reqctx->imm ? (req->assoclen + req->cryptlen) : 0);
2563 	create_wreq(a_ctx(tfm), chcr_req, &req->base, reqctx->imm, size,
2564 		   transhdr_len, temp, 0);
2565 	reqctx->skb = skb;
2566 
2567 	return skb;
2568 err:
2569 	chcr_aead_common_exit(req);
2570 
2571 	return ERR_PTR(error);
2572 }
2573 
2574 int chcr_aead_dma_map(struct device *dev,
2575 		      struct aead_request *req,
2576 		      unsigned short op_type)
2577 {
2578 	int error;
2579 	struct chcr_aead_reqctx  *reqctx = aead_request_ctx(req);
2580 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2581 	unsigned int authsize = crypto_aead_authsize(tfm);
2582 	int src_len, dst_len;
2583 
2584 	/* calculate and handle src and dst sg length separately
2585 	 * for inplace and out-of place operations
2586 	 */
2587 	if (req->src == req->dst) {
2588 		src_len = req->assoclen + req->cryptlen + (op_type ?
2589 							0 : authsize);
2590 		dst_len = src_len;
2591 	} else {
2592 		src_len = req->assoclen + req->cryptlen;
2593 		dst_len = req->assoclen + req->cryptlen + (op_type ?
2594 							-authsize : authsize);
2595 	}
2596 
2597 	if (!req->cryptlen || !src_len || !dst_len)
2598 		return 0;
2599 	reqctx->iv_dma = dma_map_single(dev, reqctx->iv, (IV + reqctx->b0_len),
2600 					DMA_BIDIRECTIONAL);
2601 	if (dma_mapping_error(dev, reqctx->iv_dma))
2602 		return -ENOMEM;
2603 	if (reqctx->b0_len)
2604 		reqctx->b0_dma = reqctx->iv_dma + IV;
2605 	else
2606 		reqctx->b0_dma = 0;
2607 	if (req->src == req->dst) {
2608 		error = dma_map_sg(dev, req->src,
2609 				sg_nents_for_len(req->src, src_len),
2610 					DMA_BIDIRECTIONAL);
2611 		if (!error)
2612 			goto err;
2613 	} else {
2614 		error = dma_map_sg(dev, req->src,
2615 				   sg_nents_for_len(req->src, src_len),
2616 				   DMA_TO_DEVICE);
2617 		if (!error)
2618 			goto err;
2619 		error = dma_map_sg(dev, req->dst,
2620 				   sg_nents_for_len(req->dst, dst_len),
2621 				   DMA_FROM_DEVICE);
2622 		if (!error) {
2623 			dma_unmap_sg(dev, req->src,
2624 				     sg_nents_for_len(req->src, src_len),
2625 				     DMA_TO_DEVICE);
2626 			goto err;
2627 		}
2628 	}
2629 
2630 	return 0;
2631 err:
2632 	dma_unmap_single(dev, reqctx->iv_dma, IV, DMA_BIDIRECTIONAL);
2633 	return -ENOMEM;
2634 }
2635 
2636 void chcr_aead_dma_unmap(struct device *dev,
2637 			 struct aead_request *req,
2638 			 unsigned short op_type)
2639 {
2640 	struct chcr_aead_reqctx  *reqctx = aead_request_ctx(req);
2641 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2642 	unsigned int authsize = crypto_aead_authsize(tfm);
2643 	int src_len, dst_len;
2644 
2645 	/* calculate and handle src and dst sg length separately
2646 	 * for inplace and out-of place operations
2647 	 */
2648 	if (req->src == req->dst) {
2649 		src_len = req->assoclen + req->cryptlen + (op_type ?
2650 							0 : authsize);
2651 		dst_len = src_len;
2652 	} else {
2653 		src_len = req->assoclen + req->cryptlen;
2654 		dst_len = req->assoclen + req->cryptlen + (op_type ?
2655 						-authsize : authsize);
2656 	}
2657 
2658 	if (!req->cryptlen || !src_len || !dst_len)
2659 		return;
2660 
2661 	dma_unmap_single(dev, reqctx->iv_dma, (IV + reqctx->b0_len),
2662 					DMA_BIDIRECTIONAL);
2663 	if (req->src == req->dst) {
2664 		dma_unmap_sg(dev, req->src,
2665 			     sg_nents_for_len(req->src, src_len),
2666 			     DMA_BIDIRECTIONAL);
2667 	} else {
2668 		dma_unmap_sg(dev, req->src,
2669 			     sg_nents_for_len(req->src, src_len),
2670 			     DMA_TO_DEVICE);
2671 		dma_unmap_sg(dev, req->dst,
2672 			     sg_nents_for_len(req->dst, dst_len),
2673 			     DMA_FROM_DEVICE);
2674 	}
2675 }
2676 
2677 void chcr_add_aead_src_ent(struct aead_request *req,
2678 			   struct ulptx_sgl *ulptx)
2679 {
2680 	struct ulptx_walk ulp_walk;
2681 	struct chcr_aead_reqctx  *reqctx = aead_request_ctx(req);
2682 
2683 	if (reqctx->imm) {
2684 		u8 *buf = (u8 *)ulptx;
2685 
2686 		if (reqctx->b0_len) {
2687 			memcpy(buf, reqctx->scratch_pad, reqctx->b0_len);
2688 			buf += reqctx->b0_len;
2689 		}
2690 		sg_pcopy_to_buffer(req->src, sg_nents(req->src),
2691 				   buf, req->cryptlen + req->assoclen, 0);
2692 	} else {
2693 		ulptx_walk_init(&ulp_walk, ulptx);
2694 		if (reqctx->b0_len)
2695 			ulptx_walk_add_page(&ulp_walk, reqctx->b0_len,
2696 					    reqctx->b0_dma);
2697 		ulptx_walk_add_sg(&ulp_walk, req->src, req->cryptlen +
2698 				  req->assoclen,  0);
2699 		ulptx_walk_end(&ulp_walk);
2700 	}
2701 }
2702 
2703 void chcr_add_aead_dst_ent(struct aead_request *req,
2704 			   struct cpl_rx_phys_dsgl *phys_cpl,
2705 			   unsigned short qid)
2706 {
2707 	struct chcr_aead_reqctx  *reqctx = aead_request_ctx(req);
2708 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2709 	struct dsgl_walk dsgl_walk;
2710 	unsigned int authsize = crypto_aead_authsize(tfm);
2711 	struct chcr_context *ctx = a_ctx(tfm);
2712 	u32 temp;
2713 	unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
2714 
2715 	dsgl_walk_init(&dsgl_walk, phys_cpl);
2716 	dsgl_walk_add_page(&dsgl_walk, IV + reqctx->b0_len, reqctx->iv_dma);
2717 	temp = req->assoclen + req->cryptlen +
2718 		(reqctx->op ? -authsize : authsize);
2719 	dsgl_walk_add_sg(&dsgl_walk, req->dst, temp, 0);
2720 	dsgl_walk_end(&dsgl_walk, qid, rx_channel_id);
2721 }
2722 
2723 void chcr_add_cipher_src_ent(struct skcipher_request *req,
2724 			     void *ulptx,
2725 			     struct  cipher_wr_param *wrparam)
2726 {
2727 	struct ulptx_walk ulp_walk;
2728 	struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
2729 	u8 *buf = ulptx;
2730 
2731 	memcpy(buf, reqctx->iv, IV);
2732 	buf += IV;
2733 	if (reqctx->imm) {
2734 		sg_pcopy_to_buffer(req->src, sg_nents(req->src),
2735 				   buf, wrparam->bytes, reqctx->processed);
2736 	} else {
2737 		ulptx_walk_init(&ulp_walk, (struct ulptx_sgl *)buf);
2738 		ulptx_walk_add_sg(&ulp_walk, reqctx->srcsg, wrparam->bytes,
2739 				  reqctx->src_ofst);
2740 		reqctx->srcsg = ulp_walk.last_sg;
2741 		reqctx->src_ofst = ulp_walk.last_sg_len;
2742 		ulptx_walk_end(&ulp_walk);
2743 	}
2744 }
2745 
2746 void chcr_add_cipher_dst_ent(struct skcipher_request *req,
2747 			     struct cpl_rx_phys_dsgl *phys_cpl,
2748 			     struct  cipher_wr_param *wrparam,
2749 			     unsigned short qid)
2750 {
2751 	struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
2752 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(wrparam->req);
2753 	struct chcr_context *ctx = c_ctx(tfm);
2754 	struct dsgl_walk dsgl_walk;
2755 	unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
2756 
2757 	dsgl_walk_init(&dsgl_walk, phys_cpl);
2758 	dsgl_walk_add_sg(&dsgl_walk, reqctx->dstsg, wrparam->bytes,
2759 			 reqctx->dst_ofst);
2760 	reqctx->dstsg = dsgl_walk.last_sg;
2761 	reqctx->dst_ofst = dsgl_walk.last_sg_len;
2762 	dsgl_walk_end(&dsgl_walk, qid, rx_channel_id);
2763 }
2764 
2765 void chcr_add_hash_src_ent(struct ahash_request *req,
2766 			   struct ulptx_sgl *ulptx,
2767 			   struct hash_wr_param *param)
2768 {
2769 	struct ulptx_walk ulp_walk;
2770 	struct chcr_ahash_req_ctx *reqctx = ahash_request_ctx(req);
2771 
2772 	if (reqctx->hctx_wr.imm) {
2773 		u8 *buf = (u8 *)ulptx;
2774 
2775 		if (param->bfr_len) {
2776 			memcpy(buf, reqctx->reqbfr, param->bfr_len);
2777 			buf += param->bfr_len;
2778 		}
2779 
2780 		sg_pcopy_to_buffer(reqctx->hctx_wr.srcsg,
2781 				   sg_nents(reqctx->hctx_wr.srcsg), buf,
2782 				   param->sg_len, 0);
2783 	} else {
2784 		ulptx_walk_init(&ulp_walk, ulptx);
2785 		if (param->bfr_len)
2786 			ulptx_walk_add_page(&ulp_walk, param->bfr_len,
2787 					    reqctx->hctx_wr.dma_addr);
2788 		ulptx_walk_add_sg(&ulp_walk, reqctx->hctx_wr.srcsg,
2789 				  param->sg_len, reqctx->hctx_wr.src_ofst);
2790 		reqctx->hctx_wr.srcsg = ulp_walk.last_sg;
2791 		reqctx->hctx_wr.src_ofst = ulp_walk.last_sg_len;
2792 		ulptx_walk_end(&ulp_walk);
2793 	}
2794 }
2795 
2796 int chcr_hash_dma_map(struct device *dev,
2797 		      struct ahash_request *req)
2798 {
2799 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
2800 	int error = 0;
2801 
2802 	if (!req->nbytes)
2803 		return 0;
2804 	error = dma_map_sg(dev, req->src, sg_nents(req->src),
2805 			   DMA_TO_DEVICE);
2806 	if (!error)
2807 		return -ENOMEM;
2808 	req_ctx->hctx_wr.is_sg_map = 1;
2809 	return 0;
2810 }
2811 
2812 void chcr_hash_dma_unmap(struct device *dev,
2813 			 struct ahash_request *req)
2814 {
2815 	struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
2816 
2817 	if (!req->nbytes)
2818 		return;
2819 
2820 	dma_unmap_sg(dev, req->src, sg_nents(req->src),
2821 			   DMA_TO_DEVICE);
2822 	req_ctx->hctx_wr.is_sg_map = 0;
2823 
2824 }
2825 
2826 int chcr_cipher_dma_map(struct device *dev,
2827 			struct skcipher_request *req)
2828 {
2829 	int error;
2830 
2831 	if (req->src == req->dst) {
2832 		error = dma_map_sg(dev, req->src, sg_nents(req->src),
2833 				   DMA_BIDIRECTIONAL);
2834 		if (!error)
2835 			goto err;
2836 	} else {
2837 		error = dma_map_sg(dev, req->src, sg_nents(req->src),
2838 				   DMA_TO_DEVICE);
2839 		if (!error)
2840 			goto err;
2841 		error = dma_map_sg(dev, req->dst, sg_nents(req->dst),
2842 				   DMA_FROM_DEVICE);
2843 		if (!error) {
2844 			dma_unmap_sg(dev, req->src, sg_nents(req->src),
2845 				   DMA_TO_DEVICE);
2846 			goto err;
2847 		}
2848 	}
2849 
2850 	return 0;
2851 err:
2852 	return -ENOMEM;
2853 }
2854 
2855 void chcr_cipher_dma_unmap(struct device *dev,
2856 			   struct skcipher_request *req)
2857 {
2858 	if (req->src == req->dst) {
2859 		dma_unmap_sg(dev, req->src, sg_nents(req->src),
2860 				   DMA_BIDIRECTIONAL);
2861 	} else {
2862 		dma_unmap_sg(dev, req->src, sg_nents(req->src),
2863 				   DMA_TO_DEVICE);
2864 		dma_unmap_sg(dev, req->dst, sg_nents(req->dst),
2865 				   DMA_FROM_DEVICE);
2866 	}
2867 }
2868 
2869 static int set_msg_len(u8 *block, unsigned int msglen, int csize)
2870 {
2871 	__be32 data;
2872 
2873 	memset(block, 0, csize);
2874 	block += csize;
2875 
2876 	if (csize >= 4)
2877 		csize = 4;
2878 	else if (msglen > (unsigned int)(1 << (8 * csize)))
2879 		return -EOVERFLOW;
2880 
2881 	data = cpu_to_be32(msglen);
2882 	memcpy(block - csize, (u8 *)&data + 4 - csize, csize);
2883 
2884 	return 0;
2885 }
2886 
2887 static int generate_b0(struct aead_request *req, u8 *ivptr,
2888 			unsigned short op_type)
2889 {
2890 	unsigned int l, lp, m;
2891 	int rc;
2892 	struct crypto_aead *aead = crypto_aead_reqtfm(req);
2893 	struct chcr_aead_reqctx *reqctx = aead_request_ctx(req);
2894 	u8 *b0 = reqctx->scratch_pad;
2895 
2896 	m = crypto_aead_authsize(aead);
2897 
2898 	memcpy(b0, ivptr, 16);
2899 
2900 	lp = b0[0];
2901 	l = lp + 1;
2902 
2903 	/* set m, bits 3-5 */
2904 	*b0 |= (8 * ((m - 2) / 2));
2905 
2906 	/* set adata, bit 6, if associated data is used */
2907 	if (req->assoclen)
2908 		*b0 |= 64;
2909 	rc = set_msg_len(b0 + 16 - l,
2910 			 (op_type == CHCR_DECRYPT_OP) ?
2911 			 req->cryptlen - m : req->cryptlen, l);
2912 
2913 	return rc;
2914 }
2915 
2916 static inline int crypto_ccm_check_iv(const u8 *iv)
2917 {
2918 	/* 2 <= L <= 8, so 1 <= L' <= 7. */
2919 	if (iv[0] < 1 || iv[0] > 7)
2920 		return -EINVAL;
2921 
2922 	return 0;
2923 }
2924 
2925 static int ccm_format_packet(struct aead_request *req,
2926 			     u8 *ivptr,
2927 			     unsigned int sub_type,
2928 			     unsigned short op_type,
2929 			     unsigned int assoclen)
2930 {
2931 	struct chcr_aead_reqctx *reqctx = aead_request_ctx(req);
2932 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2933 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
2934 	int rc = 0;
2935 
2936 	if (sub_type == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309) {
2937 		ivptr[0] = 3;
2938 		memcpy(ivptr + 1, &aeadctx->salt[0], 3);
2939 		memcpy(ivptr + 4, req->iv, 8);
2940 		memset(ivptr + 12, 0, 4);
2941 	} else {
2942 		memcpy(ivptr, req->iv, 16);
2943 	}
2944 	if (assoclen)
2945 		put_unaligned_be16(assoclen, &reqctx->scratch_pad[16]);
2946 
2947 	rc = generate_b0(req, ivptr, op_type);
2948 	/* zero the ctr value */
2949 	memset(ivptr + 15 - ivptr[0], 0, ivptr[0] + 1);
2950 	return rc;
2951 }
2952 
2953 static void fill_sec_cpl_for_aead(struct cpl_tx_sec_pdu *sec_cpl,
2954 				  unsigned int dst_size,
2955 				  struct aead_request *req,
2956 				  unsigned short op_type)
2957 {
2958 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2959 	struct chcr_context *ctx = a_ctx(tfm);
2960 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(ctx);
2961 	struct chcr_aead_reqctx *reqctx = aead_request_ctx(req);
2962 	unsigned int cipher_mode = CHCR_SCMD_CIPHER_MODE_AES_CCM;
2963 	unsigned int mac_mode = CHCR_SCMD_AUTH_MODE_CBCMAC;
2964 	unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
2965 	unsigned int ccm_xtra;
2966 	unsigned int tag_offset = 0, auth_offset = 0;
2967 	unsigned int assoclen;
2968 
2969 	if (get_aead_subtype(tfm) == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309)
2970 		assoclen = req->assoclen - 8;
2971 	else
2972 		assoclen = req->assoclen;
2973 	ccm_xtra = CCM_B0_SIZE +
2974 		((assoclen) ? CCM_AAD_FIELD_SIZE : 0);
2975 
2976 	auth_offset = req->cryptlen ?
2977 		(req->assoclen + IV + 1 + ccm_xtra) : 0;
2978 	if (op_type == CHCR_DECRYPT_OP) {
2979 		if (crypto_aead_authsize(tfm) != req->cryptlen)
2980 			tag_offset = crypto_aead_authsize(tfm);
2981 		else
2982 			auth_offset = 0;
2983 	}
2984 
2985 	sec_cpl->op_ivinsrtofst = FILL_SEC_CPL_OP_IVINSR(rx_channel_id, 2, 1);
2986 	sec_cpl->pldlen =
2987 		htonl(req->assoclen + IV + req->cryptlen + ccm_xtra);
2988 	/* For CCM there wil be b0 always. So AAD start will be 1 always */
2989 	sec_cpl->aadstart_cipherstop_hi = FILL_SEC_CPL_CIPHERSTOP_HI(
2990 				1 + IV,	IV + assoclen + ccm_xtra,
2991 				req->assoclen + IV + 1 + ccm_xtra, 0);
2992 
2993 	sec_cpl->cipherstop_lo_authinsert = FILL_SEC_CPL_AUTHINSERT(0,
2994 					auth_offset, tag_offset,
2995 					(op_type == CHCR_ENCRYPT_OP) ? 0 :
2996 					crypto_aead_authsize(tfm));
2997 	sec_cpl->seqno_numivs =  FILL_SEC_CPL_SCMD0_SEQNO(op_type,
2998 					(op_type == CHCR_ENCRYPT_OP) ? 0 : 1,
2999 					cipher_mode, mac_mode,
3000 					aeadctx->hmac_ctrl, IV >> 1);
3001 
3002 	sec_cpl->ivgen_hdrlen = FILL_SEC_CPL_IVGEN_HDRLEN(0, 0, 1, 0,
3003 					0, dst_size);
3004 }
3005 
3006 static int aead_ccm_validate_input(unsigned short op_type,
3007 				   struct aead_request *req,
3008 				   struct chcr_aead_ctx *aeadctx,
3009 				   unsigned int sub_type)
3010 {
3011 	if (sub_type != CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309) {
3012 		if (crypto_ccm_check_iv(req->iv)) {
3013 			pr_err("CCM: IV check fails\n");
3014 			return -EINVAL;
3015 		}
3016 	} else {
3017 		if (req->assoclen != 16 && req->assoclen != 20) {
3018 			pr_err("RFC4309: Invalid AAD length %d\n",
3019 			       req->assoclen);
3020 			return -EINVAL;
3021 		}
3022 	}
3023 	return 0;
3024 }
3025 
3026 static struct sk_buff *create_aead_ccm_wr(struct aead_request *req,
3027 					  unsigned short qid,
3028 					  int size)
3029 {
3030 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
3031 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3032 	struct chcr_aead_reqctx *reqctx = aead_request_ctx(req);
3033 	struct sk_buff *skb = NULL;
3034 	struct chcr_wr *chcr_req;
3035 	struct cpl_rx_phys_dsgl *phys_cpl;
3036 	struct ulptx_sgl *ulptx;
3037 	unsigned int transhdr_len;
3038 	unsigned int dst_size = 0, kctx_len, dnents, temp, snents;
3039 	unsigned int sub_type, assoclen = req->assoclen;
3040 	unsigned int authsize = crypto_aead_authsize(tfm);
3041 	int error = -EINVAL;
3042 	u8 *ivptr;
3043 	gfp_t flags = req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP ? GFP_KERNEL :
3044 		GFP_ATOMIC;
3045 	struct adapter *adap = padap(a_ctx(tfm)->dev);
3046 
3047 	sub_type = get_aead_subtype(tfm);
3048 	if (sub_type == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309)
3049 		assoclen -= 8;
3050 	reqctx->b0_len = CCM_B0_SIZE + (assoclen ? CCM_AAD_FIELD_SIZE : 0);
3051 	error = chcr_aead_common_init(req);
3052 	if (error)
3053 		return ERR_PTR(error);
3054 
3055 	error = aead_ccm_validate_input(reqctx->op, req, aeadctx, sub_type);
3056 	if (error)
3057 		goto err;
3058 	dnents = sg_nents_xlen(req->dst, req->assoclen + req->cryptlen
3059 			+ (reqctx->op ? -authsize : authsize),
3060 			CHCR_DST_SG_SIZE, 0);
3061 	dnents += MIN_CCM_SG; // For IV and B0
3062 	dst_size = get_space_for_phys_dsgl(dnents);
3063 	snents = sg_nents_xlen(req->src, req->assoclen + req->cryptlen,
3064 			       CHCR_SRC_SG_SIZE, 0);
3065 	snents += MIN_CCM_SG; //For B0
3066 	kctx_len = roundup(aeadctx->enckey_len, 16) * 2;
3067 	transhdr_len = CIPHER_TRANSHDR_SIZE(kctx_len, dst_size);
3068 	reqctx->imm = (transhdr_len + req->assoclen + req->cryptlen +
3069 		       reqctx->b0_len) <= SGE_MAX_WR_LEN;
3070 	temp = reqctx->imm ? roundup(req->assoclen + req->cryptlen +
3071 				     reqctx->b0_len, 16) :
3072 		(sgl_len(snents) *  8);
3073 	transhdr_len += temp;
3074 	transhdr_len = roundup(transhdr_len, 16);
3075 
3076 	if (chcr_aead_need_fallback(req, dnents, T6_MAX_AAD_SIZE -
3077 				reqctx->b0_len, transhdr_len, reqctx->op)) {
3078 		atomic_inc(&adap->chcr_stats.fallback);
3079 		chcr_aead_common_exit(req);
3080 		return ERR_PTR(chcr_aead_fallback(req, reqctx->op));
3081 	}
3082 	skb = alloc_skb(transhdr_len,  flags);
3083 
3084 	if (!skb) {
3085 		error = -ENOMEM;
3086 		goto err;
3087 	}
3088 
3089 	chcr_req = __skb_put_zero(skb, transhdr_len);
3090 
3091 	fill_sec_cpl_for_aead(&chcr_req->sec_cpl, dst_size, req, reqctx->op);
3092 
3093 	chcr_req->key_ctx.ctx_hdr = aeadctx->key_ctx_hdr;
3094 	memcpy(chcr_req->key_ctx.key, aeadctx->key, aeadctx->enckey_len);
3095 	memcpy(chcr_req->key_ctx.key + roundup(aeadctx->enckey_len, 16),
3096 			aeadctx->key, aeadctx->enckey_len);
3097 
3098 	phys_cpl = (struct cpl_rx_phys_dsgl *)((u8 *)(chcr_req + 1) + kctx_len);
3099 	ivptr = (u8 *)(phys_cpl + 1) + dst_size;
3100 	ulptx = (struct ulptx_sgl *)(ivptr + IV);
3101 	error = ccm_format_packet(req, ivptr, sub_type, reqctx->op, assoclen);
3102 	if (error)
3103 		goto dstmap_fail;
3104 	chcr_add_aead_dst_ent(req, phys_cpl, qid);
3105 	chcr_add_aead_src_ent(req, ulptx);
3106 
3107 	atomic_inc(&adap->chcr_stats.aead_rqst);
3108 	temp = sizeof(struct cpl_rx_phys_dsgl) + dst_size + IV +
3109 		kctx_len + (reqctx->imm ? (req->assoclen + req->cryptlen +
3110 		reqctx->b0_len) : 0);
3111 	create_wreq(a_ctx(tfm), chcr_req, &req->base, reqctx->imm, 0,
3112 		    transhdr_len, temp, 0);
3113 	reqctx->skb = skb;
3114 
3115 	return skb;
3116 dstmap_fail:
3117 	kfree_skb(skb);
3118 err:
3119 	chcr_aead_common_exit(req);
3120 	return ERR_PTR(error);
3121 }
3122 
3123 static struct sk_buff *create_gcm_wr(struct aead_request *req,
3124 				     unsigned short qid,
3125 				     int size)
3126 {
3127 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
3128 	struct chcr_context *ctx = a_ctx(tfm);
3129 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(ctx);
3130 	struct chcr_aead_reqctx  *reqctx = aead_request_ctx(req);
3131 	struct sk_buff *skb = NULL;
3132 	struct chcr_wr *chcr_req;
3133 	struct cpl_rx_phys_dsgl *phys_cpl;
3134 	struct ulptx_sgl *ulptx;
3135 	unsigned int transhdr_len, dnents = 0, snents;
3136 	unsigned int dst_size = 0, temp = 0, kctx_len, assoclen = req->assoclen;
3137 	unsigned int authsize = crypto_aead_authsize(tfm);
3138 	int error = -EINVAL;
3139 	u8 *ivptr;
3140 	gfp_t flags = req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP ? GFP_KERNEL :
3141 		GFP_ATOMIC;
3142 	struct adapter *adap = padap(ctx->dev);
3143 	unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
3144 
3145 	if (get_aead_subtype(tfm) == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106)
3146 		assoclen = req->assoclen - 8;
3147 
3148 	reqctx->b0_len = 0;
3149 	error = chcr_aead_common_init(req);
3150 	if (error)
3151 		return ERR_PTR(error);
3152 	dnents = sg_nents_xlen(req->dst, req->assoclen + req->cryptlen +
3153 				(reqctx->op ? -authsize : authsize),
3154 				CHCR_DST_SG_SIZE, 0);
3155 	snents = sg_nents_xlen(req->src, req->assoclen + req->cryptlen,
3156 			       CHCR_SRC_SG_SIZE, 0);
3157 	dnents += MIN_GCM_SG; // For IV
3158 	dst_size = get_space_for_phys_dsgl(dnents);
3159 	kctx_len = roundup(aeadctx->enckey_len, 16) + AEAD_H_SIZE;
3160 	transhdr_len = CIPHER_TRANSHDR_SIZE(kctx_len, dst_size);
3161 	reqctx->imm = (transhdr_len + req->assoclen + req->cryptlen) <=
3162 			SGE_MAX_WR_LEN;
3163 	temp = reqctx->imm ? roundup(req->assoclen + req->cryptlen, 16) :
3164 		(sgl_len(snents) * 8);
3165 	transhdr_len += temp;
3166 	transhdr_len = roundup(transhdr_len, 16);
3167 	if (chcr_aead_need_fallback(req, dnents, T6_MAX_AAD_SIZE,
3168 			    transhdr_len, reqctx->op)) {
3169 
3170 		atomic_inc(&adap->chcr_stats.fallback);
3171 		chcr_aead_common_exit(req);
3172 		return ERR_PTR(chcr_aead_fallback(req, reqctx->op));
3173 	}
3174 	skb = alloc_skb(transhdr_len, flags);
3175 	if (!skb) {
3176 		error = -ENOMEM;
3177 		goto err;
3178 	}
3179 
3180 	chcr_req = __skb_put_zero(skb, transhdr_len);
3181 
3182 	//Offset of tag from end
3183 	temp = (reqctx->op == CHCR_ENCRYPT_OP) ? 0 : authsize;
3184 	chcr_req->sec_cpl.op_ivinsrtofst = FILL_SEC_CPL_OP_IVINSR(
3185 						rx_channel_id, 2, 1);
3186 	chcr_req->sec_cpl.pldlen =
3187 		htonl(req->assoclen + IV + req->cryptlen);
3188 	chcr_req->sec_cpl.aadstart_cipherstop_hi = FILL_SEC_CPL_CIPHERSTOP_HI(
3189 					assoclen ? 1 + IV : 0,
3190 					assoclen ? IV + assoclen : 0,
3191 					req->assoclen + IV + 1, 0);
3192 	chcr_req->sec_cpl.cipherstop_lo_authinsert =
3193 			FILL_SEC_CPL_AUTHINSERT(0, req->assoclen + IV + 1,
3194 						temp, temp);
3195 	chcr_req->sec_cpl.seqno_numivs =
3196 			FILL_SEC_CPL_SCMD0_SEQNO(reqctx->op, (reqctx->op ==
3197 					CHCR_ENCRYPT_OP) ? 1 : 0,
3198 					CHCR_SCMD_CIPHER_MODE_AES_GCM,
3199 					CHCR_SCMD_AUTH_MODE_GHASH,
3200 					aeadctx->hmac_ctrl, IV >> 1);
3201 	chcr_req->sec_cpl.ivgen_hdrlen =  FILL_SEC_CPL_IVGEN_HDRLEN(0, 0, 1,
3202 					0, 0, dst_size);
3203 	chcr_req->key_ctx.ctx_hdr = aeadctx->key_ctx_hdr;
3204 	memcpy(chcr_req->key_ctx.key, aeadctx->key, aeadctx->enckey_len);
3205 	memcpy(chcr_req->key_ctx.key + roundup(aeadctx->enckey_len, 16),
3206 	       GCM_CTX(aeadctx)->ghash_h, AEAD_H_SIZE);
3207 
3208 	phys_cpl = (struct cpl_rx_phys_dsgl *)((u8 *)(chcr_req + 1) + kctx_len);
3209 	ivptr = (u8 *)(phys_cpl + 1) + dst_size;
3210 	/* prepare a 16 byte iv */
3211 	/* S   A   L  T |  IV | 0x00000001 */
3212 	if (get_aead_subtype(tfm) ==
3213 	    CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106) {
3214 		memcpy(ivptr, aeadctx->salt, 4);
3215 		memcpy(ivptr + 4, req->iv, GCM_RFC4106_IV_SIZE);
3216 	} else {
3217 		memcpy(ivptr, req->iv, GCM_AES_IV_SIZE);
3218 	}
3219 	put_unaligned_be32(0x01, &ivptr[12]);
3220 	ulptx = (struct ulptx_sgl *)(ivptr + 16);
3221 
3222 	chcr_add_aead_dst_ent(req, phys_cpl, qid);
3223 	chcr_add_aead_src_ent(req, ulptx);
3224 	atomic_inc(&adap->chcr_stats.aead_rqst);
3225 	temp = sizeof(struct cpl_rx_phys_dsgl) + dst_size + IV +
3226 		kctx_len + (reqctx->imm ? (req->assoclen + req->cryptlen) : 0);
3227 	create_wreq(a_ctx(tfm), chcr_req, &req->base, reqctx->imm, size,
3228 		    transhdr_len, temp, reqctx->verify);
3229 	reqctx->skb = skb;
3230 	return skb;
3231 
3232 err:
3233 	chcr_aead_common_exit(req);
3234 	return ERR_PTR(error);
3235 }
3236 
3237 
3238 
3239 static int chcr_aead_cra_init(struct crypto_aead *tfm)
3240 {
3241 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3242 	struct aead_alg *alg = crypto_aead_alg(tfm);
3243 
3244 	aeadctx->sw_cipher = crypto_alloc_aead(alg->base.cra_name, 0,
3245 					       CRYPTO_ALG_NEED_FALLBACK |
3246 					       CRYPTO_ALG_ASYNC);
3247 	if  (IS_ERR(aeadctx->sw_cipher))
3248 		return PTR_ERR(aeadctx->sw_cipher);
3249 	crypto_aead_set_reqsize(tfm, max(sizeof(struct chcr_aead_reqctx),
3250 				 sizeof(struct aead_request) +
3251 				 crypto_aead_reqsize(aeadctx->sw_cipher)));
3252 	return chcr_device_init(a_ctx(tfm));
3253 }
3254 
3255 static void chcr_aead_cra_exit(struct crypto_aead *tfm)
3256 {
3257 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3258 
3259 	crypto_free_aead(aeadctx->sw_cipher);
3260 }
3261 
3262 static int chcr_authenc_null_setauthsize(struct crypto_aead *tfm,
3263 					unsigned int authsize)
3264 {
3265 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3266 
3267 	aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NOP;
3268 	aeadctx->mayverify = VERIFY_HW;
3269 	return crypto_aead_setauthsize(aeadctx->sw_cipher, authsize);
3270 }
3271 static int chcr_authenc_setauthsize(struct crypto_aead *tfm,
3272 				    unsigned int authsize)
3273 {
3274 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3275 	u32 maxauth = crypto_aead_maxauthsize(tfm);
3276 
3277 	/*SHA1 authsize in ipsec is 12 instead of 10 i.e maxauthsize / 2 is not
3278 	 * true for sha1. authsize == 12 condition should be before
3279 	 * authsize == (maxauth >> 1)
3280 	 */
3281 	if (authsize == ICV_4) {
3282 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL1;
3283 		aeadctx->mayverify = VERIFY_HW;
3284 	} else if (authsize == ICV_6) {
3285 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL2;
3286 		aeadctx->mayverify = VERIFY_HW;
3287 	} else if (authsize == ICV_10) {
3288 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_TRUNC_RFC4366;
3289 		aeadctx->mayverify = VERIFY_HW;
3290 	} else if (authsize == ICV_12) {
3291 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_IPSEC_96BIT;
3292 		aeadctx->mayverify = VERIFY_HW;
3293 	} else if (authsize == ICV_14) {
3294 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL3;
3295 		aeadctx->mayverify = VERIFY_HW;
3296 	} else if (authsize == (maxauth >> 1)) {
3297 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_DIV2;
3298 		aeadctx->mayverify = VERIFY_HW;
3299 	} else if (authsize == maxauth) {
3300 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3301 		aeadctx->mayverify = VERIFY_HW;
3302 	} else {
3303 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3304 		aeadctx->mayverify = VERIFY_SW;
3305 	}
3306 	return crypto_aead_setauthsize(aeadctx->sw_cipher, authsize);
3307 }
3308 
3309 
3310 static int chcr_gcm_setauthsize(struct crypto_aead *tfm, unsigned int authsize)
3311 {
3312 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3313 
3314 	switch (authsize) {
3315 	case ICV_4:
3316 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL1;
3317 		aeadctx->mayverify = VERIFY_HW;
3318 		break;
3319 	case ICV_8:
3320 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_DIV2;
3321 		aeadctx->mayverify = VERIFY_HW;
3322 		break;
3323 	case ICV_12:
3324 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_IPSEC_96BIT;
3325 		aeadctx->mayverify = VERIFY_HW;
3326 		break;
3327 	case ICV_14:
3328 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL3;
3329 		aeadctx->mayverify = VERIFY_HW;
3330 		break;
3331 	case ICV_16:
3332 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3333 		aeadctx->mayverify = VERIFY_HW;
3334 		break;
3335 	case ICV_13:
3336 	case ICV_15:
3337 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3338 		aeadctx->mayverify = VERIFY_SW;
3339 		break;
3340 	default:
3341 		return -EINVAL;
3342 	}
3343 	return crypto_aead_setauthsize(aeadctx->sw_cipher, authsize);
3344 }
3345 
3346 static int chcr_4106_4309_setauthsize(struct crypto_aead *tfm,
3347 					  unsigned int authsize)
3348 {
3349 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3350 
3351 	switch (authsize) {
3352 	case ICV_8:
3353 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_DIV2;
3354 		aeadctx->mayverify = VERIFY_HW;
3355 		break;
3356 	case ICV_12:
3357 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_IPSEC_96BIT;
3358 		aeadctx->mayverify = VERIFY_HW;
3359 		break;
3360 	case ICV_16:
3361 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3362 		aeadctx->mayverify = VERIFY_HW;
3363 		break;
3364 	default:
3365 		return -EINVAL;
3366 	}
3367 	return crypto_aead_setauthsize(aeadctx->sw_cipher, authsize);
3368 }
3369 
3370 static int chcr_ccm_setauthsize(struct crypto_aead *tfm,
3371 				unsigned int authsize)
3372 {
3373 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3374 
3375 	switch (authsize) {
3376 	case ICV_4:
3377 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL1;
3378 		aeadctx->mayverify = VERIFY_HW;
3379 		break;
3380 	case ICV_6:
3381 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL2;
3382 		aeadctx->mayverify = VERIFY_HW;
3383 		break;
3384 	case ICV_8:
3385 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_DIV2;
3386 		aeadctx->mayverify = VERIFY_HW;
3387 		break;
3388 	case ICV_10:
3389 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_TRUNC_RFC4366;
3390 		aeadctx->mayverify = VERIFY_HW;
3391 		break;
3392 	case ICV_12:
3393 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_IPSEC_96BIT;
3394 		aeadctx->mayverify = VERIFY_HW;
3395 		break;
3396 	case ICV_14:
3397 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL3;
3398 		aeadctx->mayverify = VERIFY_HW;
3399 		break;
3400 	case ICV_16:
3401 		aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3402 		aeadctx->mayverify = VERIFY_HW;
3403 		break;
3404 	default:
3405 		return -EINVAL;
3406 	}
3407 	return crypto_aead_setauthsize(aeadctx->sw_cipher, authsize);
3408 }
3409 
3410 static int chcr_ccm_common_setkey(struct crypto_aead *aead,
3411 				const u8 *key,
3412 				unsigned int keylen)
3413 {
3414 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(aead));
3415 	unsigned char ck_size, mk_size;
3416 	int key_ctx_size = 0;
3417 
3418 	key_ctx_size = sizeof(struct _key_ctx) + roundup(keylen, 16) * 2;
3419 	if (keylen == AES_KEYSIZE_128) {
3420 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_128;
3421 		mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_128;
3422 	} else if (keylen == AES_KEYSIZE_192) {
3423 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_192;
3424 		mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_192;
3425 	} else if (keylen == AES_KEYSIZE_256) {
3426 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_256;
3427 		mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_256;
3428 	} else {
3429 		aeadctx->enckey_len = 0;
3430 		return	-EINVAL;
3431 	}
3432 	aeadctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, mk_size, 0, 0,
3433 						key_ctx_size >> 4);
3434 	memcpy(aeadctx->key, key, keylen);
3435 	aeadctx->enckey_len = keylen;
3436 
3437 	return 0;
3438 }
3439 
3440 static int chcr_aead_ccm_setkey(struct crypto_aead *aead,
3441 				const u8 *key,
3442 				unsigned int keylen)
3443 {
3444 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(aead));
3445 	int error;
3446 
3447 	crypto_aead_clear_flags(aeadctx->sw_cipher, CRYPTO_TFM_REQ_MASK);
3448 	crypto_aead_set_flags(aeadctx->sw_cipher, crypto_aead_get_flags(aead) &
3449 			      CRYPTO_TFM_REQ_MASK);
3450 	error = crypto_aead_setkey(aeadctx->sw_cipher, key, keylen);
3451 	if (error)
3452 		return error;
3453 	return chcr_ccm_common_setkey(aead, key, keylen);
3454 }
3455 
3456 static int chcr_aead_rfc4309_setkey(struct crypto_aead *aead, const u8 *key,
3457 				    unsigned int keylen)
3458 {
3459 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(aead));
3460 	int error;
3461 
3462 	if (keylen < 3) {
3463 		aeadctx->enckey_len = 0;
3464 		return	-EINVAL;
3465 	}
3466 	crypto_aead_clear_flags(aeadctx->sw_cipher, CRYPTO_TFM_REQ_MASK);
3467 	crypto_aead_set_flags(aeadctx->sw_cipher, crypto_aead_get_flags(aead) &
3468 			      CRYPTO_TFM_REQ_MASK);
3469 	error = crypto_aead_setkey(aeadctx->sw_cipher, key, keylen);
3470 	if (error)
3471 		return error;
3472 	keylen -= 3;
3473 	memcpy(aeadctx->salt, key + keylen, 3);
3474 	return chcr_ccm_common_setkey(aead, key, keylen);
3475 }
3476 
3477 static int chcr_gcm_setkey(struct crypto_aead *aead, const u8 *key,
3478 			   unsigned int keylen)
3479 {
3480 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(aead));
3481 	struct chcr_gcm_ctx *gctx = GCM_CTX(aeadctx);
3482 	unsigned int ck_size;
3483 	int ret = 0, key_ctx_size = 0;
3484 	struct crypto_aes_ctx aes;
3485 
3486 	aeadctx->enckey_len = 0;
3487 	crypto_aead_clear_flags(aeadctx->sw_cipher, CRYPTO_TFM_REQ_MASK);
3488 	crypto_aead_set_flags(aeadctx->sw_cipher, crypto_aead_get_flags(aead)
3489 			      & CRYPTO_TFM_REQ_MASK);
3490 	ret = crypto_aead_setkey(aeadctx->sw_cipher, key, keylen);
3491 	if (ret)
3492 		goto out;
3493 
3494 	if (get_aead_subtype(aead) == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106 &&
3495 	    keylen > 3) {
3496 		keylen -= 4;  /* nonce/salt is present in the last 4 bytes */
3497 		memcpy(aeadctx->salt, key + keylen, 4);
3498 	}
3499 	if (keylen == AES_KEYSIZE_128) {
3500 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_128;
3501 	} else if (keylen == AES_KEYSIZE_192) {
3502 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_192;
3503 	} else if (keylen == AES_KEYSIZE_256) {
3504 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_256;
3505 	} else {
3506 		pr_err("GCM: Invalid key length %d\n", keylen);
3507 		ret = -EINVAL;
3508 		goto out;
3509 	}
3510 
3511 	memcpy(aeadctx->key, key, keylen);
3512 	aeadctx->enckey_len = keylen;
3513 	key_ctx_size = sizeof(struct _key_ctx) + roundup(keylen, 16) +
3514 		AEAD_H_SIZE;
3515 	aeadctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size,
3516 						CHCR_KEYCTX_MAC_KEY_SIZE_128,
3517 						0, 0,
3518 						key_ctx_size >> 4);
3519 	/* Calculate the H = CIPH(K, 0 repeated 16 times).
3520 	 * It will go in key context
3521 	 */
3522 	ret = aes_expandkey(&aes, key, keylen);
3523 	if (ret) {
3524 		aeadctx->enckey_len = 0;
3525 		goto out;
3526 	}
3527 	memset(gctx->ghash_h, 0, AEAD_H_SIZE);
3528 	aes_encrypt(&aes, gctx->ghash_h, gctx->ghash_h);
3529 	memzero_explicit(&aes, sizeof(aes));
3530 
3531 out:
3532 	return ret;
3533 }
3534 
3535 static int chcr_authenc_setkey(struct crypto_aead *authenc, const u8 *key,
3536 				   unsigned int keylen)
3537 {
3538 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(authenc));
3539 	struct chcr_authenc_ctx *actx = AUTHENC_CTX(aeadctx);
3540 	/* it contains auth and cipher key both*/
3541 	struct crypto_authenc_keys keys;
3542 	unsigned int bs, subtype;
3543 	unsigned int max_authsize = crypto_aead_alg(authenc)->maxauthsize;
3544 	int err = 0, i, key_ctx_len = 0;
3545 	unsigned char ck_size = 0;
3546 	unsigned char pad[CHCR_HASH_MAX_BLOCK_SIZE_128] = { 0 };
3547 	struct crypto_shash *base_hash = ERR_PTR(-EINVAL);
3548 	struct algo_param param;
3549 	int align;
3550 	u8 *o_ptr = NULL;
3551 
3552 	crypto_aead_clear_flags(aeadctx->sw_cipher, CRYPTO_TFM_REQ_MASK);
3553 	crypto_aead_set_flags(aeadctx->sw_cipher, crypto_aead_get_flags(authenc)
3554 			      & CRYPTO_TFM_REQ_MASK);
3555 	err = crypto_aead_setkey(aeadctx->sw_cipher, key, keylen);
3556 	if (err)
3557 		goto out;
3558 
3559 	if (crypto_authenc_extractkeys(&keys, key, keylen) != 0)
3560 		goto out;
3561 
3562 	if (get_alg_config(&param, max_authsize)) {
3563 		pr_err("Unsupported digest size\n");
3564 		goto out;
3565 	}
3566 	subtype = get_aead_subtype(authenc);
3567 	if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_SHA ||
3568 		subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL) {
3569 		if (keys.enckeylen < CTR_RFC3686_NONCE_SIZE)
3570 			goto out;
3571 		memcpy(aeadctx->nonce, keys.enckey + (keys.enckeylen
3572 		- CTR_RFC3686_NONCE_SIZE), CTR_RFC3686_NONCE_SIZE);
3573 		keys.enckeylen -= CTR_RFC3686_NONCE_SIZE;
3574 	}
3575 	if (keys.enckeylen == AES_KEYSIZE_128) {
3576 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_128;
3577 	} else if (keys.enckeylen == AES_KEYSIZE_192) {
3578 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_192;
3579 	} else if (keys.enckeylen == AES_KEYSIZE_256) {
3580 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_256;
3581 	} else {
3582 		pr_err("Unsupported cipher key\n");
3583 		goto out;
3584 	}
3585 
3586 	/* Copy only encryption key. We use authkey to generate h(ipad) and
3587 	 * h(opad) so authkey is not needed again. authkeylen size have the
3588 	 * size of the hash digest size.
3589 	 */
3590 	memcpy(aeadctx->key, keys.enckey, keys.enckeylen);
3591 	aeadctx->enckey_len = keys.enckeylen;
3592 	if (subtype == CRYPTO_ALG_SUB_TYPE_CBC_SHA ||
3593 		subtype == CRYPTO_ALG_SUB_TYPE_CBC_NULL) {
3594 
3595 		get_aes_decrypt_key(actx->dec_rrkey, aeadctx->key,
3596 			    aeadctx->enckey_len << 3);
3597 	}
3598 	base_hash  = chcr_alloc_shash(max_authsize);
3599 	if (IS_ERR(base_hash)) {
3600 		pr_err("Base driver cannot be loaded\n");
3601 		goto out;
3602 	}
3603 	{
3604 		SHASH_DESC_ON_STACK(shash, base_hash);
3605 
3606 		shash->tfm = base_hash;
3607 		bs = crypto_shash_blocksize(base_hash);
3608 		align = KEYCTX_ALIGN_PAD(max_authsize);
3609 		o_ptr =  actx->h_iopad + param.result_size + align;
3610 
3611 		if (keys.authkeylen > bs) {
3612 			err = crypto_shash_digest(shash, keys.authkey,
3613 						  keys.authkeylen,
3614 						  o_ptr);
3615 			if (err) {
3616 				pr_err("Base driver cannot be loaded\n");
3617 				goto out;
3618 			}
3619 			keys.authkeylen = max_authsize;
3620 		} else
3621 			memcpy(o_ptr, keys.authkey, keys.authkeylen);
3622 
3623 		/* Compute the ipad-digest*/
3624 		memset(pad + keys.authkeylen, 0, bs - keys.authkeylen);
3625 		memcpy(pad, o_ptr, keys.authkeylen);
3626 		for (i = 0; i < bs >> 2; i++)
3627 			*((unsigned int *)pad + i) ^= IPAD_DATA;
3628 
3629 		if (chcr_compute_partial_hash(shash, pad, actx->h_iopad,
3630 					      max_authsize))
3631 			goto out;
3632 		/* Compute the opad-digest */
3633 		memset(pad + keys.authkeylen, 0, bs - keys.authkeylen);
3634 		memcpy(pad, o_ptr, keys.authkeylen);
3635 		for (i = 0; i < bs >> 2; i++)
3636 			*((unsigned int *)pad + i) ^= OPAD_DATA;
3637 
3638 		if (chcr_compute_partial_hash(shash, pad, o_ptr, max_authsize))
3639 			goto out;
3640 
3641 		/* convert the ipad and opad digest to network order */
3642 		chcr_change_order(actx->h_iopad, param.result_size);
3643 		chcr_change_order(o_ptr, param.result_size);
3644 		key_ctx_len = sizeof(struct _key_ctx) +
3645 			roundup(keys.enckeylen, 16) +
3646 			(param.result_size + align) * 2;
3647 		aeadctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, param.mk_size,
3648 						0, 1, key_ctx_len >> 4);
3649 		actx->auth_mode = param.auth_mode;
3650 		chcr_free_shash(base_hash);
3651 
3652 		memzero_explicit(&keys, sizeof(keys));
3653 		return 0;
3654 	}
3655 out:
3656 	aeadctx->enckey_len = 0;
3657 	memzero_explicit(&keys, sizeof(keys));
3658 	if (!IS_ERR(base_hash))
3659 		chcr_free_shash(base_hash);
3660 	return -EINVAL;
3661 }
3662 
3663 static int chcr_aead_digest_null_setkey(struct crypto_aead *authenc,
3664 					const u8 *key, unsigned int keylen)
3665 {
3666 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(authenc));
3667 	struct chcr_authenc_ctx *actx = AUTHENC_CTX(aeadctx);
3668 	struct crypto_authenc_keys keys;
3669 	int err;
3670 	/* it contains auth and cipher key both*/
3671 	unsigned int subtype;
3672 	int key_ctx_len = 0;
3673 	unsigned char ck_size = 0;
3674 
3675 	crypto_aead_clear_flags(aeadctx->sw_cipher, CRYPTO_TFM_REQ_MASK);
3676 	crypto_aead_set_flags(aeadctx->sw_cipher, crypto_aead_get_flags(authenc)
3677 			      & CRYPTO_TFM_REQ_MASK);
3678 	err = crypto_aead_setkey(aeadctx->sw_cipher, key, keylen);
3679 	if (err)
3680 		goto out;
3681 
3682 	if (crypto_authenc_extractkeys(&keys, key, keylen) != 0)
3683 		goto out;
3684 
3685 	subtype = get_aead_subtype(authenc);
3686 	if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_SHA ||
3687 	    subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL) {
3688 		if (keys.enckeylen < CTR_RFC3686_NONCE_SIZE)
3689 			goto out;
3690 		memcpy(aeadctx->nonce, keys.enckey + (keys.enckeylen
3691 			- CTR_RFC3686_NONCE_SIZE), CTR_RFC3686_NONCE_SIZE);
3692 		keys.enckeylen -= CTR_RFC3686_NONCE_SIZE;
3693 	}
3694 	if (keys.enckeylen == AES_KEYSIZE_128) {
3695 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_128;
3696 	} else if (keys.enckeylen == AES_KEYSIZE_192) {
3697 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_192;
3698 	} else if (keys.enckeylen == AES_KEYSIZE_256) {
3699 		ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_256;
3700 	} else {
3701 		pr_err("Unsupported cipher key %d\n", keys.enckeylen);
3702 		goto out;
3703 	}
3704 	memcpy(aeadctx->key, keys.enckey, keys.enckeylen);
3705 	aeadctx->enckey_len = keys.enckeylen;
3706 	if (subtype == CRYPTO_ALG_SUB_TYPE_CBC_SHA ||
3707 	    subtype == CRYPTO_ALG_SUB_TYPE_CBC_NULL) {
3708 		get_aes_decrypt_key(actx->dec_rrkey, aeadctx->key,
3709 				aeadctx->enckey_len << 3);
3710 	}
3711 	key_ctx_len =  sizeof(struct _key_ctx) + roundup(keys.enckeylen, 16);
3712 
3713 	aeadctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, CHCR_KEYCTX_NO_KEY, 0,
3714 						0, key_ctx_len >> 4);
3715 	actx->auth_mode = CHCR_SCMD_AUTH_MODE_NOP;
3716 	memzero_explicit(&keys, sizeof(keys));
3717 	return 0;
3718 out:
3719 	aeadctx->enckey_len = 0;
3720 	memzero_explicit(&keys, sizeof(keys));
3721 	return -EINVAL;
3722 }
3723 
3724 static int chcr_aead_op(struct aead_request *req,
3725 			int size,
3726 			create_wr_t create_wr_fn)
3727 {
3728 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
3729 	struct chcr_aead_reqctx  *reqctx = aead_request_ctx(req);
3730 	struct chcr_context *ctx = a_ctx(tfm);
3731 	struct uld_ctx *u_ctx = ULD_CTX(ctx);
3732 	struct sk_buff *skb;
3733 	struct chcr_dev *cdev;
3734 
3735 	cdev = a_ctx(tfm)->dev;
3736 	if (!cdev) {
3737 		pr_err("%s : No crypto device.\n", __func__);
3738 		return -ENXIO;
3739 	}
3740 
3741 	if (chcr_inc_wrcount(cdev)) {
3742 	/* Detach state for CHCR means lldi or padap is freed.
3743 	 * We cannot increment fallback here.
3744 	 */
3745 		return chcr_aead_fallback(req, reqctx->op);
3746 	}
3747 
3748 	if (cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
3749 					reqctx->txqidx) &&
3750 		(!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG))) {
3751 			chcr_dec_wrcount(cdev);
3752 			return -ENOSPC;
3753 	}
3754 
3755 	if (get_aead_subtype(tfm) == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106 &&
3756 	    crypto_ipsec_check_assoclen(req->assoclen) != 0) {
3757 		pr_err("RFC4106: Invalid value of assoclen %d\n",
3758 		       req->assoclen);
3759 		return -EINVAL;
3760 	}
3761 
3762 	/* Form a WR from req */
3763 	skb = create_wr_fn(req, u_ctx->lldi.rxq_ids[reqctx->rxqidx], size);
3764 
3765 	if (IS_ERR_OR_NULL(skb)) {
3766 		chcr_dec_wrcount(cdev);
3767 		return PTR_ERR_OR_ZERO(skb);
3768 	}
3769 
3770 	skb->dev = u_ctx->lldi.ports[0];
3771 	set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
3772 	chcr_send_wr(skb);
3773 	return -EINPROGRESS;
3774 }
3775 
3776 static int chcr_aead_encrypt(struct aead_request *req)
3777 {
3778 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
3779 	struct chcr_aead_reqctx *reqctx = aead_request_ctx(req);
3780 	struct chcr_context *ctx = a_ctx(tfm);
3781 	unsigned int cpu;
3782 
3783 	cpu = get_cpu();
3784 	reqctx->txqidx = cpu % ctx->ntxq;
3785 	reqctx->rxqidx = cpu % ctx->nrxq;
3786 	put_cpu();
3787 
3788 	reqctx->verify = VERIFY_HW;
3789 	reqctx->op = CHCR_ENCRYPT_OP;
3790 
3791 	switch (get_aead_subtype(tfm)) {
3792 	case CRYPTO_ALG_SUB_TYPE_CTR_SHA:
3793 	case CRYPTO_ALG_SUB_TYPE_CBC_SHA:
3794 	case CRYPTO_ALG_SUB_TYPE_CBC_NULL:
3795 	case CRYPTO_ALG_SUB_TYPE_CTR_NULL:
3796 		return chcr_aead_op(req, 0, create_authenc_wr);
3797 	case CRYPTO_ALG_SUB_TYPE_AEAD_CCM:
3798 	case CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309:
3799 		return chcr_aead_op(req, 0, create_aead_ccm_wr);
3800 	default:
3801 		return chcr_aead_op(req, 0, create_gcm_wr);
3802 	}
3803 }
3804 
3805 static int chcr_aead_decrypt(struct aead_request *req)
3806 {
3807 	struct crypto_aead *tfm = crypto_aead_reqtfm(req);
3808 	struct chcr_context *ctx = a_ctx(tfm);
3809 	struct chcr_aead_ctx *aeadctx = AEAD_CTX(ctx);
3810 	struct chcr_aead_reqctx *reqctx = aead_request_ctx(req);
3811 	int size;
3812 	unsigned int cpu;
3813 
3814 	cpu = get_cpu();
3815 	reqctx->txqidx = cpu % ctx->ntxq;
3816 	reqctx->rxqidx = cpu % ctx->nrxq;
3817 	put_cpu();
3818 
3819 	if (aeadctx->mayverify == VERIFY_SW) {
3820 		size = crypto_aead_maxauthsize(tfm);
3821 		reqctx->verify = VERIFY_SW;
3822 	} else {
3823 		size = 0;
3824 		reqctx->verify = VERIFY_HW;
3825 	}
3826 	reqctx->op = CHCR_DECRYPT_OP;
3827 	switch (get_aead_subtype(tfm)) {
3828 	case CRYPTO_ALG_SUB_TYPE_CBC_SHA:
3829 	case CRYPTO_ALG_SUB_TYPE_CTR_SHA:
3830 	case CRYPTO_ALG_SUB_TYPE_CBC_NULL:
3831 	case CRYPTO_ALG_SUB_TYPE_CTR_NULL:
3832 		return chcr_aead_op(req, size, create_authenc_wr);
3833 	case CRYPTO_ALG_SUB_TYPE_AEAD_CCM:
3834 	case CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309:
3835 		return chcr_aead_op(req, size, create_aead_ccm_wr);
3836 	default:
3837 		return chcr_aead_op(req, size, create_gcm_wr);
3838 	}
3839 }
3840 
3841 static struct chcr_alg_template driver_algs[] = {
3842 	/* AES-CBC */
3843 	{
3844 		.type = CRYPTO_ALG_TYPE_SKCIPHER | CRYPTO_ALG_SUB_TYPE_CBC,
3845 		.is_registered = 0,
3846 		.alg.skcipher = {
3847 			.base.cra_name		= "cbc(aes)",
3848 			.base.cra_driver_name	= "cbc-aes-chcr",
3849 			.base.cra_blocksize	= AES_BLOCK_SIZE,
3850 
3851 			.init			= chcr_init_tfm,
3852 			.exit			= chcr_exit_tfm,
3853 			.min_keysize		= AES_MIN_KEY_SIZE,
3854 			.max_keysize		= AES_MAX_KEY_SIZE,
3855 			.ivsize			= AES_BLOCK_SIZE,
3856 			.setkey			= chcr_aes_cbc_setkey,
3857 			.encrypt		= chcr_aes_encrypt,
3858 			.decrypt		= chcr_aes_decrypt,
3859 			}
3860 	},
3861 	{
3862 		.type = CRYPTO_ALG_TYPE_SKCIPHER | CRYPTO_ALG_SUB_TYPE_XTS,
3863 		.is_registered = 0,
3864 		.alg.skcipher = {
3865 			.base.cra_name		= "xts(aes)",
3866 			.base.cra_driver_name	= "xts-aes-chcr",
3867 			.base.cra_blocksize	= AES_BLOCK_SIZE,
3868 
3869 			.init			= chcr_init_tfm,
3870 			.exit			= chcr_exit_tfm,
3871 			.min_keysize		= 2 * AES_MIN_KEY_SIZE,
3872 			.max_keysize		= 2 * AES_MAX_KEY_SIZE,
3873 			.ivsize			= AES_BLOCK_SIZE,
3874 			.setkey			= chcr_aes_xts_setkey,
3875 			.encrypt		= chcr_aes_encrypt,
3876 			.decrypt		= chcr_aes_decrypt,
3877 			}
3878 	},
3879 	{
3880 		.type = CRYPTO_ALG_TYPE_SKCIPHER | CRYPTO_ALG_SUB_TYPE_CTR,
3881 		.is_registered = 0,
3882 		.alg.skcipher = {
3883 			.base.cra_name		= "ctr(aes)",
3884 			.base.cra_driver_name	= "ctr-aes-chcr",
3885 			.base.cra_blocksize	= 1,
3886 
3887 			.init			= chcr_init_tfm,
3888 			.exit			= chcr_exit_tfm,
3889 			.min_keysize		= AES_MIN_KEY_SIZE,
3890 			.max_keysize		= AES_MAX_KEY_SIZE,
3891 			.ivsize			= AES_BLOCK_SIZE,
3892 			.setkey			= chcr_aes_ctr_setkey,
3893 			.encrypt		= chcr_aes_encrypt,
3894 			.decrypt		= chcr_aes_decrypt,
3895 		}
3896 	},
3897 	{
3898 		.type = CRYPTO_ALG_TYPE_SKCIPHER |
3899 			CRYPTO_ALG_SUB_TYPE_CTR_RFC3686,
3900 		.is_registered = 0,
3901 		.alg.skcipher = {
3902 			.base.cra_name		= "rfc3686(ctr(aes))",
3903 			.base.cra_driver_name	= "rfc3686-ctr-aes-chcr",
3904 			.base.cra_blocksize	= 1,
3905 
3906 			.init			= chcr_rfc3686_init,
3907 			.exit			= chcr_exit_tfm,
3908 			.min_keysize		= AES_MIN_KEY_SIZE + CTR_RFC3686_NONCE_SIZE,
3909 			.max_keysize		= AES_MAX_KEY_SIZE + CTR_RFC3686_NONCE_SIZE,
3910 			.ivsize			= CTR_RFC3686_IV_SIZE,
3911 			.setkey			= chcr_aes_rfc3686_setkey,
3912 			.encrypt		= chcr_aes_encrypt,
3913 			.decrypt		= chcr_aes_decrypt,
3914 		}
3915 	},
3916 	/* SHA */
3917 	{
3918 		.type = CRYPTO_ALG_TYPE_AHASH,
3919 		.is_registered = 0,
3920 		.alg.hash = {
3921 			.halg.digestsize = SHA1_DIGEST_SIZE,
3922 			.halg.base = {
3923 				.cra_name = "sha1",
3924 				.cra_driver_name = "sha1-chcr",
3925 				.cra_blocksize = SHA1_BLOCK_SIZE,
3926 			}
3927 		}
3928 	},
3929 	{
3930 		.type = CRYPTO_ALG_TYPE_AHASH,
3931 		.is_registered = 0,
3932 		.alg.hash = {
3933 			.halg.digestsize = SHA256_DIGEST_SIZE,
3934 			.halg.base = {
3935 				.cra_name = "sha256",
3936 				.cra_driver_name = "sha256-chcr",
3937 				.cra_blocksize = SHA256_BLOCK_SIZE,
3938 			}
3939 		}
3940 	},
3941 	{
3942 		.type = CRYPTO_ALG_TYPE_AHASH,
3943 		.is_registered = 0,
3944 		.alg.hash = {
3945 			.halg.digestsize = SHA224_DIGEST_SIZE,
3946 			.halg.base = {
3947 				.cra_name = "sha224",
3948 				.cra_driver_name = "sha224-chcr",
3949 				.cra_blocksize = SHA224_BLOCK_SIZE,
3950 			}
3951 		}
3952 	},
3953 	{
3954 		.type = CRYPTO_ALG_TYPE_AHASH,
3955 		.is_registered = 0,
3956 		.alg.hash = {
3957 			.halg.digestsize = SHA384_DIGEST_SIZE,
3958 			.halg.base = {
3959 				.cra_name = "sha384",
3960 				.cra_driver_name = "sha384-chcr",
3961 				.cra_blocksize = SHA384_BLOCK_SIZE,
3962 			}
3963 		}
3964 	},
3965 	{
3966 		.type = CRYPTO_ALG_TYPE_AHASH,
3967 		.is_registered = 0,
3968 		.alg.hash = {
3969 			.halg.digestsize = SHA512_DIGEST_SIZE,
3970 			.halg.base = {
3971 				.cra_name = "sha512",
3972 				.cra_driver_name = "sha512-chcr",
3973 				.cra_blocksize = SHA512_BLOCK_SIZE,
3974 			}
3975 		}
3976 	},
3977 	/* HMAC */
3978 	{
3979 		.type = CRYPTO_ALG_TYPE_HMAC,
3980 		.is_registered = 0,
3981 		.alg.hash = {
3982 			.halg.digestsize = SHA1_DIGEST_SIZE,
3983 			.halg.base = {
3984 				.cra_name = "hmac(sha1)",
3985 				.cra_driver_name = "hmac-sha1-chcr",
3986 				.cra_blocksize = SHA1_BLOCK_SIZE,
3987 			}
3988 		}
3989 	},
3990 	{
3991 		.type = CRYPTO_ALG_TYPE_HMAC,
3992 		.is_registered = 0,
3993 		.alg.hash = {
3994 			.halg.digestsize = SHA224_DIGEST_SIZE,
3995 			.halg.base = {
3996 				.cra_name = "hmac(sha224)",
3997 				.cra_driver_name = "hmac-sha224-chcr",
3998 				.cra_blocksize = SHA224_BLOCK_SIZE,
3999 			}
4000 		}
4001 	},
4002 	{
4003 		.type = CRYPTO_ALG_TYPE_HMAC,
4004 		.is_registered = 0,
4005 		.alg.hash = {
4006 			.halg.digestsize = SHA256_DIGEST_SIZE,
4007 			.halg.base = {
4008 				.cra_name = "hmac(sha256)",
4009 				.cra_driver_name = "hmac-sha256-chcr",
4010 				.cra_blocksize = SHA256_BLOCK_SIZE,
4011 			}
4012 		}
4013 	},
4014 	{
4015 		.type = CRYPTO_ALG_TYPE_HMAC,
4016 		.is_registered = 0,
4017 		.alg.hash = {
4018 			.halg.digestsize = SHA384_DIGEST_SIZE,
4019 			.halg.base = {
4020 				.cra_name = "hmac(sha384)",
4021 				.cra_driver_name = "hmac-sha384-chcr",
4022 				.cra_blocksize = SHA384_BLOCK_SIZE,
4023 			}
4024 		}
4025 	},
4026 	{
4027 		.type = CRYPTO_ALG_TYPE_HMAC,
4028 		.is_registered = 0,
4029 		.alg.hash = {
4030 			.halg.digestsize = SHA512_DIGEST_SIZE,
4031 			.halg.base = {
4032 				.cra_name = "hmac(sha512)",
4033 				.cra_driver_name = "hmac-sha512-chcr",
4034 				.cra_blocksize = SHA512_BLOCK_SIZE,
4035 			}
4036 		}
4037 	},
4038 	/* Add AEAD Algorithms */
4039 	{
4040 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_AEAD_GCM,
4041 		.is_registered = 0,
4042 		.alg.aead = {
4043 			.base = {
4044 				.cra_name = "gcm(aes)",
4045 				.cra_driver_name = "gcm-aes-chcr",
4046 				.cra_blocksize	= 1,
4047 				.cra_priority = CHCR_AEAD_PRIORITY,
4048 				.cra_ctxsize =	sizeof(struct chcr_context) +
4049 						sizeof(struct chcr_aead_ctx) +
4050 						sizeof(struct chcr_gcm_ctx),
4051 			},
4052 			.ivsize = GCM_AES_IV_SIZE,
4053 			.maxauthsize = GHASH_DIGEST_SIZE,
4054 			.setkey = chcr_gcm_setkey,
4055 			.setauthsize = chcr_gcm_setauthsize,
4056 		}
4057 	},
4058 	{
4059 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106,
4060 		.is_registered = 0,
4061 		.alg.aead = {
4062 			.base = {
4063 				.cra_name = "rfc4106(gcm(aes))",
4064 				.cra_driver_name = "rfc4106-gcm-aes-chcr",
4065 				.cra_blocksize	 = 1,
4066 				.cra_priority = CHCR_AEAD_PRIORITY + 1,
4067 				.cra_ctxsize =	sizeof(struct chcr_context) +
4068 						sizeof(struct chcr_aead_ctx) +
4069 						sizeof(struct chcr_gcm_ctx),
4070 
4071 			},
4072 			.ivsize = GCM_RFC4106_IV_SIZE,
4073 			.maxauthsize	= GHASH_DIGEST_SIZE,
4074 			.setkey = chcr_gcm_setkey,
4075 			.setauthsize	= chcr_4106_4309_setauthsize,
4076 		}
4077 	},
4078 	{
4079 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_AEAD_CCM,
4080 		.is_registered = 0,
4081 		.alg.aead = {
4082 			.base = {
4083 				.cra_name = "ccm(aes)",
4084 				.cra_driver_name = "ccm-aes-chcr",
4085 				.cra_blocksize	 = 1,
4086 				.cra_priority = CHCR_AEAD_PRIORITY,
4087 				.cra_ctxsize =	sizeof(struct chcr_context) +
4088 						sizeof(struct chcr_aead_ctx),
4089 
4090 			},
4091 			.ivsize = AES_BLOCK_SIZE,
4092 			.maxauthsize	= GHASH_DIGEST_SIZE,
4093 			.setkey = chcr_aead_ccm_setkey,
4094 			.setauthsize	= chcr_ccm_setauthsize,
4095 		}
4096 	},
4097 	{
4098 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309,
4099 		.is_registered = 0,
4100 		.alg.aead = {
4101 			.base = {
4102 				.cra_name = "rfc4309(ccm(aes))",
4103 				.cra_driver_name = "rfc4309-ccm-aes-chcr",
4104 				.cra_blocksize	 = 1,
4105 				.cra_priority = CHCR_AEAD_PRIORITY + 1,
4106 				.cra_ctxsize =	sizeof(struct chcr_context) +
4107 						sizeof(struct chcr_aead_ctx),
4108 
4109 			},
4110 			.ivsize = 8,
4111 			.maxauthsize	= GHASH_DIGEST_SIZE,
4112 			.setkey = chcr_aead_rfc4309_setkey,
4113 			.setauthsize = chcr_4106_4309_setauthsize,
4114 		}
4115 	},
4116 	{
4117 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_SHA,
4118 		.is_registered = 0,
4119 		.alg.aead = {
4120 			.base = {
4121 				.cra_name = "authenc(hmac(sha1),cbc(aes))",
4122 				.cra_driver_name =
4123 					"authenc-hmac-sha1-cbc-aes-chcr",
4124 				.cra_blocksize	 = AES_BLOCK_SIZE,
4125 				.cra_priority = CHCR_AEAD_PRIORITY,
4126 				.cra_ctxsize =	sizeof(struct chcr_context) +
4127 						sizeof(struct chcr_aead_ctx) +
4128 						sizeof(struct chcr_authenc_ctx),
4129 
4130 			},
4131 			.ivsize = AES_BLOCK_SIZE,
4132 			.maxauthsize = SHA1_DIGEST_SIZE,
4133 			.setkey = chcr_authenc_setkey,
4134 			.setauthsize = chcr_authenc_setauthsize,
4135 		}
4136 	},
4137 	{
4138 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_SHA,
4139 		.is_registered = 0,
4140 		.alg.aead = {
4141 			.base = {
4142 
4143 				.cra_name = "authenc(hmac(sha256),cbc(aes))",
4144 				.cra_driver_name =
4145 					"authenc-hmac-sha256-cbc-aes-chcr",
4146 				.cra_blocksize	 = AES_BLOCK_SIZE,
4147 				.cra_priority = CHCR_AEAD_PRIORITY,
4148 				.cra_ctxsize =	sizeof(struct chcr_context) +
4149 						sizeof(struct chcr_aead_ctx) +
4150 						sizeof(struct chcr_authenc_ctx),
4151 
4152 			},
4153 			.ivsize = AES_BLOCK_SIZE,
4154 			.maxauthsize	= SHA256_DIGEST_SIZE,
4155 			.setkey = chcr_authenc_setkey,
4156 			.setauthsize = chcr_authenc_setauthsize,
4157 		}
4158 	},
4159 	{
4160 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_SHA,
4161 		.is_registered = 0,
4162 		.alg.aead = {
4163 			.base = {
4164 				.cra_name = "authenc(hmac(sha224),cbc(aes))",
4165 				.cra_driver_name =
4166 					"authenc-hmac-sha224-cbc-aes-chcr",
4167 				.cra_blocksize	 = AES_BLOCK_SIZE,
4168 				.cra_priority = CHCR_AEAD_PRIORITY,
4169 				.cra_ctxsize =	sizeof(struct chcr_context) +
4170 						sizeof(struct chcr_aead_ctx) +
4171 						sizeof(struct chcr_authenc_ctx),
4172 			},
4173 			.ivsize = AES_BLOCK_SIZE,
4174 			.maxauthsize = SHA224_DIGEST_SIZE,
4175 			.setkey = chcr_authenc_setkey,
4176 			.setauthsize = chcr_authenc_setauthsize,
4177 		}
4178 	},
4179 	{
4180 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_SHA,
4181 		.is_registered = 0,
4182 		.alg.aead = {
4183 			.base = {
4184 				.cra_name = "authenc(hmac(sha384),cbc(aes))",
4185 				.cra_driver_name =
4186 					"authenc-hmac-sha384-cbc-aes-chcr",
4187 				.cra_blocksize	 = AES_BLOCK_SIZE,
4188 				.cra_priority = CHCR_AEAD_PRIORITY,
4189 				.cra_ctxsize =	sizeof(struct chcr_context) +
4190 						sizeof(struct chcr_aead_ctx) +
4191 						sizeof(struct chcr_authenc_ctx),
4192 
4193 			},
4194 			.ivsize = AES_BLOCK_SIZE,
4195 			.maxauthsize = SHA384_DIGEST_SIZE,
4196 			.setkey = chcr_authenc_setkey,
4197 			.setauthsize = chcr_authenc_setauthsize,
4198 		}
4199 	},
4200 	{
4201 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_SHA,
4202 		.is_registered = 0,
4203 		.alg.aead = {
4204 			.base = {
4205 				.cra_name = "authenc(hmac(sha512),cbc(aes))",
4206 				.cra_driver_name =
4207 					"authenc-hmac-sha512-cbc-aes-chcr",
4208 				.cra_blocksize	 = AES_BLOCK_SIZE,
4209 				.cra_priority = CHCR_AEAD_PRIORITY,
4210 				.cra_ctxsize =	sizeof(struct chcr_context) +
4211 						sizeof(struct chcr_aead_ctx) +
4212 						sizeof(struct chcr_authenc_ctx),
4213 
4214 			},
4215 			.ivsize = AES_BLOCK_SIZE,
4216 			.maxauthsize = SHA512_DIGEST_SIZE,
4217 			.setkey = chcr_authenc_setkey,
4218 			.setauthsize = chcr_authenc_setauthsize,
4219 		}
4220 	},
4221 	{
4222 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_NULL,
4223 		.is_registered = 0,
4224 		.alg.aead = {
4225 			.base = {
4226 				.cra_name = "authenc(digest_null,cbc(aes))",
4227 				.cra_driver_name =
4228 					"authenc-digest_null-cbc-aes-chcr",
4229 				.cra_blocksize	 = AES_BLOCK_SIZE,
4230 				.cra_priority = CHCR_AEAD_PRIORITY,
4231 				.cra_ctxsize =	sizeof(struct chcr_context) +
4232 						sizeof(struct chcr_aead_ctx) +
4233 						sizeof(struct chcr_authenc_ctx),
4234 
4235 			},
4236 			.ivsize  = AES_BLOCK_SIZE,
4237 			.maxauthsize = 0,
4238 			.setkey  = chcr_aead_digest_null_setkey,
4239 			.setauthsize = chcr_authenc_null_setauthsize,
4240 		}
4241 	},
4242 	{
4243 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_SHA,
4244 		.is_registered = 0,
4245 		.alg.aead = {
4246 			.base = {
4247 				.cra_name = "authenc(hmac(sha1),rfc3686(ctr(aes)))",
4248 				.cra_driver_name =
4249 				"authenc-hmac-sha1-rfc3686-ctr-aes-chcr",
4250 				.cra_blocksize	 = 1,
4251 				.cra_priority = CHCR_AEAD_PRIORITY,
4252 				.cra_ctxsize =	sizeof(struct chcr_context) +
4253 						sizeof(struct chcr_aead_ctx) +
4254 						sizeof(struct chcr_authenc_ctx),
4255 
4256 			},
4257 			.ivsize = CTR_RFC3686_IV_SIZE,
4258 			.maxauthsize = SHA1_DIGEST_SIZE,
4259 			.setkey = chcr_authenc_setkey,
4260 			.setauthsize = chcr_authenc_setauthsize,
4261 		}
4262 	},
4263 	{
4264 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_SHA,
4265 		.is_registered = 0,
4266 		.alg.aead = {
4267 			.base = {
4268 
4269 				.cra_name = "authenc(hmac(sha256),rfc3686(ctr(aes)))",
4270 				.cra_driver_name =
4271 				"authenc-hmac-sha256-rfc3686-ctr-aes-chcr",
4272 				.cra_blocksize	 = 1,
4273 				.cra_priority = CHCR_AEAD_PRIORITY,
4274 				.cra_ctxsize =	sizeof(struct chcr_context) +
4275 						sizeof(struct chcr_aead_ctx) +
4276 						sizeof(struct chcr_authenc_ctx),
4277 
4278 			},
4279 			.ivsize = CTR_RFC3686_IV_SIZE,
4280 			.maxauthsize	= SHA256_DIGEST_SIZE,
4281 			.setkey = chcr_authenc_setkey,
4282 			.setauthsize = chcr_authenc_setauthsize,
4283 		}
4284 	},
4285 	{
4286 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_SHA,
4287 		.is_registered = 0,
4288 		.alg.aead = {
4289 			.base = {
4290 				.cra_name = "authenc(hmac(sha224),rfc3686(ctr(aes)))",
4291 				.cra_driver_name =
4292 				"authenc-hmac-sha224-rfc3686-ctr-aes-chcr",
4293 				.cra_blocksize	 = 1,
4294 				.cra_priority = CHCR_AEAD_PRIORITY,
4295 				.cra_ctxsize =	sizeof(struct chcr_context) +
4296 						sizeof(struct chcr_aead_ctx) +
4297 						sizeof(struct chcr_authenc_ctx),
4298 			},
4299 			.ivsize = CTR_RFC3686_IV_SIZE,
4300 			.maxauthsize = SHA224_DIGEST_SIZE,
4301 			.setkey = chcr_authenc_setkey,
4302 			.setauthsize = chcr_authenc_setauthsize,
4303 		}
4304 	},
4305 	{
4306 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_SHA,
4307 		.is_registered = 0,
4308 		.alg.aead = {
4309 			.base = {
4310 				.cra_name = "authenc(hmac(sha384),rfc3686(ctr(aes)))",
4311 				.cra_driver_name =
4312 				"authenc-hmac-sha384-rfc3686-ctr-aes-chcr",
4313 				.cra_blocksize	 = 1,
4314 				.cra_priority = CHCR_AEAD_PRIORITY,
4315 				.cra_ctxsize =	sizeof(struct chcr_context) +
4316 						sizeof(struct chcr_aead_ctx) +
4317 						sizeof(struct chcr_authenc_ctx),
4318 
4319 			},
4320 			.ivsize = CTR_RFC3686_IV_SIZE,
4321 			.maxauthsize = SHA384_DIGEST_SIZE,
4322 			.setkey = chcr_authenc_setkey,
4323 			.setauthsize = chcr_authenc_setauthsize,
4324 		}
4325 	},
4326 	{
4327 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_SHA,
4328 		.is_registered = 0,
4329 		.alg.aead = {
4330 			.base = {
4331 				.cra_name = "authenc(hmac(sha512),rfc3686(ctr(aes)))",
4332 				.cra_driver_name =
4333 				"authenc-hmac-sha512-rfc3686-ctr-aes-chcr",
4334 				.cra_blocksize	 = 1,
4335 				.cra_priority = CHCR_AEAD_PRIORITY,
4336 				.cra_ctxsize =	sizeof(struct chcr_context) +
4337 						sizeof(struct chcr_aead_ctx) +
4338 						sizeof(struct chcr_authenc_ctx),
4339 
4340 			},
4341 			.ivsize = CTR_RFC3686_IV_SIZE,
4342 			.maxauthsize = SHA512_DIGEST_SIZE,
4343 			.setkey = chcr_authenc_setkey,
4344 			.setauthsize = chcr_authenc_setauthsize,
4345 		}
4346 	},
4347 	{
4348 		.type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_NULL,
4349 		.is_registered = 0,
4350 		.alg.aead = {
4351 			.base = {
4352 				.cra_name = "authenc(digest_null,rfc3686(ctr(aes)))",
4353 				.cra_driver_name =
4354 				"authenc-digest_null-rfc3686-ctr-aes-chcr",
4355 				.cra_blocksize	 = 1,
4356 				.cra_priority = CHCR_AEAD_PRIORITY,
4357 				.cra_ctxsize =	sizeof(struct chcr_context) +
4358 						sizeof(struct chcr_aead_ctx) +
4359 						sizeof(struct chcr_authenc_ctx),
4360 
4361 			},
4362 			.ivsize  = CTR_RFC3686_IV_SIZE,
4363 			.maxauthsize = 0,
4364 			.setkey  = chcr_aead_digest_null_setkey,
4365 			.setauthsize = chcr_authenc_null_setauthsize,
4366 		}
4367 	},
4368 };
4369 
4370 /*
4371  *	chcr_unregister_alg - Deregister crypto algorithms with
4372  *	kernel framework.
4373  */
4374 static int chcr_unregister_alg(void)
4375 {
4376 	int i;
4377 
4378 	for (i = 0; i < ARRAY_SIZE(driver_algs); i++) {
4379 		switch (driver_algs[i].type & CRYPTO_ALG_TYPE_MASK) {
4380 		case CRYPTO_ALG_TYPE_SKCIPHER:
4381 			if (driver_algs[i].is_registered && refcount_read(
4382 			    &driver_algs[i].alg.skcipher.base.cra_refcnt)
4383 			    == 1) {
4384 				crypto_unregister_skcipher(
4385 						&driver_algs[i].alg.skcipher);
4386 				driver_algs[i].is_registered = 0;
4387 			}
4388 			break;
4389 		case CRYPTO_ALG_TYPE_AEAD:
4390 			if (driver_algs[i].is_registered && refcount_read(
4391 			    &driver_algs[i].alg.aead.base.cra_refcnt) == 1) {
4392 				crypto_unregister_aead(
4393 						&driver_algs[i].alg.aead);
4394 				driver_algs[i].is_registered = 0;
4395 			}
4396 			break;
4397 		case CRYPTO_ALG_TYPE_AHASH:
4398 			if (driver_algs[i].is_registered && refcount_read(
4399 			    &driver_algs[i].alg.hash.halg.base.cra_refcnt)
4400 			    == 1) {
4401 				crypto_unregister_ahash(
4402 						&driver_algs[i].alg.hash);
4403 				driver_algs[i].is_registered = 0;
4404 			}
4405 			break;
4406 		}
4407 	}
4408 	return 0;
4409 }
4410 
4411 #define SZ_AHASH_CTX sizeof(struct chcr_context)
4412 #define SZ_AHASH_H_CTX (sizeof(struct chcr_context) + sizeof(struct hmac_ctx))
4413 #define SZ_AHASH_REQ_CTX sizeof(struct chcr_ahash_req_ctx)
4414 
4415 /*
4416  *	chcr_register_alg - Register crypto algorithms with kernel framework.
4417  */
4418 static int chcr_register_alg(void)
4419 {
4420 	struct crypto_alg ai;
4421 	struct ahash_alg *a_hash;
4422 	int err = 0, i;
4423 	char *name = NULL;
4424 
4425 	for (i = 0; i < ARRAY_SIZE(driver_algs); i++) {
4426 		if (driver_algs[i].is_registered)
4427 			continue;
4428 		switch (driver_algs[i].type & CRYPTO_ALG_TYPE_MASK) {
4429 		case CRYPTO_ALG_TYPE_SKCIPHER:
4430 			driver_algs[i].alg.skcipher.base.cra_priority =
4431 				CHCR_CRA_PRIORITY;
4432 			driver_algs[i].alg.skcipher.base.cra_module = THIS_MODULE;
4433 			driver_algs[i].alg.skcipher.base.cra_flags =
4434 				CRYPTO_ALG_TYPE_SKCIPHER | CRYPTO_ALG_ASYNC |
4435 				CRYPTO_ALG_ALLOCATES_MEMORY |
4436 				CRYPTO_ALG_NEED_FALLBACK;
4437 			driver_algs[i].alg.skcipher.base.cra_ctxsize =
4438 				sizeof(struct chcr_context) +
4439 				sizeof(struct ablk_ctx);
4440 			driver_algs[i].alg.skcipher.base.cra_alignmask = 0;
4441 
4442 			err = crypto_register_skcipher(&driver_algs[i].alg.skcipher);
4443 			name = driver_algs[i].alg.skcipher.base.cra_driver_name;
4444 			break;
4445 		case CRYPTO_ALG_TYPE_AEAD:
4446 			driver_algs[i].alg.aead.base.cra_flags =
4447 				CRYPTO_ALG_ASYNC | CRYPTO_ALG_NEED_FALLBACK |
4448 				CRYPTO_ALG_ALLOCATES_MEMORY;
4449 			driver_algs[i].alg.aead.encrypt = chcr_aead_encrypt;
4450 			driver_algs[i].alg.aead.decrypt = chcr_aead_decrypt;
4451 			driver_algs[i].alg.aead.init = chcr_aead_cra_init;
4452 			driver_algs[i].alg.aead.exit = chcr_aead_cra_exit;
4453 			driver_algs[i].alg.aead.base.cra_module = THIS_MODULE;
4454 			err = crypto_register_aead(&driver_algs[i].alg.aead);
4455 			name = driver_algs[i].alg.aead.base.cra_driver_name;
4456 			break;
4457 		case CRYPTO_ALG_TYPE_AHASH:
4458 			a_hash = &driver_algs[i].alg.hash;
4459 			a_hash->update = chcr_ahash_update;
4460 			a_hash->final = chcr_ahash_final;
4461 			a_hash->finup = chcr_ahash_finup;
4462 			a_hash->digest = chcr_ahash_digest;
4463 			a_hash->export = chcr_ahash_export;
4464 			a_hash->import = chcr_ahash_import;
4465 			a_hash->halg.statesize = SZ_AHASH_REQ_CTX;
4466 			a_hash->halg.base.cra_priority = CHCR_CRA_PRIORITY;
4467 			a_hash->halg.base.cra_module = THIS_MODULE;
4468 			a_hash->halg.base.cra_flags =
4469 				CRYPTO_ALG_ASYNC | CRYPTO_ALG_ALLOCATES_MEMORY;
4470 			a_hash->halg.base.cra_alignmask = 0;
4471 			a_hash->halg.base.cra_exit = NULL;
4472 
4473 			if (driver_algs[i].type == CRYPTO_ALG_TYPE_HMAC) {
4474 				a_hash->halg.base.cra_init = chcr_hmac_cra_init;
4475 				a_hash->halg.base.cra_exit = chcr_hmac_cra_exit;
4476 				a_hash->init = chcr_hmac_init;
4477 				a_hash->setkey = chcr_ahash_setkey;
4478 				a_hash->halg.base.cra_ctxsize = SZ_AHASH_H_CTX;
4479 			} else {
4480 				a_hash->init = chcr_sha_init;
4481 				a_hash->halg.base.cra_ctxsize = SZ_AHASH_CTX;
4482 				a_hash->halg.base.cra_init = chcr_sha_cra_init;
4483 			}
4484 			err = crypto_register_ahash(&driver_algs[i].alg.hash);
4485 			ai = driver_algs[i].alg.hash.halg.base;
4486 			name = ai.cra_driver_name;
4487 			break;
4488 		}
4489 		if (err) {
4490 			pr_err("%s : Algorithm registration failed\n", name);
4491 			goto register_err;
4492 		} else {
4493 			driver_algs[i].is_registered = 1;
4494 		}
4495 	}
4496 	return 0;
4497 
4498 register_err:
4499 	chcr_unregister_alg();
4500 	return err;
4501 }
4502 
4503 /*
4504  *	start_crypto - Register the crypto algorithms.
4505  *	This should called once when the first device comesup. After this
4506  *	kernel will start calling driver APIs for crypto operations.
4507  */
4508 int start_crypto(void)
4509 {
4510 	return chcr_register_alg();
4511 }
4512 
4513 /*
4514  *	stop_crypto - Deregister all the crypto algorithms with kernel.
4515  *	This should be called once when the last device goes down. After this
4516  *	kernel will not call the driver API for crypto operations.
4517  */
4518 int stop_crypto(void)
4519 {
4520 	chcr_unregister_alg();
4521 	return 0;
4522 }
4523