1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * AES GCM routines supporting the Power 7+ Nest Accelerators driver
4 *
5 * Copyright (C) 2012 International Business Machines Inc.
6 *
7 * Author: Kent Yoder <yoder1@us.ibm.com>
8 */
9
10#include <crypto/internal/aead.h>
11#include <crypto/aes.h>
12#include <crypto/algapi.h>
13#include <crypto/gcm.h>
14#include <crypto/scatterwalk.h>
15#include <linux/module.h>
16#include <linux/types.h>
17#include <asm/vio.h>
18
19#include "nx_csbcpb.h"
20#include "nx.h"
21
22
23static int gcm_aes_nx_set_key(struct crypto_aead *tfm,
24			      const u8           *in_key,
25			      unsigned int        key_len)
26{
27	struct nx_crypto_ctx *nx_ctx = crypto_aead_ctx(tfm);
28	struct nx_csbcpb *csbcpb = nx_ctx->csbcpb;
29	struct nx_csbcpb *csbcpb_aead = nx_ctx->csbcpb_aead;
30
31	nx_ctx_init(nx_ctx, HCOP_FC_AES);
32
33	switch (key_len) {
34	case AES_KEYSIZE_128:
35		NX_CPB_SET_KEY_SIZE(csbcpb, NX_KS_AES_128);
36		NX_CPB_SET_KEY_SIZE(csbcpb_aead, NX_KS_AES_128);
37		nx_ctx->ap = &nx_ctx->props[NX_PROPS_AES_128];
38		break;
39	case AES_KEYSIZE_192:
40		NX_CPB_SET_KEY_SIZE(csbcpb, NX_KS_AES_192);
41		NX_CPB_SET_KEY_SIZE(csbcpb_aead, NX_KS_AES_192);
42		nx_ctx->ap = &nx_ctx->props[NX_PROPS_AES_192];
43		break;
44	case AES_KEYSIZE_256:
45		NX_CPB_SET_KEY_SIZE(csbcpb, NX_KS_AES_256);
46		NX_CPB_SET_KEY_SIZE(csbcpb_aead, NX_KS_AES_256);
47		nx_ctx->ap = &nx_ctx->props[NX_PROPS_AES_256];
48		break;
49	default:
50		return -EINVAL;
51	}
52
53	csbcpb->cpb.hdr.mode = NX_MODE_AES_GCM;
54	memcpy(csbcpb->cpb.aes_gcm.key, in_key, key_len);
55
56	csbcpb_aead->cpb.hdr.mode = NX_MODE_AES_GCA;
57	memcpy(csbcpb_aead->cpb.aes_gca.key, in_key, key_len);
58
59	return 0;
60}
61
62static int gcm4106_aes_nx_set_key(struct crypto_aead *tfm,
63				  const u8           *in_key,
64				  unsigned int        key_len)
65{
66	struct nx_crypto_ctx *nx_ctx = crypto_aead_ctx(tfm);
67	char *nonce = nx_ctx->priv.gcm.nonce;
68	int rc;
69
70	if (key_len < 4)
71		return -EINVAL;
72
73	key_len -= 4;
74
75	rc = gcm_aes_nx_set_key(tfm, in_key, key_len);
76	if (rc)
77		goto out;
78
79	memcpy(nonce, in_key + key_len, 4);
80out:
81	return rc;
82}
83
84static int gcm4106_aes_nx_setauthsize(struct crypto_aead *tfm,
85				      unsigned int authsize)
86{
87	switch (authsize) {
88	case 8:
89	case 12:
90	case 16:
91		break;
92	default:
93		return -EINVAL;
94	}
95
96	return 0;
97}
98
99static int nx_gca(struct nx_crypto_ctx  *nx_ctx,
100		  struct aead_request   *req,
101		  u8                    *out,
102		  unsigned int assoclen)
103{
104	int rc;
105	struct nx_csbcpb *csbcpb_aead = nx_ctx->csbcpb_aead;
106	struct scatter_walk walk;
107	struct nx_sg *nx_sg = nx_ctx->in_sg;
108	unsigned int nbytes = assoclen;
109	unsigned int processed = 0, to_process;
110	unsigned int max_sg_len;
111
112	if (nbytes <= AES_BLOCK_SIZE) {
113		scatterwalk_start(&walk, req->src);
114		scatterwalk_copychunks(out, &walk, nbytes, SCATTERWALK_FROM_SG);
115		scatterwalk_done(&walk, SCATTERWALK_FROM_SG, 0);
116		return 0;
117	}
118
119	NX_CPB_FDM(csbcpb_aead) &= ~NX_FDM_CONTINUATION;
120
121	/* page_limit: number of sg entries that fit on one page */
122	max_sg_len = min_t(u64, nx_driver.of.max_sg_len/sizeof(struct nx_sg),
123			   nx_ctx->ap->sglen);
124	max_sg_len = min_t(u64, max_sg_len,
125			   nx_ctx->ap->databytelen/NX_PAGE_SIZE);
126
127	do {
128		/*
129		 * to_process: the data chunk to process in this update.
130		 * This value is bound by sg list limits.
131		 */
132		to_process = min_t(u64, nbytes - processed,
133				   nx_ctx->ap->databytelen);
134		to_process = min_t(u64, to_process,
135				   NX_PAGE_SIZE * (max_sg_len - 1));
136
137		nx_sg = nx_walk_and_build(nx_ctx->in_sg, max_sg_len,
138					  req->src, processed, &to_process);
139
140		if ((to_process + processed) < nbytes)
141			NX_CPB_FDM(csbcpb_aead) |= NX_FDM_INTERMEDIATE;
142		else
143			NX_CPB_FDM(csbcpb_aead) &= ~NX_FDM_INTERMEDIATE;
144
145		nx_ctx->op_aead.inlen = (nx_ctx->in_sg - nx_sg)
146					* sizeof(struct nx_sg);
147
148		rc = nx_hcall_sync(nx_ctx, &nx_ctx->op_aead,
149				req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP);
150		if (rc)
151			return rc;
152
153		memcpy(csbcpb_aead->cpb.aes_gca.in_pat,
154				csbcpb_aead->cpb.aes_gca.out_pat,
155				AES_BLOCK_SIZE);
156		NX_CPB_FDM(csbcpb_aead) |= NX_FDM_CONTINUATION;
157
158		atomic_inc(&(nx_ctx->stats->aes_ops));
159		atomic64_add(assoclen, &(nx_ctx->stats->aes_bytes));
160
161		processed += to_process;
162	} while (processed < nbytes);
163
164	memcpy(out, csbcpb_aead->cpb.aes_gca.out_pat, AES_BLOCK_SIZE);
165
166	return rc;
167}
168
169static int gmac(struct aead_request *req, const u8 *iv, unsigned int assoclen)
170{
171	int rc;
172	struct nx_crypto_ctx *nx_ctx =
173		crypto_aead_ctx(crypto_aead_reqtfm(req));
174	struct nx_csbcpb *csbcpb = nx_ctx->csbcpb;
175	struct nx_sg *nx_sg;
176	unsigned int nbytes = assoclen;
177	unsigned int processed = 0, to_process;
178	unsigned int max_sg_len;
179
180	/* Set GMAC mode */
181	csbcpb->cpb.hdr.mode = NX_MODE_AES_GMAC;
182
183	NX_CPB_FDM(csbcpb) &= ~NX_FDM_CONTINUATION;
184
185	/* page_limit: number of sg entries that fit on one page */
186	max_sg_len = min_t(u64, nx_driver.of.max_sg_len/sizeof(struct nx_sg),
187			   nx_ctx->ap->sglen);
188	max_sg_len = min_t(u64, max_sg_len,
189			   nx_ctx->ap->databytelen/NX_PAGE_SIZE);
190
191	/* Copy IV */
192	memcpy(csbcpb->cpb.aes_gcm.iv_or_cnt, iv, AES_BLOCK_SIZE);
193
194	do {
195		/*
196		 * to_process: the data chunk to process in this update.
197		 * This value is bound by sg list limits.
198		 */
199		to_process = min_t(u64, nbytes - processed,
200				   nx_ctx->ap->databytelen);
201		to_process = min_t(u64, to_process,
202				   NX_PAGE_SIZE * (max_sg_len - 1));
203
204		nx_sg = nx_walk_and_build(nx_ctx->in_sg, max_sg_len,
205					  req->src, processed, &to_process);
206
207		if ((to_process + processed) < nbytes)
208			NX_CPB_FDM(csbcpb) |= NX_FDM_INTERMEDIATE;
209		else
210			NX_CPB_FDM(csbcpb) &= ~NX_FDM_INTERMEDIATE;
211
212		nx_ctx->op.inlen = (nx_ctx->in_sg - nx_sg)
213					* sizeof(struct nx_sg);
214
215		csbcpb->cpb.aes_gcm.bit_length_data = 0;
216		csbcpb->cpb.aes_gcm.bit_length_aad = 8 * nbytes;
217
218		rc = nx_hcall_sync(nx_ctx, &nx_ctx->op,
219				req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP);
220		if (rc)
221			goto out;
222
223		memcpy(csbcpb->cpb.aes_gcm.in_pat_or_aad,
224			csbcpb->cpb.aes_gcm.out_pat_or_mac, AES_BLOCK_SIZE);
225		memcpy(csbcpb->cpb.aes_gcm.in_s0,
226			csbcpb->cpb.aes_gcm.out_s0, AES_BLOCK_SIZE);
227
228		NX_CPB_FDM(csbcpb) |= NX_FDM_CONTINUATION;
229
230		atomic_inc(&(nx_ctx->stats->aes_ops));
231		atomic64_add(assoclen, &(nx_ctx->stats->aes_bytes));
232
233		processed += to_process;
234	} while (processed < nbytes);
235
236out:
237	/* Restore GCM mode */
238	csbcpb->cpb.hdr.mode = NX_MODE_AES_GCM;
239	return rc;
240}
241
242static int gcm_empty(struct aead_request *req, const u8 *iv, int enc)
243{
244	int rc;
245	struct nx_crypto_ctx *nx_ctx =
246		crypto_aead_ctx(crypto_aead_reqtfm(req));
247	struct nx_csbcpb *csbcpb = nx_ctx->csbcpb;
248	char out[AES_BLOCK_SIZE];
249	struct nx_sg *in_sg, *out_sg;
250	int len;
251
252	/* For scenarios where the input message is zero length, AES CTR mode
253	 * may be used. Set the source data to be a single block (16B) of all
254	 * zeros, and set the input IV value to be the same as the GMAC IV
255	 * value. - nx_wb 4.8.1.3 */
256
257	/* Change to ECB mode */
258	csbcpb->cpb.hdr.mode = NX_MODE_AES_ECB;
259	memcpy(csbcpb->cpb.aes_ecb.key, csbcpb->cpb.aes_gcm.key,
260			sizeof(csbcpb->cpb.aes_ecb.key));
261	if (enc)
262		NX_CPB_FDM(csbcpb) |= NX_FDM_ENDE_ENCRYPT;
263	else
264		NX_CPB_FDM(csbcpb) &= ~NX_FDM_ENDE_ENCRYPT;
265
266	len = AES_BLOCK_SIZE;
267
268	/* Encrypt the counter/IV */
269	in_sg = nx_build_sg_list(nx_ctx->in_sg, (u8 *) iv,
270				 &len, nx_ctx->ap->sglen);
271
272	if (len != AES_BLOCK_SIZE)
273		return -EINVAL;
274
275	len = sizeof(out);
276	out_sg = nx_build_sg_list(nx_ctx->out_sg, (u8 *) out, &len,
277				  nx_ctx->ap->sglen);
278
279	if (len != sizeof(out))
280		return -EINVAL;
281
282	nx_ctx->op.inlen = (nx_ctx->in_sg - in_sg) * sizeof(struct nx_sg);
283	nx_ctx->op.outlen = (nx_ctx->out_sg - out_sg) * sizeof(struct nx_sg);
284
285	rc = nx_hcall_sync(nx_ctx, &nx_ctx->op,
286			   req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP);
287	if (rc)
288		goto out;
289	atomic_inc(&(nx_ctx->stats->aes_ops));
290
291	/* Copy out the auth tag */
292	memcpy(csbcpb->cpb.aes_gcm.out_pat_or_mac, out,
293			crypto_aead_authsize(crypto_aead_reqtfm(req)));
294out:
295	/* Restore XCBC mode */
296	csbcpb->cpb.hdr.mode = NX_MODE_AES_GCM;
297
298	/*
299	 * ECB key uses the same region that GCM AAD and counter, so it's safe
300	 * to just fill it with zeroes.
301	 */
302	memset(csbcpb->cpb.aes_ecb.key, 0, sizeof(csbcpb->cpb.aes_ecb.key));
303
304	return rc;
305}
306
307static int gcm_aes_nx_crypt(struct aead_request *req, int enc,
308			    unsigned int assoclen)
309{
310	struct nx_crypto_ctx *nx_ctx =
311		crypto_aead_ctx(crypto_aead_reqtfm(req));
312	struct nx_gcm_rctx *rctx = aead_request_ctx(req);
313	struct nx_csbcpb *csbcpb = nx_ctx->csbcpb;
314	unsigned int nbytes = req->cryptlen;
315	unsigned int processed = 0, to_process;
316	unsigned long irq_flags;
317	int rc = -EINVAL;
318
319	spin_lock_irqsave(&nx_ctx->lock, irq_flags);
320
321	/* initialize the counter */
322	*(u32 *)&rctx->iv[NX_GCM_CTR_OFFSET] = 1;
323
324	if (nbytes == 0) {
325		if (assoclen == 0)
326			rc = gcm_empty(req, rctx->iv, enc);
327		else
328			rc = gmac(req, rctx->iv, assoclen);
329		if (rc)
330			goto out;
331		else
332			goto mac;
333	}
334
335	/* Process associated data */
336	csbcpb->cpb.aes_gcm.bit_length_aad = assoclen * 8;
337	if (assoclen) {
338		rc = nx_gca(nx_ctx, req, csbcpb->cpb.aes_gcm.in_pat_or_aad,
339			    assoclen);
340		if (rc)
341			goto out;
342	}
343
344	/* Set flags for encryption */
345	NX_CPB_FDM(csbcpb) &= ~NX_FDM_CONTINUATION;
346	if (enc) {
347		NX_CPB_FDM(csbcpb) |= NX_FDM_ENDE_ENCRYPT;
348	} else {
349		NX_CPB_FDM(csbcpb) &= ~NX_FDM_ENDE_ENCRYPT;
350		nbytes -= crypto_aead_authsize(crypto_aead_reqtfm(req));
351	}
352
353	do {
354		to_process = nbytes - processed;
355
356		csbcpb->cpb.aes_gcm.bit_length_data = nbytes * 8;
357		rc = nx_build_sg_lists(nx_ctx, rctx->iv, req->dst,
358				       req->src, &to_process,
359				       processed + req->assoclen,
360				       csbcpb->cpb.aes_gcm.iv_or_cnt);
361
362		if (rc)
363			goto out;
364
365		if ((to_process + processed) < nbytes)
366			NX_CPB_FDM(csbcpb) |= NX_FDM_INTERMEDIATE;
367		else
368			NX_CPB_FDM(csbcpb) &= ~NX_FDM_INTERMEDIATE;
369
370
371		rc = nx_hcall_sync(nx_ctx, &nx_ctx->op,
372				   req->base.flags & CRYPTO_TFM_REQ_MAY_SLEEP);
373		if (rc)
374			goto out;
375
376		memcpy(rctx->iv, csbcpb->cpb.aes_gcm.out_cnt, AES_BLOCK_SIZE);
377		memcpy(csbcpb->cpb.aes_gcm.in_pat_or_aad,
378			csbcpb->cpb.aes_gcm.out_pat_or_mac, AES_BLOCK_SIZE);
379		memcpy(csbcpb->cpb.aes_gcm.in_s0,
380			csbcpb->cpb.aes_gcm.out_s0, AES_BLOCK_SIZE);
381
382		NX_CPB_FDM(csbcpb) |= NX_FDM_CONTINUATION;
383
384		atomic_inc(&(nx_ctx->stats->aes_ops));
385		atomic64_add(be32_to_cpu(csbcpb->csb.processed_byte_count),
386			     &(nx_ctx->stats->aes_bytes));
387
388		processed += to_process;
389	} while (processed < nbytes);
390
391mac:
392	if (enc) {
393		/* copy out the auth tag */
394		scatterwalk_map_and_copy(
395			csbcpb->cpb.aes_gcm.out_pat_or_mac,
396			req->dst, req->assoclen + nbytes,
397			crypto_aead_authsize(crypto_aead_reqtfm(req)),
398			SCATTERWALK_TO_SG);
399	} else {
400		u8 *itag = nx_ctx->priv.gcm.iauth_tag;
401		u8 *otag = csbcpb->cpb.aes_gcm.out_pat_or_mac;
402
403		scatterwalk_map_and_copy(
404			itag, req->src, req->assoclen + nbytes,
405			crypto_aead_authsize(crypto_aead_reqtfm(req)),
406			SCATTERWALK_FROM_SG);
407		rc = crypto_memneq(itag, otag,
408			    crypto_aead_authsize(crypto_aead_reqtfm(req))) ?
409		     -EBADMSG : 0;
410	}
411out:
412	spin_unlock_irqrestore(&nx_ctx->lock, irq_flags);
413	return rc;
414}
415
416static int gcm_aes_nx_encrypt(struct aead_request *req)
417{
418	struct nx_gcm_rctx *rctx = aead_request_ctx(req);
419	char *iv = rctx->iv;
420
421	memcpy(iv, req->iv, GCM_AES_IV_SIZE);
422
423	return gcm_aes_nx_crypt(req, 1, req->assoclen);
424}
425
426static int gcm_aes_nx_decrypt(struct aead_request *req)
427{
428	struct nx_gcm_rctx *rctx = aead_request_ctx(req);
429	char *iv = rctx->iv;
430
431	memcpy(iv, req->iv, GCM_AES_IV_SIZE);
432
433	return gcm_aes_nx_crypt(req, 0, req->assoclen);
434}
435
436static int gcm4106_aes_nx_encrypt(struct aead_request *req)
437{
438	struct nx_crypto_ctx *nx_ctx =
439		crypto_aead_ctx(crypto_aead_reqtfm(req));
440	struct nx_gcm_rctx *rctx = aead_request_ctx(req);
441	char *iv = rctx->iv;
442	char *nonce = nx_ctx->priv.gcm.nonce;
443
444	memcpy(iv, nonce, NX_GCM4106_NONCE_LEN);
445	memcpy(iv + NX_GCM4106_NONCE_LEN, req->iv, 8);
446
447	if (req->assoclen < 8)
448		return -EINVAL;
449
450	return gcm_aes_nx_crypt(req, 1, req->assoclen - 8);
451}
452
453static int gcm4106_aes_nx_decrypt(struct aead_request *req)
454{
455	struct nx_crypto_ctx *nx_ctx =
456		crypto_aead_ctx(crypto_aead_reqtfm(req));
457	struct nx_gcm_rctx *rctx = aead_request_ctx(req);
458	char *iv = rctx->iv;
459	char *nonce = nx_ctx->priv.gcm.nonce;
460
461	memcpy(iv, nonce, NX_GCM4106_NONCE_LEN);
462	memcpy(iv + NX_GCM4106_NONCE_LEN, req->iv, 8);
463
464	if (req->assoclen < 8)
465		return -EINVAL;
466
467	return gcm_aes_nx_crypt(req, 0, req->assoclen - 8);
468}
469
470struct aead_alg nx_gcm_aes_alg = {
471	.base = {
472		.cra_name        = "gcm(aes)",
473		.cra_driver_name = "gcm-aes-nx",
474		.cra_priority    = 300,
475		.cra_blocksize   = 1,
476		.cra_ctxsize     = sizeof(struct nx_crypto_ctx),
477		.cra_module      = THIS_MODULE,
478	},
479	.init        = nx_crypto_ctx_aes_gcm_init,
480	.exit        = nx_crypto_ctx_aead_exit,
481	.ivsize      = GCM_AES_IV_SIZE,
482	.maxauthsize = AES_BLOCK_SIZE,
483	.setkey      = gcm_aes_nx_set_key,
484	.encrypt     = gcm_aes_nx_encrypt,
485	.decrypt     = gcm_aes_nx_decrypt,
486};
487
488struct aead_alg nx_gcm4106_aes_alg = {
489	.base = {
490		.cra_name        = "rfc4106(gcm(aes))",
491		.cra_driver_name = "rfc4106-gcm-aes-nx",
492		.cra_priority    = 300,
493		.cra_blocksize   = 1,
494		.cra_ctxsize     = sizeof(struct nx_crypto_ctx),
495		.cra_module      = THIS_MODULE,
496	},
497	.init        = nx_crypto_ctx_aes_gcm_init,
498	.exit        = nx_crypto_ctx_aead_exit,
499	.ivsize      = GCM_RFC4106_IV_SIZE,
500	.maxauthsize = AES_BLOCK_SIZE,
501	.setkey      = gcm4106_aes_nx_set_key,
502	.setauthsize = gcm4106_aes_nx_setauthsize,
503	.encrypt     = gcm4106_aes_nx_encrypt,
504	.decrypt     = gcm4106_aes_nx_decrypt,
505};
506