| /* |
| * 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_move_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); |
| |
| /** |
| * vchan_tx_desc_free - free a reusable descriptor |
| * @tx: the transfer |
| * |
| * This function frees a previously allocated reusable descriptor. The only |
| * other way is to clear the DMA_CTRL_REUSE flag and submit one last time the |
| * transfer. |
| * |
| * Returns 0 upon success |
| */ |
| int vchan_tx_desc_free(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; |
| |
| spin_lock_irqsave(&vc->lock, flags); |
| list_del(&vd->node); |
| spin_unlock_irqrestore(&vc->lock, flags); |
| |
| dev_dbg(vc->chan.device->dev, "vchan %p: txd %p[%x]: freeing\n", |
| vc, vd, vd->tx.cookie); |
| vc->desc_free(vd); |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(vchan_tx_desc_free); |
| |
| 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, *_vd; |
| struct dmaengine_desc_callback cb; |
| LIST_HEAD(head); |
| |
| spin_lock_irq(&vc->lock); |
| list_splice_tail_init(&vc->desc_completed, &head); |
| vd = vc->cyclic; |
| if (vd) { |
| vc->cyclic = NULL; |
| dmaengine_desc_get_callback(&vd->tx, &cb); |
| } else { |
| memset(&cb, 0, sizeof(cb)); |
| } |
| spin_unlock_irq(&vc->lock); |
| |
| dmaengine_desc_callback_invoke(&cb, NULL); |
| |
| list_for_each_entry_safe(vd, _vd, &head, node) { |
| dmaengine_desc_get_callback(&vd->tx, &cb); |
| |
| list_del(&vd->node); |
| vchan_vdesc_fini(vd); |
| |
| dmaengine_desc_callback_invoke(&cb, NULL); |
| } |
| } |
| |
| void vchan_dma_desc_free_list(struct virt_dma_chan *vc, struct list_head *head) |
| { |
| struct virt_dma_desc *vd, *_vd; |
| |
| list_for_each_entry_safe(vd, _vd, head, node) { |
| if (dmaengine_desc_test_reuse(&vd->tx)) { |
| list_move_tail(&vd->node, &vc->desc_allocated); |
| } else { |
| dev_dbg(vc->chan.device->dev, "txd %p: freeing\n", vd); |
| list_del(&vd->node); |
| 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_allocated); |
| 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"); |