|  | /* | 
|  | * Virtual DMA channel support for DMAengine | 
|  | * | 
|  | * Copyright (C) 2012 Russell King | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or modify | 
|  | * it under the terms of the GNU General Public License version 2 as | 
|  | * published by the Free Software Foundation. | 
|  | */ | 
|  | #include <linux/device.h> | 
|  | #include <linux/dmaengine.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/spinlock.h> | 
|  |  | 
|  | #include "virt-dma.h" | 
|  |  | 
|  | static struct virt_dma_desc *to_virt_desc(struct dma_async_tx_descriptor *tx) | 
|  | { | 
|  | return container_of(tx, struct virt_dma_desc, tx); | 
|  | } | 
|  |  | 
|  | dma_cookie_t vchan_tx_submit(struct dma_async_tx_descriptor *tx) | 
|  | { | 
|  | struct virt_dma_chan *vc = to_virt_chan(tx->chan); | 
|  | struct virt_dma_desc *vd = to_virt_desc(tx); | 
|  | unsigned long flags; | 
|  | dma_cookie_t cookie; | 
|  |  | 
|  | spin_lock_irqsave(&vc->lock, flags); | 
|  | cookie = dma_cookie_assign(tx); | 
|  |  | 
|  | list_add_tail(&vd->node, &vc->desc_submitted); | 
|  | spin_unlock_irqrestore(&vc->lock, flags); | 
|  |  | 
|  | dev_dbg(vc->chan.device->dev, "vchan %p: txd %p[%x]: submitted\n", | 
|  | vc, vd, cookie); | 
|  |  | 
|  | return cookie; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(vchan_tx_submit); | 
|  |  | 
|  | struct virt_dma_desc *vchan_find_desc(struct virt_dma_chan *vc, | 
|  | dma_cookie_t cookie) | 
|  | { | 
|  | struct virt_dma_desc *vd; | 
|  |  | 
|  | list_for_each_entry(vd, &vc->desc_issued, node) | 
|  | if (vd->tx.cookie == cookie) | 
|  | return vd; | 
|  |  | 
|  | return NULL; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(vchan_find_desc); | 
|  |  | 
|  | /* | 
|  | * This tasklet handles the completion of a DMA descriptor by | 
|  | * calling its callback and freeing it. | 
|  | */ | 
|  | static void vchan_complete(unsigned long arg) | 
|  | { | 
|  | struct virt_dma_chan *vc = (struct virt_dma_chan *)arg; | 
|  | struct virt_dma_desc *vd; | 
|  | dma_async_tx_callback cb = NULL; | 
|  | void *cb_data = NULL; | 
|  | LIST_HEAD(head); | 
|  |  | 
|  | spin_lock_irq(&vc->lock); | 
|  | list_splice_tail_init(&vc->desc_completed, &head); | 
|  | vd = vc->cyclic; | 
|  | if (vd) { | 
|  | vc->cyclic = NULL; | 
|  | cb = vd->tx.callback; | 
|  | cb_data = vd->tx.callback_param; | 
|  | } | 
|  | spin_unlock_irq(&vc->lock); | 
|  |  | 
|  | if (cb) | 
|  | cb(cb_data); | 
|  |  | 
|  | while (!list_empty(&head)) { | 
|  | vd = list_first_entry(&head, struct virt_dma_desc, node); | 
|  | cb = vd->tx.callback; | 
|  | cb_data = vd->tx.callback_param; | 
|  |  | 
|  | list_del(&vd->node); | 
|  |  | 
|  | vc->desc_free(vd); | 
|  |  | 
|  | if (cb) | 
|  | cb(cb_data); | 
|  | } | 
|  | } | 
|  |  | 
|  | void vchan_dma_desc_free_list(struct virt_dma_chan *vc, struct list_head *head) | 
|  | { | 
|  | while (!list_empty(head)) { | 
|  | struct virt_dma_desc *vd = list_first_entry(head, | 
|  | struct virt_dma_desc, node); | 
|  | list_del(&vd->node); | 
|  | dev_dbg(vc->chan.device->dev, "txd %p: freeing\n", vd); | 
|  | vc->desc_free(vd); | 
|  | } | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(vchan_dma_desc_free_list); | 
|  |  | 
|  | void vchan_init(struct virt_dma_chan *vc, struct dma_device *dmadev) | 
|  | { | 
|  | dma_cookie_init(&vc->chan); | 
|  |  | 
|  | spin_lock_init(&vc->lock); | 
|  | INIT_LIST_HEAD(&vc->desc_submitted); | 
|  | INIT_LIST_HEAD(&vc->desc_issued); | 
|  | INIT_LIST_HEAD(&vc->desc_completed); | 
|  |  | 
|  | tasklet_init(&vc->task, vchan_complete, (unsigned long)vc); | 
|  |  | 
|  | vc->chan.device = dmadev; | 
|  | list_add_tail(&vc->chan.device_node, &dmadev->channels); | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(vchan_init); | 
|  |  | 
|  | MODULE_AUTHOR("Russell King"); | 
|  | MODULE_LICENSE("GPL"); |