|
@@ -20,6 +20,7 @@
|
|
|
#include <linux/device.h>
|
|
|
#include <mach/regs-icu.h>
|
|
|
#include <mach/sram.h>
|
|
|
+#include <linux/of_device.h>
|
|
|
|
|
|
#include "dmaengine.h"
|
|
|
|
|
@@ -127,7 +128,6 @@ struct mmp_tdma_device {
|
|
|
void __iomem *base;
|
|
|
struct dma_device device;
|
|
|
struct mmp_tdma_chan *tdmac[TDMA_CHANNEL_NUM];
|
|
|
- int irq;
|
|
|
};
|
|
|
|
|
|
#define to_mmp_tdma_chan(dchan) container_of(dchan, struct mmp_tdma_chan, chan)
|
|
@@ -492,7 +492,7 @@ static int __devinit mmp_tdma_chan_init(struct mmp_tdma_device *tdev,
|
|
|
return -ENOMEM;
|
|
|
}
|
|
|
if (irq)
|
|
|
- tdmac->irq = irq + idx;
|
|
|
+ tdmac->irq = irq;
|
|
|
tdmac->dev = tdev->dev;
|
|
|
tdmac->chan.device = &tdev->device;
|
|
|
tdmac->idx = idx;
|
|
@@ -505,34 +505,43 @@ static int __devinit mmp_tdma_chan_init(struct mmp_tdma_device *tdev,
|
|
|
/* add the channel to tdma_chan list */
|
|
|
list_add_tail(&tdmac->chan.device_node,
|
|
|
&tdev->device.channels);
|
|
|
-
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+static struct of_device_id mmp_tdma_dt_ids[] = {
|
|
|
+ { .compatible = "marvell,adma-1.0", .data = (void *)MMP_AUD_TDMA},
|
|
|
+ { .compatible = "marvell,pxa910-squ", .data = (void *)PXA910_SQU},
|
|
|
+ {}
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(of, mmp_tdma_dt_ids);
|
|
|
+
|
|
|
static int __devinit mmp_tdma_probe(struct platform_device *pdev)
|
|
|
{
|
|
|
- const struct platform_device_id *id = platform_get_device_id(pdev);
|
|
|
- enum mmp_tdma_type type = id->driver_data;
|
|
|
+ enum mmp_tdma_type type;
|
|
|
+ const struct of_device_id *of_id;
|
|
|
struct mmp_tdma_device *tdev;
|
|
|
struct resource *iores;
|
|
|
int i, ret;
|
|
|
- int irq = 0;
|
|
|
+ int irq = 0, irq_num = 0;
|
|
|
int chan_num = TDMA_CHANNEL_NUM;
|
|
|
|
|
|
+ of_id = of_match_device(mmp_tdma_dt_ids, &pdev->dev);
|
|
|
+ if (of_id)
|
|
|
+ type = (enum mmp_tdma_type) of_id->data;
|
|
|
+ else
|
|
|
+ type = platform_get_device_id(pdev)->driver_data;
|
|
|
+
|
|
|
/* always have couple channels */
|
|
|
tdev = devm_kzalloc(&pdev->dev, sizeof(*tdev), GFP_KERNEL);
|
|
|
if (!tdev)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
tdev->dev = &pdev->dev;
|
|
|
- iores = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
|
|
|
- if (!iores)
|
|
|
- return -EINVAL;
|
|
|
|
|
|
- if (resource_size(iores) != chan_num)
|
|
|
- tdev->irq = iores->start;
|
|
|
- else
|
|
|
- irq = iores->start;
|
|
|
+ for (i = 0; i < chan_num; i++) {
|
|
|
+ if (platform_get_irq(pdev, i) > 0)
|
|
|
+ irq_num++;
|
|
|
+ }
|
|
|
|
|
|
iores = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
if (!iores)
|
|
@@ -542,25 +551,26 @@ static int __devinit mmp_tdma_probe(struct platform_device *pdev)
|
|
|
if (!tdev->base)
|
|
|
return -EADDRNOTAVAIL;
|
|
|
|
|
|
- if (tdev->irq) {
|
|
|
- ret = devm_request_irq(&pdev->dev, tdev->irq,
|
|
|
+ INIT_LIST_HEAD(&tdev->device.channels);
|
|
|
+
|
|
|
+ if (irq_num != chan_num) {
|
|
|
+ irq = platform_get_irq(pdev, 0);
|
|
|
+ ret = devm_request_irq(&pdev->dev, irq,
|
|
|
mmp_tdma_int_handler, IRQF_DISABLED, "tdma", tdev);
|
|
|
if (ret)
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
- dma_cap_set(DMA_SLAVE, tdev->device.cap_mask);
|
|
|
- dma_cap_set(DMA_CYCLIC, tdev->device.cap_mask);
|
|
|
-
|
|
|
- INIT_LIST_HEAD(&tdev->device.channels);
|
|
|
-
|
|
|
/* initialize channel parameters */
|
|
|
for (i = 0; i < chan_num; i++) {
|
|
|
+ irq = (irq_num != chan_num) ? 0 : platform_get_irq(pdev, i);
|
|
|
ret = mmp_tdma_chan_init(tdev, i, irq, type);
|
|
|
if (ret)
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
+ dma_cap_set(DMA_SLAVE, tdev->device.cap_mask);
|
|
|
+ dma_cap_set(DMA_CYCLIC, tdev->device.cap_mask);
|
|
|
tdev->device.dev = &pdev->dev;
|
|
|
tdev->device.device_alloc_chan_resources =
|
|
|
mmp_tdma_alloc_chan_resources;
|
|
@@ -595,6 +605,7 @@ static struct platform_driver mmp_tdma_driver = {
|
|
|
.driver = {
|
|
|
.name = "mmp-tdma",
|
|
|
.owner = THIS_MODULE,
|
|
|
+ .of_match_table = mmp_tdma_dt_ids,
|
|
|
},
|
|
|
.id_table = mmp_tdma_id_table,
|
|
|
.probe = mmp_tdma_probe,
|