forked from torvalds/linux
-
Notifications
You must be signed in to change notification settings - Fork 23
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
dma: dmamux: Introduce RZN1 DMA router support
The Renesas RZN1 DMA IP is a based on a DW core, with eg. an additional dmamux register located in the system control area which can take up to 32 requests (16 per DMA controller). Each DMA channel can be wired to two different peripherals. We need two additional information from the 'dmas' property: the channel (bit in the dmamux register) that must be accessed and the value of the mux for this channel. Signed-off-by: Miquel Raynal <miquel.raynal@bootlin.com>
- Loading branch information
1 parent
ed9b880
commit df0b7e5
Showing
2 changed files
with
176 additions
and
1 deletion.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,175 @@ | ||
// SPDX-License-Identifier: GPL-2.0-only | ||
/* | ||
* Copyright (C) 2022 Schneider-Electric | ||
* Author: Miquel Raynal <miquel.raynal@bootlin.com | ||
* Based on TI crossbar driver written by Peter Ujfalusi <peter.ujfalusi@ti.com> | ||
*/ | ||
#include <linux/slab.h> | ||
#include <linux/err.h> | ||
#include <linux/init.h> | ||
#include <linux/list.h> | ||
#include <linux/io.h> | ||
#include <linux/of_address.h> | ||
#include <linux/of_device.h> | ||
#include <linux/of_dma.h> | ||
#include <linux/soc/renesas/r9a06g032-syscon.h> | ||
|
||
#define RZN1_DMAMUX_LINES 64 | ||
|
||
struct rzn1_dmamux_data { | ||
struct dma_router dmarouter; | ||
unsigned int dmac_requests; | ||
unsigned int dmamux_requests; | ||
u32 used_chans; | ||
struct mutex lock; | ||
}; | ||
|
||
struct rzn1_dmamux_map { | ||
unsigned int req_idx; | ||
}; | ||
|
||
static void rzn1_dmamux_free(struct device *dev, void *route_data) | ||
{ | ||
struct rzn1_dmamux_data *dmamux = dev_get_drvdata(dev); | ||
struct rzn1_dmamux_map *map = route_data; | ||
|
||
dev_dbg(dev, "Unmapping DMAMUX request %u\n", map->req_idx); | ||
|
||
mutex_lock(&dmamux->lock); | ||
dmamux->used_chans &= ~BIT(map->req_idx); | ||
mutex_unlock(&dmamux->lock); | ||
|
||
kfree(map); | ||
} | ||
|
||
static void *rzn1_dmamux_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 rzn1_dmamux_data *dmamux = platform_get_drvdata(pdev); | ||
struct rzn1_dmamux_map *map; | ||
unsigned int master, chan, val; | ||
int ret; | ||
|
||
map = kzalloc(sizeof(*map), GFP_KERNEL); | ||
if (!map) | ||
return ERR_PTR(-ENOMEM); | ||
|
||
if (dma_spec->args_count != 6) | ||
return ERR_PTR(-EINVAL); | ||
|
||
chan = dma_spec->args[0]; | ||
map->req_idx = dma_spec->args[4]; | ||
val = dma_spec->args[5]; | ||
dma_spec->args_count -= 2; | ||
|
||
if (chan >= dmamux->dmac_requests) { | ||
dev_err(&pdev->dev, "Invalid DMA request line: %d\n", chan); | ||
return ERR_PTR(-EINVAL); | ||
} | ||
|
||
if (map->req_idx >= dmamux->dmamux_requests || | ||
map->req_idx % dmamux->dmac_requests != chan) { | ||
dev_err(&pdev->dev, "Invalid MUX request line: %d\n", map->req_idx); | ||
return ERR_PTR(-EINVAL); | ||
} | ||
|
||
/* The of_node_put() will be done in the core for the node */ | ||
master = map->req_idx < dmamux->dmac_requests ? 0 : 1; | ||
dma_spec->np = of_parse_phandle(ofdma->of_node, "dma-masters", master); | ||
if (!dma_spec->np) { | ||
dev_err(&pdev->dev, "Can't get DMA master\n"); | ||
return ERR_PTR(-EINVAL); | ||
} | ||
|
||
dev_dbg(&pdev->dev, "Mapping DMAMUX request %u to DMAC%u request %u\n", | ||
map->req_idx, master, chan); | ||
|
||
mutex_lock(&dmamux->lock); | ||
dmamux->used_chans |= BIT(map->req_idx); | ||
ret = r9a06g032_syscon_set_dmamux(BIT(map->req_idx), | ||
val ? BIT(map->req_idx) : 0); | ||
mutex_unlock(&dmamux->lock); | ||
if (ret) { | ||
rzn1_dmamux_free(&pdev->dev, map); | ||
return ERR_PTR(ret); | ||
} | ||
|
||
return map; | ||
} | ||
|
||
static const struct of_device_id rzn1_dmac_match[] __maybe_unused = { | ||
{ .compatible = "renesas,rzn1-dma", }, | ||
{}, | ||
}; | ||
|
||
static int rzn1_dmamux_probe(struct platform_device *pdev) | ||
{ | ||
struct device_node *node = pdev->dev.of_node; | ||
const struct of_device_id *match; | ||
struct device_node *dmac_node; | ||
struct rzn1_dmamux_data *dmamux; | ||
|
||
if (!node) | ||
return -ENODEV; | ||
|
||
dmamux = devm_kzalloc(&pdev->dev, sizeof(*dmamux), GFP_KERNEL); | ||
if (!dmamux) | ||
return -ENOMEM; | ||
|
||
mutex_init(&dmamux->lock); | ||
|
||
dmac_node = of_parse_phandle(node, "dma-masters", 0); | ||
if (!dmac_node) { | ||
dev_err(&pdev->dev, "Can't get DMA master node\n"); | ||
return -ENODEV; | ||
} | ||
|
||
match = of_match_node(rzn1_dmac_match, dmac_node); | ||
if (!match) { | ||
dev_err(&pdev->dev, "DMA master is not supported\n"); | ||
of_node_put(dmac_node); | ||
return -EINVAL; | ||
} | ||
|
||
if (of_property_read_u32(dmac_node, "dma-requests", | ||
&dmamux->dmac_requests)) { | ||
dev_err(&pdev->dev, "Missing DMAC requests information\n"); | ||
of_node_put(dmac_node); | ||
return -EINVAL; | ||
} | ||
of_node_put(dmac_node); | ||
|
||
if (of_property_read_u32(node, "dma-requests", | ||
&dmamux->dmamux_requests)) { | ||
dev_err(&pdev->dev, "Missing DMA mux requests information\n"); | ||
return -EINVAL; | ||
} | ||
|
||
dmamux->dmarouter.dev = &pdev->dev; | ||
dmamux->dmarouter.route_free = rzn1_dmamux_free; | ||
|
||
platform_set_drvdata(pdev, dmamux); | ||
|
||
return of_dma_router_register(node, rzn1_dmamux_route_allocate, | ||
&dmamux->dmarouter); | ||
} | ||
|
||
static const struct of_device_id rzn1_dmamux_match[] = { | ||
{ .compatible = "renesas,rzn1-dmamux", }, | ||
{}, | ||
}; | ||
|
||
static struct platform_driver rzn1_dmamux_driver = { | ||
.driver = { | ||
.name = "renesas,rzn1-dmamux", | ||
.of_match_table = rzn1_dmamux_match, | ||
}, | ||
.probe = rzn1_dmamux_probe, | ||
}; | ||
|
||
static int rzn1_dmamux_init(void) | ||
{ | ||
return platform_driver_register(&rzn1_dmamux_driver); | ||
} | ||
arch_initcall(rzn1_dmamux_init); |