blob: d5829c734fad2e93bf1535fa477718f2b9ac26d4 [file] [log] [blame]
Jassi Brarb3040e42010-05-23 20:28:19 -07001/* linux/drivers/dma/pl330.c
2 *
3 * Copyright (C) 2010 Samsung Electronics Co. Ltd.
4 * Jaswinder Singh <jassi.brar@samsung.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 */
11
12#include <linux/io.h>
13#include <linux/init.h>
14#include <linux/slab.h>
15#include <linux/module.h>
16#include <linux/dmaengine.h>
17#include <linux/interrupt.h>
18#include <linux/amba/bus.h>
19#include <linux/amba/pl330.h>
Boojin Kima2f52032011-09-02 09:44:29 +090020#include <linux/pm_runtime.h>
Boojin Kim1b9bb712011-09-02 09:44:30 +090021#include <linux/scatterlist.h>
Jassi Brarb3040e42010-05-23 20:28:19 -070022
23#define NR_DEFAULT_DESC 16
24
25enum desc_status {
26 /* In the DMAC pool */
27 FREE,
28 /*
29 * Allocted to some channel during prep_xxx
30 * Also may be sitting on the work_list.
31 */
32 PREP,
33 /*
34 * Sitting on the work_list and already submitted
35 * to the PL330 core. Not more than two descriptors
36 * of a channel can be BUSY at any time.
37 */
38 BUSY,
39 /*
40 * Sitting on the channel work_list but xfer done
41 * by PL330 core
42 */
43 DONE,
44};
45
46struct dma_pl330_chan {
47 /* Schedule desc completion */
48 struct tasklet_struct task;
49
50 /* DMA-Engine Channel */
51 struct dma_chan chan;
52
53 /* Last completed cookie */
54 dma_cookie_t completed;
55
56 /* List of to be xfered descriptors */
57 struct list_head work_list;
58
59 /* Pointer to the DMAC that manages this channel,
60 * NULL if the channel is available to be acquired.
61 * As the parent, this DMAC also provides descriptors
62 * to the channel.
63 */
64 struct dma_pl330_dmac *dmac;
65
66 /* To protect channel manipulation */
67 spinlock_t lock;
68
69 /* Token of a hardware channel thread of PL330 DMAC
70 * NULL if the channel is available to be acquired.
71 */
72 void *pl330_chid;
Boojin Kim1b9bb712011-09-02 09:44:30 +090073
74 /* For D-to-M and M-to-D channels */
75 int burst_sz; /* the peripheral fifo width */
76 dma_addr_t fifo_addr;
Jassi Brarb3040e42010-05-23 20:28:19 -070077};
78
79struct dma_pl330_dmac {
80 struct pl330_info pif;
81
82 /* DMA-Engine Device */
83 struct dma_device ddma;
84
85 /* Pool of descriptors available for the DMAC's channels */
86 struct list_head desc_pool;
87 /* To protect desc_pool manipulation */
88 spinlock_t pool_lock;
89
90 /* Peripheral channels connected to this DMAC */
Rob Herring4e0e6102011-07-25 16:05:04 -050091 struct dma_pl330_chan *peripherals; /* keep at end */
Boojin Kima2f52032011-09-02 09:44:29 +090092
93 struct clk *clk;
Jassi Brarb3040e42010-05-23 20:28:19 -070094};
95
96struct dma_pl330_desc {
97 /* To attach to a queue as child */
98 struct list_head node;
99
100 /* Descriptor for the DMA Engine API */
101 struct dma_async_tx_descriptor txd;
102
103 /* Xfer for PL330 core */
104 struct pl330_xfer px;
105
106 struct pl330_reqcfg rqcfg;
107 struct pl330_req req;
108
109 enum desc_status status;
110
111 /* The channel which currently holds this desc */
112 struct dma_pl330_chan *pchan;
113};
114
115static inline struct dma_pl330_chan *
116to_pchan(struct dma_chan *ch)
117{
118 if (!ch)
119 return NULL;
120
121 return container_of(ch, struct dma_pl330_chan, chan);
122}
123
124static inline struct dma_pl330_desc *
125to_desc(struct dma_async_tx_descriptor *tx)
126{
127 return container_of(tx, struct dma_pl330_desc, txd);
128}
129
130static inline void free_desc_list(struct list_head *list)
131{
132 struct dma_pl330_dmac *pdmac;
133 struct dma_pl330_desc *desc;
134 struct dma_pl330_chan *pch;
135 unsigned long flags;
136
137 if (list_empty(list))
138 return;
139
140 /* Finish off the work list */
141 list_for_each_entry(desc, list, node) {
142 dma_async_tx_callback callback;
143 void *param;
144
145 /* All desc in a list belong to same channel */
146 pch = desc->pchan;
147 callback = desc->txd.callback;
148 param = desc->txd.callback_param;
149
150 if (callback)
151 callback(param);
152
153 desc->pchan = NULL;
154 }
155
156 pdmac = pch->dmac;
157
158 spin_lock_irqsave(&pdmac->pool_lock, flags);
159 list_splice_tail_init(list, &pdmac->desc_pool);
160 spin_unlock_irqrestore(&pdmac->pool_lock, flags);
161}
162
163static inline void fill_queue(struct dma_pl330_chan *pch)
164{
165 struct dma_pl330_desc *desc;
166 int ret;
167
168 list_for_each_entry(desc, &pch->work_list, node) {
169
170 /* If already submitted */
171 if (desc->status == BUSY)
172 break;
173
174 ret = pl330_submit_req(pch->pl330_chid,
175 &desc->req);
176 if (!ret) {
177 desc->status = BUSY;
178 break;
179 } else if (ret == -EAGAIN) {
180 /* QFull or DMAC Dying */
181 break;
182 } else {
183 /* Unacceptable request */
184 desc->status = DONE;
185 dev_err(pch->dmac->pif.dev, "%s:%d Bad Desc(%d)\n",
186 __func__, __LINE__, desc->txd.cookie);
187 tasklet_schedule(&pch->task);
188 }
189 }
190}
191
192static void pl330_tasklet(unsigned long data)
193{
194 struct dma_pl330_chan *pch = (struct dma_pl330_chan *)data;
195 struct dma_pl330_desc *desc, *_dt;
196 unsigned long flags;
197 LIST_HEAD(list);
198
199 spin_lock_irqsave(&pch->lock, flags);
200
201 /* Pick up ripe tomatoes */
202 list_for_each_entry_safe(desc, _dt, &pch->work_list, node)
203 if (desc->status == DONE) {
204 pch->completed = desc->txd.cookie;
205 list_move_tail(&desc->node, &list);
206 }
207
208 /* Try to submit a req imm. next to the last completed cookie */
209 fill_queue(pch);
210
211 /* Make sure the PL330 Channel thread is active */
212 pl330_chan_ctrl(pch->pl330_chid, PL330_OP_START);
213
214 spin_unlock_irqrestore(&pch->lock, flags);
215
216 free_desc_list(&list);
217}
218
219static void dma_pl330_rqcb(void *token, enum pl330_op_err err)
220{
221 struct dma_pl330_desc *desc = token;
222 struct dma_pl330_chan *pch = desc->pchan;
223 unsigned long flags;
224
225 /* If desc aborted */
226 if (!pch)
227 return;
228
229 spin_lock_irqsave(&pch->lock, flags);
230
231 desc->status = DONE;
232
233 spin_unlock_irqrestore(&pch->lock, flags);
234
235 tasklet_schedule(&pch->task);
236}
237
238static int pl330_alloc_chan_resources(struct dma_chan *chan)
239{
240 struct dma_pl330_chan *pch = to_pchan(chan);
241 struct dma_pl330_dmac *pdmac = pch->dmac;
242 unsigned long flags;
243
244 spin_lock_irqsave(&pch->lock, flags);
245
246 pch->completed = chan->cookie = 1;
247
248 pch->pl330_chid = pl330_request_channel(&pdmac->pif);
249 if (!pch->pl330_chid) {
250 spin_unlock_irqrestore(&pch->lock, flags);
251 return 0;
252 }
253
254 tasklet_init(&pch->task, pl330_tasklet, (unsigned long) pch);
255
256 spin_unlock_irqrestore(&pch->lock, flags);
257
258 return 1;
259}
260
261static int pl330_control(struct dma_chan *chan, enum dma_ctrl_cmd cmd, unsigned long arg)
262{
263 struct dma_pl330_chan *pch = to_pchan(chan);
264 struct dma_pl330_desc *desc;
265 unsigned long flags;
266
267 /* Only supports DMA_TERMINATE_ALL */
268 if (cmd != DMA_TERMINATE_ALL)
269 return -ENXIO;
270
271 spin_lock_irqsave(&pch->lock, flags);
272
273 /* FLUSH the PL330 Channel thread */
274 pl330_chan_ctrl(pch->pl330_chid, PL330_OP_FLUSH);
275
276 /* Mark all desc done */
277 list_for_each_entry(desc, &pch->work_list, node)
278 desc->status = DONE;
279
280 spin_unlock_irqrestore(&pch->lock, flags);
281
282 pl330_tasklet((unsigned long) pch);
283
284 return 0;
285}
286
287static void pl330_free_chan_resources(struct dma_chan *chan)
288{
289 struct dma_pl330_chan *pch = to_pchan(chan);
290 unsigned long flags;
291
292 spin_lock_irqsave(&pch->lock, flags);
293
294 tasklet_kill(&pch->task);
295
296 pl330_release_channel(pch->pl330_chid);
297 pch->pl330_chid = NULL;
298
299 spin_unlock_irqrestore(&pch->lock, flags);
300}
301
302static enum dma_status
303pl330_tx_status(struct dma_chan *chan, dma_cookie_t cookie,
304 struct dma_tx_state *txstate)
305{
306 struct dma_pl330_chan *pch = to_pchan(chan);
307 dma_cookie_t last_done, last_used;
308 int ret;
309
310 last_done = pch->completed;
311 last_used = chan->cookie;
312
313 ret = dma_async_is_complete(cookie, last_done, last_used);
314
315 dma_set_tx_state(txstate, last_done, last_used, 0);
316
317 return ret;
318}
319
320static void pl330_issue_pending(struct dma_chan *chan)
321{
322 pl330_tasklet((unsigned long) to_pchan(chan));
323}
324
325/*
326 * We returned the last one of the circular list of descriptor(s)
327 * from prep_xxx, so the argument to submit corresponds to the last
328 * descriptor of the list.
329 */
330static dma_cookie_t pl330_tx_submit(struct dma_async_tx_descriptor *tx)
331{
332 struct dma_pl330_desc *desc, *last = to_desc(tx);
333 struct dma_pl330_chan *pch = to_pchan(tx->chan);
334 dma_cookie_t cookie;
335 unsigned long flags;
336
337 spin_lock_irqsave(&pch->lock, flags);
338
339 /* Assign cookies to all nodes */
340 cookie = tx->chan->cookie;
341
342 while (!list_empty(&last->node)) {
343 desc = list_entry(last->node.next, struct dma_pl330_desc, node);
344
345 if (++cookie < 0)
346 cookie = 1;
347 desc->txd.cookie = cookie;
348
349 list_move_tail(&desc->node, &pch->work_list);
350 }
351
352 if (++cookie < 0)
353 cookie = 1;
354 last->txd.cookie = cookie;
355
356 list_add_tail(&last->node, &pch->work_list);
357
358 tx->chan->cookie = cookie;
359
360 spin_unlock_irqrestore(&pch->lock, flags);
361
362 return cookie;
363}
364
365static inline void _init_desc(struct dma_pl330_desc *desc)
366{
367 desc->pchan = NULL;
368 desc->req.x = &desc->px;
369 desc->req.token = desc;
370 desc->rqcfg.swap = SWAP_NO;
371 desc->rqcfg.privileged = 0;
372 desc->rqcfg.insnaccess = 0;
373 desc->rqcfg.scctl = SCCTRL0;
374 desc->rqcfg.dcctl = DCCTRL0;
375 desc->req.cfg = &desc->rqcfg;
376 desc->req.xfer_cb = dma_pl330_rqcb;
377 desc->txd.tx_submit = pl330_tx_submit;
378
379 INIT_LIST_HEAD(&desc->node);
380}
381
382/* Returns the number of descriptors added to the DMAC pool */
383int add_desc(struct dma_pl330_dmac *pdmac, gfp_t flg, int count)
384{
385 struct dma_pl330_desc *desc;
386 unsigned long flags;
387 int i;
388
389 if (!pdmac)
390 return 0;
391
392 desc = kmalloc(count * sizeof(*desc), flg);
393 if (!desc)
394 return 0;
395
396 spin_lock_irqsave(&pdmac->pool_lock, flags);
397
398 for (i = 0; i < count; i++) {
399 _init_desc(&desc[i]);
400 list_add_tail(&desc[i].node, &pdmac->desc_pool);
401 }
402
403 spin_unlock_irqrestore(&pdmac->pool_lock, flags);
404
405 return count;
406}
407
408static struct dma_pl330_desc *
409pluck_desc(struct dma_pl330_dmac *pdmac)
410{
411 struct dma_pl330_desc *desc = NULL;
412 unsigned long flags;
413
414 if (!pdmac)
415 return NULL;
416
417 spin_lock_irqsave(&pdmac->pool_lock, flags);
418
419 if (!list_empty(&pdmac->desc_pool)) {
420 desc = list_entry(pdmac->desc_pool.next,
421 struct dma_pl330_desc, node);
422
423 list_del_init(&desc->node);
424
425 desc->status = PREP;
426 desc->txd.callback = NULL;
427 }
428
429 spin_unlock_irqrestore(&pdmac->pool_lock, flags);
430
431 return desc;
432}
433
434static struct dma_pl330_desc *pl330_get_desc(struct dma_pl330_chan *pch)
435{
436 struct dma_pl330_dmac *pdmac = pch->dmac;
437 struct dma_pl330_peri *peri = pch->chan.private;
438 struct dma_pl330_desc *desc;
439
440 /* Pluck one desc from the pool of DMAC */
441 desc = pluck_desc(pdmac);
442
443 /* If the DMAC pool is empty, alloc new */
444 if (!desc) {
445 if (!add_desc(pdmac, GFP_ATOMIC, 1))
446 return NULL;
447
448 /* Try again */
449 desc = pluck_desc(pdmac);
450 if (!desc) {
451 dev_err(pch->dmac->pif.dev,
452 "%s:%d ALERT!\n", __func__, __LINE__);
453 return NULL;
454 }
455 }
456
457 /* Initialize the descriptor */
458 desc->pchan = pch;
459 desc->txd.cookie = 0;
460 async_tx_ack(&desc->txd);
461
Rob Herring4e0e6102011-07-25 16:05:04 -0500462 if (peri) {
463 desc->req.rqtype = peri->rqtype;
Boojin Kim1b9bb712011-09-02 09:44:30 +0900464 desc->req.peri = pch->chan.chan_id;
Rob Herring4e0e6102011-07-25 16:05:04 -0500465 } else {
466 desc->req.rqtype = MEMTOMEM;
467 desc->req.peri = 0;
468 }
Jassi Brarb3040e42010-05-23 20:28:19 -0700469
470 dma_async_tx_descriptor_init(&desc->txd, &pch->chan);
471
472 return desc;
473}
474
475static inline void fill_px(struct pl330_xfer *px,
476 dma_addr_t dst, dma_addr_t src, size_t len)
477{
478 px->next = NULL;
479 px->bytes = len;
480 px->dst_addr = dst;
481 px->src_addr = src;
482}
483
484static struct dma_pl330_desc *
485__pl330_prep_dma_memcpy(struct dma_pl330_chan *pch, dma_addr_t dst,
486 dma_addr_t src, size_t len)
487{
488 struct dma_pl330_desc *desc = pl330_get_desc(pch);
489
490 if (!desc) {
491 dev_err(pch->dmac->pif.dev, "%s:%d Unable to fetch desc\n",
492 __func__, __LINE__);
493 return NULL;
494 }
495
496 /*
497 * Ideally we should lookout for reqs bigger than
498 * those that can be programmed with 256 bytes of
499 * MC buffer, but considering a req size is seldom
500 * going to be word-unaligned and more than 200MB,
501 * we take it easy.
502 * Also, should the limit is reached we'd rather
503 * have the platform increase MC buffer size than
504 * complicating this API driver.
505 */
506 fill_px(&desc->px, dst, src, len);
507
508 return desc;
509}
510
511/* Call after fixing burst size */
512static inline int get_burst_len(struct dma_pl330_desc *desc, size_t len)
513{
514 struct dma_pl330_chan *pch = desc->pchan;
515 struct pl330_info *pi = &pch->dmac->pif;
516 int burst_len;
517
518 burst_len = pi->pcfg.data_bus_width / 8;
519 burst_len *= pi->pcfg.data_buf_dep;
520 burst_len >>= desc->rqcfg.brst_size;
521
522 /* src/dst_burst_len can't be more than 16 */
523 if (burst_len > 16)
524 burst_len = 16;
525
526 while (burst_len > 1) {
527 if (!(len % (burst_len << desc->rqcfg.brst_size)))
528 break;
529 burst_len--;
530 }
531
532 return burst_len;
533}
534
535static struct dma_async_tx_descriptor *
536pl330_prep_dma_memcpy(struct dma_chan *chan, dma_addr_t dst,
537 dma_addr_t src, size_t len, unsigned long flags)
538{
539 struct dma_pl330_desc *desc;
540 struct dma_pl330_chan *pch = to_pchan(chan);
541 struct dma_pl330_peri *peri = chan->private;
542 struct pl330_info *pi;
543 int burst;
544
Rob Herring4e0e6102011-07-25 16:05:04 -0500545 if (unlikely(!pch || !len))
Jassi Brarb3040e42010-05-23 20:28:19 -0700546 return NULL;
547
Rob Herring4e0e6102011-07-25 16:05:04 -0500548 if (peri && peri->rqtype != MEMTOMEM)
Jassi Brarb3040e42010-05-23 20:28:19 -0700549 return NULL;
550
551 pi = &pch->dmac->pif;
552
553 desc = __pl330_prep_dma_memcpy(pch, dst, src, len);
554 if (!desc)
555 return NULL;
556
557 desc->rqcfg.src_inc = 1;
558 desc->rqcfg.dst_inc = 1;
559
560 /* Select max possible burst size */
561 burst = pi->pcfg.data_bus_width / 8;
562
563 while (burst > 1) {
564 if (!(len % burst))
565 break;
566 burst /= 2;
567 }
568
569 desc->rqcfg.brst_size = 0;
570 while (burst != (1 << desc->rqcfg.brst_size))
571 desc->rqcfg.brst_size++;
572
573 desc->rqcfg.brst_len = get_burst_len(desc, len);
574
575 desc->txd.flags = flags;
576
577 return &desc->txd;
578}
579
580static struct dma_async_tx_descriptor *
581pl330_prep_slave_sg(struct dma_chan *chan, struct scatterlist *sgl,
582 unsigned int sg_len, enum dma_data_direction direction,
583 unsigned long flg)
584{
585 struct dma_pl330_desc *first, *desc = NULL;
586 struct dma_pl330_chan *pch = to_pchan(chan);
587 struct dma_pl330_peri *peri = chan->private;
588 struct scatterlist *sg;
589 unsigned long flags;
Boojin Kim1b9bb712011-09-02 09:44:30 +0900590 int i;
Jassi Brarb3040e42010-05-23 20:28:19 -0700591 dma_addr_t addr;
592
Rob Herring4e0e6102011-07-25 16:05:04 -0500593 if (unlikely(!pch || !sgl || !sg_len || !peri))
Jassi Brarb3040e42010-05-23 20:28:19 -0700594 return NULL;
595
596 /* Make sure the direction is consistent */
597 if ((direction == DMA_TO_DEVICE &&
598 peri->rqtype != MEMTODEV) ||
599 (direction == DMA_FROM_DEVICE &&
600 peri->rqtype != DEVTOMEM)) {
601 dev_err(pch->dmac->pif.dev, "%s:%d Invalid Direction\n",
602 __func__, __LINE__);
603 return NULL;
604 }
605
Boojin Kim1b9bb712011-09-02 09:44:30 +0900606 addr = pch->fifo_addr;
Jassi Brarb3040e42010-05-23 20:28:19 -0700607
608 first = NULL;
609
610 for_each_sg(sgl, sg, sg_len, i) {
611
612 desc = pl330_get_desc(pch);
613 if (!desc) {
614 struct dma_pl330_dmac *pdmac = pch->dmac;
615
616 dev_err(pch->dmac->pif.dev,
617 "%s:%d Unable to fetch desc\n",
618 __func__, __LINE__);
619 if (!first)
620 return NULL;
621
622 spin_lock_irqsave(&pdmac->pool_lock, flags);
623
624 while (!list_empty(&first->node)) {
625 desc = list_entry(first->node.next,
626 struct dma_pl330_desc, node);
627 list_move_tail(&desc->node, &pdmac->desc_pool);
628 }
629
630 list_move_tail(&first->node, &pdmac->desc_pool);
631
632 spin_unlock_irqrestore(&pdmac->pool_lock, flags);
633
634 return NULL;
635 }
636
637 if (!first)
638 first = desc;
639 else
640 list_add_tail(&desc->node, &first->node);
641
642 if (direction == DMA_TO_DEVICE) {
643 desc->rqcfg.src_inc = 1;
644 desc->rqcfg.dst_inc = 0;
645 fill_px(&desc->px,
646 addr, sg_dma_address(sg), sg_dma_len(sg));
647 } else {
648 desc->rqcfg.src_inc = 0;
649 desc->rqcfg.dst_inc = 1;
650 fill_px(&desc->px,
651 sg_dma_address(sg), addr, sg_dma_len(sg));
652 }
653
Boojin Kim1b9bb712011-09-02 09:44:30 +0900654 desc->rqcfg.brst_size = pch->burst_sz;
Jassi Brarb3040e42010-05-23 20:28:19 -0700655 desc->rqcfg.brst_len = 1;
656 }
657
658 /* Return the last desc in the chain */
659 desc->txd.flags = flg;
660 return &desc->txd;
661}
662
663static irqreturn_t pl330_irq_handler(int irq, void *data)
664{
665 if (pl330_update(data))
666 return IRQ_HANDLED;
667 else
668 return IRQ_NONE;
669}
670
671static int __devinit
Russell Kingaa25afa2011-02-19 15:55:00 +0000672pl330_probe(struct amba_device *adev, const struct amba_id *id)
Jassi Brarb3040e42010-05-23 20:28:19 -0700673{
674 struct dma_pl330_platdata *pdat;
675 struct dma_pl330_dmac *pdmac;
676 struct dma_pl330_chan *pch;
677 struct pl330_info *pi;
678 struct dma_device *pd;
679 struct resource *res;
680 int i, ret, irq;
Rob Herring4e0e6102011-07-25 16:05:04 -0500681 int num_chan;
Jassi Brarb3040e42010-05-23 20:28:19 -0700682
683 pdat = adev->dev.platform_data;
684
Jassi Brarb3040e42010-05-23 20:28:19 -0700685 /* Allocate a new DMAC and its Channels */
Rob Herring4e0e6102011-07-25 16:05:04 -0500686 pdmac = kzalloc(sizeof(*pdmac), GFP_KERNEL);
Jassi Brarb3040e42010-05-23 20:28:19 -0700687 if (!pdmac) {
688 dev_err(&adev->dev, "unable to allocate mem\n");
689 return -ENOMEM;
690 }
691
692 pi = &pdmac->pif;
693 pi->dev = &adev->dev;
694 pi->pl330_data = NULL;
Rob Herring4e0e6102011-07-25 16:05:04 -0500695 pi->mcbufsz = pdat ? pdat->mcbuf_sz : 0;
Jassi Brarb3040e42010-05-23 20:28:19 -0700696
697 res = &adev->res;
698 request_mem_region(res->start, resource_size(res), "dma-pl330");
699
700 pi->base = ioremap(res->start, resource_size(res));
701 if (!pi->base) {
702 ret = -ENXIO;
703 goto probe_err1;
704 }
705
Boojin Kima2f52032011-09-02 09:44:29 +0900706 pdmac->clk = clk_get(&adev->dev, "dma");
707 if (IS_ERR(pdmac->clk)) {
708 dev_err(&adev->dev, "Cannot get operation clock.\n");
709 ret = -EINVAL;
710 goto probe_err1;
711 }
712
713 amba_set_drvdata(adev, pdmac);
714
715#ifdef CONFIG_PM_RUNTIME
716 /* to use the runtime PM helper functions */
717 pm_runtime_enable(&adev->dev);
718
719 /* enable the power domain */
720 if (pm_runtime_get_sync(&adev->dev)) {
721 dev_err(&adev->dev, "failed to get runtime pm\n");
722 ret = -ENODEV;
723 goto probe_err1;
724 }
725#else
726 /* enable dma clk */
727 clk_enable(pdmac->clk);
728#endif
729
Jassi Brarb3040e42010-05-23 20:28:19 -0700730 irq = adev->irq[0];
731 ret = request_irq(irq, pl330_irq_handler, 0,
732 dev_name(&adev->dev), pi);
733 if (ret)
734 goto probe_err2;
735
736 ret = pl330_add(pi);
737 if (ret)
738 goto probe_err3;
739
740 INIT_LIST_HEAD(&pdmac->desc_pool);
741 spin_lock_init(&pdmac->pool_lock);
742
743 /* Create a descriptor pool of default size */
744 if (!add_desc(pdmac, GFP_KERNEL, NR_DEFAULT_DESC))
745 dev_warn(&adev->dev, "unable to allocate desc\n");
746
747 pd = &pdmac->ddma;
748 INIT_LIST_HEAD(&pd->channels);
749
750 /* Initialize channel parameters */
Rob Herring4e0e6102011-07-25 16:05:04 -0500751 num_chan = max(pdat ? pdat->nr_valid_peri : 0, (u8)pi->pcfg.num_chan);
752 pdmac->peripherals = kzalloc(num_chan * sizeof(*pch), GFP_KERNEL);
Jassi Brarb3040e42010-05-23 20:28:19 -0700753
Rob Herring4e0e6102011-07-25 16:05:04 -0500754 for (i = 0; i < num_chan; i++) {
755 pch = &pdmac->peripherals[i];
756 if (pdat) {
757 struct dma_pl330_peri *peri = &pdat->peri[i];
758
759 switch (peri->rqtype) {
760 case MEMTOMEM:
761 dma_cap_set(DMA_MEMCPY, pd->cap_mask);
762 break;
763 case MEMTODEV:
764 case DEVTOMEM:
765 dma_cap_set(DMA_SLAVE, pd->cap_mask);
766 break;
767 default:
768 dev_err(&adev->dev, "DEVTODEV Not Supported\n");
769 continue;
770 }
771 pch->chan.private = peri;
772 } else {
Jassi Brarb3040e42010-05-23 20:28:19 -0700773 dma_cap_set(DMA_MEMCPY, pd->cap_mask);
Rob Herring4e0e6102011-07-25 16:05:04 -0500774 pch->chan.private = NULL;
Jassi Brarb3040e42010-05-23 20:28:19 -0700775 }
776
777 INIT_LIST_HEAD(&pch->work_list);
778 spin_lock_init(&pch->lock);
779 pch->pl330_chid = NULL;
Jassi Brarb3040e42010-05-23 20:28:19 -0700780 pch->chan.device = pd;
781 pch->chan.chan_id = i;
782 pch->dmac = pdmac;
783
784 /* Add the channel to the DMAC list */
785 pd->chancnt++;
786 list_add_tail(&pch->chan.device_node, &pd->channels);
787 }
788
789 pd->dev = &adev->dev;
790
791 pd->device_alloc_chan_resources = pl330_alloc_chan_resources;
792 pd->device_free_chan_resources = pl330_free_chan_resources;
793 pd->device_prep_dma_memcpy = pl330_prep_dma_memcpy;
794 pd->device_tx_status = pl330_tx_status;
795 pd->device_prep_slave_sg = pl330_prep_slave_sg;
796 pd->device_control = pl330_control;
797 pd->device_issue_pending = pl330_issue_pending;
798
799 ret = dma_async_device_register(pd);
800 if (ret) {
801 dev_err(&adev->dev, "unable to register DMAC\n");
802 goto probe_err4;
803 }
804
Jassi Brarb3040e42010-05-23 20:28:19 -0700805 dev_info(&adev->dev,
806 "Loaded driver for PL330 DMAC-%d\n", adev->periphid);
807 dev_info(&adev->dev,
808 "\tDBUFF-%ux%ubytes Num_Chans-%u Num_Peri-%u Num_Events-%u\n",
809 pi->pcfg.data_buf_dep,
810 pi->pcfg.data_bus_width / 8, pi->pcfg.num_chan,
811 pi->pcfg.num_peri, pi->pcfg.num_events);
812
813 return 0;
814
815probe_err4:
816 pl330_del(pi);
817probe_err3:
818 free_irq(irq, pi);
819probe_err2:
820 iounmap(pi->base);
821probe_err1:
822 release_mem_region(res->start, resource_size(res));
823 kfree(pdmac);
824
825 return ret;
826}
827
828static int __devexit pl330_remove(struct amba_device *adev)
829{
830 struct dma_pl330_dmac *pdmac = amba_get_drvdata(adev);
831 struct dma_pl330_chan *pch, *_p;
832 struct pl330_info *pi;
833 struct resource *res;
834 int irq;
835
836 if (!pdmac)
837 return 0;
838
839 amba_set_drvdata(adev, NULL);
840
841 /* Idle the DMAC */
842 list_for_each_entry_safe(pch, _p, &pdmac->ddma.channels,
843 chan.device_node) {
844
845 /* Remove the channel */
846 list_del(&pch->chan.device_node);
847
848 /* Flush the channel */
849 pl330_control(&pch->chan, DMA_TERMINATE_ALL, 0);
850 pl330_free_chan_resources(&pch->chan);
851 }
852
853 pi = &pdmac->pif;
854
855 pl330_del(pi);
856
857 irq = adev->irq[0];
858 free_irq(irq, pi);
859
860 iounmap(pi->base);
861
862 res = &adev->res;
863 release_mem_region(res->start, resource_size(res));
864
Boojin Kima2f52032011-09-02 09:44:29 +0900865#ifdef CONFIG_PM_RUNTIME
866 pm_runtime_put(&adev->dev);
867 pm_runtime_disable(&adev->dev);
868#else
869 clk_disable(pdmac->clk);
870#endif
871
Jassi Brarb3040e42010-05-23 20:28:19 -0700872 kfree(pdmac);
873
874 return 0;
875}
876
877static struct amba_id pl330_ids[] = {
878 {
879 .id = 0x00041330,
880 .mask = 0x000fffff,
881 },
882 { 0, 0 },
883};
884
Boojin Kima2f52032011-09-02 09:44:29 +0900885#ifdef CONFIG_PM_RUNTIME
886static int pl330_runtime_suspend(struct device *dev)
887{
888 struct dma_pl330_dmac *pdmac = dev_get_drvdata(dev);
889
890 if (!pdmac) {
891 dev_err(dev, "failed to get dmac\n");
892 return -ENODEV;
893 }
894
895 clk_disable(pdmac->clk);
896
897 return 0;
898}
899
900static int pl330_runtime_resume(struct device *dev)
901{
902 struct dma_pl330_dmac *pdmac = dev_get_drvdata(dev);
903
904 if (!pdmac) {
905 dev_err(dev, "failed to get dmac\n");
906 return -ENODEV;
907 }
908
909 clk_enable(pdmac->clk);
910
911 return 0;
912}
913#else
914#define pl330_runtime_suspend NULL
915#define pl330_runtime_resume NULL
916#endif /* CONFIG_PM_RUNTIME */
917
918static const struct dev_pm_ops pl330_pm_ops = {
919 .runtime_suspend = pl330_runtime_suspend,
920 .runtime_resume = pl330_runtime_resume,
921};
922
Jassi Brarb3040e42010-05-23 20:28:19 -0700923static struct amba_driver pl330_driver = {
924 .drv = {
925 .owner = THIS_MODULE,
926 .name = "dma-pl330",
Boojin Kima2f52032011-09-02 09:44:29 +0900927 .pm = &pl330_pm_ops,
Jassi Brarb3040e42010-05-23 20:28:19 -0700928 },
929 .id_table = pl330_ids,
930 .probe = pl330_probe,
931 .remove = pl330_remove,
932};
933
934static int __init pl330_init(void)
935{
936 return amba_driver_register(&pl330_driver);
937}
938module_init(pl330_init);
939
940static void __exit pl330_exit(void)
941{
942 amba_driver_unregister(&pl330_driver);
943 return;
944}
945module_exit(pl330_exit);
946
947MODULE_AUTHOR("Jaswinder Singh <jassi.brar@samsung.com>");
948MODULE_DESCRIPTION("API Driver for PL330 DMAC");
949MODULE_LICENSE("GPL");