4 * Support for OMAP AES HW acceleration.
6 * Copyright (c) 2010 Nokia Corporation
7 * Author: Dmitry Kasatkin <dmitry.kasatkin@nokia.com>
8 * Copyright (c) 2011 Texas Instruments Incorporated
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License version 2 as published
12 * by the Free Software Foundation.
16 #define pr_fmt(fmt) "%20s: " fmt, __func__
17 #define prn(num) pr_debug(#num "=%d\n", num)
18 #define prx(num) pr_debug(#num "=%x\n", num)
20 #include <linux/err.h>
21 #include <linux/module.h>
22 #include <linux/init.h>
23 #include <linux/errno.h>
24 #include <linux/kernel.h>
25 #include <linux/platform_device.h>
26 #include <linux/scatterlist.h>
27 #include <linux/dma-mapping.h>
28 #include <linux/dmaengine.h>
29 #include <linux/omap-dma.h>
30 #include <linux/pm_runtime.h>
32 #include <linux/of_device.h>
33 #include <linux/of_address.h>
35 #include <linux/crypto.h>
36 #include <linux/interrupt.h>
37 #include <crypto/scatterwalk.h>
38 #include <crypto/aes.h>
40 #define DST_MAXBURST 4
41 #define DMA_MIN (DST_MAXBURST * sizeof(u32))
43 #define _calc_walked(inout) (dd->inout##_walk.offset - dd->inout##_sg->offset)
45 /* OMAP TRM gives bitfields as start:end, where start is the higher bit
46 number. For example 7:0 */
47 #define FLD_MASK(start, end) (((1 << ((start) - (end) + 1)) - 1) << (end))
48 #define FLD_VAL(val, start, end) (((val) << (end)) & FLD_MASK(start, end))
50 #define AES_REG_KEY(dd, x) ((dd)->pdata->key_ofs - \
52 #define AES_REG_IV(dd, x) ((dd)->pdata->iv_ofs + ((x) * 0x04))
54 #define AES_REG_CTRL(dd) ((dd)->pdata->ctrl_ofs)
55 #define AES_REG_CTRL_CTR_WIDTH_MASK (3 << 7)
56 #define AES_REG_CTRL_CTR_WIDTH_32 (0 << 7)
57 #define AES_REG_CTRL_CTR_WIDTH_64 (1 << 7)
58 #define AES_REG_CTRL_CTR_WIDTH_96 (2 << 7)
59 #define AES_REG_CTRL_CTR_WIDTH_128 (3 << 7)
60 #define AES_REG_CTRL_CTR (1 << 6)
61 #define AES_REG_CTRL_CBC (1 << 5)
62 #define AES_REG_CTRL_KEY_SIZE (3 << 3)
63 #define AES_REG_CTRL_DIRECTION (1 << 2)
64 #define AES_REG_CTRL_INPUT_READY (1 << 1)
65 #define AES_REG_CTRL_OUTPUT_READY (1 << 0)
67 #define AES_REG_DATA_N(dd, x) ((dd)->pdata->data_ofs + ((x) * 0x04))
69 #define AES_REG_REV(dd) ((dd)->pdata->rev_ofs)
71 #define AES_REG_MASK(dd) ((dd)->pdata->mask_ofs)
72 #define AES_REG_MASK_SIDLE (1 << 6)
73 #define AES_REG_MASK_START (1 << 5)
74 #define AES_REG_MASK_DMA_OUT_EN (1 << 3)
75 #define AES_REG_MASK_DMA_IN_EN (1 << 2)
76 #define AES_REG_MASK_SOFTRESET (1 << 1)
77 #define AES_REG_AUTOIDLE (1 << 0)
79 #define AES_REG_LENGTH_N(x) (0x54 + ((x) * 0x04))
81 #define AES_REG_IRQ_STATUS(dd) ((dd)->pdata->irq_status_ofs)
82 #define AES_REG_IRQ_ENABLE(dd) ((dd)->pdata->irq_enable_ofs)
83 #define AES_REG_IRQ_DATA_IN BIT(1)
84 #define AES_REG_IRQ_DATA_OUT BIT(2)
85 #define DEFAULT_TIMEOUT (5*HZ)
87 #define FLAGS_MODE_MASK 0x000f
88 #define FLAGS_ENCRYPT BIT(0)
89 #define FLAGS_CBC BIT(1)
90 #define FLAGS_GIV BIT(2)
91 #define FLAGS_CTR BIT(3)
93 #define FLAGS_INIT BIT(4)
94 #define FLAGS_FAST BIT(5)
95 #define FLAGS_BUSY BIT(6)
97 #define AES_BLOCK_WORDS (AES_BLOCK_SIZE >> 2)
100 struct omap_aes_dev *dd;
103 u32 key[AES_KEYSIZE_256 / sizeof(u32)];
107 struct omap_aes_reqctx {
111 #define OMAP_AES_QUEUE_LENGTH 1
112 #define OMAP_AES_CACHE_SIZE 0
114 struct omap_aes_algs_info {
115 struct crypto_alg *algs_list;
117 unsigned int registered;
120 struct omap_aes_pdata {
121 struct omap_aes_algs_info *algs_info;
122 unsigned int algs_info_size;
124 void (*trigger)(struct omap_aes_dev *dd, int length);
145 struct omap_aes_dev {
146 struct list_head list;
147 unsigned long phys_base;
148 void __iomem *io_base;
149 struct omap_aes_ctx *ctx;
155 struct crypto_queue queue;
157 struct tasklet_struct done_task;
158 struct tasklet_struct queue_task;
160 struct ablkcipher_request *req;
162 struct scatterlist *in_sg;
163 struct scatterlist *out_sg;
164 struct scatter_walk in_walk;
165 struct scatter_walk out_walk;
167 struct dma_chan *dma_lch_in;
169 struct dma_chan *dma_lch_out;
172 const struct omap_aes_pdata *pdata;
175 /* keep registered devices data here */
176 static LIST_HEAD(dev_list);
177 static DEFINE_SPINLOCK(list_lock);
180 #define omap_aes_read(dd, offset) \
183 _read_ret = __raw_readl(dd->io_base + offset); \
184 pr_debug("omap_aes_read(" #offset "=%#x)= %#x\n", \
185 offset, _read_ret); \
189 static inline u32 omap_aes_read(struct omap_aes_dev *dd, u32 offset)
191 return __raw_readl(dd->io_base + offset);
196 #define omap_aes_write(dd, offset, value) \
198 pr_debug("omap_aes_write(" #offset "=%#x) value=%#x\n", \
200 __raw_writel(value, dd->io_base + offset); \
203 static inline void omap_aes_write(struct omap_aes_dev *dd, u32 offset,
206 __raw_writel(value, dd->io_base + offset);
210 static inline void omap_aes_write_mask(struct omap_aes_dev *dd, u32 offset,
215 val = omap_aes_read(dd, offset);
218 omap_aes_write(dd, offset, val);
221 static void omap_aes_write_n(struct omap_aes_dev *dd, u32 offset,
222 u32 *value, int count)
224 for (; count--; value++, offset += 4)
225 omap_aes_write(dd, offset, *value);
228 static int omap_aes_hw_init(struct omap_aes_dev *dd)
230 if (!(dd->flags & FLAGS_INIT)) {
231 dd->flags |= FLAGS_INIT;
238 static int omap_aes_write_ctrl(struct omap_aes_dev *dd)
244 err = omap_aes_hw_init(dd);
248 key32 = dd->ctx->keylen / sizeof(u32);
250 /* it seems a key should always be set even if it has not changed */
251 for (i = 0; i < key32; i++) {
252 omap_aes_write(dd, AES_REG_KEY(dd, i),
253 __le32_to_cpu(dd->ctx->key[i]));
256 if ((dd->flags & (FLAGS_CBC | FLAGS_CTR)) && dd->req->info)
257 omap_aes_write_n(dd, AES_REG_IV(dd, 0), dd->req->info, 4);
259 val = FLD_VAL(((dd->ctx->keylen >> 3) - 1), 4, 3);
260 if (dd->flags & FLAGS_CBC)
261 val |= AES_REG_CTRL_CBC;
262 if (dd->flags & FLAGS_CTR) {
263 val |= AES_REG_CTRL_CTR | AES_REG_CTRL_CTR_WIDTH_32;
264 mask = AES_REG_CTRL_CTR | AES_REG_CTRL_CTR_WIDTH_MASK;
266 if (dd->flags & FLAGS_ENCRYPT)
267 val |= AES_REG_CTRL_DIRECTION;
269 mask |= AES_REG_CTRL_CBC | AES_REG_CTRL_DIRECTION |
270 AES_REG_CTRL_KEY_SIZE;
272 omap_aes_write_mask(dd, AES_REG_CTRL(dd), val, mask);
277 static void omap_aes_dma_trigger_omap2(struct omap_aes_dev *dd, int length)
281 val = dd->pdata->dma_start;
283 if (dd->dma_lch_out != NULL)
284 val |= dd->pdata->dma_enable_out;
285 if (dd->dma_lch_in != NULL)
286 val |= dd->pdata->dma_enable_in;
288 mask = dd->pdata->dma_enable_out | dd->pdata->dma_enable_in |
289 dd->pdata->dma_start;
291 omap_aes_write_mask(dd, AES_REG_MASK(dd), val, mask);
295 static void omap_aes_dma_trigger_omap4(struct omap_aes_dev *dd, int length)
297 omap_aes_write(dd, AES_REG_LENGTH_N(0), length);
298 omap_aes_write(dd, AES_REG_LENGTH_N(1), 0);
300 omap_aes_dma_trigger_omap2(dd, length);
303 static void omap_aes_dma_stop(struct omap_aes_dev *dd)
307 mask = dd->pdata->dma_enable_out | dd->pdata->dma_enable_in |
308 dd->pdata->dma_start;
310 omap_aes_write_mask(dd, AES_REG_MASK(dd), 0, mask);
313 static struct omap_aes_dev *omap_aes_find_dev(struct omap_aes_ctx *ctx)
315 struct omap_aes_dev *dd = NULL, *tmp;
317 spin_lock_bh(&list_lock);
319 list_for_each_entry(tmp, &dev_list, list) {
320 /* FIXME: take fist available aes core */
326 /* already found before */
329 spin_unlock_bh(&list_lock);
334 static void omap_aes_dma_out_callback(void *data)
336 struct omap_aes_dev *dd = data;
338 /* dma_lch_out - completed */
339 tasklet_schedule(&dd->done_task);
342 static int omap_aes_dma_init(struct omap_aes_dev *dd)
347 dd->dma_lch_out = NULL;
348 dd->dma_lch_in = NULL;
351 dma_cap_set(DMA_SLAVE, mask);
353 dd->dma_lch_in = dma_request_slave_channel_compat(mask,
357 if (!dd->dma_lch_in) {
358 dev_err(dd->dev, "Unable to request in DMA channel\n");
362 dd->dma_lch_out = dma_request_slave_channel_compat(mask,
366 if (!dd->dma_lch_out) {
367 dev_err(dd->dev, "Unable to request out DMA channel\n");
374 dma_release_channel(dd->dma_lch_in);
377 pr_err("error: %d\n", err);
381 static void omap_aes_dma_cleanup(struct omap_aes_dev *dd)
383 dma_release_channel(dd->dma_lch_out);
384 dma_release_channel(dd->dma_lch_in);
387 static void sg_copy_buf(void *buf, struct scatterlist *sg,
388 unsigned int start, unsigned int nbytes, int out)
390 struct scatter_walk walk;
395 scatterwalk_start(&walk, sg);
396 scatterwalk_advance(&walk, start);
397 scatterwalk_copychunks(buf, &walk, nbytes, out);
398 scatterwalk_done(&walk, out, 0);
401 static int omap_aes_crypt_dma(struct crypto_tfm *tfm,
402 struct scatterlist *in_sg, struct scatterlist *out_sg,
403 int in_sg_len, int out_sg_len)
405 struct omap_aes_ctx *ctx = crypto_tfm_ctx(tfm);
406 struct omap_aes_dev *dd = ctx->dd;
407 struct dma_async_tx_descriptor *tx_in, *tx_out;
408 struct dma_slave_config cfg;
411 dma_sync_sg_for_device(dd->dev, dd->in_sg, in_sg_len, DMA_TO_DEVICE);
413 memset(&cfg, 0, sizeof(cfg));
415 cfg.src_addr = dd->phys_base + AES_REG_DATA_N(dd, 0);
416 cfg.dst_addr = dd->phys_base + AES_REG_DATA_N(dd, 0);
417 cfg.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
418 cfg.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
419 cfg.src_maxburst = DST_MAXBURST;
420 cfg.dst_maxburst = DST_MAXBURST;
423 ret = dmaengine_slave_config(dd->dma_lch_in, &cfg);
425 dev_err(dd->dev, "can't configure IN dmaengine slave: %d\n",
430 tx_in = dmaengine_prep_slave_sg(dd->dma_lch_in, in_sg, in_sg_len,
432 DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
434 dev_err(dd->dev, "IN prep_slave_sg() failed\n");
438 /* No callback necessary */
439 tx_in->callback_param = dd;
442 ret = dmaengine_slave_config(dd->dma_lch_out, &cfg);
444 dev_err(dd->dev, "can't configure OUT dmaengine slave: %d\n",
449 tx_out = dmaengine_prep_slave_sg(dd->dma_lch_out, out_sg, out_sg_len,
451 DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
453 dev_err(dd->dev, "OUT prep_slave_sg() failed\n");
457 tx_out->callback = omap_aes_dma_out_callback;
458 tx_out->callback_param = dd;
460 dmaengine_submit(tx_in);
461 dmaengine_submit(tx_out);
463 dma_async_issue_pending(dd->dma_lch_in);
464 dma_async_issue_pending(dd->dma_lch_out);
467 dd->pdata->trigger(dd, dd->total);
472 static int omap_aes_crypt_dma_start(struct omap_aes_dev *dd)
474 struct crypto_tfm *tfm = crypto_ablkcipher_tfm(
475 crypto_ablkcipher_reqtfm(dd->req));
478 pr_debug("total: %d\n", dd->total);
480 err = dma_map_sg(dd->dev, dd->in_sg, dd->in_sg_len, DMA_TO_DEVICE);
482 dev_err(dd->dev, "dma_map_sg() error\n");
486 err = dma_map_sg(dd->dev, dd->out_sg, dd->out_sg_len, DMA_FROM_DEVICE);
488 dev_err(dd->dev, "dma_map_sg() error\n");
492 err = omap_aes_crypt_dma(tfm, dd->in_sg, dd->out_sg, dd->in_sg_len,
495 dma_unmap_sg(dd->dev, dd->in_sg, dd->in_sg_len, DMA_TO_DEVICE);
496 dma_unmap_sg(dd->dev, dd->out_sg, dd->out_sg_len,
503 static void omap_aes_finish_req(struct omap_aes_dev *dd, int err)
505 struct ablkcipher_request *req = dd->req;
507 pr_debug("err: %d\n", err);
509 dd->flags &= ~FLAGS_BUSY;
511 req->base.complete(&req->base, err);
514 static int omap_aes_crypt_dma_stop(struct omap_aes_dev *dd)
518 pr_debug("total: %d\n", dd->total);
520 omap_aes_dma_stop(dd);
522 dmaengine_terminate_all(dd->dma_lch_in);
523 dmaengine_terminate_all(dd->dma_lch_out);
525 dma_unmap_sg(dd->dev, dd->in_sg, dd->in_sg_len, DMA_TO_DEVICE);
526 dma_unmap_sg(dd->dev, dd->out_sg, dd->out_sg_len, DMA_FROM_DEVICE);
531 static int omap_aes_handle_queue(struct omap_aes_dev *dd,
532 struct ablkcipher_request *req)
534 struct crypto_async_request *async_req, *backlog;
535 struct omap_aes_ctx *ctx;
536 struct omap_aes_reqctx *rctx;
540 spin_lock_irqsave(&dd->lock, flags);
542 ret = ablkcipher_enqueue_request(&dd->queue, req);
543 if (dd->flags & FLAGS_BUSY) {
544 spin_unlock_irqrestore(&dd->lock, flags);
547 backlog = crypto_get_backlog(&dd->queue);
548 async_req = crypto_dequeue_request(&dd->queue);
550 dd->flags |= FLAGS_BUSY;
551 spin_unlock_irqrestore(&dd->lock, flags);
557 backlog->complete(backlog, -EINPROGRESS);
559 req = ablkcipher_request_cast(async_req);
561 /* assign new request to device */
563 dd->total = req->nbytes;
564 dd->in_sg = req->src;
565 dd->out_sg = req->dst;
567 dd->in_sg_len = scatterwalk_bytes_sglen(dd->in_sg, dd->total);
568 dd->out_sg_len = scatterwalk_bytes_sglen(dd->out_sg, dd->total);
569 BUG_ON(dd->in_sg_len < 0 || dd->out_sg_len < 0);
571 rctx = ablkcipher_request_ctx(req);
572 ctx = crypto_ablkcipher_ctx(crypto_ablkcipher_reqtfm(req));
573 rctx->mode &= FLAGS_MODE_MASK;
574 dd->flags = (dd->flags & ~FLAGS_MODE_MASK) | rctx->mode;
579 err = omap_aes_write_ctrl(dd);
581 err = omap_aes_crypt_dma_start(dd);
583 /* aes_task will not finish it, so do it here */
584 omap_aes_finish_req(dd, err);
585 tasklet_schedule(&dd->queue_task);
588 return ret; /* return ret, which is enqueue return value */
591 static void omap_aes_done_task(unsigned long data)
593 struct omap_aes_dev *dd = (struct omap_aes_dev *)data;
595 pr_debug("enter done_task\n");
597 dma_sync_sg_for_cpu(dd->dev, dd->in_sg, dd->in_sg_len, DMA_FROM_DEVICE);
599 omap_aes_crypt_dma_stop(dd);
600 omap_aes_finish_req(dd, 0);
601 omap_aes_handle_queue(dd, NULL);
606 static void omap_aes_queue_task(unsigned long data)
608 struct omap_aes_dev *dd = (struct omap_aes_dev *)data;
610 omap_aes_handle_queue(dd, NULL);
613 static int omap_aes_crypt(struct ablkcipher_request *req, unsigned long mode)
615 struct omap_aes_ctx *ctx = crypto_ablkcipher_ctx(
616 crypto_ablkcipher_reqtfm(req));
617 struct omap_aes_reqctx *rctx = ablkcipher_request_ctx(req);
618 struct omap_aes_dev *dd;
620 pr_debug("nbytes: %d, enc: %d, cbc: %d\n", req->nbytes,
621 !!(mode & FLAGS_ENCRYPT),
622 !!(mode & FLAGS_CBC));
624 if (!IS_ALIGNED(req->nbytes, AES_BLOCK_SIZE)) {
625 pr_err("request size is not exact amount of AES blocks\n");
629 dd = omap_aes_find_dev(ctx);
635 return omap_aes_handle_queue(dd, req);
638 /* ********************** ALG API ************************************ */
640 static int omap_aes_setkey(struct crypto_ablkcipher *tfm, const u8 *key,
643 struct omap_aes_ctx *ctx = crypto_ablkcipher_ctx(tfm);
645 if (keylen != AES_KEYSIZE_128 && keylen != AES_KEYSIZE_192 &&
646 keylen != AES_KEYSIZE_256)
649 pr_debug("enter, keylen: %d\n", keylen);
651 memcpy(ctx->key, key, keylen);
652 ctx->keylen = keylen;
657 static int omap_aes_ecb_encrypt(struct ablkcipher_request *req)
659 return omap_aes_crypt(req, FLAGS_ENCRYPT);
662 static int omap_aes_ecb_decrypt(struct ablkcipher_request *req)
664 return omap_aes_crypt(req, 0);
667 static int omap_aes_cbc_encrypt(struct ablkcipher_request *req)
669 return omap_aes_crypt(req, FLAGS_ENCRYPT | FLAGS_CBC);
672 static int omap_aes_cbc_decrypt(struct ablkcipher_request *req)
674 return omap_aes_crypt(req, FLAGS_CBC);
677 static int omap_aes_ctr_encrypt(struct ablkcipher_request *req)
679 return omap_aes_crypt(req, FLAGS_ENCRYPT | FLAGS_CTR);
682 static int omap_aes_ctr_decrypt(struct ablkcipher_request *req)
684 return omap_aes_crypt(req, FLAGS_CTR);
687 static int omap_aes_cra_init(struct crypto_tfm *tfm)
689 struct omap_aes_dev *dd = NULL;
691 /* Find AES device, currently picks the first device */
692 spin_lock_bh(&list_lock);
693 list_for_each_entry(dd, &dev_list, list) {
696 spin_unlock_bh(&list_lock);
698 pm_runtime_get_sync(dd->dev);
699 tfm->crt_ablkcipher.reqsize = sizeof(struct omap_aes_reqctx);
704 static void omap_aes_cra_exit(struct crypto_tfm *tfm)
706 struct omap_aes_dev *dd = NULL;
708 /* Find AES device, currently picks the first device */
709 spin_lock_bh(&list_lock);
710 list_for_each_entry(dd, &dev_list, list) {
713 spin_unlock_bh(&list_lock);
715 pm_runtime_put_sync(dd->dev);
718 /* ********************** ALGS ************************************ */
720 static struct crypto_alg algs_ecb_cbc[] = {
722 .cra_name = "ecb(aes)",
723 .cra_driver_name = "ecb-aes-omap",
725 .cra_flags = CRYPTO_ALG_TYPE_ABLKCIPHER |
726 CRYPTO_ALG_KERN_DRIVER_ONLY |
728 .cra_blocksize = AES_BLOCK_SIZE,
729 .cra_ctxsize = sizeof(struct omap_aes_ctx),
731 .cra_type = &crypto_ablkcipher_type,
732 .cra_module = THIS_MODULE,
733 .cra_init = omap_aes_cra_init,
734 .cra_exit = omap_aes_cra_exit,
735 .cra_u.ablkcipher = {
736 .min_keysize = AES_MIN_KEY_SIZE,
737 .max_keysize = AES_MAX_KEY_SIZE,
738 .setkey = omap_aes_setkey,
739 .encrypt = omap_aes_ecb_encrypt,
740 .decrypt = omap_aes_ecb_decrypt,
744 .cra_name = "cbc(aes)",
745 .cra_driver_name = "cbc-aes-omap",
747 .cra_flags = CRYPTO_ALG_TYPE_ABLKCIPHER |
748 CRYPTO_ALG_KERN_DRIVER_ONLY |
750 .cra_blocksize = AES_BLOCK_SIZE,
751 .cra_ctxsize = sizeof(struct omap_aes_ctx),
753 .cra_type = &crypto_ablkcipher_type,
754 .cra_module = THIS_MODULE,
755 .cra_init = omap_aes_cra_init,
756 .cra_exit = omap_aes_cra_exit,
757 .cra_u.ablkcipher = {
758 .min_keysize = AES_MIN_KEY_SIZE,
759 .max_keysize = AES_MAX_KEY_SIZE,
760 .ivsize = AES_BLOCK_SIZE,
761 .setkey = omap_aes_setkey,
762 .encrypt = omap_aes_cbc_encrypt,
763 .decrypt = omap_aes_cbc_decrypt,
768 static struct crypto_alg algs_ctr[] = {
770 .cra_name = "ctr(aes)",
771 .cra_driver_name = "ctr-aes-omap",
773 .cra_flags = CRYPTO_ALG_TYPE_ABLKCIPHER |
774 CRYPTO_ALG_KERN_DRIVER_ONLY |
776 .cra_blocksize = AES_BLOCK_SIZE,
777 .cra_ctxsize = sizeof(struct omap_aes_ctx),
779 .cra_type = &crypto_ablkcipher_type,
780 .cra_module = THIS_MODULE,
781 .cra_init = omap_aes_cra_init,
782 .cra_exit = omap_aes_cra_exit,
783 .cra_u.ablkcipher = {
784 .min_keysize = AES_MIN_KEY_SIZE,
785 .max_keysize = AES_MAX_KEY_SIZE,
787 .ivsize = AES_BLOCK_SIZE,
788 .setkey = omap_aes_setkey,
789 .encrypt = omap_aes_ctr_encrypt,
790 .decrypt = omap_aes_ctr_decrypt,
795 static struct omap_aes_algs_info omap_aes_algs_info_ecb_cbc[] = {
797 .algs_list = algs_ecb_cbc,
798 .size = ARRAY_SIZE(algs_ecb_cbc),
802 static const struct omap_aes_pdata omap_aes_pdata_omap2 = {
803 .algs_info = omap_aes_algs_info_ecb_cbc,
804 .algs_info_size = ARRAY_SIZE(omap_aes_algs_info_ecb_cbc),
805 .trigger = omap_aes_dma_trigger_omap2,
812 .dma_enable_in = BIT(2),
813 .dma_enable_out = BIT(3),
822 static struct omap_aes_algs_info omap_aes_algs_info_ecb_cbc_ctr[] = {
824 .algs_list = algs_ecb_cbc,
825 .size = ARRAY_SIZE(algs_ecb_cbc),
828 .algs_list = algs_ctr,
829 .size = ARRAY_SIZE(algs_ctr),
833 static const struct omap_aes_pdata omap_aes_pdata_omap3 = {
834 .algs_info = omap_aes_algs_info_ecb_cbc_ctr,
835 .algs_info_size = ARRAY_SIZE(omap_aes_algs_info_ecb_cbc_ctr),
836 .trigger = omap_aes_dma_trigger_omap2,
843 .dma_enable_in = BIT(2),
844 .dma_enable_out = BIT(3),
852 static const struct omap_aes_pdata omap_aes_pdata_omap4 = {
853 .algs_info = omap_aes_algs_info_ecb_cbc_ctr,
854 .algs_info_size = ARRAY_SIZE(omap_aes_algs_info_ecb_cbc_ctr),
855 .trigger = omap_aes_dma_trigger_omap4,
862 .irq_status_ofs = 0x8c,
863 .irq_enable_ofs = 0x90,
864 .dma_enable_in = BIT(5),
865 .dma_enable_out = BIT(6),
866 .major_mask = 0x0700,
868 .minor_mask = 0x003f,
872 static irqreturn_t omap_aes_irq(int irq, void *dev_id)
874 struct omap_aes_dev *dd = dev_id;
878 status = omap_aes_read(dd, AES_REG_IRQ_STATUS(dd));
879 if (status & AES_REG_IRQ_DATA_IN) {
880 omap_aes_write(dd, AES_REG_IRQ_ENABLE(dd), 0x0);
884 BUG_ON(_calc_walked(in) > dd->in_sg->length);
886 src = sg_virt(dd->in_sg) + _calc_walked(in);
888 for (i = 0; i < AES_BLOCK_WORDS; i++) {
889 omap_aes_write(dd, AES_REG_DATA_N(dd, i), *src);
891 scatterwalk_advance(&dd->in_walk, 4);
892 if (dd->in_sg->length == _calc_walked(in)) {
893 dd->in_sg = scatterwalk_sg_next(dd->in_sg);
895 scatterwalk_start(&dd->in_walk,
897 src = sg_virt(dd->in_sg) +
905 /* Clear IRQ status */
906 status &= ~AES_REG_IRQ_DATA_IN;
907 omap_aes_write(dd, AES_REG_IRQ_STATUS(dd), status);
909 /* Enable DATA_OUT interrupt */
910 omap_aes_write(dd, AES_REG_IRQ_ENABLE(dd), 0x4);
912 } else if (status & AES_REG_IRQ_DATA_OUT) {
913 omap_aes_write(dd, AES_REG_IRQ_ENABLE(dd), 0x0);
917 BUG_ON(_calc_walked(out) > dd->out_sg->length);
919 dst = sg_virt(dd->out_sg) + _calc_walked(out);
921 for (i = 0; i < AES_BLOCK_WORDS; i++) {
922 *dst = omap_aes_read(dd, AES_REG_DATA_N(dd, i));
923 scatterwalk_advance(&dd->out_walk, 4);
924 if (dd->out_sg->length == _calc_walked(out)) {
925 dd->out_sg = scatterwalk_sg_next(dd->out_sg);
927 scatterwalk_start(&dd->out_walk,
929 dst = sg_virt(dd->out_sg) +
937 dd->total -= AES_BLOCK_SIZE;
939 BUG_ON(dd->total < 0);
941 /* Clear IRQ status */
942 status &= ~AES_REG_IRQ_DATA_OUT;
943 omap_aes_write(dd, AES_REG_IRQ_STATUS(dd), status);
946 /* All bytes read! */
947 tasklet_schedule(&dd->done_task);
949 /* Enable DATA_IN interrupt for next block */
950 omap_aes_write(dd, AES_REG_IRQ_ENABLE(dd), 0x2);
956 static const struct of_device_id omap_aes_of_match[] = {
958 .compatible = "ti,omap2-aes",
959 .data = &omap_aes_pdata_omap2,
962 .compatible = "ti,omap3-aes",
963 .data = &omap_aes_pdata_omap3,
966 .compatible = "ti,omap4-aes",
967 .data = &omap_aes_pdata_omap4,
971 MODULE_DEVICE_TABLE(of, omap_aes_of_match);
973 static int omap_aes_get_res_of(struct omap_aes_dev *dd,
974 struct device *dev, struct resource *res)
976 struct device_node *node = dev->of_node;
977 const struct of_device_id *match;
980 match = of_match_device(of_match_ptr(omap_aes_of_match), dev);
982 dev_err(dev, "no compatible OF match\n");
987 err = of_address_to_resource(node, 0, res);
989 dev_err(dev, "can't translate OF node address\n");
994 dd->dma_out = -1; /* Dummy value that's unused */
995 dd->dma_in = -1; /* Dummy value that's unused */
997 dd->pdata = match->data;
1003 static const struct of_device_id omap_aes_of_match[] = {
1007 static int omap_aes_get_res_of(struct omap_aes_dev *dd,
1008 struct device *dev, struct resource *res)
1014 static int omap_aes_get_res_pdev(struct omap_aes_dev *dd,
1015 struct platform_device *pdev, struct resource *res)
1017 struct device *dev = &pdev->dev;
1021 /* Get the base address */
1022 r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1024 dev_err(dev, "no MEM resource info\n");
1028 memcpy(res, r, sizeof(*res));
1030 /* Get the DMA out channel */
1031 r = platform_get_resource(pdev, IORESOURCE_DMA, 0);
1033 dev_err(dev, "no DMA out resource info\n");
1037 dd->dma_out = r->start;
1039 /* Get the DMA in channel */
1040 r = platform_get_resource(pdev, IORESOURCE_DMA, 1);
1042 dev_err(dev, "no DMA in resource info\n");
1046 dd->dma_in = r->start;
1048 /* Only OMAP2/3 can be non-DT */
1049 dd->pdata = &omap_aes_pdata_omap2;
1055 static int omap_aes_probe(struct platform_device *pdev)
1057 struct device *dev = &pdev->dev;
1058 struct omap_aes_dev *dd;
1059 struct crypto_alg *algp;
1060 struct resource res;
1061 int err = -ENOMEM, i, j;
1064 dd = kzalloc(sizeof(struct omap_aes_dev), GFP_KERNEL);
1066 dev_err(dev, "unable to alloc data struct.\n");
1070 platform_set_drvdata(pdev, dd);
1072 spin_lock_init(&dd->lock);
1073 crypto_init_queue(&dd->queue, OMAP_AES_QUEUE_LENGTH);
1075 err = (dev->of_node) ? omap_aes_get_res_of(dd, dev, &res) :
1076 omap_aes_get_res_pdev(dd, pdev, &res);
1080 dd->io_base = devm_ioremap_resource(dev, &res);
1081 if (IS_ERR(dd->io_base)) {
1082 err = PTR_ERR(dd->io_base);
1085 dd->phys_base = res.start;
1087 pm_runtime_enable(dev);
1088 pm_runtime_get_sync(dev);
1090 omap_aes_dma_stop(dd);
1092 reg = omap_aes_read(dd, AES_REG_REV(dd));
1094 pm_runtime_put_sync(dev);
1096 dev_info(dev, "OMAP AES hw accel rev: %u.%u\n",
1097 (reg & dd->pdata->major_mask) >> dd->pdata->major_shift,
1098 (reg & dd->pdata->minor_mask) >> dd->pdata->minor_shift);
1100 tasklet_init(&dd->done_task, omap_aes_done_task, (unsigned long)dd);
1101 tasklet_init(&dd->queue_task, omap_aes_queue_task, (unsigned long)dd);
1103 err = omap_aes_dma_init(dd);
1107 INIT_LIST_HEAD(&dd->list);
1108 spin_lock(&list_lock);
1109 list_add_tail(&dd->list, &dev_list);
1110 spin_unlock(&list_lock);
1112 for (i = 0; i < dd->pdata->algs_info_size; i++) {
1113 for (j = 0; j < dd->pdata->algs_info[i].size; j++) {
1114 algp = &dd->pdata->algs_info[i].algs_list[j];
1116 pr_debug("reg alg: %s\n", algp->cra_name);
1117 INIT_LIST_HEAD(&algp->cra_list);
1119 err = crypto_register_alg(algp);
1123 dd->pdata->algs_info[i].registered++;
1129 for (i = dd->pdata->algs_info_size - 1; i >= 0; i--)
1130 for (j = dd->pdata->algs_info[i].registered - 1; j >= 0; j--)
1131 crypto_unregister_alg(
1132 &dd->pdata->algs_info[i].algs_list[j]);
1133 omap_aes_dma_cleanup(dd);
1135 tasklet_kill(&dd->done_task);
1136 tasklet_kill(&dd->queue_task);
1137 pm_runtime_disable(dev);
1142 dev_err(dev, "initialization failed.\n");
1146 static int omap_aes_remove(struct platform_device *pdev)
1148 struct omap_aes_dev *dd = platform_get_drvdata(pdev);
1154 spin_lock(&list_lock);
1155 list_del(&dd->list);
1156 spin_unlock(&list_lock);
1158 for (i = dd->pdata->algs_info_size - 1; i >= 0; i--)
1159 for (j = dd->pdata->algs_info[i].registered - 1; j >= 0; j--)
1160 crypto_unregister_alg(
1161 &dd->pdata->algs_info[i].algs_list[j]);
1163 tasklet_kill(&dd->done_task);
1164 tasklet_kill(&dd->queue_task);
1165 omap_aes_dma_cleanup(dd);
1166 pm_runtime_disable(dd->dev);
1173 #ifdef CONFIG_PM_SLEEP
1174 static int omap_aes_suspend(struct device *dev)
1176 pm_runtime_put_sync(dev);
1180 static int omap_aes_resume(struct device *dev)
1182 pm_runtime_get_sync(dev);
1187 static const struct dev_pm_ops omap_aes_pm_ops = {
1188 SET_SYSTEM_SLEEP_PM_OPS(omap_aes_suspend, omap_aes_resume)
1191 static struct platform_driver omap_aes_driver = {
1192 .probe = omap_aes_probe,
1193 .remove = omap_aes_remove,
1196 .owner = THIS_MODULE,
1197 .pm = &omap_aes_pm_ops,
1198 .of_match_table = omap_aes_of_match,
1202 module_platform_driver(omap_aes_driver);
1204 MODULE_DESCRIPTION("OMAP AES hw acceleration support.");
1205 MODULE_LICENSE("GPL v2");
1206 MODULE_AUTHOR("Dmitry Kasatkin");