This adds a new U-Boot command 'c5_pl330_dma' for Cyclone V SoCDK
boards. It provides access to the Reset Manager's Per2ModRst register
to release the reset for ARM PrimeCell PL330 DMA channels. This allows
software to initialize and use the PL330 DMA controller properly after
reset.

Tested-by: Sune Brian <brians...@gmail.com>
Tested on: Cyclone V SoCDK

Signed-off-by: briansune <brians...@gmail.com>
---
 cmd/Kconfig        |  9 +++++++++
 cmd/Makefile       |  1 +
 cmd/c5_pl330_dma.c | 50 ++++++++++++++++++++++++++++++++++++++++++++++
 3 files changed, 60 insertions(+)
 create mode 100644 cmd/c5_pl330_dma.c

diff --git a/cmd/Kconfig b/cmd/Kconfig
index 29de857ba7c..75c388d19da 100644
--- a/cmd/Kconfig
+++ b/cmd/Kconfig
@@ -1791,6 +1791,15 @@ endmenu
 
 menu "Shell scripting commands"
 
+if TARGET_SOCFPGA_CYCLONE5_SOCDK
+
+config CMD_C5_PL330_DMA
+       bool "Release Reset DMA Channels for PL330 Handshake"
+       help
+         Provides access to Reset Manager Per2ModRst. Enables DMA
+         channels for ARM PrimeCell PL330 via reset release.
+endif
+
 config CMD_CAT
        bool "cat"
        help
diff --git a/cmd/Makefile b/cmd/Makefile
index 36e79cc3c28..d16e6fae20a 100644
--- a/cmd/Makefile
+++ b/cmd/Makefile
@@ -42,6 +42,7 @@ obj-$(CONFIG_CMD_BOOTI) += booti.o
 obj-$(CONFIG_CMD_BTRFS) += btrfs.o
 obj-$(CONFIG_CMD_BUTTON) += button.o
 obj-$(CONFIG_CMD_CAT) += cat.o
+obj-$(CONFIG_CMD_C5_PL330_DMA) += c5_pl330_dma.o
 obj-$(CONFIG_CMD_CACHE) += cache.o
 obj-$(CONFIG_CMD_CBFS) += cbfs.o
 obj-$(CONFIG_CMD_CEDIT) += cedit.o
diff --git a/cmd/c5_pl330_dma.c b/cmd/c5_pl330_dma.c
new file mode 100644
index 00000000000..53bd7a44b7e
--- /dev/null
+++ b/cmd/c5_pl330_dma.c
@@ -0,0 +1,50 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*
+ * Brian Sune <brians...@gmail.com>
+ */
+
+#include <vsprintf.h>
+#include <command.h>
+#include <asm/io.h>
+
+#include <asm/arch/base_addr_ac5.h>
+
+#define RSTMGR_PERMODRST 0x18   /* PERMODRST register offset */
+
+static int do_dmareset(struct cmd_tbl *cmdtp, int flag, int argc,
+       char * const argv[])
+{
+       u8 val;
+       int i, ch;
+
+       if (argc < 2) {
+               printf("Usage: dmareset <channel 0-7> [<channel 0-7> ...]\n");
+               return CMD_RET_USAGE;
+       }
+
+       /* Read current register value */
+       val = readb(SOCFPGA_RSTMGR_ADDRESS + RSTMGR_PERMODRST);
+
+       /* Iterate over all channels given as arguments */
+       for (i = 1; i < argc; i++) {
+               ch = simple_strtoul(argv[i], NULL, 0);
+               if (ch < 0 || ch > 7) {
+                       printf("Error: channel must be 0-7\n");
+                       return CMD_RET_USAGE;
+               }
+               val &= ~(1 << ch);
+               printf("PL330 DMA channel %d reset released\n", ch);
+       }
+
+       /* Write back */
+       writeb(val, (SOCFPGA_RSTMGR_ADDRESS + RSTMGR_PERMODRST));
+
+       return 0;
+}
+
+U_BOOT_CMD(
+       dmareset, 8, 0, do_dmareset,
+       "Release PL330 DMA channel reset(s) for SoCFPGA",
+       "dmareset <channel 0-7> [<channel 0-7> ...]  - release reset for one or 
more DMA channels"
+);
+
-- 
2.47.1.windows.1

Reply via email to