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(¶ms.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, ¶ms);
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(¶ms.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, ¶ms);
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(¶ms.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, ¶ms);
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
chcr_ahash_digest(struct ahash_request * req)1923 static int chcr_ahash_digest(struct ahash_request *req)
1924 {
1925 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
1926 struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
1927 struct chcr_dev *dev = h_ctx(rtfm)->dev;
1928 struct uld_ctx *u_ctx = ULD_CTX(h_ctx(rtfm));
1929 struct chcr_context *ctx = h_ctx(rtfm);
1930 struct sk_buff *skb;
1931 struct hash_wr_param params;
1932 u8 bs;
1933 int error;
1934 unsigned int cpu;
1935
1936 cpu = get_cpu();
1937 req_ctx->txqidx = cpu % ctx->ntxq;
1938 req_ctx->rxqidx = cpu % ctx->nrxq;
1939 put_cpu();
1940
1941 rtfm->init(req);
1942 bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
1943 error = chcr_inc_wrcount(dev);
1944 if (error)
1945 return -ENXIO;
1946
1947 if (unlikely(cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
1948 req_ctx->txqidx) &&
1949 (!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG)))) {
1950 error = -ENOSPC;
1951 goto err;
1952 }
1953
1954 chcr_init_hctx_per_wr(req_ctx);
1955 error = chcr_hash_dma_map(&u_ctx->lldi.pdev->dev, req);
1956 if (error) {
1957 error = -ENOMEM;
1958 goto err;
1959 }
1960
1961 get_alg_config(¶ms.alg_prm, crypto_ahash_digestsize(rtfm));
1962 params.kctx_len = roundup(params.alg_prm.result_size, 16);
1963 if (is_hmac(crypto_ahash_tfm(rtfm))) {
1964 params.kctx_len *= 2;
1965 params.opad_needed = 1;
1966 } else {
1967 params.opad_needed = 0;
1968 }
1969 params.sg_len = chcr_hash_ent_in_wr(req->src, !!req_ctx->reqlen,
1970 HASH_SPACE_LEFT(params.kctx_len), 0);
1971 if (params.sg_len < req->nbytes) {
1972 if (is_hmac(crypto_ahash_tfm(rtfm))) {
1973 params.kctx_len /= 2;
1974 params.opad_needed = 0;
1975 }
1976 params.last = 0;
1977 params.more = 1;
1978 params.scmd1 = 0;
1979 params.sg_len = rounddown(params.sg_len, bs);
1980 params.hash_size = params.alg_prm.result_size;
1981 } else {
1982 params.sg_len = req->nbytes;
1983 params.hash_size = crypto_ahash_digestsize(rtfm);
1984 params.last = 1;
1985 params.more = 0;
1986 params.scmd1 = req->nbytes + req_ctx->data_len;
1987
1988 }
1989 params.bfr_len = 0;
1990 req_ctx->hctx_wr.result = 1;
1991 req_ctx->hctx_wr.srcsg = req->src;
1992 req_ctx->data_len += params.bfr_len + params.sg_len;
1993
1994 if (req->nbytes == 0) {
1995 create_last_hash_block(req_ctx->reqbfr, bs, req_ctx->data_len);
1996 params.more = 1;
1997 params.bfr_len = bs;
1998 }
1999
2000 skb = create_hash_wr(req, ¶ms);
2001 if (IS_ERR(skb)) {
2002 error = PTR_ERR(skb);
2003 goto unmap;
2004 }
2005 req_ctx->hctx_wr.processed += params.sg_len;
2006 skb->dev = u_ctx->lldi.ports[0];
2007 set_wr_txq(skb, CPL_PRIORITY_DATA, req_ctx->txqidx);
2008 chcr_send_wr(skb);
2009 return -EINPROGRESS;
2010 unmap:
2011 chcr_hash_dma_unmap(&u_ctx->lldi.pdev->dev, req);
2012 err:
2013 chcr_dec_wrcount(dev);
2014 return error;
2015 }
2016
chcr_ahash_continue(struct ahash_request * req)2017 static int chcr_ahash_continue(struct ahash_request *req)
2018 {
2019 struct chcr_ahash_req_ctx *reqctx = ahash_request_ctx(req);
2020 struct chcr_hctx_per_wr *hctx_wr = &reqctx->hctx_wr;
2021 struct crypto_ahash *rtfm = crypto_ahash_reqtfm(req);
2022 struct chcr_context *ctx = h_ctx(rtfm);
2023 struct uld_ctx *u_ctx = ULD_CTX(ctx);
2024 struct sk_buff *skb;
2025 struct hash_wr_param params;
2026 u8 bs;
2027 int error;
2028 unsigned int cpu;
2029
2030 cpu = get_cpu();
2031 reqctx->txqidx = cpu % ctx->ntxq;
2032 reqctx->rxqidx = cpu % ctx->nrxq;
2033 put_cpu();
2034
2035 bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
2036 get_alg_config(¶ms.alg_prm, crypto_ahash_digestsize(rtfm));
2037 params.kctx_len = roundup(params.alg_prm.result_size, 16);
2038 if (is_hmac(crypto_ahash_tfm(rtfm))) {
2039 params.kctx_len *= 2;
2040 params.opad_needed = 1;
2041 } else {
2042 params.opad_needed = 0;
2043 }
2044 params.sg_len = chcr_hash_ent_in_wr(hctx_wr->srcsg, 0,
2045 HASH_SPACE_LEFT(params.kctx_len),
2046 hctx_wr->src_ofst);
2047 if ((params.sg_len + hctx_wr->processed) > req->nbytes)
2048 params.sg_len = req->nbytes - hctx_wr->processed;
2049 if (!hctx_wr->result ||
2050 ((params.sg_len + hctx_wr->processed) < req->nbytes)) {
2051 if (is_hmac(crypto_ahash_tfm(rtfm))) {
2052 params.kctx_len /= 2;
2053 params.opad_needed = 0;
2054 }
2055 params.last = 0;
2056 params.more = 1;
2057 params.sg_len = rounddown(params.sg_len, bs);
2058 params.hash_size = params.alg_prm.result_size;
2059 params.scmd1 = 0;
2060 } else {
2061 params.last = 1;
2062 params.more = 0;
2063 params.hash_size = crypto_ahash_digestsize(rtfm);
2064 params.scmd1 = reqctx->data_len + params.sg_len;
2065 }
2066 params.bfr_len = 0;
2067 reqctx->data_len += params.sg_len;
2068 skb = create_hash_wr(req, ¶ms);
2069 if (IS_ERR(skb)) {
2070 error = PTR_ERR(skb);
2071 goto err;
2072 }
2073 hctx_wr->processed += params.sg_len;
2074 skb->dev = u_ctx->lldi.ports[0];
2075 set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
2076 chcr_send_wr(skb);
2077 return 0;
2078 err:
2079 return error;
2080 }
2081
chcr_handle_ahash_resp(struct ahash_request * req,unsigned char * input,int err)2082 static inline void chcr_handle_ahash_resp(struct ahash_request *req,
2083 unsigned char *input,
2084 int err)
2085 {
2086 struct chcr_ahash_req_ctx *reqctx = ahash_request_ctx(req);
2087 struct chcr_hctx_per_wr *hctx_wr = &reqctx->hctx_wr;
2088 int digestsize, updated_digestsize;
2089 struct crypto_ahash *tfm = crypto_ahash_reqtfm(req);
2090 struct uld_ctx *u_ctx = ULD_CTX(h_ctx(tfm));
2091 struct chcr_dev *dev = h_ctx(tfm)->dev;
2092
2093 if (input == NULL)
2094 goto out;
2095 digestsize = crypto_ahash_digestsize(crypto_ahash_reqtfm(req));
2096 updated_digestsize = digestsize;
2097 if (digestsize == SHA224_DIGEST_SIZE)
2098 updated_digestsize = SHA256_DIGEST_SIZE;
2099 else if (digestsize == SHA384_DIGEST_SIZE)
2100 updated_digestsize = SHA512_DIGEST_SIZE;
2101
2102 if (hctx_wr->dma_addr) {
2103 dma_unmap_single(&u_ctx->lldi.pdev->dev, hctx_wr->dma_addr,
2104 hctx_wr->dma_len, DMA_TO_DEVICE);
2105 hctx_wr->dma_addr = 0;
2106 }
2107 if (hctx_wr->isfinal || ((hctx_wr->processed + reqctx->reqlen) ==
2108 req->nbytes)) {
2109 if (hctx_wr->result == 1) {
2110 hctx_wr->result = 0;
2111 memcpy(req->result, input + sizeof(struct cpl_fw6_pld),
2112 digestsize);
2113 } else {
2114 memcpy(reqctx->partial_hash,
2115 input + sizeof(struct cpl_fw6_pld),
2116 updated_digestsize);
2117
2118 }
2119 goto unmap;
2120 }
2121 memcpy(reqctx->partial_hash, input + sizeof(struct cpl_fw6_pld),
2122 updated_digestsize);
2123
2124 err = chcr_ahash_continue(req);
2125 if (err)
2126 goto unmap;
2127 return;
2128 unmap:
2129 if (hctx_wr->is_sg_map)
2130 chcr_hash_dma_unmap(&u_ctx->lldi.pdev->dev, req);
2131
2132
2133 out:
2134 chcr_dec_wrcount(dev);
2135 ahash_request_complete(req, err);
2136 }
2137
2138 /*
2139 * chcr_handle_resp - Unmap the DMA buffers associated with the request
2140 * @req: crypto request
2141 */
chcr_handle_resp(struct crypto_async_request * req,unsigned char * input,int err)2142 int chcr_handle_resp(struct crypto_async_request *req, unsigned char *input,
2143 int err)
2144 {
2145 struct crypto_tfm *tfm = req->tfm;
2146 struct chcr_context *ctx = crypto_tfm_ctx(tfm);
2147 struct adapter *adap = padap(ctx->dev);
2148
2149 switch (tfm->__crt_alg->cra_flags & CRYPTO_ALG_TYPE_MASK) {
2150 case CRYPTO_ALG_TYPE_AEAD:
2151 err = chcr_handle_aead_resp(aead_request_cast(req), input, err);
2152 break;
2153
2154 case CRYPTO_ALG_TYPE_SKCIPHER:
2155 chcr_handle_cipher_resp(skcipher_request_cast(req),
2156 input, err);
2157 break;
2158 case CRYPTO_ALG_TYPE_AHASH:
2159 chcr_handle_ahash_resp(ahash_request_cast(req), input, err);
2160 }
2161 atomic_inc(&adap->chcr_stats.complete);
2162 return err;
2163 }
chcr_ahash_export(struct ahash_request * areq,void * out)2164 static int chcr_ahash_export(struct ahash_request *areq, void *out)
2165 {
2166 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
2167 struct chcr_ahash_req_ctx *state = out;
2168
2169 state->reqlen = req_ctx->reqlen;
2170 state->data_len = req_ctx->data_len;
2171 memcpy(state->bfr1, req_ctx->reqbfr, req_ctx->reqlen);
2172 memcpy(state->partial_hash, req_ctx->partial_hash,
2173 CHCR_HASH_MAX_DIGEST_SIZE);
2174 chcr_init_hctx_per_wr(state);
2175 return 0;
2176 }
2177
chcr_ahash_import(struct ahash_request * areq,const void * in)2178 static int chcr_ahash_import(struct ahash_request *areq, const void *in)
2179 {
2180 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
2181 struct chcr_ahash_req_ctx *state = (struct chcr_ahash_req_ctx *)in;
2182
2183 req_ctx->reqlen = state->reqlen;
2184 req_ctx->data_len = state->data_len;
2185 req_ctx->reqbfr = req_ctx->bfr1;
2186 req_ctx->skbfr = req_ctx->bfr2;
2187 memcpy(req_ctx->bfr1, state->bfr1, CHCR_HASH_MAX_BLOCK_SIZE_128);
2188 memcpy(req_ctx->partial_hash, state->partial_hash,
2189 CHCR_HASH_MAX_DIGEST_SIZE);
2190 chcr_init_hctx_per_wr(req_ctx);
2191 return 0;
2192 }
2193
chcr_ahash_setkey(struct crypto_ahash * tfm,const u8 * key,unsigned int keylen)2194 static int chcr_ahash_setkey(struct crypto_ahash *tfm, const u8 *key,
2195 unsigned int keylen)
2196 {
2197 struct hmac_ctx *hmacctx = HMAC_CTX(h_ctx(tfm));
2198 unsigned int digestsize = crypto_ahash_digestsize(tfm);
2199 unsigned int bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(tfm));
2200 unsigned int i, err = 0, updated_digestsize;
2201
2202 SHASH_DESC_ON_STACK(shash, hmacctx->base_hash);
2203
2204 /* use the key to calculate the ipad and opad. ipad will sent with the
2205 * first request's data. opad will be sent with the final hash result
2206 * ipad in hmacctx->ipad and opad in hmacctx->opad location
2207 */
2208 shash->tfm = hmacctx->base_hash;
2209 if (keylen > bs) {
2210 err = crypto_shash_digest(shash, key, keylen,
2211 hmacctx->ipad);
2212 if (err)
2213 goto out;
2214 keylen = digestsize;
2215 } else {
2216 memcpy(hmacctx->ipad, key, keylen);
2217 }
2218 memset(hmacctx->ipad + keylen, 0, bs - keylen);
2219 unsafe_memcpy(hmacctx->opad, hmacctx->ipad, bs,
2220 "fortified memcpy causes -Wrestrict warning");
2221
2222 for (i = 0; i < bs / sizeof(int); i++) {
2223 *((unsigned int *)(&hmacctx->ipad) + i) ^= IPAD_DATA;
2224 *((unsigned int *)(&hmacctx->opad) + i) ^= OPAD_DATA;
2225 }
2226
2227 updated_digestsize = digestsize;
2228 if (digestsize == SHA224_DIGEST_SIZE)
2229 updated_digestsize = SHA256_DIGEST_SIZE;
2230 else if (digestsize == SHA384_DIGEST_SIZE)
2231 updated_digestsize = SHA512_DIGEST_SIZE;
2232 err = chcr_compute_partial_hash(shash, hmacctx->ipad,
2233 hmacctx->ipad, digestsize);
2234 if (err)
2235 goto out;
2236 chcr_change_order(hmacctx->ipad, updated_digestsize);
2237
2238 err = chcr_compute_partial_hash(shash, hmacctx->opad,
2239 hmacctx->opad, digestsize);
2240 if (err)
2241 goto out;
2242 chcr_change_order(hmacctx->opad, updated_digestsize);
2243 out:
2244 return err;
2245 }
2246
chcr_aes_xts_setkey(struct crypto_skcipher * cipher,const u8 * key,unsigned int key_len)2247 static int chcr_aes_xts_setkey(struct crypto_skcipher *cipher, const u8 *key,
2248 unsigned int key_len)
2249 {
2250 struct ablk_ctx *ablkctx = ABLK_CTX(c_ctx(cipher));
2251 unsigned short context_size = 0;
2252 int err;
2253
2254 err = chcr_cipher_fallback_setkey(cipher, key, key_len);
2255 if (err)
2256 goto badkey_err;
2257
2258 memcpy(ablkctx->key, key, key_len);
2259 ablkctx->enckey_len = key_len;
2260 get_aes_decrypt_key(ablkctx->rrkey, ablkctx->key, key_len << 2);
2261 context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD + key_len) >> 4;
2262 /* Both keys for xts must be aligned to 16 byte boundary
2263 * by padding with zeros. So for 24 byte keys padding 8 zeroes.
2264 */
2265 if (key_len == 48) {
2266 context_size = (KEY_CONTEXT_HDR_SALT_AND_PAD + key_len
2267 + 16) >> 4;
2268 memmove(ablkctx->key + 32, ablkctx->key + 24, 24);
2269 memset(ablkctx->key + 24, 0, 8);
2270 memset(ablkctx->key + 56, 0, 8);
2271 ablkctx->enckey_len = 64;
2272 ablkctx->key_ctx_hdr =
2273 FILL_KEY_CTX_HDR(CHCR_KEYCTX_CIPHER_KEY_SIZE_192,
2274 CHCR_KEYCTX_NO_KEY, 1,
2275 0, context_size);
2276 } else {
2277 ablkctx->key_ctx_hdr =
2278 FILL_KEY_CTX_HDR((key_len == AES_KEYSIZE_256) ?
2279 CHCR_KEYCTX_CIPHER_KEY_SIZE_128 :
2280 CHCR_KEYCTX_CIPHER_KEY_SIZE_256,
2281 CHCR_KEYCTX_NO_KEY, 1,
2282 0, context_size);
2283 }
2284 ablkctx->ciph_mode = CHCR_SCMD_CIPHER_MODE_AES_XTS;
2285 return 0;
2286 badkey_err:
2287 ablkctx->enckey_len = 0;
2288
2289 return err;
2290 }
2291
chcr_sha_init(struct ahash_request * areq)2292 static int chcr_sha_init(struct ahash_request *areq)
2293 {
2294 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
2295 struct crypto_ahash *tfm = crypto_ahash_reqtfm(areq);
2296 int digestsize = crypto_ahash_digestsize(tfm);
2297
2298 req_ctx->data_len = 0;
2299 req_ctx->reqlen = 0;
2300 req_ctx->reqbfr = req_ctx->bfr1;
2301 req_ctx->skbfr = req_ctx->bfr2;
2302 copy_hash_init_values(req_ctx->partial_hash, digestsize);
2303
2304 return 0;
2305 }
2306
chcr_sha_cra_init(struct crypto_tfm * tfm)2307 static int chcr_sha_cra_init(struct crypto_tfm *tfm)
2308 {
2309 crypto_ahash_set_reqsize(__crypto_ahash_cast(tfm),
2310 sizeof(struct chcr_ahash_req_ctx));
2311 return chcr_device_init(crypto_tfm_ctx(tfm));
2312 }
2313
chcr_hmac_init(struct ahash_request * areq)2314 static int chcr_hmac_init(struct ahash_request *areq)
2315 {
2316 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(areq);
2317 struct crypto_ahash *rtfm = crypto_ahash_reqtfm(areq);
2318 struct hmac_ctx *hmacctx = HMAC_CTX(h_ctx(rtfm));
2319 unsigned int digestsize = crypto_ahash_digestsize(rtfm);
2320 unsigned int bs = crypto_tfm_alg_blocksize(crypto_ahash_tfm(rtfm));
2321
2322 chcr_sha_init(areq);
2323 req_ctx->data_len = bs;
2324 if (is_hmac(crypto_ahash_tfm(rtfm))) {
2325 if (digestsize == SHA224_DIGEST_SIZE)
2326 memcpy(req_ctx->partial_hash, hmacctx->ipad,
2327 SHA256_DIGEST_SIZE);
2328 else if (digestsize == SHA384_DIGEST_SIZE)
2329 memcpy(req_ctx->partial_hash, hmacctx->ipad,
2330 SHA512_DIGEST_SIZE);
2331 else
2332 memcpy(req_ctx->partial_hash, hmacctx->ipad,
2333 digestsize);
2334 }
2335 return 0;
2336 }
2337
chcr_hmac_cra_init(struct crypto_tfm * tfm)2338 static int chcr_hmac_cra_init(struct crypto_tfm *tfm)
2339 {
2340 struct chcr_context *ctx = crypto_tfm_ctx(tfm);
2341 struct hmac_ctx *hmacctx = HMAC_CTX(ctx);
2342 unsigned int digestsize =
2343 crypto_ahash_digestsize(__crypto_ahash_cast(tfm));
2344
2345 crypto_ahash_set_reqsize(__crypto_ahash_cast(tfm),
2346 sizeof(struct chcr_ahash_req_ctx));
2347 hmacctx->base_hash = chcr_alloc_shash(digestsize);
2348 if (IS_ERR(hmacctx->base_hash))
2349 return PTR_ERR(hmacctx->base_hash);
2350 return chcr_device_init(crypto_tfm_ctx(tfm));
2351 }
2352
chcr_hmac_cra_exit(struct crypto_tfm * tfm)2353 static void chcr_hmac_cra_exit(struct crypto_tfm *tfm)
2354 {
2355 struct chcr_context *ctx = crypto_tfm_ctx(tfm);
2356 struct hmac_ctx *hmacctx = HMAC_CTX(ctx);
2357
2358 if (hmacctx->base_hash) {
2359 chcr_free_shash(hmacctx->base_hash);
2360 hmacctx->base_hash = NULL;
2361 }
2362 }
2363
chcr_aead_common_exit(struct aead_request * req)2364 inline void chcr_aead_common_exit(struct aead_request *req)
2365 {
2366 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
2367 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2368 struct uld_ctx *u_ctx = ULD_CTX(a_ctx(tfm));
2369
2370 chcr_aead_dma_unmap(&u_ctx->lldi.pdev->dev, req, reqctx->op);
2371 }
2372
chcr_aead_common_init(struct aead_request * req)2373 static int chcr_aead_common_init(struct aead_request *req)
2374 {
2375 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2376 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
2377 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
2378 unsigned int authsize = crypto_aead_authsize(tfm);
2379 int error = -EINVAL;
2380
2381 /* validate key size */
2382 if (aeadctx->enckey_len == 0)
2383 goto err;
2384 if (reqctx->op && req->cryptlen < authsize)
2385 goto err;
2386 if (reqctx->b0_len)
2387 reqctx->scratch_pad = reqctx->iv + IV;
2388 else
2389 reqctx->scratch_pad = NULL;
2390
2391 error = chcr_aead_dma_map(&ULD_CTX(a_ctx(tfm))->lldi.pdev->dev, req,
2392 reqctx->op);
2393 if (error) {
2394 error = -ENOMEM;
2395 goto err;
2396 }
2397
2398 return 0;
2399 err:
2400 return error;
2401 }
2402
chcr_aead_need_fallback(struct aead_request * req,int dst_nents,int aadmax,int wrlen,unsigned short op_type)2403 static int chcr_aead_need_fallback(struct aead_request *req, int dst_nents,
2404 int aadmax, int wrlen,
2405 unsigned short op_type)
2406 {
2407 unsigned int authsize = crypto_aead_authsize(crypto_aead_reqtfm(req));
2408
2409 if (((req->cryptlen - (op_type ? authsize : 0)) == 0) ||
2410 dst_nents > MAX_DSGL_ENT ||
2411 (req->assoclen > aadmax) ||
2412 (wrlen > SGE_MAX_WR_LEN))
2413 return 1;
2414 return 0;
2415 }
2416
chcr_aead_fallback(struct aead_request * req,unsigned short op_type)2417 static int chcr_aead_fallback(struct aead_request *req, unsigned short op_type)
2418 {
2419 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2420 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
2421 struct aead_request *subreq = aead_request_ctx_dma(req);
2422
2423 aead_request_set_tfm(subreq, aeadctx->sw_cipher);
2424 aead_request_set_callback(subreq, req->base.flags,
2425 req->base.complete, req->base.data);
2426 aead_request_set_crypt(subreq, req->src, req->dst, req->cryptlen,
2427 req->iv);
2428 aead_request_set_ad(subreq, req->assoclen);
2429 return op_type ? crypto_aead_decrypt(subreq) :
2430 crypto_aead_encrypt(subreq);
2431 }
2432
create_authenc_wr(struct aead_request * req,unsigned short qid,int size)2433 static struct sk_buff *create_authenc_wr(struct aead_request *req,
2434 unsigned short qid,
2435 int size)
2436 {
2437 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2438 struct chcr_context *ctx = a_ctx(tfm);
2439 struct uld_ctx *u_ctx = ULD_CTX(ctx);
2440 struct chcr_aead_ctx *aeadctx = AEAD_CTX(ctx);
2441 struct chcr_authenc_ctx *actx = AUTHENC_CTX(aeadctx);
2442 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
2443 struct sk_buff *skb = NULL;
2444 struct chcr_wr *chcr_req;
2445 struct cpl_rx_phys_dsgl *phys_cpl;
2446 struct ulptx_sgl *ulptx;
2447 unsigned int transhdr_len;
2448 unsigned int dst_size = 0, temp, subtype = get_aead_subtype(tfm);
2449 unsigned int kctx_len = 0, dnents, snents;
2450 unsigned int authsize = crypto_aead_authsize(tfm);
2451 int error = -EINVAL;
2452 u8 *ivptr;
2453 int null = 0;
2454 gfp_t flags = req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP ? GFP_KERNEL :
2455 GFP_ATOMIC;
2456 struct adapter *adap = padap(ctx->dev);
2457 unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
2458
2459 rx_channel_id = cxgb4_port_e2cchan(u_ctx->lldi.ports[rx_channel_id]);
2460 if (req->cryptlen == 0)
2461 return NULL;
2462
2463 reqctx->b0_len = 0;
2464 error = chcr_aead_common_init(req);
2465 if (error)
2466 return ERR_PTR(error);
2467
2468 if (subtype == CRYPTO_ALG_SUB_TYPE_CBC_NULL ||
2469 subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL) {
2470 null = 1;
2471 }
2472 dnents = sg_nents_xlen(req->dst, req->assoclen + req->cryptlen +
2473 (reqctx->op ? -authsize : authsize), CHCR_DST_SG_SIZE, 0);
2474 dnents += MIN_AUTH_SG; // For IV
2475 snents = sg_nents_xlen(req->src, req->assoclen + req->cryptlen,
2476 CHCR_SRC_SG_SIZE, 0);
2477 dst_size = get_space_for_phys_dsgl(dnents);
2478 kctx_len = (KEY_CONTEXT_CTX_LEN_G(ntohl(aeadctx->key_ctx_hdr)) << 4)
2479 - sizeof(chcr_req->key_ctx);
2480 transhdr_len = CIPHER_TRANSHDR_SIZE(kctx_len, dst_size);
2481 reqctx->imm = (transhdr_len + req->assoclen + req->cryptlen) <
2482 SGE_MAX_WR_LEN;
2483 temp = reqctx->imm ? roundup(req->assoclen + req->cryptlen, 16)
2484 : (sgl_len(snents) * 8);
2485 transhdr_len += temp;
2486 transhdr_len = roundup(transhdr_len, 16);
2487
2488 if (chcr_aead_need_fallback(req, dnents, T6_MAX_AAD_SIZE,
2489 transhdr_len, reqctx->op)) {
2490 atomic_inc(&adap->chcr_stats.fallback);
2491 chcr_aead_common_exit(req);
2492 return ERR_PTR(chcr_aead_fallback(req, reqctx->op));
2493 }
2494 skb = alloc_skb(transhdr_len, flags);
2495 if (!skb) {
2496 error = -ENOMEM;
2497 goto err;
2498 }
2499
2500 chcr_req = __skb_put_zero(skb, transhdr_len);
2501
2502 temp = (reqctx->op == CHCR_ENCRYPT_OP) ? 0 : authsize;
2503
2504 /*
2505 * Input order is AAD,IV and Payload. where IV should be included as
2506 * the part of authdata. All other fields should be filled according
2507 * to the hardware spec
2508 */
2509 chcr_req->sec_cpl.op_ivinsrtofst =
2510 FILL_SEC_CPL_OP_IVINSR(rx_channel_id, 2, 1);
2511 chcr_req->sec_cpl.pldlen = htonl(req->assoclen + IV + req->cryptlen);
2512 chcr_req->sec_cpl.aadstart_cipherstop_hi = FILL_SEC_CPL_CIPHERSTOP_HI(
2513 null ? 0 : 1 + IV,
2514 null ? 0 : IV + req->assoclen,
2515 req->assoclen + IV + 1,
2516 (temp & 0x1F0) >> 4);
2517 chcr_req->sec_cpl.cipherstop_lo_authinsert = FILL_SEC_CPL_AUTHINSERT(
2518 temp & 0xF,
2519 null ? 0 : req->assoclen + IV + 1,
2520 temp, temp);
2521 if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL ||
2522 subtype == CRYPTO_ALG_SUB_TYPE_CTR_SHA)
2523 temp = CHCR_SCMD_CIPHER_MODE_AES_CTR;
2524 else
2525 temp = CHCR_SCMD_CIPHER_MODE_AES_CBC;
2526 chcr_req->sec_cpl.seqno_numivs = FILL_SEC_CPL_SCMD0_SEQNO(reqctx->op,
2527 (reqctx->op == CHCR_ENCRYPT_OP) ? 1 : 0,
2528 temp,
2529 actx->auth_mode, aeadctx->hmac_ctrl,
2530 IV >> 1);
2531 chcr_req->sec_cpl.ivgen_hdrlen = FILL_SEC_CPL_IVGEN_HDRLEN(0, 0, 1,
2532 0, 0, dst_size);
2533
2534 chcr_req->key_ctx.ctx_hdr = aeadctx->key_ctx_hdr;
2535 if (reqctx->op == CHCR_ENCRYPT_OP ||
2536 subtype == CRYPTO_ALG_SUB_TYPE_CTR_SHA ||
2537 subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL)
2538 memcpy(chcr_req->key_ctx.key, aeadctx->key,
2539 aeadctx->enckey_len);
2540 else
2541 memcpy(chcr_req->key_ctx.key, actx->dec_rrkey,
2542 aeadctx->enckey_len);
2543
2544 memcpy(chcr_req->key_ctx.key + roundup(aeadctx->enckey_len, 16),
2545 actx->h_iopad, kctx_len - roundup(aeadctx->enckey_len, 16));
2546 phys_cpl = (struct cpl_rx_phys_dsgl *)((u8 *)(chcr_req + 1) + kctx_len);
2547 ivptr = (u8 *)(phys_cpl + 1) + dst_size;
2548 ulptx = (struct ulptx_sgl *)(ivptr + IV);
2549 if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_SHA ||
2550 subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL) {
2551 memcpy(ivptr, aeadctx->nonce, CTR_RFC3686_NONCE_SIZE);
2552 memcpy(ivptr + CTR_RFC3686_NONCE_SIZE, req->iv,
2553 CTR_RFC3686_IV_SIZE);
2554 *(__be32 *)(ivptr + CTR_RFC3686_NONCE_SIZE +
2555 CTR_RFC3686_IV_SIZE) = cpu_to_be32(1);
2556 } else {
2557 memcpy(ivptr, req->iv, IV);
2558 }
2559 chcr_add_aead_dst_ent(req, phys_cpl, qid);
2560 chcr_add_aead_src_ent(req, ulptx);
2561 atomic_inc(&adap->chcr_stats.cipher_rqst);
2562 temp = sizeof(struct cpl_rx_phys_dsgl) + dst_size + IV +
2563 kctx_len + (reqctx->imm ? (req->assoclen + req->cryptlen) : 0);
2564 create_wreq(a_ctx(tfm), chcr_req, &req->base, reqctx->imm, size,
2565 transhdr_len, temp, 0);
2566 reqctx->skb = skb;
2567
2568 return skb;
2569 err:
2570 chcr_aead_common_exit(req);
2571
2572 return ERR_PTR(error);
2573 }
2574
chcr_aead_dma_map(struct device * dev,struct aead_request * req,unsigned short op_type)2575 int chcr_aead_dma_map(struct device *dev,
2576 struct aead_request *req,
2577 unsigned short op_type)
2578 {
2579 int error;
2580 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
2581 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2582 unsigned int authsize = crypto_aead_authsize(tfm);
2583 int src_len, dst_len;
2584
2585 /* calculate and handle src and dst sg length separately
2586 * for inplace and out-of place operations
2587 */
2588 if (req->src == req->dst) {
2589 src_len = req->assoclen + req->cryptlen + (op_type ?
2590 0 : authsize);
2591 dst_len = src_len;
2592 } else {
2593 src_len = req->assoclen + req->cryptlen;
2594 dst_len = req->assoclen + req->cryptlen + (op_type ?
2595 -authsize : authsize);
2596 }
2597
2598 if (!req->cryptlen || !src_len || !dst_len)
2599 return 0;
2600 reqctx->iv_dma = dma_map_single(dev, reqctx->iv, (IV + reqctx->b0_len),
2601 DMA_BIDIRECTIONAL);
2602 if (dma_mapping_error(dev, reqctx->iv_dma))
2603 return -ENOMEM;
2604 if (reqctx->b0_len)
2605 reqctx->b0_dma = reqctx->iv_dma + IV;
2606 else
2607 reqctx->b0_dma = 0;
2608 if (req->src == req->dst) {
2609 error = dma_map_sg(dev, req->src,
2610 sg_nents_for_len(req->src, src_len),
2611 DMA_BIDIRECTIONAL);
2612 if (!error)
2613 goto err;
2614 } else {
2615 error = dma_map_sg(dev, req->src,
2616 sg_nents_for_len(req->src, src_len),
2617 DMA_TO_DEVICE);
2618 if (!error)
2619 goto err;
2620 error = dma_map_sg(dev, req->dst,
2621 sg_nents_for_len(req->dst, dst_len),
2622 DMA_FROM_DEVICE);
2623 if (!error) {
2624 dma_unmap_sg(dev, req->src,
2625 sg_nents_for_len(req->src, src_len),
2626 DMA_TO_DEVICE);
2627 goto err;
2628 }
2629 }
2630
2631 return 0;
2632 err:
2633 dma_unmap_single(dev, reqctx->iv_dma, IV, DMA_BIDIRECTIONAL);
2634 return -ENOMEM;
2635 }
2636
chcr_aead_dma_unmap(struct device * dev,struct aead_request * req,unsigned short op_type)2637 void chcr_aead_dma_unmap(struct device *dev,
2638 struct aead_request *req,
2639 unsigned short op_type)
2640 {
2641 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
2642 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2643 unsigned int authsize = crypto_aead_authsize(tfm);
2644 int src_len, dst_len;
2645
2646 /* calculate and handle src and dst sg length separately
2647 * for inplace and out-of place operations
2648 */
2649 if (req->src == req->dst) {
2650 src_len = req->assoclen + req->cryptlen + (op_type ?
2651 0 : authsize);
2652 dst_len = src_len;
2653 } else {
2654 src_len = req->assoclen + req->cryptlen;
2655 dst_len = req->assoclen + req->cryptlen + (op_type ?
2656 -authsize : authsize);
2657 }
2658
2659 if (!req->cryptlen || !src_len || !dst_len)
2660 return;
2661
2662 dma_unmap_single(dev, reqctx->iv_dma, (IV + reqctx->b0_len),
2663 DMA_BIDIRECTIONAL);
2664 if (req->src == req->dst) {
2665 dma_unmap_sg(dev, req->src,
2666 sg_nents_for_len(req->src, src_len),
2667 DMA_BIDIRECTIONAL);
2668 } else {
2669 dma_unmap_sg(dev, req->src,
2670 sg_nents_for_len(req->src, src_len),
2671 DMA_TO_DEVICE);
2672 dma_unmap_sg(dev, req->dst,
2673 sg_nents_for_len(req->dst, dst_len),
2674 DMA_FROM_DEVICE);
2675 }
2676 }
2677
chcr_add_aead_src_ent(struct aead_request * req,struct ulptx_sgl * ulptx)2678 void chcr_add_aead_src_ent(struct aead_request *req,
2679 struct ulptx_sgl *ulptx)
2680 {
2681 struct ulptx_walk ulp_walk;
2682 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
2683
2684 if (reqctx->imm) {
2685 u8 *buf = (u8 *)ulptx;
2686
2687 if (reqctx->b0_len) {
2688 memcpy(buf, reqctx->scratch_pad, reqctx->b0_len);
2689 buf += reqctx->b0_len;
2690 }
2691 sg_pcopy_to_buffer(req->src, sg_nents(req->src),
2692 buf, req->cryptlen + req->assoclen, 0);
2693 } else {
2694 ulptx_walk_init(&ulp_walk, ulptx);
2695 if (reqctx->b0_len)
2696 ulptx_walk_add_page(&ulp_walk, reqctx->b0_len,
2697 reqctx->b0_dma);
2698 ulptx_walk_add_sg(&ulp_walk, req->src, req->cryptlen +
2699 req->assoclen, 0);
2700 ulptx_walk_end(&ulp_walk);
2701 }
2702 }
2703
chcr_add_aead_dst_ent(struct aead_request * req,struct cpl_rx_phys_dsgl * phys_cpl,unsigned short qid)2704 void chcr_add_aead_dst_ent(struct aead_request *req,
2705 struct cpl_rx_phys_dsgl *phys_cpl,
2706 unsigned short qid)
2707 {
2708 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
2709 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2710 struct dsgl_walk dsgl_walk;
2711 unsigned int authsize = crypto_aead_authsize(tfm);
2712 struct chcr_context *ctx = a_ctx(tfm);
2713 struct uld_ctx *u_ctx = ULD_CTX(ctx);
2714 u32 temp;
2715 unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
2716
2717 rx_channel_id = cxgb4_port_e2cchan(u_ctx->lldi.ports[rx_channel_id]);
2718 dsgl_walk_init(&dsgl_walk, phys_cpl);
2719 dsgl_walk_add_page(&dsgl_walk, IV + reqctx->b0_len, reqctx->iv_dma);
2720 temp = req->assoclen + req->cryptlen +
2721 (reqctx->op ? -authsize : authsize);
2722 dsgl_walk_add_sg(&dsgl_walk, req->dst, temp, 0);
2723 dsgl_walk_end(&dsgl_walk, qid, rx_channel_id);
2724 }
2725
chcr_add_cipher_src_ent(struct skcipher_request * req,void * ulptx,struct cipher_wr_param * wrparam)2726 void chcr_add_cipher_src_ent(struct skcipher_request *req,
2727 void *ulptx,
2728 struct cipher_wr_param *wrparam)
2729 {
2730 struct ulptx_walk ulp_walk;
2731 struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
2732 u8 *buf = ulptx;
2733
2734 memcpy(buf, reqctx->iv, IV);
2735 buf += IV;
2736 if (reqctx->imm) {
2737 sg_pcopy_to_buffer(req->src, sg_nents(req->src),
2738 buf, wrparam->bytes, reqctx->processed);
2739 } else {
2740 ulptx_walk_init(&ulp_walk, (struct ulptx_sgl *)buf);
2741 ulptx_walk_add_sg(&ulp_walk, reqctx->srcsg, wrparam->bytes,
2742 reqctx->src_ofst);
2743 reqctx->srcsg = ulp_walk.last_sg;
2744 reqctx->src_ofst = ulp_walk.last_sg_len;
2745 ulptx_walk_end(&ulp_walk);
2746 }
2747 }
2748
chcr_add_cipher_dst_ent(struct skcipher_request * req,struct cpl_rx_phys_dsgl * phys_cpl,struct cipher_wr_param * wrparam,unsigned short qid)2749 void chcr_add_cipher_dst_ent(struct skcipher_request *req,
2750 struct cpl_rx_phys_dsgl *phys_cpl,
2751 struct cipher_wr_param *wrparam,
2752 unsigned short qid)
2753 {
2754 struct chcr_skcipher_req_ctx *reqctx = skcipher_request_ctx(req);
2755 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(wrparam->req);
2756 struct chcr_context *ctx = c_ctx(tfm);
2757 struct uld_ctx *u_ctx = ULD_CTX(ctx);
2758 struct dsgl_walk dsgl_walk;
2759 unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
2760
2761 rx_channel_id = cxgb4_port_e2cchan(u_ctx->lldi.ports[rx_channel_id]);
2762 dsgl_walk_init(&dsgl_walk, phys_cpl);
2763 dsgl_walk_add_sg(&dsgl_walk, reqctx->dstsg, wrparam->bytes,
2764 reqctx->dst_ofst);
2765 reqctx->dstsg = dsgl_walk.last_sg;
2766 reqctx->dst_ofst = dsgl_walk.last_sg_len;
2767 dsgl_walk_end(&dsgl_walk, qid, rx_channel_id);
2768 }
2769
chcr_add_hash_src_ent(struct ahash_request * req,struct ulptx_sgl * ulptx,struct hash_wr_param * param)2770 void chcr_add_hash_src_ent(struct ahash_request *req,
2771 struct ulptx_sgl *ulptx,
2772 struct hash_wr_param *param)
2773 {
2774 struct ulptx_walk ulp_walk;
2775 struct chcr_ahash_req_ctx *reqctx = ahash_request_ctx(req);
2776
2777 if (reqctx->hctx_wr.imm) {
2778 u8 *buf = (u8 *)ulptx;
2779
2780 if (param->bfr_len) {
2781 memcpy(buf, reqctx->reqbfr, param->bfr_len);
2782 buf += param->bfr_len;
2783 }
2784
2785 sg_pcopy_to_buffer(reqctx->hctx_wr.srcsg,
2786 sg_nents(reqctx->hctx_wr.srcsg), buf,
2787 param->sg_len, 0);
2788 } else {
2789 ulptx_walk_init(&ulp_walk, ulptx);
2790 if (param->bfr_len)
2791 ulptx_walk_add_page(&ulp_walk, param->bfr_len,
2792 reqctx->hctx_wr.dma_addr);
2793 ulptx_walk_add_sg(&ulp_walk, reqctx->hctx_wr.srcsg,
2794 param->sg_len, reqctx->hctx_wr.src_ofst);
2795 reqctx->hctx_wr.srcsg = ulp_walk.last_sg;
2796 reqctx->hctx_wr.src_ofst = ulp_walk.last_sg_len;
2797 ulptx_walk_end(&ulp_walk);
2798 }
2799 }
2800
chcr_hash_dma_map(struct device * dev,struct ahash_request * req)2801 int chcr_hash_dma_map(struct device *dev,
2802 struct ahash_request *req)
2803 {
2804 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
2805 int error = 0;
2806
2807 if (!req->nbytes)
2808 return 0;
2809 error = dma_map_sg(dev, req->src, sg_nents(req->src),
2810 DMA_TO_DEVICE);
2811 if (!error)
2812 return -ENOMEM;
2813 req_ctx->hctx_wr.is_sg_map = 1;
2814 return 0;
2815 }
2816
chcr_hash_dma_unmap(struct device * dev,struct ahash_request * req)2817 void chcr_hash_dma_unmap(struct device *dev,
2818 struct ahash_request *req)
2819 {
2820 struct chcr_ahash_req_ctx *req_ctx = ahash_request_ctx(req);
2821
2822 if (!req->nbytes)
2823 return;
2824
2825 dma_unmap_sg(dev, req->src, sg_nents(req->src),
2826 DMA_TO_DEVICE);
2827 req_ctx->hctx_wr.is_sg_map = 0;
2828
2829 }
2830
chcr_cipher_dma_map(struct device * dev,struct skcipher_request * req)2831 int chcr_cipher_dma_map(struct device *dev,
2832 struct skcipher_request *req)
2833 {
2834 int error;
2835
2836 if (req->src == req->dst) {
2837 error = dma_map_sg(dev, req->src, sg_nents(req->src),
2838 DMA_BIDIRECTIONAL);
2839 if (!error)
2840 goto err;
2841 } else {
2842 error = dma_map_sg(dev, req->src, sg_nents(req->src),
2843 DMA_TO_DEVICE);
2844 if (!error)
2845 goto err;
2846 error = dma_map_sg(dev, req->dst, sg_nents(req->dst),
2847 DMA_FROM_DEVICE);
2848 if (!error) {
2849 dma_unmap_sg(dev, req->src, sg_nents(req->src),
2850 DMA_TO_DEVICE);
2851 goto err;
2852 }
2853 }
2854
2855 return 0;
2856 err:
2857 return -ENOMEM;
2858 }
2859
chcr_cipher_dma_unmap(struct device * dev,struct skcipher_request * req)2860 void chcr_cipher_dma_unmap(struct device *dev,
2861 struct skcipher_request *req)
2862 {
2863 if (req->src == req->dst) {
2864 dma_unmap_sg(dev, req->src, sg_nents(req->src),
2865 DMA_BIDIRECTIONAL);
2866 } else {
2867 dma_unmap_sg(dev, req->src, sg_nents(req->src),
2868 DMA_TO_DEVICE);
2869 dma_unmap_sg(dev, req->dst, sg_nents(req->dst),
2870 DMA_FROM_DEVICE);
2871 }
2872 }
2873
set_msg_len(u8 * block,unsigned int msglen,int csize)2874 static int set_msg_len(u8 *block, unsigned int msglen, int csize)
2875 {
2876 __be32 data;
2877
2878 memset(block, 0, csize);
2879 block += csize;
2880
2881 if (csize >= 4)
2882 csize = 4;
2883 else if (msglen > (unsigned int)(1 << (8 * csize)))
2884 return -EOVERFLOW;
2885
2886 data = cpu_to_be32(msglen);
2887 memcpy(block - csize, (u8 *)&data + 4 - csize, csize);
2888
2889 return 0;
2890 }
2891
generate_b0(struct aead_request * req,u8 * ivptr,unsigned short op_type)2892 static int generate_b0(struct aead_request *req, u8 *ivptr,
2893 unsigned short op_type)
2894 {
2895 unsigned int l, lp, m;
2896 int rc;
2897 struct crypto_aead *aead = crypto_aead_reqtfm(req);
2898 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
2899 u8 *b0 = reqctx->scratch_pad;
2900
2901 m = crypto_aead_authsize(aead);
2902
2903 memcpy(b0, ivptr, 16);
2904
2905 lp = b0[0];
2906 l = lp + 1;
2907
2908 /* set m, bits 3-5 */
2909 *b0 |= (8 * ((m - 2) / 2));
2910
2911 /* set adata, bit 6, if associated data is used */
2912 if (req->assoclen)
2913 *b0 |= 64;
2914 rc = set_msg_len(b0 + 16 - l,
2915 (op_type == CHCR_DECRYPT_OP) ?
2916 req->cryptlen - m : req->cryptlen, l);
2917
2918 return rc;
2919 }
2920
crypto_ccm_check_iv(const u8 * iv)2921 static inline int crypto_ccm_check_iv(const u8 *iv)
2922 {
2923 /* 2 <= L <= 8, so 1 <= L' <= 7. */
2924 if (iv[0] < 1 || iv[0] > 7)
2925 return -EINVAL;
2926
2927 return 0;
2928 }
2929
ccm_format_packet(struct aead_request * req,u8 * ivptr,unsigned int sub_type,unsigned short op_type,unsigned int assoclen)2930 static int ccm_format_packet(struct aead_request *req,
2931 u8 *ivptr,
2932 unsigned int sub_type,
2933 unsigned short op_type,
2934 unsigned int assoclen)
2935 {
2936 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
2937 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2938 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
2939 int rc = 0;
2940
2941 if (sub_type == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309) {
2942 ivptr[0] = 3;
2943 memcpy(ivptr + 1, &aeadctx->salt[0], 3);
2944 memcpy(ivptr + 4, req->iv, 8);
2945 memset(ivptr + 12, 0, 4);
2946 } else {
2947 memcpy(ivptr, req->iv, 16);
2948 }
2949 if (assoclen)
2950 put_unaligned_be16(assoclen, &reqctx->scratch_pad[16]);
2951
2952 rc = generate_b0(req, ivptr, op_type);
2953 /* zero the ctr value */
2954 memset(ivptr + 15 - ivptr[0], 0, ivptr[0] + 1);
2955 return rc;
2956 }
2957
fill_sec_cpl_for_aead(struct cpl_tx_sec_pdu * sec_cpl,unsigned int dst_size,struct aead_request * req,unsigned short op_type)2958 static void fill_sec_cpl_for_aead(struct cpl_tx_sec_pdu *sec_cpl,
2959 unsigned int dst_size,
2960 struct aead_request *req,
2961 unsigned short op_type)
2962 {
2963 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
2964 struct chcr_context *ctx = a_ctx(tfm);
2965 struct uld_ctx *u_ctx = ULD_CTX(ctx);
2966 struct chcr_aead_ctx *aeadctx = AEAD_CTX(ctx);
2967 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
2968 unsigned int cipher_mode = CHCR_SCMD_CIPHER_MODE_AES_CCM;
2969 unsigned int mac_mode = CHCR_SCMD_AUTH_MODE_CBCMAC;
2970 unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
2971 unsigned int ccm_xtra;
2972 unsigned int tag_offset = 0, auth_offset = 0;
2973 unsigned int assoclen;
2974
2975 rx_channel_id = cxgb4_port_e2cchan(u_ctx->lldi.ports[rx_channel_id]);
2976
2977 if (get_aead_subtype(tfm) == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309)
2978 assoclen = req->assoclen - 8;
2979 else
2980 assoclen = req->assoclen;
2981 ccm_xtra = CCM_B0_SIZE +
2982 ((assoclen) ? CCM_AAD_FIELD_SIZE : 0);
2983
2984 auth_offset = req->cryptlen ?
2985 (req->assoclen + IV + 1 + ccm_xtra) : 0;
2986 if (op_type == CHCR_DECRYPT_OP) {
2987 if (crypto_aead_authsize(tfm) != req->cryptlen)
2988 tag_offset = crypto_aead_authsize(tfm);
2989 else
2990 auth_offset = 0;
2991 }
2992
2993 sec_cpl->op_ivinsrtofst = FILL_SEC_CPL_OP_IVINSR(rx_channel_id, 2, 1);
2994 sec_cpl->pldlen =
2995 htonl(req->assoclen + IV + req->cryptlen + ccm_xtra);
2996 /* For CCM there wil be b0 always. So AAD start will be 1 always */
2997 sec_cpl->aadstart_cipherstop_hi = FILL_SEC_CPL_CIPHERSTOP_HI(
2998 1 + IV, IV + assoclen + ccm_xtra,
2999 req->assoclen + IV + 1 + ccm_xtra, 0);
3000
3001 sec_cpl->cipherstop_lo_authinsert = FILL_SEC_CPL_AUTHINSERT(0,
3002 auth_offset, tag_offset,
3003 (op_type == CHCR_ENCRYPT_OP) ? 0 :
3004 crypto_aead_authsize(tfm));
3005 sec_cpl->seqno_numivs = FILL_SEC_CPL_SCMD0_SEQNO(op_type,
3006 (op_type == CHCR_ENCRYPT_OP) ? 0 : 1,
3007 cipher_mode, mac_mode,
3008 aeadctx->hmac_ctrl, IV >> 1);
3009
3010 sec_cpl->ivgen_hdrlen = FILL_SEC_CPL_IVGEN_HDRLEN(0, 0, 1, 0,
3011 0, dst_size);
3012 }
3013
aead_ccm_validate_input(unsigned short op_type,struct aead_request * req,struct chcr_aead_ctx * aeadctx,unsigned int sub_type)3014 static int aead_ccm_validate_input(unsigned short op_type,
3015 struct aead_request *req,
3016 struct chcr_aead_ctx *aeadctx,
3017 unsigned int sub_type)
3018 {
3019 if (sub_type != CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309) {
3020 if (crypto_ccm_check_iv(req->iv)) {
3021 pr_err("CCM: IV check fails\n");
3022 return -EINVAL;
3023 }
3024 } else {
3025 if (req->assoclen != 16 && req->assoclen != 20) {
3026 pr_err("RFC4309: Invalid AAD length %d\n",
3027 req->assoclen);
3028 return -EINVAL;
3029 }
3030 }
3031 return 0;
3032 }
3033
create_aead_ccm_wr(struct aead_request * req,unsigned short qid,int size)3034 static struct sk_buff *create_aead_ccm_wr(struct aead_request *req,
3035 unsigned short qid,
3036 int size)
3037 {
3038 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
3039 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3040 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
3041 struct sk_buff *skb = NULL;
3042 struct chcr_wr *chcr_req;
3043 struct cpl_rx_phys_dsgl *phys_cpl;
3044 struct ulptx_sgl *ulptx;
3045 unsigned int transhdr_len;
3046 unsigned int dst_size = 0, kctx_len, dnents, temp, snents;
3047 unsigned int sub_type, assoclen = req->assoclen;
3048 unsigned int authsize = crypto_aead_authsize(tfm);
3049 int error = -EINVAL;
3050 u8 *ivptr;
3051 gfp_t flags = req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP ? GFP_KERNEL :
3052 GFP_ATOMIC;
3053 struct adapter *adap = padap(a_ctx(tfm)->dev);
3054
3055 sub_type = get_aead_subtype(tfm);
3056 if (sub_type == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309)
3057 assoclen -= 8;
3058 reqctx->b0_len = CCM_B0_SIZE + (assoclen ? CCM_AAD_FIELD_SIZE : 0);
3059 error = chcr_aead_common_init(req);
3060 if (error)
3061 return ERR_PTR(error);
3062
3063 error = aead_ccm_validate_input(reqctx->op, req, aeadctx, sub_type);
3064 if (error)
3065 goto err;
3066 dnents = sg_nents_xlen(req->dst, req->assoclen + req->cryptlen
3067 + (reqctx->op ? -authsize : authsize),
3068 CHCR_DST_SG_SIZE, 0);
3069 dnents += MIN_CCM_SG; // For IV and B0
3070 dst_size = get_space_for_phys_dsgl(dnents);
3071 snents = sg_nents_xlen(req->src, req->assoclen + req->cryptlen,
3072 CHCR_SRC_SG_SIZE, 0);
3073 snents += MIN_CCM_SG; //For B0
3074 kctx_len = roundup(aeadctx->enckey_len, 16) * 2;
3075 transhdr_len = CIPHER_TRANSHDR_SIZE(kctx_len, dst_size);
3076 reqctx->imm = (transhdr_len + req->assoclen + req->cryptlen +
3077 reqctx->b0_len) <= SGE_MAX_WR_LEN;
3078 temp = reqctx->imm ? roundup(req->assoclen + req->cryptlen +
3079 reqctx->b0_len, 16) :
3080 (sgl_len(snents) * 8);
3081 transhdr_len += temp;
3082 transhdr_len = roundup(transhdr_len, 16);
3083
3084 if (chcr_aead_need_fallback(req, dnents, T6_MAX_AAD_SIZE -
3085 reqctx->b0_len, transhdr_len, reqctx->op)) {
3086 atomic_inc(&adap->chcr_stats.fallback);
3087 chcr_aead_common_exit(req);
3088 return ERR_PTR(chcr_aead_fallback(req, reqctx->op));
3089 }
3090 skb = alloc_skb(transhdr_len, flags);
3091
3092 if (!skb) {
3093 error = -ENOMEM;
3094 goto err;
3095 }
3096
3097 chcr_req = __skb_put_zero(skb, transhdr_len);
3098
3099 fill_sec_cpl_for_aead(&chcr_req->sec_cpl, dst_size, req, reqctx->op);
3100
3101 chcr_req->key_ctx.ctx_hdr = aeadctx->key_ctx_hdr;
3102 memcpy(chcr_req->key_ctx.key, aeadctx->key, aeadctx->enckey_len);
3103 memcpy(chcr_req->key_ctx.key + roundup(aeadctx->enckey_len, 16),
3104 aeadctx->key, aeadctx->enckey_len);
3105
3106 phys_cpl = (struct cpl_rx_phys_dsgl *)((u8 *)(chcr_req + 1) + kctx_len);
3107 ivptr = (u8 *)(phys_cpl + 1) + dst_size;
3108 ulptx = (struct ulptx_sgl *)(ivptr + IV);
3109 error = ccm_format_packet(req, ivptr, sub_type, reqctx->op, assoclen);
3110 if (error)
3111 goto dstmap_fail;
3112 chcr_add_aead_dst_ent(req, phys_cpl, qid);
3113 chcr_add_aead_src_ent(req, ulptx);
3114
3115 atomic_inc(&adap->chcr_stats.aead_rqst);
3116 temp = sizeof(struct cpl_rx_phys_dsgl) + dst_size + IV +
3117 kctx_len + (reqctx->imm ? (req->assoclen + req->cryptlen +
3118 reqctx->b0_len) : 0);
3119 create_wreq(a_ctx(tfm), chcr_req, &req->base, reqctx->imm, 0,
3120 transhdr_len, temp, 0);
3121 reqctx->skb = skb;
3122
3123 return skb;
3124 dstmap_fail:
3125 kfree_skb(skb);
3126 err:
3127 chcr_aead_common_exit(req);
3128 return ERR_PTR(error);
3129 }
3130
create_gcm_wr(struct aead_request * req,unsigned short qid,int size)3131 static struct sk_buff *create_gcm_wr(struct aead_request *req,
3132 unsigned short qid,
3133 int size)
3134 {
3135 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
3136 struct chcr_context *ctx = a_ctx(tfm);
3137 struct uld_ctx *u_ctx = ULD_CTX(ctx);
3138 struct chcr_aead_ctx *aeadctx = AEAD_CTX(ctx);
3139 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
3140 struct sk_buff *skb = NULL;
3141 struct chcr_wr *chcr_req;
3142 struct cpl_rx_phys_dsgl *phys_cpl;
3143 struct ulptx_sgl *ulptx;
3144 unsigned int transhdr_len, dnents = 0, snents;
3145 unsigned int dst_size = 0, temp = 0, kctx_len, assoclen = req->assoclen;
3146 unsigned int authsize = crypto_aead_authsize(tfm);
3147 int error = -EINVAL;
3148 u8 *ivptr;
3149 gfp_t flags = req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP ? GFP_KERNEL :
3150 GFP_ATOMIC;
3151 struct adapter *adap = padap(ctx->dev);
3152 unsigned int rx_channel_id = reqctx->rxqidx / ctx->rxq_perchan;
3153
3154 rx_channel_id = cxgb4_port_e2cchan(u_ctx->lldi.ports[rx_channel_id]);
3155 if (get_aead_subtype(tfm) == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106)
3156 assoclen = req->assoclen - 8;
3157
3158 reqctx->b0_len = 0;
3159 error = chcr_aead_common_init(req);
3160 if (error)
3161 return ERR_PTR(error);
3162 dnents = sg_nents_xlen(req->dst, req->assoclen + req->cryptlen +
3163 (reqctx->op ? -authsize : authsize),
3164 CHCR_DST_SG_SIZE, 0);
3165 snents = sg_nents_xlen(req->src, req->assoclen + req->cryptlen,
3166 CHCR_SRC_SG_SIZE, 0);
3167 dnents += MIN_GCM_SG; // For IV
3168 dst_size = get_space_for_phys_dsgl(dnents);
3169 kctx_len = roundup(aeadctx->enckey_len, 16) + AEAD_H_SIZE;
3170 transhdr_len = CIPHER_TRANSHDR_SIZE(kctx_len, dst_size);
3171 reqctx->imm = (transhdr_len + req->assoclen + req->cryptlen) <=
3172 SGE_MAX_WR_LEN;
3173 temp = reqctx->imm ? roundup(req->assoclen + req->cryptlen, 16) :
3174 (sgl_len(snents) * 8);
3175 transhdr_len += temp;
3176 transhdr_len = roundup(transhdr_len, 16);
3177 if (chcr_aead_need_fallback(req, dnents, T6_MAX_AAD_SIZE,
3178 transhdr_len, reqctx->op)) {
3179
3180 atomic_inc(&adap->chcr_stats.fallback);
3181 chcr_aead_common_exit(req);
3182 return ERR_PTR(chcr_aead_fallback(req, reqctx->op));
3183 }
3184 skb = alloc_skb(transhdr_len, flags);
3185 if (!skb) {
3186 error = -ENOMEM;
3187 goto err;
3188 }
3189
3190 chcr_req = __skb_put_zero(skb, transhdr_len);
3191
3192 //Offset of tag from end
3193 temp = (reqctx->op == CHCR_ENCRYPT_OP) ? 0 : authsize;
3194 chcr_req->sec_cpl.op_ivinsrtofst = FILL_SEC_CPL_OP_IVINSR(
3195 rx_channel_id, 2, 1);
3196 chcr_req->sec_cpl.pldlen =
3197 htonl(req->assoclen + IV + req->cryptlen);
3198 chcr_req->sec_cpl.aadstart_cipherstop_hi = FILL_SEC_CPL_CIPHERSTOP_HI(
3199 assoclen ? 1 + IV : 0,
3200 assoclen ? IV + assoclen : 0,
3201 req->assoclen + IV + 1, 0);
3202 chcr_req->sec_cpl.cipherstop_lo_authinsert =
3203 FILL_SEC_CPL_AUTHINSERT(0, req->assoclen + IV + 1,
3204 temp, temp);
3205 chcr_req->sec_cpl.seqno_numivs =
3206 FILL_SEC_CPL_SCMD0_SEQNO(reqctx->op, (reqctx->op ==
3207 CHCR_ENCRYPT_OP) ? 1 : 0,
3208 CHCR_SCMD_CIPHER_MODE_AES_GCM,
3209 CHCR_SCMD_AUTH_MODE_GHASH,
3210 aeadctx->hmac_ctrl, IV >> 1);
3211 chcr_req->sec_cpl.ivgen_hdrlen = FILL_SEC_CPL_IVGEN_HDRLEN(0, 0, 1,
3212 0, 0, dst_size);
3213 chcr_req->key_ctx.ctx_hdr = aeadctx->key_ctx_hdr;
3214 memcpy(chcr_req->key_ctx.key, aeadctx->key, aeadctx->enckey_len);
3215 memcpy(chcr_req->key_ctx.key + roundup(aeadctx->enckey_len, 16),
3216 GCM_CTX(aeadctx)->ghash_h, AEAD_H_SIZE);
3217
3218 phys_cpl = (struct cpl_rx_phys_dsgl *)((u8 *)(chcr_req + 1) + kctx_len);
3219 ivptr = (u8 *)(phys_cpl + 1) + dst_size;
3220 /* prepare a 16 byte iv */
3221 /* S A L T | IV | 0x00000001 */
3222 if (get_aead_subtype(tfm) ==
3223 CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106) {
3224 memcpy(ivptr, aeadctx->salt, 4);
3225 memcpy(ivptr + 4, req->iv, GCM_RFC4106_IV_SIZE);
3226 } else {
3227 memcpy(ivptr, req->iv, GCM_AES_IV_SIZE);
3228 }
3229 put_unaligned_be32(0x01, &ivptr[12]);
3230 ulptx = (struct ulptx_sgl *)(ivptr + 16);
3231
3232 chcr_add_aead_dst_ent(req, phys_cpl, qid);
3233 chcr_add_aead_src_ent(req, ulptx);
3234 atomic_inc(&adap->chcr_stats.aead_rqst);
3235 temp = sizeof(struct cpl_rx_phys_dsgl) + dst_size + IV +
3236 kctx_len + (reqctx->imm ? (req->assoclen + req->cryptlen) : 0);
3237 create_wreq(a_ctx(tfm), chcr_req, &req->base, reqctx->imm, size,
3238 transhdr_len, temp, reqctx->verify);
3239 reqctx->skb = skb;
3240 return skb;
3241
3242 err:
3243 chcr_aead_common_exit(req);
3244 return ERR_PTR(error);
3245 }
3246
3247
3248
chcr_aead_cra_init(struct crypto_aead * tfm)3249 static int chcr_aead_cra_init(struct crypto_aead *tfm)
3250 {
3251 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3252 struct aead_alg *alg = crypto_aead_alg(tfm);
3253
3254 aeadctx->sw_cipher = crypto_alloc_aead(alg->base.cra_name, 0,
3255 CRYPTO_ALG_NEED_FALLBACK |
3256 CRYPTO_ALG_ASYNC);
3257 if (IS_ERR(aeadctx->sw_cipher))
3258 return PTR_ERR(aeadctx->sw_cipher);
3259 crypto_aead_set_reqsize_dma(
3260 tfm, max(sizeof(struct chcr_aead_reqctx),
3261 sizeof(struct aead_request) +
3262 crypto_aead_reqsize(aeadctx->sw_cipher)));
3263 return chcr_device_init(a_ctx(tfm));
3264 }
3265
chcr_aead_cra_exit(struct crypto_aead * tfm)3266 static void chcr_aead_cra_exit(struct crypto_aead *tfm)
3267 {
3268 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3269
3270 crypto_free_aead(aeadctx->sw_cipher);
3271 }
3272
chcr_authenc_null_setauthsize(struct crypto_aead * tfm,unsigned int authsize)3273 static int chcr_authenc_null_setauthsize(struct crypto_aead *tfm,
3274 unsigned int authsize)
3275 {
3276 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3277
3278 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NOP;
3279 aeadctx->mayverify = VERIFY_HW;
3280 return crypto_aead_setauthsize(aeadctx->sw_cipher, authsize);
3281 }
chcr_authenc_setauthsize(struct crypto_aead * tfm,unsigned int authsize)3282 static int chcr_authenc_setauthsize(struct crypto_aead *tfm,
3283 unsigned int authsize)
3284 {
3285 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3286 u32 maxauth = crypto_aead_maxauthsize(tfm);
3287
3288 /*SHA1 authsize in ipsec is 12 instead of 10 i.e maxauthsize / 2 is not
3289 * true for sha1. authsize == 12 condition should be before
3290 * authsize == (maxauth >> 1)
3291 */
3292 if (authsize == ICV_4) {
3293 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL1;
3294 aeadctx->mayverify = VERIFY_HW;
3295 } else if (authsize == ICV_6) {
3296 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL2;
3297 aeadctx->mayverify = VERIFY_HW;
3298 } else if (authsize == ICV_10) {
3299 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_TRUNC_RFC4366;
3300 aeadctx->mayverify = VERIFY_HW;
3301 } else if (authsize == ICV_12) {
3302 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_IPSEC_96BIT;
3303 aeadctx->mayverify = VERIFY_HW;
3304 } else if (authsize == ICV_14) {
3305 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL3;
3306 aeadctx->mayverify = VERIFY_HW;
3307 } else if (authsize == (maxauth >> 1)) {
3308 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_DIV2;
3309 aeadctx->mayverify = VERIFY_HW;
3310 } else if (authsize == maxauth) {
3311 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3312 aeadctx->mayverify = VERIFY_HW;
3313 } else {
3314 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3315 aeadctx->mayverify = VERIFY_SW;
3316 }
3317 return crypto_aead_setauthsize(aeadctx->sw_cipher, authsize);
3318 }
3319
3320
chcr_gcm_setauthsize(struct crypto_aead * tfm,unsigned int authsize)3321 static int chcr_gcm_setauthsize(struct crypto_aead *tfm, unsigned int authsize)
3322 {
3323 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3324
3325 switch (authsize) {
3326 case ICV_4:
3327 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL1;
3328 aeadctx->mayverify = VERIFY_HW;
3329 break;
3330 case ICV_8:
3331 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_DIV2;
3332 aeadctx->mayverify = VERIFY_HW;
3333 break;
3334 case ICV_12:
3335 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_IPSEC_96BIT;
3336 aeadctx->mayverify = VERIFY_HW;
3337 break;
3338 case ICV_14:
3339 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL3;
3340 aeadctx->mayverify = VERIFY_HW;
3341 break;
3342 case ICV_16:
3343 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3344 aeadctx->mayverify = VERIFY_HW;
3345 break;
3346 case ICV_13:
3347 case ICV_15:
3348 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3349 aeadctx->mayverify = VERIFY_SW;
3350 break;
3351 default:
3352 return -EINVAL;
3353 }
3354 return crypto_aead_setauthsize(aeadctx->sw_cipher, authsize);
3355 }
3356
chcr_4106_4309_setauthsize(struct crypto_aead * tfm,unsigned int authsize)3357 static int chcr_4106_4309_setauthsize(struct crypto_aead *tfm,
3358 unsigned int authsize)
3359 {
3360 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3361
3362 switch (authsize) {
3363 case ICV_8:
3364 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_DIV2;
3365 aeadctx->mayverify = VERIFY_HW;
3366 break;
3367 case ICV_12:
3368 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_IPSEC_96BIT;
3369 aeadctx->mayverify = VERIFY_HW;
3370 break;
3371 case ICV_16:
3372 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3373 aeadctx->mayverify = VERIFY_HW;
3374 break;
3375 default:
3376 return -EINVAL;
3377 }
3378 return crypto_aead_setauthsize(aeadctx->sw_cipher, authsize);
3379 }
3380
chcr_ccm_setauthsize(struct crypto_aead * tfm,unsigned int authsize)3381 static int chcr_ccm_setauthsize(struct crypto_aead *tfm,
3382 unsigned int authsize)
3383 {
3384 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(tfm));
3385
3386 switch (authsize) {
3387 case ICV_4:
3388 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL1;
3389 aeadctx->mayverify = VERIFY_HW;
3390 break;
3391 case ICV_6:
3392 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL2;
3393 aeadctx->mayverify = VERIFY_HW;
3394 break;
3395 case ICV_8:
3396 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_DIV2;
3397 aeadctx->mayverify = VERIFY_HW;
3398 break;
3399 case ICV_10:
3400 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_TRUNC_RFC4366;
3401 aeadctx->mayverify = VERIFY_HW;
3402 break;
3403 case ICV_12:
3404 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_IPSEC_96BIT;
3405 aeadctx->mayverify = VERIFY_HW;
3406 break;
3407 case ICV_14:
3408 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_PL3;
3409 aeadctx->mayverify = VERIFY_HW;
3410 break;
3411 case ICV_16:
3412 aeadctx->hmac_ctrl = CHCR_SCMD_HMAC_CTRL_NO_TRUNC;
3413 aeadctx->mayverify = VERIFY_HW;
3414 break;
3415 default:
3416 return -EINVAL;
3417 }
3418 return crypto_aead_setauthsize(aeadctx->sw_cipher, authsize);
3419 }
3420
chcr_ccm_common_setkey(struct crypto_aead * aead,const u8 * key,unsigned int keylen)3421 static int chcr_ccm_common_setkey(struct crypto_aead *aead,
3422 const u8 *key,
3423 unsigned int keylen)
3424 {
3425 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(aead));
3426 unsigned char ck_size, mk_size;
3427 int key_ctx_size = 0;
3428
3429 key_ctx_size = sizeof(struct _key_ctx) + roundup(keylen, 16) * 2;
3430 if (keylen == AES_KEYSIZE_128) {
3431 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_128;
3432 mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_128;
3433 } else if (keylen == AES_KEYSIZE_192) {
3434 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_192;
3435 mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_192;
3436 } else if (keylen == AES_KEYSIZE_256) {
3437 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_256;
3438 mk_size = CHCR_KEYCTX_MAC_KEY_SIZE_256;
3439 } else {
3440 aeadctx->enckey_len = 0;
3441 return -EINVAL;
3442 }
3443 aeadctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, mk_size, 0, 0,
3444 key_ctx_size >> 4);
3445 memcpy(aeadctx->key, key, keylen);
3446 aeadctx->enckey_len = keylen;
3447
3448 return 0;
3449 }
3450
chcr_aead_ccm_setkey(struct crypto_aead * aead,const u8 * key,unsigned int keylen)3451 static int chcr_aead_ccm_setkey(struct crypto_aead *aead,
3452 const u8 *key,
3453 unsigned int keylen)
3454 {
3455 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(aead));
3456 int error;
3457
3458 crypto_aead_clear_flags(aeadctx->sw_cipher, CRYPTO_TFM_REQ_MASK);
3459 crypto_aead_set_flags(aeadctx->sw_cipher, crypto_aead_get_flags(aead) &
3460 CRYPTO_TFM_REQ_MASK);
3461 error = crypto_aead_setkey(aeadctx->sw_cipher, key, keylen);
3462 if (error)
3463 return error;
3464 return chcr_ccm_common_setkey(aead, key, keylen);
3465 }
3466
chcr_aead_rfc4309_setkey(struct crypto_aead * aead,const u8 * key,unsigned int keylen)3467 static int chcr_aead_rfc4309_setkey(struct crypto_aead *aead, const u8 *key,
3468 unsigned int keylen)
3469 {
3470 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(aead));
3471 int error;
3472
3473 if (keylen < 3) {
3474 aeadctx->enckey_len = 0;
3475 return -EINVAL;
3476 }
3477 crypto_aead_clear_flags(aeadctx->sw_cipher, CRYPTO_TFM_REQ_MASK);
3478 crypto_aead_set_flags(aeadctx->sw_cipher, crypto_aead_get_flags(aead) &
3479 CRYPTO_TFM_REQ_MASK);
3480 error = crypto_aead_setkey(aeadctx->sw_cipher, key, keylen);
3481 if (error)
3482 return error;
3483 keylen -= 3;
3484 memcpy(aeadctx->salt, key + keylen, 3);
3485 return chcr_ccm_common_setkey(aead, key, keylen);
3486 }
3487
chcr_gcm_setkey(struct crypto_aead * aead,const u8 * key,unsigned int keylen)3488 static int chcr_gcm_setkey(struct crypto_aead *aead, const u8 *key,
3489 unsigned int keylen)
3490 {
3491 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(aead));
3492 struct chcr_gcm_ctx *gctx = GCM_CTX(aeadctx);
3493 unsigned int ck_size;
3494 int ret = 0, key_ctx_size = 0;
3495 struct crypto_aes_ctx aes;
3496
3497 aeadctx->enckey_len = 0;
3498 crypto_aead_clear_flags(aeadctx->sw_cipher, CRYPTO_TFM_REQ_MASK);
3499 crypto_aead_set_flags(aeadctx->sw_cipher, crypto_aead_get_flags(aead)
3500 & CRYPTO_TFM_REQ_MASK);
3501 ret = crypto_aead_setkey(aeadctx->sw_cipher, key, keylen);
3502 if (ret)
3503 goto out;
3504
3505 if (get_aead_subtype(aead) == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106 &&
3506 keylen > 3) {
3507 keylen -= 4; /* nonce/salt is present in the last 4 bytes */
3508 memcpy(aeadctx->salt, key + keylen, 4);
3509 }
3510 if (keylen == AES_KEYSIZE_128) {
3511 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_128;
3512 } else if (keylen == AES_KEYSIZE_192) {
3513 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_192;
3514 } else if (keylen == AES_KEYSIZE_256) {
3515 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_256;
3516 } else {
3517 pr_err("GCM: Invalid key length %d\n", keylen);
3518 ret = -EINVAL;
3519 goto out;
3520 }
3521
3522 memcpy(aeadctx->key, key, keylen);
3523 aeadctx->enckey_len = keylen;
3524 key_ctx_size = sizeof(struct _key_ctx) + roundup(keylen, 16) +
3525 AEAD_H_SIZE;
3526 aeadctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size,
3527 CHCR_KEYCTX_MAC_KEY_SIZE_128,
3528 0, 0,
3529 key_ctx_size >> 4);
3530 /* Calculate the H = CIPH(K, 0 repeated 16 times).
3531 * It will go in key context
3532 */
3533 ret = aes_expandkey(&aes, key, keylen);
3534 if (ret) {
3535 aeadctx->enckey_len = 0;
3536 goto out;
3537 }
3538 memset(gctx->ghash_h, 0, AEAD_H_SIZE);
3539 aes_encrypt(&aes, gctx->ghash_h, gctx->ghash_h);
3540 memzero_explicit(&aes, sizeof(aes));
3541
3542 out:
3543 return ret;
3544 }
3545
chcr_authenc_setkey(struct crypto_aead * authenc,const u8 * key,unsigned int keylen)3546 static int chcr_authenc_setkey(struct crypto_aead *authenc, const u8 *key,
3547 unsigned int keylen)
3548 {
3549 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(authenc));
3550 struct chcr_authenc_ctx *actx = AUTHENC_CTX(aeadctx);
3551 /* it contains auth and cipher key both*/
3552 struct crypto_authenc_keys keys;
3553 unsigned int bs, subtype;
3554 unsigned int max_authsize = crypto_aead_alg(authenc)->maxauthsize;
3555 int err = 0, i, key_ctx_len = 0;
3556 unsigned char ck_size = 0;
3557 unsigned char pad[CHCR_HASH_MAX_BLOCK_SIZE_128] = { 0 };
3558 struct crypto_shash *base_hash = ERR_PTR(-EINVAL);
3559 struct algo_param param;
3560 int align;
3561 u8 *o_ptr = NULL;
3562
3563 crypto_aead_clear_flags(aeadctx->sw_cipher, CRYPTO_TFM_REQ_MASK);
3564 crypto_aead_set_flags(aeadctx->sw_cipher, crypto_aead_get_flags(authenc)
3565 & CRYPTO_TFM_REQ_MASK);
3566 err = crypto_aead_setkey(aeadctx->sw_cipher, key, keylen);
3567 if (err)
3568 goto out;
3569
3570 if (crypto_authenc_extractkeys(&keys, key, keylen) != 0)
3571 goto out;
3572
3573 if (get_alg_config(¶m, max_authsize)) {
3574 pr_err("Unsupported digest size\n");
3575 goto out;
3576 }
3577 subtype = get_aead_subtype(authenc);
3578 if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_SHA ||
3579 subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL) {
3580 if (keys.enckeylen < CTR_RFC3686_NONCE_SIZE)
3581 goto out;
3582 memcpy(aeadctx->nonce, keys.enckey + (keys.enckeylen
3583 - CTR_RFC3686_NONCE_SIZE), CTR_RFC3686_NONCE_SIZE);
3584 keys.enckeylen -= CTR_RFC3686_NONCE_SIZE;
3585 }
3586 if (keys.enckeylen == AES_KEYSIZE_128) {
3587 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_128;
3588 } else if (keys.enckeylen == AES_KEYSIZE_192) {
3589 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_192;
3590 } else if (keys.enckeylen == AES_KEYSIZE_256) {
3591 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_256;
3592 } else {
3593 pr_err("Unsupported cipher key\n");
3594 goto out;
3595 }
3596
3597 /* Copy only encryption key. We use authkey to generate h(ipad) and
3598 * h(opad) so authkey is not needed again. authkeylen size have the
3599 * size of the hash digest size.
3600 */
3601 memcpy(aeadctx->key, keys.enckey, keys.enckeylen);
3602 aeadctx->enckey_len = keys.enckeylen;
3603 if (subtype == CRYPTO_ALG_SUB_TYPE_CBC_SHA ||
3604 subtype == CRYPTO_ALG_SUB_TYPE_CBC_NULL) {
3605
3606 get_aes_decrypt_key(actx->dec_rrkey, aeadctx->key,
3607 aeadctx->enckey_len << 3);
3608 }
3609 base_hash = chcr_alloc_shash(max_authsize);
3610 if (IS_ERR(base_hash)) {
3611 pr_err("Base driver cannot be loaded\n");
3612 goto out;
3613 }
3614 {
3615 SHASH_DESC_ON_STACK(shash, base_hash);
3616
3617 shash->tfm = base_hash;
3618 bs = crypto_shash_blocksize(base_hash);
3619 align = KEYCTX_ALIGN_PAD(max_authsize);
3620 o_ptr = actx->h_iopad + param.result_size + align;
3621
3622 if (keys.authkeylen > bs) {
3623 err = crypto_shash_digest(shash, keys.authkey,
3624 keys.authkeylen,
3625 o_ptr);
3626 if (err) {
3627 pr_err("Base driver cannot be loaded\n");
3628 goto out;
3629 }
3630 keys.authkeylen = max_authsize;
3631 } else
3632 memcpy(o_ptr, keys.authkey, keys.authkeylen);
3633
3634 /* Compute the ipad-digest*/
3635 memset(pad + keys.authkeylen, 0, bs - keys.authkeylen);
3636 memcpy(pad, o_ptr, keys.authkeylen);
3637 for (i = 0; i < bs >> 2; i++)
3638 *((unsigned int *)pad + i) ^= IPAD_DATA;
3639
3640 if (chcr_compute_partial_hash(shash, pad, actx->h_iopad,
3641 max_authsize))
3642 goto out;
3643 /* Compute the opad-digest */
3644 memset(pad + keys.authkeylen, 0, bs - keys.authkeylen);
3645 memcpy(pad, o_ptr, keys.authkeylen);
3646 for (i = 0; i < bs >> 2; i++)
3647 *((unsigned int *)pad + i) ^= OPAD_DATA;
3648
3649 if (chcr_compute_partial_hash(shash, pad, o_ptr, max_authsize))
3650 goto out;
3651
3652 /* convert the ipad and opad digest to network order */
3653 chcr_change_order(actx->h_iopad, param.result_size);
3654 chcr_change_order(o_ptr, param.result_size);
3655 key_ctx_len = sizeof(struct _key_ctx) +
3656 roundup(keys.enckeylen, 16) +
3657 (param.result_size + align) * 2;
3658 aeadctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, param.mk_size,
3659 0, 1, key_ctx_len >> 4);
3660 actx->auth_mode = param.auth_mode;
3661 chcr_free_shash(base_hash);
3662
3663 memzero_explicit(&keys, sizeof(keys));
3664 return 0;
3665 }
3666 out:
3667 aeadctx->enckey_len = 0;
3668 memzero_explicit(&keys, sizeof(keys));
3669 if (!IS_ERR(base_hash))
3670 chcr_free_shash(base_hash);
3671 return -EINVAL;
3672 }
3673
chcr_aead_digest_null_setkey(struct crypto_aead * authenc,const u8 * key,unsigned int keylen)3674 static int chcr_aead_digest_null_setkey(struct crypto_aead *authenc,
3675 const u8 *key, unsigned int keylen)
3676 {
3677 struct chcr_aead_ctx *aeadctx = AEAD_CTX(a_ctx(authenc));
3678 struct chcr_authenc_ctx *actx = AUTHENC_CTX(aeadctx);
3679 struct crypto_authenc_keys keys;
3680 int err;
3681 /* it contains auth and cipher key both*/
3682 unsigned int subtype;
3683 int key_ctx_len = 0;
3684 unsigned char ck_size = 0;
3685
3686 crypto_aead_clear_flags(aeadctx->sw_cipher, CRYPTO_TFM_REQ_MASK);
3687 crypto_aead_set_flags(aeadctx->sw_cipher, crypto_aead_get_flags(authenc)
3688 & CRYPTO_TFM_REQ_MASK);
3689 err = crypto_aead_setkey(aeadctx->sw_cipher, key, keylen);
3690 if (err)
3691 goto out;
3692
3693 if (crypto_authenc_extractkeys(&keys, key, keylen) != 0)
3694 goto out;
3695
3696 subtype = get_aead_subtype(authenc);
3697 if (subtype == CRYPTO_ALG_SUB_TYPE_CTR_SHA ||
3698 subtype == CRYPTO_ALG_SUB_TYPE_CTR_NULL) {
3699 if (keys.enckeylen < CTR_RFC3686_NONCE_SIZE)
3700 goto out;
3701 memcpy(aeadctx->nonce, keys.enckey + (keys.enckeylen
3702 - CTR_RFC3686_NONCE_SIZE), CTR_RFC3686_NONCE_SIZE);
3703 keys.enckeylen -= CTR_RFC3686_NONCE_SIZE;
3704 }
3705 if (keys.enckeylen == AES_KEYSIZE_128) {
3706 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_128;
3707 } else if (keys.enckeylen == AES_KEYSIZE_192) {
3708 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_192;
3709 } else if (keys.enckeylen == AES_KEYSIZE_256) {
3710 ck_size = CHCR_KEYCTX_CIPHER_KEY_SIZE_256;
3711 } else {
3712 pr_err("Unsupported cipher key %d\n", keys.enckeylen);
3713 goto out;
3714 }
3715 memcpy(aeadctx->key, keys.enckey, keys.enckeylen);
3716 aeadctx->enckey_len = keys.enckeylen;
3717 if (subtype == CRYPTO_ALG_SUB_TYPE_CBC_SHA ||
3718 subtype == CRYPTO_ALG_SUB_TYPE_CBC_NULL) {
3719 get_aes_decrypt_key(actx->dec_rrkey, aeadctx->key,
3720 aeadctx->enckey_len << 3);
3721 }
3722 key_ctx_len = sizeof(struct _key_ctx) + roundup(keys.enckeylen, 16);
3723
3724 aeadctx->key_ctx_hdr = FILL_KEY_CTX_HDR(ck_size, CHCR_KEYCTX_NO_KEY, 0,
3725 0, key_ctx_len >> 4);
3726 actx->auth_mode = CHCR_SCMD_AUTH_MODE_NOP;
3727 memzero_explicit(&keys, sizeof(keys));
3728 return 0;
3729 out:
3730 aeadctx->enckey_len = 0;
3731 memzero_explicit(&keys, sizeof(keys));
3732 return -EINVAL;
3733 }
3734
chcr_aead_op(struct aead_request * req,int size,create_wr_t create_wr_fn)3735 static int chcr_aead_op(struct aead_request *req,
3736 int size,
3737 create_wr_t create_wr_fn)
3738 {
3739 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
3740 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
3741 struct chcr_context *ctx = a_ctx(tfm);
3742 struct uld_ctx *u_ctx = ULD_CTX(ctx);
3743 struct sk_buff *skb;
3744 struct chcr_dev *cdev;
3745
3746 cdev = a_ctx(tfm)->dev;
3747 if (!cdev) {
3748 pr_err("%s : No crypto device.\n", __func__);
3749 return -ENXIO;
3750 }
3751
3752 if (chcr_inc_wrcount(cdev)) {
3753 /* Detach state for CHCR means lldi or padap is freed.
3754 * We cannot increment fallback here.
3755 */
3756 return chcr_aead_fallback(req, reqctx->op);
3757 }
3758
3759 if (cxgb4_is_crypto_q_full(u_ctx->lldi.ports[0],
3760 reqctx->txqidx) &&
3761 (!(req->base.flags & CRYPTO_TFM_REQ_MAY_BACKLOG))) {
3762 chcr_dec_wrcount(cdev);
3763 return -ENOSPC;
3764 }
3765
3766 if (get_aead_subtype(tfm) == CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106 &&
3767 crypto_ipsec_check_assoclen(req->assoclen) != 0) {
3768 pr_err("RFC4106: Invalid value of assoclen %d\n",
3769 req->assoclen);
3770 return -EINVAL;
3771 }
3772
3773 /* Form a WR from req */
3774 skb = create_wr_fn(req, u_ctx->lldi.rxq_ids[reqctx->rxqidx], size);
3775
3776 if (IS_ERR_OR_NULL(skb)) {
3777 chcr_dec_wrcount(cdev);
3778 return PTR_ERR_OR_ZERO(skb);
3779 }
3780
3781 skb->dev = u_ctx->lldi.ports[0];
3782 set_wr_txq(skb, CPL_PRIORITY_DATA, reqctx->txqidx);
3783 chcr_send_wr(skb);
3784 return -EINPROGRESS;
3785 }
3786
chcr_aead_encrypt(struct aead_request * req)3787 static int chcr_aead_encrypt(struct aead_request *req)
3788 {
3789 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
3790 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
3791 struct chcr_context *ctx = a_ctx(tfm);
3792 unsigned int cpu;
3793
3794 cpu = get_cpu();
3795 reqctx->txqidx = cpu % ctx->ntxq;
3796 reqctx->rxqidx = cpu % ctx->nrxq;
3797 put_cpu();
3798
3799 reqctx->verify = VERIFY_HW;
3800 reqctx->op = CHCR_ENCRYPT_OP;
3801
3802 switch (get_aead_subtype(tfm)) {
3803 case CRYPTO_ALG_SUB_TYPE_CTR_SHA:
3804 case CRYPTO_ALG_SUB_TYPE_CBC_SHA:
3805 case CRYPTO_ALG_SUB_TYPE_CBC_NULL:
3806 case CRYPTO_ALG_SUB_TYPE_CTR_NULL:
3807 return chcr_aead_op(req, 0, create_authenc_wr);
3808 case CRYPTO_ALG_SUB_TYPE_AEAD_CCM:
3809 case CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309:
3810 return chcr_aead_op(req, 0, create_aead_ccm_wr);
3811 default:
3812 return chcr_aead_op(req, 0, create_gcm_wr);
3813 }
3814 }
3815
chcr_aead_decrypt(struct aead_request * req)3816 static int chcr_aead_decrypt(struct aead_request *req)
3817 {
3818 struct crypto_aead *tfm = crypto_aead_reqtfm(req);
3819 struct chcr_context *ctx = a_ctx(tfm);
3820 struct chcr_aead_ctx *aeadctx = AEAD_CTX(ctx);
3821 struct chcr_aead_reqctx *reqctx = aead_request_ctx_dma(req);
3822 int size;
3823 unsigned int cpu;
3824
3825 cpu = get_cpu();
3826 reqctx->txqidx = cpu % ctx->ntxq;
3827 reqctx->rxqidx = cpu % ctx->nrxq;
3828 put_cpu();
3829
3830 if (aeadctx->mayverify == VERIFY_SW) {
3831 size = crypto_aead_maxauthsize(tfm);
3832 reqctx->verify = VERIFY_SW;
3833 } else {
3834 size = 0;
3835 reqctx->verify = VERIFY_HW;
3836 }
3837 reqctx->op = CHCR_DECRYPT_OP;
3838 switch (get_aead_subtype(tfm)) {
3839 case CRYPTO_ALG_SUB_TYPE_CBC_SHA:
3840 case CRYPTO_ALG_SUB_TYPE_CTR_SHA:
3841 case CRYPTO_ALG_SUB_TYPE_CBC_NULL:
3842 case CRYPTO_ALG_SUB_TYPE_CTR_NULL:
3843 return chcr_aead_op(req, size, create_authenc_wr);
3844 case CRYPTO_ALG_SUB_TYPE_AEAD_CCM:
3845 case CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309:
3846 return chcr_aead_op(req, size, create_aead_ccm_wr);
3847 default:
3848 return chcr_aead_op(req, size, create_gcm_wr);
3849 }
3850 }
3851
3852 static struct chcr_alg_template driver_algs[] = {
3853 /* AES-CBC */
3854 {
3855 .type = CRYPTO_ALG_TYPE_SKCIPHER | CRYPTO_ALG_SUB_TYPE_CBC,
3856 .is_registered = 0,
3857 .alg.skcipher = {
3858 .base.cra_name = "cbc(aes)",
3859 .base.cra_driver_name = "cbc-aes-chcr",
3860 .base.cra_blocksize = AES_BLOCK_SIZE,
3861
3862 .init = chcr_init_tfm,
3863 .exit = chcr_exit_tfm,
3864 .min_keysize = AES_MIN_KEY_SIZE,
3865 .max_keysize = AES_MAX_KEY_SIZE,
3866 .ivsize = AES_BLOCK_SIZE,
3867 .setkey = chcr_aes_cbc_setkey,
3868 .encrypt = chcr_aes_encrypt,
3869 .decrypt = chcr_aes_decrypt,
3870 }
3871 },
3872 {
3873 .type = CRYPTO_ALG_TYPE_SKCIPHER | CRYPTO_ALG_SUB_TYPE_XTS,
3874 .is_registered = 0,
3875 .alg.skcipher = {
3876 .base.cra_name = "xts(aes)",
3877 .base.cra_driver_name = "xts-aes-chcr",
3878 .base.cra_blocksize = AES_BLOCK_SIZE,
3879
3880 .init = chcr_init_tfm,
3881 .exit = chcr_exit_tfm,
3882 .min_keysize = 2 * AES_MIN_KEY_SIZE,
3883 .max_keysize = 2 * AES_MAX_KEY_SIZE,
3884 .ivsize = AES_BLOCK_SIZE,
3885 .setkey = chcr_aes_xts_setkey,
3886 .encrypt = chcr_aes_encrypt,
3887 .decrypt = chcr_aes_decrypt,
3888 }
3889 },
3890 {
3891 .type = CRYPTO_ALG_TYPE_SKCIPHER | CRYPTO_ALG_SUB_TYPE_CTR,
3892 .is_registered = 0,
3893 .alg.skcipher = {
3894 .base.cra_name = "ctr(aes)",
3895 .base.cra_driver_name = "ctr-aes-chcr",
3896 .base.cra_blocksize = 1,
3897
3898 .init = chcr_init_tfm,
3899 .exit = chcr_exit_tfm,
3900 .min_keysize = AES_MIN_KEY_SIZE,
3901 .max_keysize = AES_MAX_KEY_SIZE,
3902 .ivsize = AES_BLOCK_SIZE,
3903 .setkey = chcr_aes_ctr_setkey,
3904 .encrypt = chcr_aes_encrypt,
3905 .decrypt = chcr_aes_decrypt,
3906 }
3907 },
3908 {
3909 .type = CRYPTO_ALG_TYPE_SKCIPHER |
3910 CRYPTO_ALG_SUB_TYPE_CTR_RFC3686,
3911 .is_registered = 0,
3912 .alg.skcipher = {
3913 .base.cra_name = "rfc3686(ctr(aes))",
3914 .base.cra_driver_name = "rfc3686-ctr-aes-chcr",
3915 .base.cra_blocksize = 1,
3916
3917 .init = chcr_rfc3686_init,
3918 .exit = chcr_exit_tfm,
3919 .min_keysize = AES_MIN_KEY_SIZE + CTR_RFC3686_NONCE_SIZE,
3920 .max_keysize = AES_MAX_KEY_SIZE + CTR_RFC3686_NONCE_SIZE,
3921 .ivsize = CTR_RFC3686_IV_SIZE,
3922 .setkey = chcr_aes_rfc3686_setkey,
3923 .encrypt = chcr_aes_encrypt,
3924 .decrypt = chcr_aes_decrypt,
3925 }
3926 },
3927 /* SHA */
3928 {
3929 .type = CRYPTO_ALG_TYPE_AHASH,
3930 .is_registered = 0,
3931 .alg.hash = {
3932 .halg.digestsize = SHA1_DIGEST_SIZE,
3933 .halg.base = {
3934 .cra_name = "sha1",
3935 .cra_driver_name = "sha1-chcr",
3936 .cra_blocksize = SHA1_BLOCK_SIZE,
3937 }
3938 }
3939 },
3940 {
3941 .type = CRYPTO_ALG_TYPE_AHASH,
3942 .is_registered = 0,
3943 .alg.hash = {
3944 .halg.digestsize = SHA256_DIGEST_SIZE,
3945 .halg.base = {
3946 .cra_name = "sha256",
3947 .cra_driver_name = "sha256-chcr",
3948 .cra_blocksize = SHA256_BLOCK_SIZE,
3949 }
3950 }
3951 },
3952 {
3953 .type = CRYPTO_ALG_TYPE_AHASH,
3954 .is_registered = 0,
3955 .alg.hash = {
3956 .halg.digestsize = SHA224_DIGEST_SIZE,
3957 .halg.base = {
3958 .cra_name = "sha224",
3959 .cra_driver_name = "sha224-chcr",
3960 .cra_blocksize = SHA224_BLOCK_SIZE,
3961 }
3962 }
3963 },
3964 {
3965 .type = CRYPTO_ALG_TYPE_AHASH,
3966 .is_registered = 0,
3967 .alg.hash = {
3968 .halg.digestsize = SHA384_DIGEST_SIZE,
3969 .halg.base = {
3970 .cra_name = "sha384",
3971 .cra_driver_name = "sha384-chcr",
3972 .cra_blocksize = SHA384_BLOCK_SIZE,
3973 }
3974 }
3975 },
3976 {
3977 .type = CRYPTO_ALG_TYPE_AHASH,
3978 .is_registered = 0,
3979 .alg.hash = {
3980 .halg.digestsize = SHA512_DIGEST_SIZE,
3981 .halg.base = {
3982 .cra_name = "sha512",
3983 .cra_driver_name = "sha512-chcr",
3984 .cra_blocksize = SHA512_BLOCK_SIZE,
3985 }
3986 }
3987 },
3988 /* HMAC */
3989 {
3990 .type = CRYPTO_ALG_TYPE_HMAC,
3991 .is_registered = 0,
3992 .alg.hash = {
3993 .halg.digestsize = SHA1_DIGEST_SIZE,
3994 .halg.base = {
3995 .cra_name = "hmac(sha1)",
3996 .cra_driver_name = "hmac-sha1-chcr",
3997 .cra_blocksize = SHA1_BLOCK_SIZE,
3998 }
3999 }
4000 },
4001 {
4002 .type = CRYPTO_ALG_TYPE_HMAC,
4003 .is_registered = 0,
4004 .alg.hash = {
4005 .halg.digestsize = SHA224_DIGEST_SIZE,
4006 .halg.base = {
4007 .cra_name = "hmac(sha224)",
4008 .cra_driver_name = "hmac-sha224-chcr",
4009 .cra_blocksize = SHA224_BLOCK_SIZE,
4010 }
4011 }
4012 },
4013 {
4014 .type = CRYPTO_ALG_TYPE_HMAC,
4015 .is_registered = 0,
4016 .alg.hash = {
4017 .halg.digestsize = SHA256_DIGEST_SIZE,
4018 .halg.base = {
4019 .cra_name = "hmac(sha256)",
4020 .cra_driver_name = "hmac-sha256-chcr",
4021 .cra_blocksize = SHA256_BLOCK_SIZE,
4022 }
4023 }
4024 },
4025 {
4026 .type = CRYPTO_ALG_TYPE_HMAC,
4027 .is_registered = 0,
4028 .alg.hash = {
4029 .halg.digestsize = SHA384_DIGEST_SIZE,
4030 .halg.base = {
4031 .cra_name = "hmac(sha384)",
4032 .cra_driver_name = "hmac-sha384-chcr",
4033 .cra_blocksize = SHA384_BLOCK_SIZE,
4034 }
4035 }
4036 },
4037 {
4038 .type = CRYPTO_ALG_TYPE_HMAC,
4039 .is_registered = 0,
4040 .alg.hash = {
4041 .halg.digestsize = SHA512_DIGEST_SIZE,
4042 .halg.base = {
4043 .cra_name = "hmac(sha512)",
4044 .cra_driver_name = "hmac-sha512-chcr",
4045 .cra_blocksize = SHA512_BLOCK_SIZE,
4046 }
4047 }
4048 },
4049 /* Add AEAD Algorithms */
4050 {
4051 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_AEAD_GCM,
4052 .is_registered = 0,
4053 .alg.aead = {
4054 .base = {
4055 .cra_name = "gcm(aes)",
4056 .cra_driver_name = "gcm-aes-chcr",
4057 .cra_blocksize = 1,
4058 .cra_priority = CHCR_AEAD_PRIORITY,
4059 .cra_ctxsize = sizeof(struct chcr_context) +
4060 sizeof(struct chcr_aead_ctx) +
4061 sizeof(struct chcr_gcm_ctx),
4062 },
4063 .ivsize = GCM_AES_IV_SIZE,
4064 .maxauthsize = GHASH_DIGEST_SIZE,
4065 .setkey = chcr_gcm_setkey,
4066 .setauthsize = chcr_gcm_setauthsize,
4067 }
4068 },
4069 {
4070 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_AEAD_RFC4106,
4071 .is_registered = 0,
4072 .alg.aead = {
4073 .base = {
4074 .cra_name = "rfc4106(gcm(aes))",
4075 .cra_driver_name = "rfc4106-gcm-aes-chcr",
4076 .cra_blocksize = 1,
4077 .cra_priority = CHCR_AEAD_PRIORITY + 1,
4078 .cra_ctxsize = sizeof(struct chcr_context) +
4079 sizeof(struct chcr_aead_ctx) +
4080 sizeof(struct chcr_gcm_ctx),
4081
4082 },
4083 .ivsize = GCM_RFC4106_IV_SIZE,
4084 .maxauthsize = GHASH_DIGEST_SIZE,
4085 .setkey = chcr_gcm_setkey,
4086 .setauthsize = chcr_4106_4309_setauthsize,
4087 }
4088 },
4089 {
4090 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_AEAD_CCM,
4091 .is_registered = 0,
4092 .alg.aead = {
4093 .base = {
4094 .cra_name = "ccm(aes)",
4095 .cra_driver_name = "ccm-aes-chcr",
4096 .cra_blocksize = 1,
4097 .cra_priority = CHCR_AEAD_PRIORITY,
4098 .cra_ctxsize = sizeof(struct chcr_context) +
4099 sizeof(struct chcr_aead_ctx),
4100
4101 },
4102 .ivsize = AES_BLOCK_SIZE,
4103 .maxauthsize = GHASH_DIGEST_SIZE,
4104 .setkey = chcr_aead_ccm_setkey,
4105 .setauthsize = chcr_ccm_setauthsize,
4106 }
4107 },
4108 {
4109 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_AEAD_RFC4309,
4110 .is_registered = 0,
4111 .alg.aead = {
4112 .base = {
4113 .cra_name = "rfc4309(ccm(aes))",
4114 .cra_driver_name = "rfc4309-ccm-aes-chcr",
4115 .cra_blocksize = 1,
4116 .cra_priority = CHCR_AEAD_PRIORITY + 1,
4117 .cra_ctxsize = sizeof(struct chcr_context) +
4118 sizeof(struct chcr_aead_ctx),
4119
4120 },
4121 .ivsize = 8,
4122 .maxauthsize = GHASH_DIGEST_SIZE,
4123 .setkey = chcr_aead_rfc4309_setkey,
4124 .setauthsize = chcr_4106_4309_setauthsize,
4125 }
4126 },
4127 {
4128 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_SHA,
4129 .is_registered = 0,
4130 .alg.aead = {
4131 .base = {
4132 .cra_name = "authenc(hmac(sha1),cbc(aes))",
4133 .cra_driver_name =
4134 "authenc-hmac-sha1-cbc-aes-chcr",
4135 .cra_blocksize = AES_BLOCK_SIZE,
4136 .cra_priority = CHCR_AEAD_PRIORITY,
4137 .cra_ctxsize = sizeof(struct chcr_context) +
4138 sizeof(struct chcr_aead_ctx) +
4139 sizeof(struct chcr_authenc_ctx),
4140
4141 },
4142 .ivsize = AES_BLOCK_SIZE,
4143 .maxauthsize = SHA1_DIGEST_SIZE,
4144 .setkey = chcr_authenc_setkey,
4145 .setauthsize = chcr_authenc_setauthsize,
4146 }
4147 },
4148 {
4149 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_SHA,
4150 .is_registered = 0,
4151 .alg.aead = {
4152 .base = {
4153
4154 .cra_name = "authenc(hmac(sha256),cbc(aes))",
4155 .cra_driver_name =
4156 "authenc-hmac-sha256-cbc-aes-chcr",
4157 .cra_blocksize = AES_BLOCK_SIZE,
4158 .cra_priority = CHCR_AEAD_PRIORITY,
4159 .cra_ctxsize = sizeof(struct chcr_context) +
4160 sizeof(struct chcr_aead_ctx) +
4161 sizeof(struct chcr_authenc_ctx),
4162
4163 },
4164 .ivsize = AES_BLOCK_SIZE,
4165 .maxauthsize = SHA256_DIGEST_SIZE,
4166 .setkey = chcr_authenc_setkey,
4167 .setauthsize = chcr_authenc_setauthsize,
4168 }
4169 },
4170 {
4171 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_SHA,
4172 .is_registered = 0,
4173 .alg.aead = {
4174 .base = {
4175 .cra_name = "authenc(hmac(sha224),cbc(aes))",
4176 .cra_driver_name =
4177 "authenc-hmac-sha224-cbc-aes-chcr",
4178 .cra_blocksize = AES_BLOCK_SIZE,
4179 .cra_priority = CHCR_AEAD_PRIORITY,
4180 .cra_ctxsize = sizeof(struct chcr_context) +
4181 sizeof(struct chcr_aead_ctx) +
4182 sizeof(struct chcr_authenc_ctx),
4183 },
4184 .ivsize = AES_BLOCK_SIZE,
4185 .maxauthsize = SHA224_DIGEST_SIZE,
4186 .setkey = chcr_authenc_setkey,
4187 .setauthsize = chcr_authenc_setauthsize,
4188 }
4189 },
4190 {
4191 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_SHA,
4192 .is_registered = 0,
4193 .alg.aead = {
4194 .base = {
4195 .cra_name = "authenc(hmac(sha384),cbc(aes))",
4196 .cra_driver_name =
4197 "authenc-hmac-sha384-cbc-aes-chcr",
4198 .cra_blocksize = AES_BLOCK_SIZE,
4199 .cra_priority = CHCR_AEAD_PRIORITY,
4200 .cra_ctxsize = sizeof(struct chcr_context) +
4201 sizeof(struct chcr_aead_ctx) +
4202 sizeof(struct chcr_authenc_ctx),
4203
4204 },
4205 .ivsize = AES_BLOCK_SIZE,
4206 .maxauthsize = SHA384_DIGEST_SIZE,
4207 .setkey = chcr_authenc_setkey,
4208 .setauthsize = chcr_authenc_setauthsize,
4209 }
4210 },
4211 {
4212 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_SHA,
4213 .is_registered = 0,
4214 .alg.aead = {
4215 .base = {
4216 .cra_name = "authenc(hmac(sha512),cbc(aes))",
4217 .cra_driver_name =
4218 "authenc-hmac-sha512-cbc-aes-chcr",
4219 .cra_blocksize = AES_BLOCK_SIZE,
4220 .cra_priority = CHCR_AEAD_PRIORITY,
4221 .cra_ctxsize = sizeof(struct chcr_context) +
4222 sizeof(struct chcr_aead_ctx) +
4223 sizeof(struct chcr_authenc_ctx),
4224
4225 },
4226 .ivsize = AES_BLOCK_SIZE,
4227 .maxauthsize = SHA512_DIGEST_SIZE,
4228 .setkey = chcr_authenc_setkey,
4229 .setauthsize = chcr_authenc_setauthsize,
4230 }
4231 },
4232 {
4233 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CBC_NULL,
4234 .is_registered = 0,
4235 .alg.aead = {
4236 .base = {
4237 .cra_name = "authenc(digest_null,cbc(aes))",
4238 .cra_driver_name =
4239 "authenc-digest_null-cbc-aes-chcr",
4240 .cra_blocksize = AES_BLOCK_SIZE,
4241 .cra_priority = CHCR_AEAD_PRIORITY,
4242 .cra_ctxsize = sizeof(struct chcr_context) +
4243 sizeof(struct chcr_aead_ctx) +
4244 sizeof(struct chcr_authenc_ctx),
4245
4246 },
4247 .ivsize = AES_BLOCK_SIZE,
4248 .maxauthsize = 0,
4249 .setkey = chcr_aead_digest_null_setkey,
4250 .setauthsize = chcr_authenc_null_setauthsize,
4251 }
4252 },
4253 {
4254 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_SHA,
4255 .is_registered = 0,
4256 .alg.aead = {
4257 .base = {
4258 .cra_name = "authenc(hmac(sha1),rfc3686(ctr(aes)))",
4259 .cra_driver_name =
4260 "authenc-hmac-sha1-rfc3686-ctr-aes-chcr",
4261 .cra_blocksize = 1,
4262 .cra_priority = CHCR_AEAD_PRIORITY,
4263 .cra_ctxsize = sizeof(struct chcr_context) +
4264 sizeof(struct chcr_aead_ctx) +
4265 sizeof(struct chcr_authenc_ctx),
4266
4267 },
4268 .ivsize = CTR_RFC3686_IV_SIZE,
4269 .maxauthsize = SHA1_DIGEST_SIZE,
4270 .setkey = chcr_authenc_setkey,
4271 .setauthsize = chcr_authenc_setauthsize,
4272 }
4273 },
4274 {
4275 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_SHA,
4276 .is_registered = 0,
4277 .alg.aead = {
4278 .base = {
4279
4280 .cra_name = "authenc(hmac(sha256),rfc3686(ctr(aes)))",
4281 .cra_driver_name =
4282 "authenc-hmac-sha256-rfc3686-ctr-aes-chcr",
4283 .cra_blocksize = 1,
4284 .cra_priority = CHCR_AEAD_PRIORITY,
4285 .cra_ctxsize = sizeof(struct chcr_context) +
4286 sizeof(struct chcr_aead_ctx) +
4287 sizeof(struct chcr_authenc_ctx),
4288
4289 },
4290 .ivsize = CTR_RFC3686_IV_SIZE,
4291 .maxauthsize = SHA256_DIGEST_SIZE,
4292 .setkey = chcr_authenc_setkey,
4293 .setauthsize = chcr_authenc_setauthsize,
4294 }
4295 },
4296 {
4297 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_SHA,
4298 .is_registered = 0,
4299 .alg.aead = {
4300 .base = {
4301 .cra_name = "authenc(hmac(sha224),rfc3686(ctr(aes)))",
4302 .cra_driver_name =
4303 "authenc-hmac-sha224-rfc3686-ctr-aes-chcr",
4304 .cra_blocksize = 1,
4305 .cra_priority = CHCR_AEAD_PRIORITY,
4306 .cra_ctxsize = sizeof(struct chcr_context) +
4307 sizeof(struct chcr_aead_ctx) +
4308 sizeof(struct chcr_authenc_ctx),
4309 },
4310 .ivsize = CTR_RFC3686_IV_SIZE,
4311 .maxauthsize = SHA224_DIGEST_SIZE,
4312 .setkey = chcr_authenc_setkey,
4313 .setauthsize = chcr_authenc_setauthsize,
4314 }
4315 },
4316 {
4317 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_SHA,
4318 .is_registered = 0,
4319 .alg.aead = {
4320 .base = {
4321 .cra_name = "authenc(hmac(sha384),rfc3686(ctr(aes)))",
4322 .cra_driver_name =
4323 "authenc-hmac-sha384-rfc3686-ctr-aes-chcr",
4324 .cra_blocksize = 1,
4325 .cra_priority = CHCR_AEAD_PRIORITY,
4326 .cra_ctxsize = sizeof(struct chcr_context) +
4327 sizeof(struct chcr_aead_ctx) +
4328 sizeof(struct chcr_authenc_ctx),
4329
4330 },
4331 .ivsize = CTR_RFC3686_IV_SIZE,
4332 .maxauthsize = SHA384_DIGEST_SIZE,
4333 .setkey = chcr_authenc_setkey,
4334 .setauthsize = chcr_authenc_setauthsize,
4335 }
4336 },
4337 {
4338 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_SHA,
4339 .is_registered = 0,
4340 .alg.aead = {
4341 .base = {
4342 .cra_name = "authenc(hmac(sha512),rfc3686(ctr(aes)))",
4343 .cra_driver_name =
4344 "authenc-hmac-sha512-rfc3686-ctr-aes-chcr",
4345 .cra_blocksize = 1,
4346 .cra_priority = CHCR_AEAD_PRIORITY,
4347 .cra_ctxsize = sizeof(struct chcr_context) +
4348 sizeof(struct chcr_aead_ctx) +
4349 sizeof(struct chcr_authenc_ctx),
4350
4351 },
4352 .ivsize = CTR_RFC3686_IV_SIZE,
4353 .maxauthsize = SHA512_DIGEST_SIZE,
4354 .setkey = chcr_authenc_setkey,
4355 .setauthsize = chcr_authenc_setauthsize,
4356 }
4357 },
4358 {
4359 .type = CRYPTO_ALG_TYPE_AEAD | CRYPTO_ALG_SUB_TYPE_CTR_NULL,
4360 .is_registered = 0,
4361 .alg.aead = {
4362 .base = {
4363 .cra_name = "authenc(digest_null,rfc3686(ctr(aes)))",
4364 .cra_driver_name =
4365 "authenc-digest_null-rfc3686-ctr-aes-chcr",
4366 .cra_blocksize = 1,
4367 .cra_priority = CHCR_AEAD_PRIORITY,
4368 .cra_ctxsize = sizeof(struct chcr_context) +
4369 sizeof(struct chcr_aead_ctx) +
4370 sizeof(struct chcr_authenc_ctx),
4371
4372 },
4373 .ivsize = CTR_RFC3686_IV_SIZE,
4374 .maxauthsize = 0,
4375 .setkey = chcr_aead_digest_null_setkey,
4376 .setauthsize = chcr_authenc_null_setauthsize,
4377 }
4378 },
4379 };
4380
4381 /*
4382 * chcr_unregister_alg - Deregister crypto algorithms with
4383 * kernel framework.
4384 */
chcr_unregister_alg(void)4385 static int chcr_unregister_alg(void)
4386 {
4387 int i;
4388
4389 for (i = 0; i < ARRAY_SIZE(driver_algs); i++) {
4390 switch (driver_algs[i].type & CRYPTO_ALG_TYPE_MASK) {
4391 case CRYPTO_ALG_TYPE_SKCIPHER:
4392 if (driver_algs[i].is_registered && refcount_read(
4393 &driver_algs[i].alg.skcipher.base.cra_refcnt)
4394 == 1) {
4395 crypto_unregister_skcipher(
4396 &driver_algs[i].alg.skcipher);
4397 driver_algs[i].is_registered = 0;
4398 }
4399 break;
4400 case CRYPTO_ALG_TYPE_AEAD:
4401 if (driver_algs[i].is_registered && refcount_read(
4402 &driver_algs[i].alg.aead.base.cra_refcnt) == 1) {
4403 crypto_unregister_aead(
4404 &driver_algs[i].alg.aead);
4405 driver_algs[i].is_registered = 0;
4406 }
4407 break;
4408 case CRYPTO_ALG_TYPE_AHASH:
4409 if (driver_algs[i].is_registered && refcount_read(
4410 &driver_algs[i].alg.hash.halg.base.cra_refcnt)
4411 == 1) {
4412 crypto_unregister_ahash(
4413 &driver_algs[i].alg.hash);
4414 driver_algs[i].is_registered = 0;
4415 }
4416 break;
4417 }
4418 }
4419 return 0;
4420 }
4421
4422 #define SZ_AHASH_CTX sizeof(struct chcr_context)
4423 #define SZ_AHASH_H_CTX (sizeof(struct chcr_context) + sizeof(struct hmac_ctx))
4424 #define SZ_AHASH_REQ_CTX sizeof(struct chcr_ahash_req_ctx)
4425
4426 /*
4427 * chcr_register_alg - Register crypto algorithms with kernel framework.
4428 */
chcr_register_alg(void)4429 static int chcr_register_alg(void)
4430 {
4431 struct crypto_alg ai;
4432 struct ahash_alg *a_hash;
4433 int err = 0, i;
4434 char *name = NULL;
4435
4436 for (i = 0; i < ARRAY_SIZE(driver_algs); i++) {
4437 if (driver_algs[i].is_registered)
4438 continue;
4439 switch (driver_algs[i].type & CRYPTO_ALG_TYPE_MASK) {
4440 case CRYPTO_ALG_TYPE_SKCIPHER:
4441 driver_algs[i].alg.skcipher.base.cra_priority =
4442 CHCR_CRA_PRIORITY;
4443 driver_algs[i].alg.skcipher.base.cra_module = THIS_MODULE;
4444 driver_algs[i].alg.skcipher.base.cra_flags =
4445 CRYPTO_ALG_TYPE_SKCIPHER | CRYPTO_ALG_ASYNC |
4446 CRYPTO_ALG_ALLOCATES_MEMORY |
4447 CRYPTO_ALG_NEED_FALLBACK;
4448 driver_algs[i].alg.skcipher.base.cra_ctxsize =
4449 sizeof(struct chcr_context) +
4450 sizeof(struct ablk_ctx);
4451 driver_algs[i].alg.skcipher.base.cra_alignmask = 0;
4452
4453 err = crypto_register_skcipher(&driver_algs[i].alg.skcipher);
4454 name = driver_algs[i].alg.skcipher.base.cra_driver_name;
4455 break;
4456 case CRYPTO_ALG_TYPE_AEAD:
4457 driver_algs[i].alg.aead.base.cra_flags =
4458 CRYPTO_ALG_ASYNC | CRYPTO_ALG_NEED_FALLBACK |
4459 CRYPTO_ALG_ALLOCATES_MEMORY;
4460 driver_algs[i].alg.aead.encrypt = chcr_aead_encrypt;
4461 driver_algs[i].alg.aead.decrypt = chcr_aead_decrypt;
4462 driver_algs[i].alg.aead.init = chcr_aead_cra_init;
4463 driver_algs[i].alg.aead.exit = chcr_aead_cra_exit;
4464 driver_algs[i].alg.aead.base.cra_module = THIS_MODULE;
4465 err = crypto_register_aead(&driver_algs[i].alg.aead);
4466 name = driver_algs[i].alg.aead.base.cra_driver_name;
4467 break;
4468 case CRYPTO_ALG_TYPE_AHASH:
4469 a_hash = &driver_algs[i].alg.hash;
4470 a_hash->update = chcr_ahash_update;
4471 a_hash->final = chcr_ahash_final;
4472 a_hash->finup = chcr_ahash_finup;
4473 a_hash->digest = chcr_ahash_digest;
4474 a_hash->export = chcr_ahash_export;
4475 a_hash->import = chcr_ahash_import;
4476 a_hash->halg.statesize = SZ_AHASH_REQ_CTX;
4477 a_hash->halg.base.cra_priority = CHCR_CRA_PRIORITY;
4478 a_hash->halg.base.cra_module = THIS_MODULE;
4479 a_hash->halg.base.cra_flags =
4480 CRYPTO_ALG_ASYNC | CRYPTO_ALG_ALLOCATES_MEMORY;
4481 a_hash->halg.base.cra_alignmask = 0;
4482 a_hash->halg.base.cra_exit = NULL;
4483
4484 if (driver_algs[i].type == CRYPTO_ALG_TYPE_HMAC) {
4485 a_hash->halg.base.cra_init = chcr_hmac_cra_init;
4486 a_hash->halg.base.cra_exit = chcr_hmac_cra_exit;
4487 a_hash->init = chcr_hmac_init;
4488 a_hash->setkey = chcr_ahash_setkey;
4489 a_hash->halg.base.cra_ctxsize = SZ_AHASH_H_CTX;
4490 } else {
4491 a_hash->init = chcr_sha_init;
4492 a_hash->halg.base.cra_ctxsize = SZ_AHASH_CTX;
4493 a_hash->halg.base.cra_init = chcr_sha_cra_init;
4494 }
4495 err = crypto_register_ahash(&driver_algs[i].alg.hash);
4496 ai = driver_algs[i].alg.hash.halg.base;
4497 name = ai.cra_driver_name;
4498 break;
4499 }
4500 if (err) {
4501 pr_err("%s : Algorithm registration failed\n", name);
4502 goto register_err;
4503 } else {
4504 driver_algs[i].is_registered = 1;
4505 }
4506 }
4507 return 0;
4508
4509 register_err:
4510 chcr_unregister_alg();
4511 return err;
4512 }
4513
4514 /*
4515 * start_crypto - Register the crypto algorithms.
4516 * This should called once when the first device comesup. After this
4517 * kernel will start calling driver APIs for crypto operations.
4518 */
start_crypto(void)4519 int start_crypto(void)
4520 {
4521 return chcr_register_alg();
4522 }
4523
4524 /*
4525 * stop_crypto - Deregister all the crypto algorithms with kernel.
4526 * This should be called once when the last device goes down. After this
4527 * kernel will not call the driver API for crypto operations.
4528 */
stop_crypto(void)4529 int stop_crypto(void)
4530 {
4531 chcr_unregister_alg();
4532 return 0;
4533 }
4534