Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / drivers / dma / virt-dma.c

diff --git a/kernel/drivers/dma/virt-dma.c b/kernel/drivers/dma/virt-dma.c
new file mode 100644 (file)
index 0000000..6f80432
--- /dev/null
+++ b/kernel/drivers/dma/virt-dma.c
@@ -0,0 +1,123 @@
+/*
+ * 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");