cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

nx-aes-gcm.c (13333B)


      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};