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