mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-12-05 11:00:15 +00:00
4954937d92
uclass_first_device/uclass_next_device return value will be removed, don't use it. With the current implementation dev is equivalent to !ret. It is redundant to check both, ret check can be replaced with dev check, and ret check inside the iteration is dead code. Signed-off-by: Michal Suchanek <msuchanek@suse.de> Reviewed-by: Simon Glass <sjg@chromium.org>
268 lines
5.4 KiB
C
268 lines
5.4 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Direct Memory Access U-Class driver
|
|
*
|
|
* Copyright (C) 2018 Álvaro Fernández Rojas <noltari@gmail.com>
|
|
* Copyright (C) 2015 - 2018 Texas Instruments Incorporated <www.ti.com>
|
|
* Written by Mugunthan V N <mugunthanvnm@ti.com>
|
|
*
|
|
* Author: Mugunthan V N <mugunthanvnm@ti.com>
|
|
*/
|
|
|
|
#define LOG_CATEGORY UCLASS_DMA
|
|
|
|
#include <common.h>
|
|
#include <cpu_func.h>
|
|
#include <dm.h>
|
|
#include <log.h>
|
|
#include <malloc.h>
|
|
#include <asm/cache.h>
|
|
#include <dm/read.h>
|
|
#include <dma-uclass.h>
|
|
#include <linux/dma-mapping.h>
|
|
#include <dt-structs.h>
|
|
#include <errno.h>
|
|
|
|
#ifdef CONFIG_DMA_CHANNELS
|
|
static inline struct dma_ops *dma_dev_ops(struct udevice *dev)
|
|
{
|
|
return (struct dma_ops *)dev->driver->ops;
|
|
}
|
|
|
|
# if CONFIG_IS_ENABLED(OF_CONTROL)
|
|
static int dma_of_xlate_default(struct dma *dma,
|
|
struct ofnode_phandle_args *args)
|
|
{
|
|
debug("%s(dma=%p)\n", __func__, dma);
|
|
|
|
if (args->args_count > 1) {
|
|
pr_err("Invalid args_count: %d\n", args->args_count);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (args->args_count)
|
|
dma->id = args->args[0];
|
|
else
|
|
dma->id = 0;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int dma_get_by_index(struct udevice *dev, int index, struct dma *dma)
|
|
{
|
|
int ret;
|
|
struct ofnode_phandle_args args;
|
|
struct udevice *dev_dma;
|
|
const struct dma_ops *ops;
|
|
|
|
debug("%s(dev=%p, index=%d, dma=%p)\n", __func__, dev, index, dma);
|
|
|
|
assert(dma);
|
|
dma->dev = NULL;
|
|
|
|
ret = dev_read_phandle_with_args(dev, "dmas", "#dma-cells", 0, index,
|
|
&args);
|
|
if (ret) {
|
|
pr_err("%s: dev_read_phandle_with_args failed: err=%d\n",
|
|
__func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = uclass_get_device_by_ofnode(UCLASS_DMA, args.node, &dev_dma);
|
|
if (ret) {
|
|
pr_err("%s: uclass_get_device_by_ofnode failed: err=%d\n",
|
|
__func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
dma->dev = dev_dma;
|
|
|
|
ops = dma_dev_ops(dev_dma);
|
|
|
|
if (ops->of_xlate)
|
|
ret = ops->of_xlate(dma, &args);
|
|
else
|
|
ret = dma_of_xlate_default(dma, &args);
|
|
if (ret) {
|
|
pr_err("of_xlate() failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
return dma_request(dev_dma, dma);
|
|
}
|
|
|
|
int dma_get_by_name(struct udevice *dev, const char *name, struct dma *dma)
|
|
{
|
|
int index;
|
|
|
|
debug("%s(dev=%p, name=%s, dma=%p)\n", __func__, dev, name, dma);
|
|
dma->dev = NULL;
|
|
|
|
index = dev_read_stringlist_search(dev, "dma-names", name);
|
|
if (index < 0) {
|
|
pr_err("dev_read_stringlist_search() failed: %d\n", index);
|
|
return index;
|
|
}
|
|
|
|
return dma_get_by_index(dev, index, dma);
|
|
}
|
|
# endif /* OF_CONTROL */
|
|
|
|
int dma_request(struct udevice *dev, struct dma *dma)
|
|
{
|
|
struct dma_ops *ops = dma_dev_ops(dev);
|
|
|
|
debug("%s(dev=%p, dma=%p)\n", __func__, dev, dma);
|
|
|
|
dma->dev = dev;
|
|
|
|
if (!ops->request)
|
|
return 0;
|
|
|
|
return ops->request(dma);
|
|
}
|
|
|
|
int dma_free(struct dma *dma)
|
|
{
|
|
struct dma_ops *ops = dma_dev_ops(dma->dev);
|
|
|
|
debug("%s(dma=%p)\n", __func__, dma);
|
|
|
|
if (!ops->rfree)
|
|
return 0;
|
|
|
|
return ops->rfree(dma);
|
|
}
|
|
|
|
int dma_enable(struct dma *dma)
|
|
{
|
|
struct dma_ops *ops = dma_dev_ops(dma->dev);
|
|
|
|
debug("%s(dma=%p)\n", __func__, dma);
|
|
|
|
if (!ops->enable)
|
|
return -ENOSYS;
|
|
|
|
return ops->enable(dma);
|
|
}
|
|
|
|
int dma_disable(struct dma *dma)
|
|
{
|
|
struct dma_ops *ops = dma_dev_ops(dma->dev);
|
|
|
|
debug("%s(dma=%p)\n", __func__, dma);
|
|
|
|
if (!ops->disable)
|
|
return -ENOSYS;
|
|
|
|
return ops->disable(dma);
|
|
}
|
|
|
|
int dma_prepare_rcv_buf(struct dma *dma, void *dst, size_t size)
|
|
{
|
|
struct dma_ops *ops = dma_dev_ops(dma->dev);
|
|
|
|
debug("%s(dma=%p)\n", __func__, dma);
|
|
|
|
if (!ops->prepare_rcv_buf)
|
|
return -1;
|
|
|
|
return ops->prepare_rcv_buf(dma, dst, size);
|
|
}
|
|
|
|
int dma_receive(struct dma *dma, void **dst, void *metadata)
|
|
{
|
|
struct dma_ops *ops = dma_dev_ops(dma->dev);
|
|
|
|
debug("%s(dma=%p)\n", __func__, dma);
|
|
|
|
if (!ops->receive)
|
|
return -ENOSYS;
|
|
|
|
return ops->receive(dma, dst, metadata);
|
|
}
|
|
|
|
int dma_send(struct dma *dma, void *src, size_t len, void *metadata)
|
|
{
|
|
struct dma_ops *ops = dma_dev_ops(dma->dev);
|
|
|
|
debug("%s(dma=%p)\n", __func__, dma);
|
|
|
|
if (!ops->send)
|
|
return -ENOSYS;
|
|
|
|
return ops->send(dma, src, len, metadata);
|
|
}
|
|
|
|
int dma_get_cfg(struct dma *dma, u32 cfg_id, void **cfg_data)
|
|
{
|
|
struct dma_ops *ops = dma_dev_ops(dma->dev);
|
|
|
|
debug("%s(dma=%p)\n", __func__, dma);
|
|
|
|
if (!ops->get_cfg)
|
|
return -ENOSYS;
|
|
|
|
return ops->get_cfg(dma, cfg_id, cfg_data);
|
|
}
|
|
#endif /* CONFIG_DMA_CHANNELS */
|
|
|
|
int dma_get_device(u32 transfer_type, struct udevice **devp)
|
|
{
|
|
struct udevice *dev;
|
|
|
|
for (uclass_first_device(UCLASS_DMA, &dev); dev;
|
|
uclass_next_device(&dev)) {
|
|
struct dma_dev_priv *uc_priv;
|
|
|
|
uc_priv = dev_get_uclass_priv(dev);
|
|
if (uc_priv->supported & transfer_type)
|
|
break;
|
|
}
|
|
|
|
if (!dev) {
|
|
pr_debug("No DMA device found that supports %x type\n",
|
|
transfer_type);
|
|
return -EPROTONOSUPPORT;
|
|
}
|
|
|
|
*devp = dev;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int dma_memcpy(void *dst, void *src, size_t len)
|
|
{
|
|
struct udevice *dev;
|
|
const struct dma_ops *ops;
|
|
dma_addr_t destination;
|
|
dma_addr_t source;
|
|
int ret;
|
|
|
|
ret = dma_get_device(DMA_SUPPORTS_MEM_TO_MEM, &dev);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ops = device_get_ops(dev);
|
|
if (!ops->transfer)
|
|
return -ENOSYS;
|
|
|
|
/* Clean the areas, so no writeback into the RAM races with DMA */
|
|
destination = dma_map_single(dst, len, DMA_FROM_DEVICE);
|
|
source = dma_map_single(src, len, DMA_TO_DEVICE);
|
|
|
|
ret = ops->transfer(dev, DMA_MEM_TO_MEM, destination, source, len);
|
|
|
|
/* Clean+Invalidate the areas after, so we can see DMA'd data */
|
|
dma_unmap_single(destination, len, DMA_FROM_DEVICE);
|
|
dma_unmap_single(source, len, DMA_TO_DEVICE);
|
|
|
|
return ret;
|
|
}
|
|
|
|
UCLASS_DRIVER(dma) = {
|
|
.id = UCLASS_DMA,
|
|
.name = "dma",
|
|
.flags = DM_UC_FLAG_SEQ_ALIAS,
|
|
.per_device_auto = sizeof(struct dma_dev_priv),
|
|
};
|