blob: 10db7df366c8a44307aef5b41f7ef984c97005b9 [file] [log] [blame]
Sonic Zhangb8840092012-06-04 12:24:47 +08001/*
2 * Cryptographic API.
3 *
4 * Support Blackfin CRC HW acceleration.
5 *
6 * Copyright 2012 Analog Devices Inc.
7 *
8 * Licensed under the GPL-2.
9 */
10
11#include <linux/err.h>
12#include <linux/device.h>
13#include <linux/module.h>
14#include <linux/init.h>
15#include <linux/errno.h>
16#include <linux/interrupt.h>
17#include <linux/kernel.h>
18#include <linux/irq.h>
19#include <linux/io.h>
20#include <linux/platform_device.h>
21#include <linux/scatterlist.h>
22#include <linux/dma-mapping.h>
23#include <linux/delay.h>
Sonic Zhangb8840092012-06-04 12:24:47 +080024#include <linux/crypto.h>
25#include <linux/cryptohash.h>
26#include <crypto/scatterwalk.h>
27#include <crypto/algapi.h>
28#include <crypto/hash.h>
29#include <crypto/internal/hash.h>
Johannes Berg1e0bdad2014-11-19 21:16:04 +010030#include <asm/unaligned.h>
Sonic Zhangb8840092012-06-04 12:24:47 +080031
Sonic Zhangb8840092012-06-04 12:24:47 +080032#include <asm/dma.h>
33#include <asm/portmux.h>
Sonic Zhang52e6e542014-04-10 14:30:56 +080034#include <asm/io.h>
35
36#include "bfin_crc.h"
Sonic Zhangb8840092012-06-04 12:24:47 +080037
38#define CRC_CCRYPTO_QUEUE_LENGTH 5
39
40#define DRIVER_NAME "bfin-hmac-crc"
41#define CHKSUM_DIGEST_SIZE 4
42#define CHKSUM_BLOCK_SIZE 1
43
44#define CRC_MAX_DMA_DESC 100
45
46#define CRC_CRYPTO_STATE_UPDATE 1
47#define CRC_CRYPTO_STATE_FINALUPDATE 2
48#define CRC_CRYPTO_STATE_FINISH 3
49
50struct bfin_crypto_crc {
51 struct list_head list;
52 struct device *dev;
53 spinlock_t lock;
54
55 int irq;
56 int dma_ch;
57 u32 poly;
Sonic Zhang52e6e542014-04-10 14:30:56 +080058 struct crc_register *regs;
Sonic Zhangb8840092012-06-04 12:24:47 +080059
60 struct ahash_request *req; /* current request in operation */
61 struct dma_desc_array *sg_cpu; /* virt addr of sg dma descriptors */
62 dma_addr_t sg_dma; /* phy addr of sg dma descriptors */
63 u8 *sg_mid_buf;
Sonic Zhang52d77eb2014-04-10 16:40:59 +080064 dma_addr_t sg_mid_dma; /* phy addr of sg mid buffer */
Sonic Zhangb8840092012-06-04 12:24:47 +080065
66 struct tasklet_struct done_task;
67 struct crypto_queue queue; /* waiting requests */
68
69 u8 busy:1; /* crc device in operation flag */
70};
71
72static struct bfin_crypto_crc_list {
73 struct list_head dev_list;
74 spinlock_t lock;
75} crc_list;
76
77struct bfin_crypto_crc_reqctx {
78 struct bfin_crypto_crc *crc;
79
80 unsigned int total; /* total request bytes */
81 size_t sg_buflen; /* bytes for this update */
82 unsigned int sg_nents;
83 struct scatterlist *sg; /* sg list head for this update*/
84 struct scatterlist bufsl[2]; /* chained sg list */
85
86 size_t bufnext_len;
87 size_t buflast_len;
88 u8 bufnext[CHKSUM_DIGEST_SIZE]; /* extra bytes for next udpate */
89 u8 buflast[CHKSUM_DIGEST_SIZE]; /* extra bytes from last udpate */
90
91 u8 flag;
92};
93
94struct bfin_crypto_crc_ctx {
95 struct bfin_crypto_crc *crc;
96 u32 key;
97};
98
Sonic Zhangb8840092012-06-04 12:24:47 +080099/*
100 * get element in scatter list by given index
101 */
102static struct scatterlist *sg_get(struct scatterlist *sg_list, unsigned int nents,
103 unsigned int index)
104{
105 struct scatterlist *sg = NULL;
106 int i;
107
108 for_each_sg(sg_list, sg, nents, i)
109 if (i == index)
110 break;
111
112 return sg;
113}
114
115static int bfin_crypto_crc_init_hw(struct bfin_crypto_crc *crc, u32 key)
116{
Sonic Zhang52e6e542014-04-10 14:30:56 +0800117 writel(0, &crc->regs->datacntrld);
118 writel(MODE_CALC_CRC << OPMODE_OFFSET, &crc->regs->control);
119 writel(key, &crc->regs->curresult);
Sonic Zhangb8840092012-06-04 12:24:47 +0800120
121 /* setup CRC interrupts */
Sonic Zhang52e6e542014-04-10 14:30:56 +0800122 writel(CMPERRI | DCNTEXPI, &crc->regs->status);
123 writel(CMPERRI | DCNTEXPI, &crc->regs->intrenset);
Sonic Zhangb8840092012-06-04 12:24:47 +0800124
125 return 0;
126}
127
128static int bfin_crypto_crc_init(struct ahash_request *req)
129{
130 struct crypto_ahash *tfm = crypto_ahash_reqtfm(req);
131 struct bfin_crypto_crc_ctx *crc_ctx = crypto_ahash_ctx(tfm);
132 struct bfin_crypto_crc_reqctx *ctx = ahash_request_ctx(req);
133 struct bfin_crypto_crc *crc;
134
Syam Sidhardhanfb1dd792013-02-25 03:57:39 +0530135 dev_dbg(ctx->crc->dev, "crc_init\n");
Sonic Zhangb8840092012-06-04 12:24:47 +0800136 spin_lock_bh(&crc_list.lock);
137 list_for_each_entry(crc, &crc_list.dev_list, list) {
138 crc_ctx->crc = crc;
139 break;
140 }
141 spin_unlock_bh(&crc_list.lock);
142
LABBE Corentin1f6d79d2015-09-18 14:57:09 +0200143 if (sg_nents(req->src) > CRC_MAX_DMA_DESC) {
Syam Sidhardhanfb1dd792013-02-25 03:57:39 +0530144 dev_dbg(ctx->crc->dev, "init: requested sg list is too big > %d\n",
Sonic Zhangb8840092012-06-04 12:24:47 +0800145 CRC_MAX_DMA_DESC);
146 return -EINVAL;
147 }
148
149 ctx->crc = crc;
150 ctx->bufnext_len = 0;
151 ctx->buflast_len = 0;
152 ctx->sg_buflen = 0;
153 ctx->total = 0;
154 ctx->flag = 0;
155
156 /* init crc results */
157 put_unaligned_le32(crc_ctx->key, req->result);
158
Syam Sidhardhanfb1dd792013-02-25 03:57:39 +0530159 dev_dbg(ctx->crc->dev, "init: digest size: %d\n",
Sonic Zhangb8840092012-06-04 12:24:47 +0800160 crypto_ahash_digestsize(tfm));
161
162 return bfin_crypto_crc_init_hw(crc, crc_ctx->key);
163}
164
165static void bfin_crypto_crc_config_dma(struct bfin_crypto_crc *crc)
166{
167 struct scatterlist *sg;
168 struct bfin_crypto_crc_reqctx *ctx = ahash_request_ctx(crc->req);
169 int i = 0, j = 0;
170 unsigned long dma_config;
171 unsigned int dma_count;
172 unsigned int dma_addr;
173 unsigned int mid_dma_count = 0;
174 int dma_mod;
175
176 dma_map_sg(crc->dev, ctx->sg, ctx->sg_nents, DMA_TO_DEVICE);
177
178 for_each_sg(ctx->sg, sg, ctx->sg_nents, j) {
Sonic Zhangb8840092012-06-04 12:24:47 +0800179 dma_addr = sg_dma_address(sg);
180 /* deduce extra bytes in last sg */
181 if (sg_is_last(sg))
182 dma_count = sg_dma_len(sg) - ctx->bufnext_len;
183 else
184 dma_count = sg_dma_len(sg);
185
186 if (mid_dma_count) {
187 /* Append last middle dma buffer to 4 bytes with first
188 bytes in current sg buffer. Move addr of current
189 sg and deduce the length of current sg.
190 */
Sonic Zhang52d77eb2014-04-10 16:40:59 +0800191 memcpy(crc->sg_mid_buf +(i << 2) + mid_dma_count,
192 sg_virt(sg),
Sonic Zhangb8840092012-06-04 12:24:47 +0800193 CHKSUM_DIGEST_SIZE - mid_dma_count);
194 dma_addr += CHKSUM_DIGEST_SIZE - mid_dma_count;
195 dma_count -= CHKSUM_DIGEST_SIZE - mid_dma_count;
Sonic Zhang52d77eb2014-04-10 16:40:59 +0800196
197 dma_config = DMAFLOW_ARRAY | RESTART | NDSIZE_3 |
198 DMAEN | PSIZE_32 | WDSIZE_32;
199
200 /* setup new dma descriptor for next middle dma */
201 crc->sg_cpu[i].start_addr = crc->sg_mid_dma + (i << 2);
202 crc->sg_cpu[i].cfg = dma_config;
203 crc->sg_cpu[i].x_count = 1;
204 crc->sg_cpu[i].x_modify = CHKSUM_DIGEST_SIZE;
205 dev_dbg(crc->dev, "%d: crc_dma: start_addr:0x%lx, "
206 "cfg:0x%lx, x_count:0x%lx, x_modify:0x%lx\n",
207 i, crc->sg_cpu[i].start_addr,
208 crc->sg_cpu[i].cfg, crc->sg_cpu[i].x_count,
209 crc->sg_cpu[i].x_modify);
210 i++;
Sonic Zhangb8840092012-06-04 12:24:47 +0800211 }
Sonic Zhang52d77eb2014-04-10 16:40:59 +0800212
213 dma_config = DMAFLOW_ARRAY | RESTART | NDSIZE_3 | DMAEN | PSIZE_32;
Sonic Zhangb8840092012-06-04 12:24:47 +0800214 /* chop current sg dma len to multiple of 32 bits */
215 mid_dma_count = dma_count % 4;
216 dma_count &= ~0x3;
217
218 if (dma_addr % 4 == 0) {
219 dma_config |= WDSIZE_32;
220 dma_count >>= 2;
221 dma_mod = 4;
222 } else if (dma_addr % 2 == 0) {
223 dma_config |= WDSIZE_16;
224 dma_count >>= 1;
225 dma_mod = 2;
226 } else {
227 dma_config |= WDSIZE_8;
228 dma_mod = 1;
229 }
230
231 crc->sg_cpu[i].start_addr = dma_addr;
232 crc->sg_cpu[i].cfg = dma_config;
233 crc->sg_cpu[i].x_count = dma_count;
234 crc->sg_cpu[i].x_modify = dma_mod;
235 dev_dbg(crc->dev, "%d: crc_dma: start_addr:0x%lx, "
236 "cfg:0x%lx, x_count:0x%lx, x_modify:0x%lx\n",
237 i, crc->sg_cpu[i].start_addr,
238 crc->sg_cpu[i].cfg, crc->sg_cpu[i].x_count,
239 crc->sg_cpu[i].x_modify);
240 i++;
241
242 if (mid_dma_count) {
243 /* copy extra bytes to next middle dma buffer */
Sonic Zhangb8840092012-06-04 12:24:47 +0800244 memcpy(crc->sg_mid_buf + (i << 2),
Sonic Zhang52d77eb2014-04-10 16:40:59 +0800245 (u8*)sg_virt(sg) + (dma_count << 2),
Sonic Zhangb8840092012-06-04 12:24:47 +0800246 mid_dma_count);
Sonic Zhangb8840092012-06-04 12:24:47 +0800247 }
248 }
249
250 dma_config = DMAFLOW_ARRAY | RESTART | NDSIZE_3 | DMAEN | PSIZE_32 | WDSIZE_32;
251 /* For final update req, append the buffer for next update as well*/
252 if (ctx->bufnext_len && (ctx->flag == CRC_CRYPTO_STATE_FINALUPDATE ||
253 ctx->flag == CRC_CRYPTO_STATE_FINISH)) {
254 crc->sg_cpu[i].start_addr = dma_map_single(crc->dev, ctx->bufnext,
255 CHKSUM_DIGEST_SIZE, DMA_TO_DEVICE);
256 crc->sg_cpu[i].cfg = dma_config;
257 crc->sg_cpu[i].x_count = 1;
258 crc->sg_cpu[i].x_modify = CHKSUM_DIGEST_SIZE;
259 dev_dbg(crc->dev, "%d: crc_dma: start_addr:0x%lx, "
260 "cfg:0x%lx, x_count:0x%lx, x_modify:0x%lx\n",
261 i, crc->sg_cpu[i].start_addr,
262 crc->sg_cpu[i].cfg, crc->sg_cpu[i].x_count,
263 crc->sg_cpu[i].x_modify);
264 i++;
265 }
266
267 if (i == 0)
268 return;
269
Sonic Zhangb8840092012-06-04 12:24:47 +0800270 /* Set the last descriptor to stop mode */
271 crc->sg_cpu[i - 1].cfg &= ~(DMAFLOW | NDSIZE);
272 crc->sg_cpu[i - 1].cfg |= DI_EN;
273 set_dma_curr_desc_addr(crc->dma_ch, (unsigned long *)crc->sg_dma);
274 set_dma_x_count(crc->dma_ch, 0);
275 set_dma_x_modify(crc->dma_ch, 0);
Sonic Zhangb8840092012-06-04 12:24:47 +0800276 set_dma_config(crc->dma_ch, dma_config);
277}
278
279static int bfin_crypto_crc_handle_queue(struct bfin_crypto_crc *crc,
280 struct ahash_request *req)
281{
282 struct crypto_async_request *async_req, *backlog;
283 struct bfin_crypto_crc_reqctx *ctx;
284 struct scatterlist *sg;
285 int ret = 0;
286 int nsg, i, j;
287 unsigned int nextlen;
288 unsigned long flags;
Sonic Zhang52e6e542014-04-10 14:30:56 +0800289 u32 reg;
Sonic Zhangb8840092012-06-04 12:24:47 +0800290
291 spin_lock_irqsave(&crc->lock, flags);
292 if (req)
293 ret = ahash_enqueue_request(&crc->queue, req);
294 if (crc->busy) {
295 spin_unlock_irqrestore(&crc->lock, flags);
296 return ret;
297 }
298 backlog = crypto_get_backlog(&crc->queue);
299 async_req = crypto_dequeue_request(&crc->queue);
300 if (async_req)
301 crc->busy = 1;
302 spin_unlock_irqrestore(&crc->lock, flags);
303
304 if (!async_req)
305 return ret;
306
307 if (backlog)
308 backlog->complete(backlog, -EINPROGRESS);
309
310 req = ahash_request_cast(async_req);
311 crc->req = req;
312 ctx = ahash_request_ctx(req);
313 ctx->sg = NULL;
314 ctx->sg_buflen = 0;
315 ctx->sg_nents = 0;
316
317 dev_dbg(crc->dev, "handling new req, flag=%u, nbytes: %d\n",
318 ctx->flag, req->nbytes);
319
320 if (ctx->flag == CRC_CRYPTO_STATE_FINISH) {
321 if (ctx->bufnext_len == 0) {
322 crc->busy = 0;
323 return 0;
324 }
325
326 /* Pack last crc update buffer to 32bit */
327 memset(ctx->bufnext + ctx->bufnext_len, 0,
328 CHKSUM_DIGEST_SIZE - ctx->bufnext_len);
329 } else {
330 /* Pack small data which is less than 32bit to buffer for next update. */
331 if (ctx->bufnext_len + req->nbytes < CHKSUM_DIGEST_SIZE) {
332 memcpy(ctx->bufnext + ctx->bufnext_len,
333 sg_virt(req->src), req->nbytes);
334 ctx->bufnext_len += req->nbytes;
335 if (ctx->flag == CRC_CRYPTO_STATE_FINALUPDATE &&
336 ctx->bufnext_len) {
337 goto finish_update;
338 } else {
339 crc->busy = 0;
340 return 0;
341 }
342 }
343
344 if (ctx->bufnext_len) {
345 /* Chain in extra bytes of last update */
346 ctx->buflast_len = ctx->bufnext_len;
347 memcpy(ctx->buflast, ctx->bufnext, ctx->buflast_len);
348
349 nsg = ctx->sg_buflen ? 2 : 1;
350 sg_init_table(ctx->bufsl, nsg);
351 sg_set_buf(ctx->bufsl, ctx->buflast, ctx->buflast_len);
352 if (nsg > 1)
Dan Williamsc56f6d12015-08-07 18:15:13 +0200353 sg_chain(ctx->bufsl, nsg, req->src);
Sonic Zhangb8840092012-06-04 12:24:47 +0800354 ctx->sg = ctx->bufsl;
355 } else
356 ctx->sg = req->src;
357
358 /* Chop crc buffer size to multiple of 32 bit */
LABBE Corentin1f6d79d2015-09-18 14:57:09 +0200359 nsg = sg_nents(ctx->sg);
360 ctx->sg_nents = nsg;
Sonic Zhangb8840092012-06-04 12:24:47 +0800361 ctx->sg_buflen = ctx->buflast_len + req->nbytes;
362 ctx->bufnext_len = ctx->sg_buflen % 4;
363 ctx->sg_buflen &= ~0x3;
364
365 if (ctx->bufnext_len) {
366 /* copy extra bytes to buffer for next update */
367 memset(ctx->bufnext, 0, CHKSUM_DIGEST_SIZE);
368 nextlen = ctx->bufnext_len;
369 for (i = nsg - 1; i >= 0; i--) {
370 sg = sg_get(ctx->sg, nsg, i);
371 j = min(nextlen, sg_dma_len(sg));
372 memcpy(ctx->bufnext + nextlen - j,
373 sg_virt(sg) + sg_dma_len(sg) - j, j);
374 if (j == sg_dma_len(sg))
375 ctx->sg_nents--;
376 nextlen -= j;
377 if (nextlen == 0)
378 break;
379 }
380 }
381 }
382
383finish_update:
384 if (ctx->bufnext_len && (ctx->flag == CRC_CRYPTO_STATE_FINALUPDATE ||
385 ctx->flag == CRC_CRYPTO_STATE_FINISH))
386 ctx->sg_buflen += CHKSUM_DIGEST_SIZE;
387
388 /* set CRC data count before start DMA */
Sonic Zhang52e6e542014-04-10 14:30:56 +0800389 writel(ctx->sg_buflen >> 2, &crc->regs->datacnt);
Sonic Zhangb8840092012-06-04 12:24:47 +0800390
391 /* setup and enable CRC DMA */
392 bfin_crypto_crc_config_dma(crc);
393
394 /* finally kick off CRC operation */
Sonic Zhang52e6e542014-04-10 14:30:56 +0800395 reg = readl(&crc->regs->control);
396 writel(reg | BLKEN, &crc->regs->control);
Sonic Zhangb8840092012-06-04 12:24:47 +0800397
398 return -EINPROGRESS;
399}
400
401static int bfin_crypto_crc_update(struct ahash_request *req)
402{
403 struct bfin_crypto_crc_reqctx *ctx = ahash_request_ctx(req);
404
405 if (!req->nbytes)
406 return 0;
407
408 dev_dbg(ctx->crc->dev, "crc_update\n");
409 ctx->total += req->nbytes;
410 ctx->flag = CRC_CRYPTO_STATE_UPDATE;
411
412 return bfin_crypto_crc_handle_queue(ctx->crc, req);
413}
414
415static int bfin_crypto_crc_final(struct ahash_request *req)
416{
417 struct crypto_ahash *tfm = crypto_ahash_reqtfm(req);
418 struct bfin_crypto_crc_ctx *crc_ctx = crypto_ahash_ctx(tfm);
419 struct bfin_crypto_crc_reqctx *ctx = ahash_request_ctx(req);
420
421 dev_dbg(ctx->crc->dev, "crc_final\n");
422 ctx->flag = CRC_CRYPTO_STATE_FINISH;
423 crc_ctx->key = 0;
424
425 return bfin_crypto_crc_handle_queue(ctx->crc, req);
426}
427
428static int bfin_crypto_crc_finup(struct ahash_request *req)
429{
430 struct crypto_ahash *tfm = crypto_ahash_reqtfm(req);
431 struct bfin_crypto_crc_ctx *crc_ctx = crypto_ahash_ctx(tfm);
432 struct bfin_crypto_crc_reqctx *ctx = ahash_request_ctx(req);
433
434 dev_dbg(ctx->crc->dev, "crc_finishupdate\n");
435 ctx->total += req->nbytes;
436 ctx->flag = CRC_CRYPTO_STATE_FINALUPDATE;
437 crc_ctx->key = 0;
438
439 return bfin_crypto_crc_handle_queue(ctx->crc, req);
440}
441
442static int bfin_crypto_crc_digest(struct ahash_request *req)
443{
444 int ret;
445
446 ret = bfin_crypto_crc_init(req);
447 if (ret)
448 return ret;
449
450 return bfin_crypto_crc_finup(req);
451}
452
453static int bfin_crypto_crc_setkey(struct crypto_ahash *tfm, const u8 *key,
454 unsigned int keylen)
455{
456 struct bfin_crypto_crc_ctx *crc_ctx = crypto_ahash_ctx(tfm);
457
458 dev_dbg(crc_ctx->crc->dev, "crc_setkey\n");
459 if (keylen != CHKSUM_DIGEST_SIZE) {
460 crypto_ahash_set_flags(tfm, CRYPTO_TFM_RES_BAD_KEY_LEN);
461 return -EINVAL;
462 }
463
464 crc_ctx->key = get_unaligned_le32(key);
465
466 return 0;
467}
468
469static int bfin_crypto_crc_cra_init(struct crypto_tfm *tfm)
470{
471 struct bfin_crypto_crc_ctx *crc_ctx = crypto_tfm_ctx(tfm);
472
473 crc_ctx->key = 0;
474 crypto_ahash_set_reqsize(__crypto_ahash_cast(tfm),
475 sizeof(struct bfin_crypto_crc_reqctx));
476
477 return 0;
478}
479
480static void bfin_crypto_crc_cra_exit(struct crypto_tfm *tfm)
481{
482}
483
484static struct ahash_alg algs = {
485 .init = bfin_crypto_crc_init,
486 .update = bfin_crypto_crc_update,
487 .final = bfin_crypto_crc_final,
488 .finup = bfin_crypto_crc_finup,
489 .digest = bfin_crypto_crc_digest,
490 .setkey = bfin_crypto_crc_setkey,
491 .halg.digestsize = CHKSUM_DIGEST_SIZE,
492 .halg.base = {
493 .cra_name = "hmac(crc32)",
494 .cra_driver_name = DRIVER_NAME,
495 .cra_priority = 100,
496 .cra_flags = CRYPTO_ALG_TYPE_AHASH |
497 CRYPTO_ALG_ASYNC,
498 .cra_blocksize = CHKSUM_BLOCK_SIZE,
499 .cra_ctxsize = sizeof(struct bfin_crypto_crc_ctx),
500 .cra_alignmask = 3,
501 .cra_module = THIS_MODULE,
502 .cra_init = bfin_crypto_crc_cra_init,
503 .cra_exit = bfin_crypto_crc_cra_exit,
504 }
505};
506
507static void bfin_crypto_crc_done_task(unsigned long data)
508{
509 struct bfin_crypto_crc *crc = (struct bfin_crypto_crc *)data;
510
511 bfin_crypto_crc_handle_queue(crc, NULL);
512}
513
514static irqreturn_t bfin_crypto_crc_handler(int irq, void *dev_id)
515{
516 struct bfin_crypto_crc *crc = dev_id;
Sonic Zhang52e6e542014-04-10 14:30:56 +0800517 u32 reg;
Sonic Zhangb8840092012-06-04 12:24:47 +0800518
Sonic Zhang52e6e542014-04-10 14:30:56 +0800519 if (readl(&crc->regs->status) & DCNTEXP) {
520 writel(DCNTEXP, &crc->regs->status);
Sonic Zhangb8840092012-06-04 12:24:47 +0800521
522 /* prepare results */
Sonic Zhang52e6e542014-04-10 14:30:56 +0800523 put_unaligned_le32(readl(&crc->regs->result),
524 crc->req->result);
Sonic Zhangb8840092012-06-04 12:24:47 +0800525
Sonic Zhang52e6e542014-04-10 14:30:56 +0800526 reg = readl(&crc->regs->control);
527 writel(reg & ~BLKEN, &crc->regs->control);
Sonic Zhangb8840092012-06-04 12:24:47 +0800528 crc->busy = 0;
529
530 if (crc->req->base.complete)
531 crc->req->base.complete(&crc->req->base, 0);
532
533 tasklet_schedule(&crc->done_task);
534
535 return IRQ_HANDLED;
536 } else
537 return IRQ_NONE;
538}
539
540#ifdef CONFIG_PM
541/**
542 * bfin_crypto_crc_suspend - suspend crc device
543 * @pdev: device being suspended
544 * @state: requested suspend state
545 */
546static int bfin_crypto_crc_suspend(struct platform_device *pdev, pm_message_t state)
547{
548 struct bfin_crypto_crc *crc = platform_get_drvdata(pdev);
549 int i = 100000;
550
Sonic Zhang52e6e542014-04-10 14:30:56 +0800551 while ((readl(&crc->regs->control) & BLKEN) && --i)
Sonic Zhangb8840092012-06-04 12:24:47 +0800552 cpu_relax();
553
554 if (i == 0)
555 return -EBUSY;
556
557 return 0;
558}
559#else
560# define bfin_crypto_crc_suspend NULL
561#endif
562
563#define bfin_crypto_crc_resume NULL
564
565/**
566 * bfin_crypto_crc_probe - Initialize module
567 *
568 */
Greg Kroah-Hartman49cfe4d2012-12-21 13:14:09 -0800569static int bfin_crypto_crc_probe(struct platform_device *pdev)
Sonic Zhangb8840092012-06-04 12:24:47 +0800570{
571 struct device *dev = &pdev->dev;
572 struct resource *res;
573 struct bfin_crypto_crc *crc;
574 unsigned int timeout = 100000;
575 int ret;
576
Sonic Zhang4ea5d992014-02-26 10:39:16 +0800577 crc = devm_kzalloc(dev, sizeof(*crc), GFP_KERNEL);
Sonic Zhangb8840092012-06-04 12:24:47 +0800578 if (!crc) {
579 dev_err(&pdev->dev, "fail to malloc bfin_crypto_crc\n");
580 return -ENOMEM;
581 }
582
583 crc->dev = dev;
584
585 INIT_LIST_HEAD(&crc->list);
586 spin_lock_init(&crc->lock);
587 tasklet_init(&crc->done_task, bfin_crypto_crc_done_task, (unsigned long)crc);
588 crypto_init_queue(&crc->queue, CRC_CCRYPTO_QUEUE_LENGTH);
589
590 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
Sonic Zhang4ea5d992014-02-26 10:39:16 +0800591 crc->regs = devm_ioremap_resource(dev, res);
592 if (IS_ERR((void *)crc->regs)) {
Sonic Zhangb8840092012-06-04 12:24:47 +0800593 dev_err(&pdev->dev, "Cannot map CRC IO\n");
Sonic Zhang4ea5d992014-02-26 10:39:16 +0800594 return PTR_ERR((void *)crc->regs);
Sonic Zhangb8840092012-06-04 12:24:47 +0800595 }
596
597 crc->irq = platform_get_irq(pdev, 0);
598 if (crc->irq < 0) {
599 dev_err(&pdev->dev, "No CRC DCNTEXP IRQ specified\n");
Sonic Zhang4ea5d992014-02-26 10:39:16 +0800600 return -ENOENT;
Sonic Zhangb8840092012-06-04 12:24:47 +0800601 }
602
Sonic Zhang4ea5d992014-02-26 10:39:16 +0800603 ret = devm_request_irq(dev, crc->irq, bfin_crypto_crc_handler,
604 IRQF_SHARED, dev_name(dev), crc);
Sonic Zhangb8840092012-06-04 12:24:47 +0800605 if (ret) {
606 dev_err(&pdev->dev, "Unable to request blackfin crc irq\n");
Sonic Zhang4ea5d992014-02-26 10:39:16 +0800607 return ret;
Sonic Zhangb8840092012-06-04 12:24:47 +0800608 }
609
610 res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
611 if (res == NULL) {
612 dev_err(&pdev->dev, "No CRC DMA channel specified\n");
Sonic Zhang4ea5d992014-02-26 10:39:16 +0800613 return -ENOENT;
Sonic Zhangb8840092012-06-04 12:24:47 +0800614 }
615 crc->dma_ch = res->start;
616
617 ret = request_dma(crc->dma_ch, dev_name(dev));
618 if (ret) {
619 dev_err(&pdev->dev, "Unable to attach Blackfin CRC DMA channel\n");
Sonic Zhang4ea5d992014-02-26 10:39:16 +0800620 return ret;
Sonic Zhangb8840092012-06-04 12:24:47 +0800621 }
622
623 crc->sg_cpu = dma_alloc_coherent(&pdev->dev, PAGE_SIZE, &crc->sg_dma, GFP_KERNEL);
624 if (crc->sg_cpu == NULL) {
625 ret = -ENOMEM;
626 goto out_error_dma;
627 }
628 /*
629 * need at most CRC_MAX_DMA_DESC sg + CRC_MAX_DMA_DESC middle +
630 * 1 last + 1 next dma descriptors
631 */
632 crc->sg_mid_buf = (u8 *)(crc->sg_cpu + ((CRC_MAX_DMA_DESC + 1) << 1));
Sonic Zhang52d77eb2014-04-10 16:40:59 +0800633 crc->sg_mid_dma = crc->sg_dma + sizeof(struct dma_desc_array)
634 * ((CRC_MAX_DMA_DESC + 1) << 1);
Sonic Zhangb8840092012-06-04 12:24:47 +0800635
Sonic Zhang52e6e542014-04-10 14:30:56 +0800636 writel(0, &crc->regs->control);
637 crc->poly = (u32)pdev->dev.platform_data;
638 writel(crc->poly, &crc->regs->poly);
Sonic Zhangb8840092012-06-04 12:24:47 +0800639
Sonic Zhang52e6e542014-04-10 14:30:56 +0800640 while (!(readl(&crc->regs->status) & LUTDONE) && (--timeout) > 0)
Sonic Zhangb8840092012-06-04 12:24:47 +0800641 cpu_relax();
642
643 if (timeout == 0)
644 dev_info(&pdev->dev, "init crc poly timeout\n");
645
Sonic Zhang8d390392014-04-11 17:30:25 +0800646 platform_set_drvdata(pdev, crc);
647
Sonic Zhangb8840092012-06-04 12:24:47 +0800648 spin_lock(&crc_list.lock);
649 list_add(&crc->list, &crc_list.dev_list);
650 spin_unlock(&crc_list.lock);
651
Sonic Zhang8d390392014-04-11 17:30:25 +0800652 if (list_is_singular(&crc_list.dev_list)) {
653 ret = crypto_register_ahash(&algs);
654 if (ret) {
655 dev_err(&pdev->dev,
656 "Can't register crypto ahash device\n");
657 goto out_error_dma;
658 }
Sonic Zhangb8840092012-06-04 12:24:47 +0800659 }
660
661 dev_info(&pdev->dev, "initialized\n");
662
663 return 0;
664
665out_error_dma:
666 if (crc->sg_cpu)
667 dma_free_coherent(&pdev->dev, PAGE_SIZE, crc->sg_cpu, crc->sg_dma);
668 free_dma(crc->dma_ch);
Sonic Zhangb8840092012-06-04 12:24:47 +0800669
670 return ret;
671}
672
673/**
674 * bfin_crypto_crc_remove - Initialize module
675 *
676 */
Greg Kroah-Hartman49cfe4d2012-12-21 13:14:09 -0800677static int bfin_crypto_crc_remove(struct platform_device *pdev)
Sonic Zhangb8840092012-06-04 12:24:47 +0800678{
679 struct bfin_crypto_crc *crc = platform_get_drvdata(pdev);
680
681 if (!crc)
682 return -ENODEV;
683
684 spin_lock(&crc_list.lock);
685 list_del(&crc->list);
686 spin_unlock(&crc_list.lock);
687
688 crypto_unregister_ahash(&algs);
689 tasklet_kill(&crc->done_task);
Sonic Zhangb8840092012-06-04 12:24:47 +0800690 free_dma(crc->dma_ch);
Sonic Zhangb8840092012-06-04 12:24:47 +0800691
692 return 0;
693}
694
695static struct platform_driver bfin_crypto_crc_driver = {
696 .probe = bfin_crypto_crc_probe,
Greg Kroah-Hartman49cfe4d2012-12-21 13:14:09 -0800697 .remove = bfin_crypto_crc_remove,
Sonic Zhangb8840092012-06-04 12:24:47 +0800698 .suspend = bfin_crypto_crc_suspend,
699 .resume = bfin_crypto_crc_resume,
700 .driver = {
701 .name = DRIVER_NAME,
Sonic Zhangb8840092012-06-04 12:24:47 +0800702 },
703};
704
705/**
706 * bfin_crypto_crc_mod_init - Initialize module
707 *
708 * Checks the module params and registers the platform driver.
709 * Real work is in the platform probe function.
710 */
711static int __init bfin_crypto_crc_mod_init(void)
712{
713 int ret;
714
715 pr_info("Blackfin hardware CRC crypto driver\n");
716
717 INIT_LIST_HEAD(&crc_list.dev_list);
718 spin_lock_init(&crc_list.lock);
719
720 ret = platform_driver_register(&bfin_crypto_crc_driver);
721 if (ret) {
Masanari Iida28c29f52015-01-02 12:40:46 +0900722 pr_err("unable to register driver\n");
Sonic Zhangb8840092012-06-04 12:24:47 +0800723 return ret;
724 }
725
726 return 0;
727}
728
729/**
730 * bfin_crypto_crc_mod_exit - Deinitialize module
731 */
732static void __exit bfin_crypto_crc_mod_exit(void)
733{
734 platform_driver_unregister(&bfin_crypto_crc_driver);
735}
736
737module_init(bfin_crypto_crc_mod_init);
738module_exit(bfin_crypto_crc_mod_exit);
739
740MODULE_AUTHOR("Sonic Zhang <sonic.zhang@analog.com>");
741MODULE_DESCRIPTION("Blackfin CRC hardware crypto driver");
742MODULE_LICENSE("GPL");