Subject: [PATCH v4 3/8] dmaengine: Add driver for TI DMA crossbar on DRA7x

From: [email-masked] (Maxime Ripard)
Date: Wed, 8 Apr 2015 17:23:49 +0200

Hi,

On Wed, Apr 08, 2015 at 04:14:47PM +0300, Peter Ujfalusi wrote:
> The DRA7x has more peripherals with DMA requests than the sDMA can handle:
> 205 vs 127. All DMA requests are routed through the DMA crossbar, which can
> be configured to route selected incoming DMA requests to specific sDMA
> request.
> 
> Signed-off-by: Peter Ujfalusi <[email-masked]>
> ---
>  drivers/dma/Kconfig           |   4 +
>  drivers/dma/Makefile          |   1 +
>  drivers/dma/ti-dma-crossbar.c | 185 ++++++++++++++++++++++++++++++++++++++++++
>  3 files changed, 190 insertions(+)
>  create mode 100644 drivers/dma/ti-dma-crossbar.c
> 
> diff --git a/drivers/dma/Kconfig b/drivers/dma/Kconfig
> index 91eced044321..33a7401597be 100644
> --- a/drivers/dma/Kconfig
> +++ b/drivers/dma/Kconfig
> @@ -234,6 +234,9 @@ config TI_EDMA
>  	  Enable support for the TI EDMA controller. This DMA
>  	  engine is found on TI DaVinci and AM33xx parts.
>  
> +config TI_DMA_CROSSBAR
> +	bool
> +
>  config ARCH_HAS_ASYNC_TX_FIND_CHANNEL
>  	bool
>  
> @@ -319,6 +322,7 @@ config DMA_OMAP
>  	depends on ARCH_OMAP
>  	select DMA_ENGINE
>  	select DMA_VIRTUAL_CHANNELS
> +	select TI_DMA_CROSSBAR if SOC_DRA7XX
>  
>  config DMA_BCM2835
>  	tristate "BCM2835 DMA engine support"
> diff --git a/drivers/dma/Makefile b/drivers/dma/Makefile
> index 7e8301cb489d..19ac70b8af0a 100644
> --- a/drivers/dma/Makefile
> +++ b/drivers/dma/Makefile
> @@ -38,6 +38,7 @@ obj-$(CONFIG_EP93XX_DMA) += ep93xx_dma.o
>  obj-$(CONFIG_DMA_SA11X0) += sa11x0-dma.o
>  obj-$(CONFIG_MMP_TDMA) += mmp_tdma.o
>  obj-$(CONFIG_DMA_OMAP) += omap-dma.o
> +obj-$(CONFIG_TI_DMA_CROSSBAR) += ti-dma-crossbar.o
>  obj-$(CONFIG_DMA_BCM2835) += bcm2835-dma.o
>  obj-$(CONFIG_MMP_PDMA) += mmp_pdma.o
>  obj-$(CONFIG_DMA_JZ4740) += dma-jz4740.o
> diff --git a/drivers/dma/ti-dma-crossbar.c b/drivers/dma/ti-dma-crossbar.c
> new file mode 100644
> index 000000000000..5cb1eb7e86d2
> --- /dev/null
> +++ b/drivers/dma/ti-dma-crossbar.c
> @@ -0,0 +1,185 @@
> +/*
> + *  Copyright (C) 2015 Texas Instruments Incorporated - http://www.ti.com
> + *  Author: Peter Ujfalusi <[email-masked]>
> + *
> + * 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/slab.h>
> +#include <linux/err.h>
> +#include <linux/init.h>
> +#include <linux/list.h>
> +#include <linux/io.h>
> +#include <linux/idr.h>
> +#include <linux/of_address.h>
> +#include <linux/of_device.h>
> +#include <linux/of_dma.h>
> +
> +#define TI_XBAR_OUTPUTS	127
> +#define TI_XBAR_INPUTS	256
> +
> +static DEFINE_IDR(map_idr);
> +
> +struct ti_dma_xbar_data {
> +	void __iomem *iomem;
> +
> +	struct dma_router dmarouter;
> +
> +	uint safe_val; /* Value to rest the crossbar lines */
> +	uint xbar_requests; /* number of DMA requests connected to XBAR */
> +	uint dma_requests; /* number of DMA requests forwarded to DMA */
> +};
> +
> +struct ti_dma_xbar_map {
> +	int xbar_in;
> +	int xbar_out;
> +};
> +
> +static inline void ti_dma_xbar_write(void __iomem *iomem, int xbar, int val)
> +{
> +	writew_relaxed(val, iomem + (xbar * 2));

Silently casting val (an integer) to a u16 isn't really nice I
guess. At least you could be upfront about it in the prototype.

> +}
> +
> +static void ti_dma_xbar_free(struct device *dev, void *route_data)
> +{
> +	struct ti_dma_xbar_data *xbar = dev_get_drvdata(dev);
> +	struct ti_dma_xbar_map *map = route_data;
> +
> +	dev_dbg(dev, "Unmapping XBAR%d (was routed to %d)\n",
> +		map->xbar_in, map->xbar_out);
> +
> +	ti_dma_xbar_write(xbar->iomem, map->xbar_out, xbar->safe_val);
> +	idr_remove(&map_idr, map->xbar_out);
> +	kfree(map);
> +}
> +
> +static void *ti_dma_xbar_route_allocate(struct of_phandle_args *dma_spec,
> +					struct of_dma *ofdma)
> +{
> +	struct platform_device *pdev = of_find_device_by_node(ofdma->of_node);
> +	struct ti_dma_xbar_data *xbar = platform_get_drvdata(pdev);
> +	struct ti_dma_xbar_map *map;
> +
> +	if (dma_spec->args[0] >= xbar->xbar_requests) {
> +		dev_err(&pdev->dev, "Invalid XBAR request number: %d\n",
> +			dma_spec->args[0]);
> +		return NULL;
> +	}
> +
> +	dma_spec->np = of_parse_phandle(ofdma->of_node, "dma-masters", 0);
> +	if (!dma_spec->np) {
> +		dev_err(&pdev->dev, "Can't get DMA master\n");
> +		return NULL;
> +	}
> +
> +	map = kzalloc(sizeof(*map), GFP_KERNEL);
> +	if (!map)
> +		return NULL;

You're leaking dma_spec->np.

> +
> +	map->xbar_out = idr_alloc(&map_idr, NULL, 0, xbar->dma_requests,
> +				  GFP_KERNEL);
> +	map->xbar_in = dma_spec->args[0];
> +
> +	/* The DMA request is 1 based in sDMA */
> +	dma_spec->args[0] = map->xbar_out + 1;
> +
> +	dev_dbg(&pdev->dev, "Mapping XBAR%d to DMA%d\n",
> +		map->xbar_in, map->xbar_out);
> +
> +	ti_dma_xbar_write(xbar->iomem, map->xbar_out, map->xbar_in);
> +
> +	return map;
> +}
> +
> +static int ti_dma_xbar_probe(struct platform_device *pdev)
> +{
> +	struct device_node *node = pdev->dev.of_node;
> +	struct device_node *dma_node;
> +	struct ti_dma_xbar_data *xbar;
> +	struct resource *res;
> +	void __iomem *iomem;
> +	int i, ret;
> +
> +	if (!node)
> +		return -ENODEV;
> +
> +	dma_node = of_parse_phandle(node, "dma-masters", 0);
> +	if (!dma_node) {
> +		dev_err(&pdev->dev, "Can't get DMA master node\n");
> +		return -ENODEV;
> +	}
> +
> +	xbar = devm_kzalloc(&pdev->dev, sizeof(*xbar), GFP_KERNEL);
> +	if (!xbar)
> +		return -ENOMEM;

And here too.

> +	if (of_property_read_u32(dma_node, "dma-requests",
> +				 &xbar->dma_requests)) {
> +		dev_info(&pdev->dev,
> +			 "Missing XBAR output information, using %u.\n",
> +			 TI_XBAR_OUTPUTS);
> +		xbar->dma_requests = TI_XBAR_OUTPUTS;
> +	}
> +	of_node_put(dma_node);
> +
> +	if (of_property_read_u32(node, "dma-requests", &xbar->xbar_requests)) {
> +		dev_info(&pdev->dev,
> +			 "Missing XBAR input information, using %u.\n",
> +			 TI_XBAR_INPUTS);
> +		xbar->xbar_requests = TI_XBAR_INPUTS;
> +	}
> +
> +	if (of_property_read_u32(node, "ti,dma-safe-map", &xbar->safe_val))
> +		xbar->safe_val = 0;
> +
> +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> +	if (!res)
> +		return -ENODEV;
> +
> +	if (!devm_request_mem_region(&pdev->dev, res->start, resource_size(res),
> +				     dev_name(&pdev->dev)))
> +		return -ENODEV;
> +
> +	iomem = devm_ioremap(&pdev->dev, res->start, resource_size(res));
> +	if (!iomem)
> +		return -ENOMEM;

You can use devm_ioremap_resource here.

> +	xbar->iomem = iomem;
> +
> +	xbar->dmarouter.dev = &pdev->dev;
> +	xbar->dmarouter.route_free = ti_dma_xbar_free;
> +
> +	platform_set_drvdata(pdev, xbar);
> +
> +	ret = of_dma_router_register(node, ti_dma_xbar_route_allocate,
> +				     &xbar->dmarouter);
> +	if (ret)
> +		return -ENODEV;

Starting here, I'd expect that your driver can be used....

> +
> +	/* Reset the crossbar */
> +	for (i = 0; i < xbar->dma_requests; i++)
> +		ti_dma_xbar_write(xbar->iomem, i, xbar->safe_val);

... however, the hardware doesn't seem ready. Isn't it a race?

> +	return 0;
> +}
> +
> +static const struct of_device_id ti_dma_xbar_match[] = {
> +	{ .compatible = "ti,dra7-dma-crossbar" },
> +	{},
> +};
> +
> +static struct platform_driver ti_dma_xbar_driver = {
> +	.driver = {
> +		.name = "ti-dma-crossbar",
> +		.of_match_table = of_match_ptr(ti_dma_xbar_match),
> +	},
> +	.probe	= ti_dma_xbar_probe,
> +};
> +
> +int omap_dmaxbar_init(void)
> +{
> +	return platform_driver_register(&ti_dma_xbar_driver);
> +}
> +arch_initcall(omap_dmaxbar_init);

Thanks,
Maxime

-- 
Maxime Ripard, Free Electrons
Embedded Linux, Kernel and Android engineering
http://free-electrons.com
-------------- next part --------------
A non-text attachment was scrubbed...
Name: signature.asc
Type: application/pgp-signature
Size: 819 bytes
Desc: Digital signature
URL: <http://lists.infradead.org/pipermail/linux-arm-kernel/attachments/20150408/44642fa9/attachment.sig>