1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Xilinx ZynqMP AES Driver. 4 * Copyright (c) 2020 Xilinx Inc. 5 */ 6 7 #include <crypto/aes.h> 8 #include <crypto/engine.h> 9 #include <crypto/gcm.h> 10 #include <crypto/internal/aead.h> 11 #include <crypto/scatterwalk.h> 12 #include <linux/dma-mapping.h> 13 #include <linux/err.h> 14 #include <linux/firmware/xlnx-zynqmp.h> 15 #include <linux/kernel.h> 16 #include <linux/module.h> 17 #include <linux/mod_devicetable.h> 18 #include <linux/platform_device.h> 19 #include <linux/string.h> 20 21 #define ZYNQMP_DMA_BIT_MASK 32U 22 23 #define ZYNQMP_AES_KEY_SIZE AES_KEYSIZE_256 24 #define ZYNQMP_AES_AUTH_SIZE 16U 25 #define ZYNQMP_KEY_SRC_SEL_KEY_LEN 1U 26 #define ZYNQMP_AES_BLK_SIZE 1U 27 #define ZYNQMP_AES_MIN_INPUT_BLK_SIZE 4U 28 #define ZYNQMP_AES_WORD_LEN 4U 29 30 #define ZYNQMP_AES_GCM_TAG_MISMATCH_ERR 0x01 31 #define ZYNQMP_AES_WRONG_KEY_SRC_ERR 0x13 32 #define ZYNQMP_AES_PUF_NOT_PROGRAMMED 0xE300 33 34 enum zynqmp_aead_op { 35 ZYNQMP_AES_DECRYPT = 0, 36 ZYNQMP_AES_ENCRYPT 37 }; 38 39 enum zynqmp_aead_keysrc { 40 ZYNQMP_AES_KUP_KEY = 0, 41 ZYNQMP_AES_DEV_KEY, 42 ZYNQMP_AES_PUF_KEY 43 }; 44 45 struct zynqmp_aead_drv_ctx { 46 union { 47 struct aead_engine_alg aead; 48 } alg; 49 struct device *dev; 50 struct crypto_engine *engine; 51 }; 52 53 struct zynqmp_aead_hw_req { 54 u64 src; 55 u64 iv; 56 u64 key; 57 u64 dst; 58 u64 size; 59 u64 op; 60 u64 keysrc; 61 }; 62 63 struct zynqmp_aead_tfm_ctx { 64 struct device *dev; 65 u8 key[ZYNQMP_AES_KEY_SIZE]; 66 u8 *iv; 67 u32 keylen; 68 u32 authsize; 69 enum zynqmp_aead_keysrc keysrc; 70 struct crypto_aead *fbk_cipher; 71 }; 72 73 struct zynqmp_aead_req_ctx { 74 enum zynqmp_aead_op op; 75 }; 76 77 static int zynqmp_aes_aead_cipher(struct aead_request *req) 78 { 79 struct crypto_aead *aead = crypto_aead_reqtfm(req); 80 struct zynqmp_aead_tfm_ctx *tfm_ctx = crypto_aead_ctx(aead); 81 struct zynqmp_aead_req_ctx *rq_ctx = aead_request_ctx(req); 82 struct device *dev = tfm_ctx->dev; 83 struct zynqmp_aead_hw_req *hwreq; 84 dma_addr_t dma_addr_data, dma_addr_hw_req; 85 unsigned int data_size; 86 unsigned int status; 87 int ret; 88 size_t dma_size; 89 char *kbuf; 90 int err; 91 92 if (tfm_ctx->keysrc == ZYNQMP_AES_KUP_KEY) 93 dma_size = req->cryptlen + ZYNQMP_AES_KEY_SIZE 94 + GCM_AES_IV_SIZE; 95 else 96 dma_size = req->cryptlen + GCM_AES_IV_SIZE; 97 98 kbuf = dma_alloc_coherent(dev, dma_size, &dma_addr_data, GFP_KERNEL); 99 if (!kbuf) 100 return -ENOMEM; 101 102 hwreq = dma_alloc_coherent(dev, sizeof(struct zynqmp_aead_hw_req), 103 &dma_addr_hw_req, GFP_KERNEL); 104 if (!hwreq) { 105 dma_free_coherent(dev, dma_size, kbuf, dma_addr_data); 106 return -ENOMEM; 107 } 108 109 data_size = req->cryptlen; 110 scatterwalk_map_and_copy(kbuf, req->src, 0, req->cryptlen, 0); 111 memcpy(kbuf + data_size, req->iv, GCM_AES_IV_SIZE); 112 113 hwreq->src = dma_addr_data; 114 hwreq->dst = dma_addr_data; 115 hwreq->iv = hwreq->src + data_size; 116 hwreq->keysrc = tfm_ctx->keysrc; 117 hwreq->op = rq_ctx->op; 118 119 if (hwreq->op == ZYNQMP_AES_ENCRYPT) 120 hwreq->size = data_size; 121 else 122 hwreq->size = data_size - ZYNQMP_AES_AUTH_SIZE; 123 124 if (hwreq->keysrc == ZYNQMP_AES_KUP_KEY) { 125 memcpy(kbuf + data_size + GCM_AES_IV_SIZE, 126 tfm_ctx->key, ZYNQMP_AES_KEY_SIZE); 127 128 hwreq->key = hwreq->src + data_size + GCM_AES_IV_SIZE; 129 } else { 130 hwreq->key = 0; 131 } 132 133 ret = zynqmp_pm_aes_engine(dma_addr_hw_req, &status); 134 135 if (ret) { 136 dev_err(dev, "ERROR: AES PM API failed\n"); 137 err = ret; 138 } else if (status) { 139 switch (status) { 140 case ZYNQMP_AES_GCM_TAG_MISMATCH_ERR: 141 dev_err(dev, "ERROR: Gcm Tag mismatch\n"); 142 break; 143 case ZYNQMP_AES_WRONG_KEY_SRC_ERR: 144 dev_err(dev, "ERROR: Wrong KeySrc, enable secure mode\n"); 145 break; 146 case ZYNQMP_AES_PUF_NOT_PROGRAMMED: 147 dev_err(dev, "ERROR: PUF is not registered\n"); 148 break; 149 default: 150 dev_err(dev, "ERROR: Unknown error\n"); 151 break; 152 } 153 err = -status; 154 } else { 155 if (hwreq->op == ZYNQMP_AES_ENCRYPT) 156 data_size = data_size + ZYNQMP_AES_AUTH_SIZE; 157 else 158 data_size = data_size - ZYNQMP_AES_AUTH_SIZE; 159 160 sg_copy_from_buffer(req->dst, sg_nents(req->dst), 161 kbuf, data_size); 162 err = 0; 163 } 164 165 if (kbuf) { 166 memzero_explicit(kbuf, dma_size); 167 dma_free_coherent(dev, dma_size, kbuf, dma_addr_data); 168 } 169 if (hwreq) { 170 memzero_explicit(hwreq, sizeof(struct zynqmp_aead_hw_req)); 171 dma_free_coherent(dev, sizeof(struct zynqmp_aead_hw_req), 172 hwreq, dma_addr_hw_req); 173 } 174 return err; 175 } 176 177 static int zynqmp_fallback_check(struct zynqmp_aead_tfm_ctx *tfm_ctx, 178 struct aead_request *req) 179 { 180 int need_fallback = 0; 181 struct zynqmp_aead_req_ctx *rq_ctx = aead_request_ctx(req); 182 183 if (tfm_ctx->authsize != ZYNQMP_AES_AUTH_SIZE) 184 need_fallback = 1; 185 186 if (tfm_ctx->keysrc == ZYNQMP_AES_KUP_KEY && 187 tfm_ctx->keylen != ZYNQMP_AES_KEY_SIZE) { 188 need_fallback = 1; 189 } 190 if (req->assoclen != 0 || 191 req->cryptlen < ZYNQMP_AES_MIN_INPUT_BLK_SIZE) { 192 need_fallback = 1; 193 } 194 if ((req->cryptlen % ZYNQMP_AES_WORD_LEN) != 0) 195 need_fallback = 1; 196 197 if (rq_ctx->op == ZYNQMP_AES_DECRYPT && 198 req->cryptlen <= ZYNQMP_AES_AUTH_SIZE) { 199 need_fallback = 1; 200 } 201 return need_fallback; 202 } 203 204 static int zynqmp_handle_aes_req(struct crypto_engine *engine, 205 void *req) 206 { 207 struct aead_request *areq = 208 container_of(req, struct aead_request, base); 209 struct crypto_aead *aead = crypto_aead_reqtfm(req); 210 struct zynqmp_aead_tfm_ctx *tfm_ctx = crypto_aead_ctx(aead); 211 struct zynqmp_aead_req_ctx *rq_ctx = aead_request_ctx(areq); 212 struct aead_request *subreq = aead_request_ctx(req); 213 int need_fallback; 214 int err; 215 216 need_fallback = zynqmp_fallback_check(tfm_ctx, areq); 217 218 if (need_fallback) { 219 aead_request_set_tfm(subreq, tfm_ctx->fbk_cipher); 220 221 aead_request_set_callback(subreq, areq->base.flags, 222 NULL, NULL); 223 aead_request_set_crypt(subreq, areq->src, areq->dst, 224 areq->cryptlen, areq->iv); 225 aead_request_set_ad(subreq, areq->assoclen); 226 if (rq_ctx->op == ZYNQMP_AES_ENCRYPT) 227 err = crypto_aead_encrypt(subreq); 228 else 229 err = crypto_aead_decrypt(subreq); 230 } else { 231 err = zynqmp_aes_aead_cipher(areq); 232 } 233 234 crypto_finalize_aead_request(engine, areq, err); 235 return 0; 236 } 237 238 static int zynqmp_aes_aead_setkey(struct crypto_aead *aead, const u8 *key, 239 unsigned int keylen) 240 { 241 struct crypto_tfm *tfm = crypto_aead_tfm(aead); 242 struct zynqmp_aead_tfm_ctx *tfm_ctx = 243 (struct zynqmp_aead_tfm_ctx *)crypto_tfm_ctx(tfm); 244 unsigned char keysrc; 245 246 if (keylen == ZYNQMP_KEY_SRC_SEL_KEY_LEN) { 247 keysrc = *key; 248 if (keysrc == ZYNQMP_AES_KUP_KEY || 249 keysrc == ZYNQMP_AES_DEV_KEY || 250 keysrc == ZYNQMP_AES_PUF_KEY) { 251 tfm_ctx->keysrc = (enum zynqmp_aead_keysrc)keysrc; 252 } else { 253 tfm_ctx->keylen = keylen; 254 } 255 } else { 256 tfm_ctx->keylen = keylen; 257 if (keylen == ZYNQMP_AES_KEY_SIZE) { 258 tfm_ctx->keysrc = ZYNQMP_AES_KUP_KEY; 259 memcpy(tfm_ctx->key, key, keylen); 260 } 261 } 262 263 tfm_ctx->fbk_cipher->base.crt_flags &= ~CRYPTO_TFM_REQ_MASK; 264 tfm_ctx->fbk_cipher->base.crt_flags |= (aead->base.crt_flags & 265 CRYPTO_TFM_REQ_MASK); 266 267 return crypto_aead_setkey(tfm_ctx->fbk_cipher, key, keylen); 268 } 269 270 static int zynqmp_aes_aead_setauthsize(struct crypto_aead *aead, 271 unsigned int authsize) 272 { 273 struct crypto_tfm *tfm = crypto_aead_tfm(aead); 274 struct zynqmp_aead_tfm_ctx *tfm_ctx = 275 (struct zynqmp_aead_tfm_ctx *)crypto_tfm_ctx(tfm); 276 277 tfm_ctx->authsize = authsize; 278 return crypto_aead_setauthsize(tfm_ctx->fbk_cipher, authsize); 279 } 280 281 static int zynqmp_aes_aead_encrypt(struct aead_request *req) 282 { 283 struct zynqmp_aead_drv_ctx *drv_ctx; 284 struct crypto_aead *aead = crypto_aead_reqtfm(req); 285 struct aead_alg *alg = crypto_aead_alg(aead); 286 struct zynqmp_aead_req_ctx *rq_ctx = aead_request_ctx(req); 287 288 rq_ctx->op = ZYNQMP_AES_ENCRYPT; 289 drv_ctx = container_of(alg, struct zynqmp_aead_drv_ctx, alg.aead.base); 290 291 return crypto_transfer_aead_request_to_engine(drv_ctx->engine, req); 292 } 293 294 static int zynqmp_aes_aead_decrypt(struct aead_request *req) 295 { 296 struct zynqmp_aead_drv_ctx *drv_ctx; 297 struct crypto_aead *aead = crypto_aead_reqtfm(req); 298 struct aead_alg *alg = crypto_aead_alg(aead); 299 struct zynqmp_aead_req_ctx *rq_ctx = aead_request_ctx(req); 300 301 rq_ctx->op = ZYNQMP_AES_DECRYPT; 302 drv_ctx = container_of(alg, struct zynqmp_aead_drv_ctx, alg.aead.base); 303 304 return crypto_transfer_aead_request_to_engine(drv_ctx->engine, req); 305 } 306 307 static int zynqmp_aes_aead_init(struct crypto_aead *aead) 308 { 309 struct crypto_tfm *tfm = crypto_aead_tfm(aead); 310 struct zynqmp_aead_tfm_ctx *tfm_ctx = 311 (struct zynqmp_aead_tfm_ctx *)crypto_tfm_ctx(tfm); 312 struct zynqmp_aead_drv_ctx *drv_ctx; 313 struct aead_alg *alg = crypto_aead_alg(aead); 314 315 drv_ctx = container_of(alg, struct zynqmp_aead_drv_ctx, alg.aead.base); 316 tfm_ctx->dev = drv_ctx->dev; 317 318 tfm_ctx->fbk_cipher = crypto_alloc_aead(drv_ctx->alg.aead.base.base.cra_name, 319 0, 320 CRYPTO_ALG_NEED_FALLBACK); 321 322 if (IS_ERR(tfm_ctx->fbk_cipher)) { 323 pr_err("%s() Error: failed to allocate fallback for %s\n", 324 __func__, drv_ctx->alg.aead.base.base.cra_name); 325 return PTR_ERR(tfm_ctx->fbk_cipher); 326 } 327 328 crypto_aead_set_reqsize(aead, 329 max(sizeof(struct zynqmp_aead_req_ctx), 330 sizeof(struct aead_request) + 331 crypto_aead_reqsize(tfm_ctx->fbk_cipher))); 332 return 0; 333 } 334 335 static void zynqmp_aes_aead_exit(struct crypto_aead *aead) 336 { 337 struct crypto_tfm *tfm = crypto_aead_tfm(aead); 338 struct zynqmp_aead_tfm_ctx *tfm_ctx = 339 (struct zynqmp_aead_tfm_ctx *)crypto_tfm_ctx(tfm); 340 341 if (tfm_ctx->fbk_cipher) { 342 crypto_free_aead(tfm_ctx->fbk_cipher); 343 tfm_ctx->fbk_cipher = NULL; 344 } 345 memzero_explicit(tfm_ctx, sizeof(struct zynqmp_aead_tfm_ctx)); 346 } 347 348 static struct zynqmp_aead_drv_ctx aes_drv_ctx = { 349 .alg.aead.base = { 350 .setkey = zynqmp_aes_aead_setkey, 351 .setauthsize = zynqmp_aes_aead_setauthsize, 352 .encrypt = zynqmp_aes_aead_encrypt, 353 .decrypt = zynqmp_aes_aead_decrypt, 354 .init = zynqmp_aes_aead_init, 355 .exit = zynqmp_aes_aead_exit, 356 .ivsize = GCM_AES_IV_SIZE, 357 .maxauthsize = ZYNQMP_AES_AUTH_SIZE, 358 .base = { 359 .cra_name = "gcm(aes)", 360 .cra_driver_name = "xilinx-zynqmp-aes-gcm", 361 .cra_priority = 200, 362 .cra_flags = CRYPTO_ALG_TYPE_AEAD | 363 CRYPTO_ALG_ASYNC | 364 CRYPTO_ALG_ALLOCATES_MEMORY | 365 CRYPTO_ALG_KERN_DRIVER_ONLY | 366 CRYPTO_ALG_NEED_FALLBACK, 367 .cra_blocksize = ZYNQMP_AES_BLK_SIZE, 368 .cra_ctxsize = sizeof(struct zynqmp_aead_tfm_ctx), 369 .cra_module = THIS_MODULE, 370 } 371 }, 372 .alg.aead.op = { 373 .do_one_request = zynqmp_handle_aes_req, 374 }, 375 }; 376 377 static int zynqmp_aes_aead_probe(struct platform_device *pdev) 378 { 379 struct device *dev = &pdev->dev; 380 int err; 381 382 /* ZynqMP AES driver supports only one instance */ 383 if (!aes_drv_ctx.dev) 384 aes_drv_ctx.dev = dev; 385 else 386 return -ENODEV; 387 388 err = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(ZYNQMP_DMA_BIT_MASK)); 389 if (err < 0) { 390 dev_err(dev, "No usable DMA configuration\n"); 391 return err; 392 } 393 394 aes_drv_ctx.engine = crypto_engine_alloc_init(dev, 1); 395 if (!aes_drv_ctx.engine) { 396 dev_err(dev, "Cannot alloc AES engine\n"); 397 err = -ENOMEM; 398 goto err_engine; 399 } 400 401 err = crypto_engine_start(aes_drv_ctx.engine); 402 if (err) { 403 dev_err(dev, "Cannot start AES engine\n"); 404 goto err_engine; 405 } 406 407 err = crypto_engine_register_aead(&aes_drv_ctx.alg.aead); 408 if (err < 0) { 409 dev_err(dev, "Failed to register AEAD alg.\n"); 410 goto err_aead; 411 } 412 return 0; 413 414 err_aead: 415 crypto_engine_unregister_aead(&aes_drv_ctx.alg.aead); 416 417 err_engine: 418 if (aes_drv_ctx.engine) 419 crypto_engine_exit(aes_drv_ctx.engine); 420 421 return err; 422 } 423 424 static int zynqmp_aes_aead_remove(struct platform_device *pdev) 425 { 426 crypto_engine_exit(aes_drv_ctx.engine); 427 crypto_engine_unregister_aead(&aes_drv_ctx.alg.aead); 428 429 return 0; 430 } 431 432 static const struct of_device_id zynqmp_aes_dt_ids[] = { 433 { .compatible = "xlnx,zynqmp-aes" }, 434 { /* sentinel */ } 435 }; 436 MODULE_DEVICE_TABLE(of, zynqmp_aes_dt_ids); 437 438 static struct platform_driver zynqmp_aes_driver = { 439 .probe = zynqmp_aes_aead_probe, 440 .remove = zynqmp_aes_aead_remove, 441 .driver = { 442 .name = "zynqmp-aes", 443 .of_match_table = zynqmp_aes_dt_ids, 444 }, 445 }; 446 447 module_platform_driver(zynqmp_aes_driver); 448 MODULE_LICENSE("GPL"); 449