506 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * AES GCM routines supporting the Power 7+ Nest Accelerators driver4 *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 else143 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 else210 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 mode253 * may be used. Set the source data to be a single block (16B) of all254 * zeros, and set the input IV value to be the same as the GMAC IV255 * 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 else264 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 safe300 * 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 else328 rc = gmac(req, rctx->iv, assoclen);329 if (rc)330 goto out;331 else332 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 else368 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