1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * sun4i-ss-cipher.c - hardware cryptographic accelerator for Allwinner A20 SoC
4  *
5  * Copyright (C) 2013-2015 Corentin LABBE <clabbe.montjoie@gmail.com>
6  *
7  * This file add support for AES cipher with 128,192,256 bits
8  * keysize in CBC and ECB mode.
9  * Add support also for DES and 3DES in CBC and ECB mode.
10  *
11  * You could find the datasheet in Documentation/arch/arm/sunxi.rst
12  */
13 #include "sun4i-ss.h"
14 
sun4i_ss_opti_poll(struct skcipher_request * areq)15 static int noinline_for_stack sun4i_ss_opti_poll(struct skcipher_request *areq)
16 {
17 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
18 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
19 	struct sun4i_ss_ctx *ss = op->ss;
20 	unsigned int ivsize = crypto_skcipher_ivsize(tfm);
21 	struct sun4i_cipher_req_ctx *ctx = skcipher_request_ctx(areq);
22 	u32 mode = ctx->mode;
23 	/* when activating SS, the default FIFO space is SS_RX_DEFAULT(32) */
24 	u32 rx_cnt = SS_RX_DEFAULT;
25 	u32 tx_cnt = 0;
26 	u32 spaces;
27 	u32 v;
28 	int err = 0;
29 	unsigned int i;
30 	unsigned int ileft = areq->cryptlen;
31 	unsigned int oleft = areq->cryptlen;
32 	unsigned int todo;
33 	unsigned long pi = 0, po = 0; /* progress for in and out */
34 	bool miter_err;
35 	struct sg_mapping_iter mi, mo;
36 	unsigned int oi, oo; /* offset for in and out */
37 	unsigned long flags;
38 	struct skcipher_alg *alg = crypto_skcipher_alg(tfm);
39 	struct sun4i_ss_alg_template *algt;
40 
41 	if (!areq->cryptlen)
42 		return 0;
43 
44 	if (!areq->src || !areq->dst) {
45 		dev_err_ratelimited(ss->dev, "ERROR: Some SGs are NULL\n");
46 		return -EINVAL;
47 	}
48 
49 	if (areq->iv && ivsize > 0 && mode & SS_DECRYPTION) {
50 		scatterwalk_map_and_copy(ctx->backup_iv, areq->src,
51 					 areq->cryptlen - ivsize, ivsize, 0);
52 	}
53 
54 	if (IS_ENABLED(CONFIG_CRYPTO_DEV_SUN4I_SS_DEBUG)) {
55 		algt = container_of(alg, struct sun4i_ss_alg_template, alg.crypto);
56 		algt->stat_opti++;
57 		algt->stat_bytes += areq->cryptlen;
58 	}
59 
60 	spin_lock_irqsave(&ss->slock, flags);
61 
62 	for (i = 0; i < op->keylen / 4; i++)
63 		writesl(ss->base + SS_KEY0 + i * 4, &op->key[i], 1);
64 
65 	if (areq->iv) {
66 		for (i = 0; i < 4 && i < ivsize / 4; i++) {
67 			v = *(u32 *)(areq->iv + i * 4);
68 			writesl(ss->base + SS_IV0 + i * 4, &v, 1);
69 		}
70 	}
71 	writel(mode, ss->base + SS_CTL);
72 
73 
74 	ileft = areq->cryptlen / 4;
75 	oleft = areq->cryptlen / 4;
76 	oi = 0;
77 	oo = 0;
78 	do {
79 		if (ileft) {
80 			sg_miter_start(&mi, areq->src, sg_nents(areq->src),
81 					SG_MITER_FROM_SG | SG_MITER_ATOMIC);
82 			if (pi)
83 				sg_miter_skip(&mi, pi);
84 			miter_err = sg_miter_next(&mi);
85 			if (!miter_err || !mi.addr) {
86 				dev_err_ratelimited(ss->dev, "ERROR: sg_miter return null\n");
87 				err = -EINVAL;
88 				goto release_ss;
89 			}
90 			todo = min(rx_cnt, ileft);
91 			todo = min_t(size_t, todo, (mi.length - oi) / 4);
92 			if (todo) {
93 				ileft -= todo;
94 				writesl(ss->base + SS_RXFIFO, mi.addr + oi, todo);
95 				oi += todo * 4;
96 			}
97 			if (oi == mi.length) {
98 				pi += mi.length;
99 				oi = 0;
100 			}
101 			sg_miter_stop(&mi);
102 		}
103 
104 		spaces = readl(ss->base + SS_FCSR);
105 		rx_cnt = SS_RXFIFO_SPACES(spaces);
106 		tx_cnt = SS_TXFIFO_SPACES(spaces);
107 
108 		sg_miter_start(&mo, areq->dst, sg_nents(areq->dst),
109 			       SG_MITER_TO_SG | SG_MITER_ATOMIC);
110 		if (po)
111 			sg_miter_skip(&mo, po);
112 		miter_err = sg_miter_next(&mo);
113 		if (!miter_err || !mo.addr) {
114 			dev_err_ratelimited(ss->dev, "ERROR: sg_miter return null\n");
115 			err = -EINVAL;
116 			goto release_ss;
117 		}
118 		todo = min(tx_cnt, oleft);
119 		todo = min_t(size_t, todo, (mo.length - oo) / 4);
120 		if (todo) {
121 			oleft -= todo;
122 			readsl(ss->base + SS_TXFIFO, mo.addr + oo, todo);
123 			oo += todo * 4;
124 		}
125 		if (oo == mo.length) {
126 			oo = 0;
127 			po += mo.length;
128 		}
129 		sg_miter_stop(&mo);
130 	} while (oleft);
131 
132 	if (areq->iv) {
133 		if (mode & SS_DECRYPTION) {
134 			memcpy(areq->iv, ctx->backup_iv, ivsize);
135 			memzero_explicit(ctx->backup_iv, ivsize);
136 		} else {
137 			scatterwalk_map_and_copy(areq->iv, areq->dst, areq->cryptlen - ivsize,
138 						 ivsize, 0);
139 		}
140 	}
141 
142 release_ss:
143 	writel(0, ss->base + SS_CTL);
144 	spin_unlock_irqrestore(&ss->slock, flags);
145 	return err;
146 }
147 
sun4i_ss_cipher_poll_fallback(struct skcipher_request * areq)148 static int noinline_for_stack sun4i_ss_cipher_poll_fallback(struct skcipher_request *areq)
149 {
150 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
151 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
152 	struct sun4i_cipher_req_ctx *ctx = skcipher_request_ctx(areq);
153 	int err;
154 	struct skcipher_alg *alg = crypto_skcipher_alg(tfm);
155 	struct sun4i_ss_alg_template *algt;
156 
157 	if (IS_ENABLED(CONFIG_CRYPTO_DEV_SUN4I_SS_DEBUG)) {
158 		algt = container_of(alg, struct sun4i_ss_alg_template, alg.crypto);
159 		algt->stat_fb++;
160 	}
161 
162 	skcipher_request_set_tfm(&ctx->fallback_req, op->fallback_tfm);
163 	skcipher_request_set_callback(&ctx->fallback_req, areq->base.flags,
164 				      areq->base.complete, areq->base.data);
165 	skcipher_request_set_crypt(&ctx->fallback_req, areq->src, areq->dst,
166 				   areq->cryptlen, areq->iv);
167 	if (ctx->mode & SS_DECRYPTION)
168 		err = crypto_skcipher_decrypt(&ctx->fallback_req);
169 	else
170 		err = crypto_skcipher_encrypt(&ctx->fallback_req);
171 
172 	return err;
173 }
174 
175 /* Generic function that support SG with size not multiple of 4 */
sun4i_ss_cipher_poll(struct skcipher_request * areq)176 static int sun4i_ss_cipher_poll(struct skcipher_request *areq)
177 {
178 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
179 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
180 	struct sun4i_ss_ctx *ss = op->ss;
181 	int no_chunk = 1;
182 	struct scatterlist *in_sg = areq->src;
183 	struct scatterlist *out_sg = areq->dst;
184 	unsigned int ivsize = crypto_skcipher_ivsize(tfm);
185 	struct sun4i_cipher_req_ctx *ctx = skcipher_request_ctx(areq);
186 	struct skcipher_alg *alg = crypto_skcipher_alg(tfm);
187 	struct sun4i_ss_alg_template *algt;
188 	u32 mode = ctx->mode;
189 	/* when activating SS, the default FIFO space is SS_RX_DEFAULT(32) */
190 	u32 rx_cnt = SS_RX_DEFAULT;
191 	u32 tx_cnt = 0;
192 	u32 v;
193 	u32 spaces;
194 	int err = 0;
195 	unsigned int i;
196 	unsigned int ileft = areq->cryptlen;
197 	unsigned int oleft = areq->cryptlen;
198 	unsigned int todo;
199 	struct sg_mapping_iter mi, mo;
200 	unsigned long pi = 0, po = 0; /* progress for in and out */
201 	bool miter_err;
202 	unsigned int oi, oo;	/* offset for in and out */
203 	unsigned int ob = 0;	/* offset in buf */
204 	unsigned int obo = 0;	/* offset in bufo*/
205 	unsigned int obl = 0;	/* length of data in bufo */
206 	unsigned long flags;
207 	bool need_fallback = false;
208 
209 	if (!areq->cryptlen)
210 		return 0;
211 
212 	if (!areq->src || !areq->dst) {
213 		dev_err_ratelimited(ss->dev, "ERROR: Some SGs are NULL\n");
214 		return -EINVAL;
215 	}
216 
217 	algt = container_of(alg, struct sun4i_ss_alg_template, alg.crypto);
218 	if (areq->cryptlen % algt->alg.crypto.base.cra_blocksize)
219 		need_fallback = true;
220 
221 	/*
222 	 * if we have only SGs with size multiple of 4,
223 	 * we can use the SS optimized function
224 	 */
225 	while (in_sg && no_chunk == 1) {
226 		if ((in_sg->length | in_sg->offset) & 3u)
227 			no_chunk = 0;
228 		in_sg = sg_next(in_sg);
229 	}
230 	while (out_sg && no_chunk == 1) {
231 		if ((out_sg->length | out_sg->offset) & 3u)
232 			no_chunk = 0;
233 		out_sg = sg_next(out_sg);
234 	}
235 
236 	if (no_chunk == 1 && !need_fallback)
237 		return sun4i_ss_opti_poll(areq);
238 
239 	if (need_fallback)
240 		return sun4i_ss_cipher_poll_fallback(areq);
241 
242 	if (areq->iv && ivsize > 0 && mode & SS_DECRYPTION) {
243 		scatterwalk_map_and_copy(ctx->backup_iv, areq->src,
244 					 areq->cryptlen - ivsize, ivsize, 0);
245 	}
246 
247 	if (IS_ENABLED(CONFIG_CRYPTO_DEV_SUN4I_SS_DEBUG)) {
248 		algt->stat_req++;
249 		algt->stat_bytes += areq->cryptlen;
250 	}
251 
252 	spin_lock_irqsave(&ss->slock, flags);
253 
254 	for (i = 0; i < op->keylen / 4; i++)
255 		writesl(ss->base + SS_KEY0 + i * 4, &op->key[i], 1);
256 
257 	if (areq->iv) {
258 		for (i = 0; i < 4 && i < ivsize / 4; i++) {
259 			v = *(u32 *)(areq->iv + i * 4);
260 			writesl(ss->base + SS_IV0 + i * 4, &v, 1);
261 		}
262 	}
263 	writel(mode, ss->base + SS_CTL);
264 
265 	ileft = areq->cryptlen;
266 	oleft = areq->cryptlen;
267 	oi = 0;
268 	oo = 0;
269 
270 	while (oleft) {
271 		if (ileft) {
272 			sg_miter_start(&mi, areq->src, sg_nents(areq->src),
273 				       SG_MITER_FROM_SG | SG_MITER_ATOMIC);
274 			if (pi)
275 				sg_miter_skip(&mi, pi);
276 			miter_err = sg_miter_next(&mi);
277 			if (!miter_err || !mi.addr) {
278 				dev_err_ratelimited(ss->dev, "ERROR: sg_miter return null\n");
279 				err = -EINVAL;
280 				goto release_ss;
281 			}
282 			/*
283 			 * todo is the number of consecutive 4byte word that we
284 			 * can read from current SG
285 			 */
286 			todo = min(rx_cnt, ileft / 4);
287 			todo = min_t(size_t, todo, (mi.length - oi) / 4);
288 			if (todo && !ob) {
289 				writesl(ss->base + SS_RXFIFO, mi.addr + oi,
290 					todo);
291 				ileft -= todo * 4;
292 				oi += todo * 4;
293 			} else {
294 				/*
295 				 * not enough consecutive bytes, so we need to
296 				 * linearize in buf. todo is in bytes
297 				 * After that copy, if we have a multiple of 4
298 				 * we need to be able to write all buf in one
299 				 * pass, so it is why we min() with rx_cnt
300 				 */
301 				todo = min(rx_cnt * 4 - ob, ileft);
302 				todo = min_t(size_t, todo, mi.length - oi);
303 				memcpy(ss->buf + ob, mi.addr + oi, todo);
304 				ileft -= todo;
305 				oi += todo;
306 				ob += todo;
307 				if (!(ob % 4)) {
308 					writesl(ss->base + SS_RXFIFO, ss->buf,
309 						ob / 4);
310 					ob = 0;
311 				}
312 			}
313 			if (oi == mi.length) {
314 				pi += mi.length;
315 				oi = 0;
316 			}
317 			sg_miter_stop(&mi);
318 		}
319 
320 		spaces = readl(ss->base + SS_FCSR);
321 		rx_cnt = SS_RXFIFO_SPACES(spaces);
322 		tx_cnt = SS_TXFIFO_SPACES(spaces);
323 
324 		if (!tx_cnt)
325 			continue;
326 		sg_miter_start(&mo, areq->dst, sg_nents(areq->dst),
327 			       SG_MITER_TO_SG | SG_MITER_ATOMIC);
328 		if (po)
329 			sg_miter_skip(&mo, po);
330 		miter_err = sg_miter_next(&mo);
331 		if (!miter_err || !mo.addr) {
332 			dev_err_ratelimited(ss->dev, "ERROR: sg_miter return null\n");
333 			err = -EINVAL;
334 			goto release_ss;
335 		}
336 		/* todo in 4bytes word */
337 		todo = min(tx_cnt, oleft / 4);
338 		todo = min_t(size_t, todo, (mo.length - oo) / 4);
339 
340 		if (todo) {
341 			readsl(ss->base + SS_TXFIFO, mo.addr + oo, todo);
342 			oleft -= todo * 4;
343 			oo += todo * 4;
344 			if (oo == mo.length) {
345 				po += mo.length;
346 				oo = 0;
347 			}
348 		} else {
349 			/*
350 			 * read obl bytes in bufo, we read at maximum for
351 			 * emptying the device
352 			 */
353 			readsl(ss->base + SS_TXFIFO, ss->bufo, tx_cnt);
354 			obl = tx_cnt * 4;
355 			obo = 0;
356 			do {
357 				/*
358 				 * how many bytes we can copy ?
359 				 * no more than remaining SG size
360 				 * no more than remaining buffer
361 				 * no need to test against oleft
362 				 */
363 				todo = min_t(size_t,
364 					     mo.length - oo, obl - obo);
365 				memcpy(mo.addr + oo, ss->bufo + obo, todo);
366 				oleft -= todo;
367 				obo += todo;
368 				oo += todo;
369 				if (oo == mo.length) {
370 					po += mo.length;
371 					sg_miter_next(&mo);
372 					oo = 0;
373 				}
374 			} while (obo < obl);
375 			/* bufo must be fully used here */
376 		}
377 		sg_miter_stop(&mo);
378 	}
379 	if (areq->iv) {
380 		if (mode & SS_DECRYPTION) {
381 			memcpy(areq->iv, ctx->backup_iv, ivsize);
382 			memzero_explicit(ctx->backup_iv, ivsize);
383 		} else {
384 			scatterwalk_map_and_copy(areq->iv, areq->dst, areq->cryptlen - ivsize,
385 						 ivsize, 0);
386 		}
387 	}
388 
389 release_ss:
390 	writel(0, ss->base + SS_CTL);
391 	spin_unlock_irqrestore(&ss->slock, flags);
392 
393 	return err;
394 }
395 
396 /* CBC AES */
sun4i_ss_cbc_aes_encrypt(struct skcipher_request * areq)397 int sun4i_ss_cbc_aes_encrypt(struct skcipher_request *areq)
398 {
399 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
400 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
401 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
402 
403 	rctx->mode = SS_OP_AES | SS_CBC | SS_ENABLED | SS_ENCRYPTION |
404 		op->keymode;
405 	return sun4i_ss_cipher_poll(areq);
406 }
407 
sun4i_ss_cbc_aes_decrypt(struct skcipher_request * areq)408 int sun4i_ss_cbc_aes_decrypt(struct skcipher_request *areq)
409 {
410 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
411 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
412 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
413 
414 	rctx->mode = SS_OP_AES | SS_CBC | SS_ENABLED | SS_DECRYPTION |
415 		op->keymode;
416 	return sun4i_ss_cipher_poll(areq);
417 }
418 
419 /* ECB AES */
sun4i_ss_ecb_aes_encrypt(struct skcipher_request * areq)420 int sun4i_ss_ecb_aes_encrypt(struct skcipher_request *areq)
421 {
422 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
423 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
424 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
425 
426 	rctx->mode = SS_OP_AES | SS_ECB | SS_ENABLED | SS_ENCRYPTION |
427 		op->keymode;
428 	return sun4i_ss_cipher_poll(areq);
429 }
430 
sun4i_ss_ecb_aes_decrypt(struct skcipher_request * areq)431 int sun4i_ss_ecb_aes_decrypt(struct skcipher_request *areq)
432 {
433 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
434 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
435 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
436 
437 	rctx->mode = SS_OP_AES | SS_ECB | SS_ENABLED | SS_DECRYPTION |
438 		op->keymode;
439 	return sun4i_ss_cipher_poll(areq);
440 }
441 
442 /* CBC DES */
sun4i_ss_cbc_des_encrypt(struct skcipher_request * areq)443 int sun4i_ss_cbc_des_encrypt(struct skcipher_request *areq)
444 {
445 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
446 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
447 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
448 
449 	rctx->mode = SS_OP_DES | SS_CBC | SS_ENABLED | SS_ENCRYPTION |
450 		op->keymode;
451 	return sun4i_ss_cipher_poll(areq);
452 }
453 
sun4i_ss_cbc_des_decrypt(struct skcipher_request * areq)454 int sun4i_ss_cbc_des_decrypt(struct skcipher_request *areq)
455 {
456 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
457 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
458 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
459 
460 	rctx->mode = SS_OP_DES | SS_CBC | SS_ENABLED | SS_DECRYPTION |
461 		op->keymode;
462 	return sun4i_ss_cipher_poll(areq);
463 }
464 
465 /* ECB DES */
sun4i_ss_ecb_des_encrypt(struct skcipher_request * areq)466 int sun4i_ss_ecb_des_encrypt(struct skcipher_request *areq)
467 {
468 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
469 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
470 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
471 
472 	rctx->mode = SS_OP_DES | SS_ECB | SS_ENABLED | SS_ENCRYPTION |
473 		op->keymode;
474 	return sun4i_ss_cipher_poll(areq);
475 }
476 
sun4i_ss_ecb_des_decrypt(struct skcipher_request * areq)477 int sun4i_ss_ecb_des_decrypt(struct skcipher_request *areq)
478 {
479 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
480 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
481 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
482 
483 	rctx->mode = SS_OP_DES | SS_ECB | SS_ENABLED | SS_DECRYPTION |
484 		op->keymode;
485 	return sun4i_ss_cipher_poll(areq);
486 }
487 
488 /* CBC 3DES */
sun4i_ss_cbc_des3_encrypt(struct skcipher_request * areq)489 int sun4i_ss_cbc_des3_encrypt(struct skcipher_request *areq)
490 {
491 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
492 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
493 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
494 
495 	rctx->mode = SS_OP_3DES | SS_CBC | SS_ENABLED | SS_ENCRYPTION |
496 		op->keymode;
497 	return sun4i_ss_cipher_poll(areq);
498 }
499 
sun4i_ss_cbc_des3_decrypt(struct skcipher_request * areq)500 int sun4i_ss_cbc_des3_decrypt(struct skcipher_request *areq)
501 {
502 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
503 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
504 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
505 
506 	rctx->mode = SS_OP_3DES | SS_CBC | SS_ENABLED | SS_DECRYPTION |
507 		op->keymode;
508 	return sun4i_ss_cipher_poll(areq);
509 }
510 
511 /* ECB 3DES */
sun4i_ss_ecb_des3_encrypt(struct skcipher_request * areq)512 int sun4i_ss_ecb_des3_encrypt(struct skcipher_request *areq)
513 {
514 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
515 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
516 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
517 
518 	rctx->mode = SS_OP_3DES | SS_ECB | SS_ENABLED | SS_ENCRYPTION |
519 		op->keymode;
520 	return sun4i_ss_cipher_poll(areq);
521 }
522 
sun4i_ss_ecb_des3_decrypt(struct skcipher_request * areq)523 int sun4i_ss_ecb_des3_decrypt(struct skcipher_request *areq)
524 {
525 	struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(areq);
526 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
527 	struct sun4i_cipher_req_ctx *rctx = skcipher_request_ctx(areq);
528 
529 	rctx->mode = SS_OP_3DES | SS_ECB | SS_ENABLED | SS_DECRYPTION |
530 		op->keymode;
531 	return sun4i_ss_cipher_poll(areq);
532 }
533 
sun4i_ss_cipher_init(struct crypto_tfm * tfm)534 int sun4i_ss_cipher_init(struct crypto_tfm *tfm)
535 {
536 	struct sun4i_tfm_ctx *op = crypto_tfm_ctx(tfm);
537 	struct sun4i_ss_alg_template *algt;
538 	const char *name = crypto_tfm_alg_name(tfm);
539 	int err;
540 
541 	memset(op, 0, sizeof(struct sun4i_tfm_ctx));
542 
543 	algt = container_of(tfm->__crt_alg, struct sun4i_ss_alg_template,
544 			    alg.crypto.base);
545 	op->ss = algt->ss;
546 
547 	op->fallback_tfm = crypto_alloc_skcipher(name, 0, CRYPTO_ALG_NEED_FALLBACK);
548 	if (IS_ERR(op->fallback_tfm)) {
549 		dev_err(op->ss->dev, "ERROR: Cannot allocate fallback for %s %ld\n",
550 			name, PTR_ERR(op->fallback_tfm));
551 		return PTR_ERR(op->fallback_tfm);
552 	}
553 
554 	crypto_skcipher_set_reqsize(__crypto_skcipher_cast(tfm),
555 				    sizeof(struct sun4i_cipher_req_ctx) +
556 				    crypto_skcipher_reqsize(op->fallback_tfm));
557 
558 	err = pm_runtime_resume_and_get(op->ss->dev);
559 	if (err < 0)
560 		goto error_pm;
561 
562 	return 0;
563 error_pm:
564 	crypto_free_skcipher(op->fallback_tfm);
565 	return err;
566 }
567 
sun4i_ss_cipher_exit(struct crypto_tfm * tfm)568 void sun4i_ss_cipher_exit(struct crypto_tfm *tfm)
569 {
570 	struct sun4i_tfm_ctx *op = crypto_tfm_ctx(tfm);
571 
572 	crypto_free_skcipher(op->fallback_tfm);
573 	pm_runtime_put(op->ss->dev);
574 }
575 
576 /* check and set the AES key, prepare the mode to be used */
sun4i_ss_aes_setkey(struct crypto_skcipher * tfm,const u8 * key,unsigned int keylen)577 int sun4i_ss_aes_setkey(struct crypto_skcipher *tfm, const u8 *key,
578 			unsigned int keylen)
579 {
580 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
581 	struct sun4i_ss_ctx *ss = op->ss;
582 
583 	switch (keylen) {
584 	case 128 / 8:
585 		op->keymode = SS_AES_128BITS;
586 		break;
587 	case 192 / 8:
588 		op->keymode = SS_AES_192BITS;
589 		break;
590 	case 256 / 8:
591 		op->keymode = SS_AES_256BITS;
592 		break;
593 	default:
594 		dev_dbg(ss->dev, "ERROR: Invalid keylen %u\n", keylen);
595 		return -EINVAL;
596 	}
597 	op->keylen = keylen;
598 	memcpy(op->key, key, keylen);
599 
600 	crypto_skcipher_clear_flags(op->fallback_tfm, CRYPTO_TFM_REQ_MASK);
601 	crypto_skcipher_set_flags(op->fallback_tfm, tfm->base.crt_flags & CRYPTO_TFM_REQ_MASK);
602 
603 	return crypto_skcipher_setkey(op->fallback_tfm, key, keylen);
604 }
605 
606 /* check and set the DES key, prepare the mode to be used */
sun4i_ss_des_setkey(struct crypto_skcipher * tfm,const u8 * key,unsigned int keylen)607 int sun4i_ss_des_setkey(struct crypto_skcipher *tfm, const u8 *key,
608 			unsigned int keylen)
609 {
610 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
611 	int err;
612 
613 	err = verify_skcipher_des_key(tfm, key);
614 	if (err)
615 		return err;
616 
617 	op->keylen = keylen;
618 	memcpy(op->key, key, keylen);
619 
620 	crypto_skcipher_clear_flags(op->fallback_tfm, CRYPTO_TFM_REQ_MASK);
621 	crypto_skcipher_set_flags(op->fallback_tfm, tfm->base.crt_flags & CRYPTO_TFM_REQ_MASK);
622 
623 	return crypto_skcipher_setkey(op->fallback_tfm, key, keylen);
624 }
625 
626 /* check and set the 3DES key, prepare the mode to be used */
sun4i_ss_des3_setkey(struct crypto_skcipher * tfm,const u8 * key,unsigned int keylen)627 int sun4i_ss_des3_setkey(struct crypto_skcipher *tfm, const u8 *key,
628 			 unsigned int keylen)
629 {
630 	struct sun4i_tfm_ctx *op = crypto_skcipher_ctx(tfm);
631 	int err;
632 
633 	err = verify_skcipher_des3_key(tfm, key);
634 	if (err)
635 		return err;
636 
637 	op->keylen = keylen;
638 	memcpy(op->key, key, keylen);
639 
640 	crypto_skcipher_clear_flags(op->fallback_tfm, CRYPTO_TFM_REQ_MASK);
641 	crypto_skcipher_set_flags(op->fallback_tfm, tfm->base.crt_flags & CRYPTO_TFM_REQ_MASK);
642 
643 	return crypto_skcipher_setkey(op->fallback_tfm, key, keylen);
644 }
645