[PATCH v5 1/3] platform: generic: renesas: rzfive: Add support to configure the PMA
Lad Prabhakar
prabhakar.mahadev-lad.rj at bp.renesas.com
Mon Feb 13 13:51:09 PST 2023
I/O Coherence Port (IOCP) provides an AXI interface for connecting
external non-caching masters, such as DMA controllers. The accesses
from IOCP are coherent with D-Caches and L2 Cache.
IOCP is a specification option and is disabled on the Renesas RZ/Five
SoC due to this reason IP blocks using DMA will fail.
The Andes AX45MP core has a Programmable Physical Memory Attributes (PMA)
block that allows dynamic adjustment of memory attributes in the runtime.
It contains a configurable amount of PMA entries implemented as CSR
registers to control the attributes of memory locations in interest.
Below are the memory attributes supported:
* Device, Non-bufferable
* Device, bufferable
* Memory, Non-cacheable, Non-bufferable
* Memory, Non-cacheable, Bufferable
* Memory, Write-back, No-allocate
* Memory, Write-back, Read-allocate
* Memory, Write-back, Write-allocate
* Memory, Write-back, Read and Write-allocate
More info about PMA (section 10.3):
Link: http://www.andestech.com/wp-content/uploads/AX45MP-1C-Rev.-5.0.0-Datasheet.pdf
As a workaround for SoCs with IOCP disabled CMO needs to be handled by
software. Firstly OpenSBI configures the memory region as
"Memory, Non-cacheable, Bufferable" and passes this region as a global
shared dma pool as a DT node. With DMA_GLOBAL_POOL enabled all DMA
allocations happen from this region and synchronization callbacks are
implemented to synchronize when doing DMA transactions.
Example PMA region passed as a DT node from OpenSBI:
reserved-memory {
#address-cells = <2>;
#size-cells = <2>;
ranges;
pma_resv0 at 58000000 {
compatible = "shared-dma-pool";
reg = <0x0 0x58000000 0x0 0x08000000>;
no-map;
linux,dma-default;
};
};
Signed-off-by: Lad Prabhakar <prabhakar.mahadev-lad.rj at bp.renesas.com>
Reviewed-by: Yu Chien Peter Lin <peterlin at andestech.com>
---
platform/generic/Kconfig | 2 +
platform/generic/andes/Kconfig | 5 +
platform/generic/andes/andes45-pma.c | 350 +++++++++++++++++++
platform/generic/andes/objects.mk | 2 +
platform/generic/include/andes/andes45_pma.h | 48 +++
5 files changed, 407 insertions(+)
create mode 100644 platform/generic/andes/Kconfig
create mode 100644 platform/generic/andes/andes45-pma.c
create mode 100644 platform/generic/include/andes/andes45_pma.h
diff --git a/platform/generic/Kconfig b/platform/generic/Kconfig
index c7f198a..39fb4e9 100644
--- a/platform/generic/Kconfig
+++ b/platform/generic/Kconfig
@@ -50,4 +50,6 @@ config PLATFORM_STARFIVE_JH7110
bool "StarFive JH7110 support"
default n
+source "$(OPENSBI_SRC_DIR)/platform/generic/andes/Kconfig"
+
endif
diff --git a/platform/generic/andes/Kconfig b/platform/generic/andes/Kconfig
new file mode 100644
index 0000000..3ad4e4c
--- /dev/null
+++ b/platform/generic/andes/Kconfig
@@ -0,0 +1,5 @@
+# SPDX-License-Identifier: BSD-2-Clause
+
+config ANDES45_PMA
+ bool "Andes PMA support"
+ default n
diff --git a/platform/generic/andes/andes45-pma.c b/platform/generic/andes/andes45-pma.c
new file mode 100644
index 0000000..2745bc3
--- /dev/null
+++ b/platform/generic/andes/andes45-pma.c
@@ -0,0 +1,350 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2023 Renesas Electronics Corp.
+ *
+ * Copyright (c) 2020 Andes Technology Corporation
+ *
+ * Authors:
+ * Nick Hu <nickhu at andestech.com>
+ * Nylon Chen <nylon7 at andestech.com>
+ * Lad Prabhakar <prabhakar.mahadev-lad.rj at bp.renesas.com>
+ */
+
+#include <andes/andes45_pma.h>
+#include <libfdt.h>
+#include <sbi/riscv_asm.h>
+#include <sbi/riscv_io.h>
+#include <sbi/sbi_console.h>
+#include <sbi/sbi_error.h>
+#include <sbi_utils/fdt/fdt_helper.h>
+
+/* Configuration Registers */
+#define ANDES45_CSR_MMSC_CFG 0xFC2
+#define ANDES45_CSR_MMSC_PPMA_OFFSET (1 << 30)
+
+#define ANDES45_PMAADDR_0 0xBD0
+
+#define ANDES45_PMACFG_0 0xBC0
+
+static inline unsigned long andes45_pma_read_cfg(unsigned int pma_cfg_off)
+{
+#define switchcase_pma_cfg_read(__pma_cfg_off, __val) \
+ case __pma_cfg_off: \
+ __val = csr_read(__pma_cfg_off); \
+ break;
+#define switchcase_pma_cfg_read_2(__pma_cfg_off, __val) \
+ switchcase_pma_cfg_read(__pma_cfg_off + 0, __val) \
+ switchcase_pma_cfg_read(__pma_cfg_off + 2, __val)
+
+ unsigned long ret = 0;
+
+ switch (pma_cfg_off) {
+ switchcase_pma_cfg_read_2(ANDES45_PMACFG_0, ret)
+
+ default:
+ sbi_panic("%s: Unknown PMA CFG offset %#x", __func__, pma_cfg_off);
+ break;
+ }
+
+ return ret;
+
+#undef switchcase_pma_cfg_read_2
+#undef switchcase_pma_cfg_read
+}
+
+static inline void andes45_pma_write_cfg(unsigned int pma_cfg_off, unsigned long val)
+{
+#define switchcase_pma_cfg_write(__pma_cfg_off, __val) \
+ case __pma_cfg_off: \
+ csr_write(__pma_cfg_off, __val); \
+ break;
+#define switchcase_pma_cfg_write_2(__pma_cfg_off, __val) \
+ switchcase_pma_cfg_write(__pma_cfg_off + 0, __val) \
+ switchcase_pma_cfg_write(__pma_cfg_off + 2, __val)
+
+ switch (pma_cfg_off) {
+ switchcase_pma_cfg_write_2(ANDES45_PMACFG_0, val)
+
+ default:
+ sbi_panic("%s: Unknown PMA CFG offset %#x", __func__, pma_cfg_off);
+ break;
+ }
+
+#undef switchcase_pma_cfg_write_2
+#undef switchcase_pma_cfg_write
+}
+
+static inline void andes45_pma_write_addr(unsigned int pma_addr_off, unsigned long val)
+{
+#define switchcase_pma_write(__pma_addr_off, __val) \
+ case __pma_addr_off: \
+ csr_write(__pma_addr_off, __val); \
+ break;
+#define switchcase_pma_write_2(__pma_addr_off, __val) \
+ switchcase_pma_write(__pma_addr_off + 0, __val) \
+ switchcase_pma_write(__pma_addr_off + 1, __val)
+#define switchcase_pma_write_4(__pma_addr_off, __val) \
+ switchcase_pma_write_2(__pma_addr_off + 0, __val) \
+ switchcase_pma_write_2(__pma_addr_off + 2, __val)
+#define switchcase_pma_write_8(__pma_addr_off, __val) \
+ switchcase_pma_write_4(__pma_addr_off + 0, __val) \
+ switchcase_pma_write_4(__pma_addr_off + 4, __val)
+#define switchcase_pma_write_16(__pma_addr_off, __val) \
+ switchcase_pma_write_8(__pma_addr_off + 0, __val) \
+ switchcase_pma_write_8(__pma_addr_off + 8, __val)
+
+ switch (pma_addr_off) {
+ switchcase_pma_write_16(ANDES45_PMAADDR_0, val)
+
+ default:
+ sbi_panic("%s: Unknown PMA ADDR offset %#x", __func__, pma_addr_off);
+ break;
+ }
+
+#undef switchcase_pma_write_16
+#undef switchcase_pma_write_8
+#undef switchcase_pma_write_4
+#undef switchcase_pma_write_2
+#undef switchcase_pma_write
+}
+
+static inline unsigned long andes45_pma_read_addr(unsigned int pma_addr_off)
+{
+#define switchcase_pma_read(__pma_addr_off, __val) \
+ case __pma_addr_off: \
+ __val = csr_read(__pma_addr_off); \
+ break;
+#define switchcase_pma_read_2(__pma_addr_off, __val) \
+ switchcase_pma_read(__pma_addr_off + 0, __val) \
+ switchcase_pma_read(__pma_addr_off + 1, __val)
+#define switchcase_pma_read_4(__pma_addr_off, __val) \
+ switchcase_pma_read_2(__pma_addr_off + 0, __val) \
+ switchcase_pma_read_2(__pma_addr_off + 2, __val)
+#define switchcase_pma_read_8(__pma_addr_off, __val) \
+ switchcase_pma_read_4(__pma_addr_off + 0, __val) \
+ switchcase_pma_read_4(__pma_addr_off + 4, __val)
+#define switchcase_pma_read_16(__pma_addr_off, __val) \
+ switchcase_pma_read_8(__pma_addr_off + 0, __val) \
+ switchcase_pma_read_8(__pma_addr_off + 8, __val)
+
+ unsigned long ret = 0;
+
+ switch (pma_addr_off) {
+ switchcase_pma_read_16(ANDES45_PMAADDR_0, ret)
+
+ default:
+ sbi_panic("%s: Unknown PMA ADDR offset %#x", __func__, pma_addr_off);
+ break;
+ }
+
+ return ret;
+
+#undef switchcase_pma_read_16
+#undef switchcase_pma_read_8
+#undef switchcase_pma_read_4
+#undef switchcase_pma_read_2
+#undef switchcase_pma_read
+}
+
+static unsigned long
+andes45_pma_setup(const struct andes45_pma_region *pma_region,
+ unsigned int entry_id)
+{
+ unsigned long size = pma_region->size;
+ unsigned long addr = pma_region->pa;
+ unsigned int pma_cfg_addr;
+ unsigned long pmacfg_val;
+ unsigned long pmaaddr;
+ char *pmaxcfg;
+
+ /* Check for 4KiB granularity */
+ if (size < (1 << 12))
+ return SBI_EINVAL;
+
+ /* Check size is power of 2 */
+ if (size & (size - 1))
+ return SBI_EINVAL;
+
+ if (entry_id > 15)
+ return SBI_EINVAL;
+
+ if (!(pma_region->flags & ANDES45_PMACFG_ETYP_NAPOT))
+ return SBI_EINVAL;
+
+ if ((addr & (size - 1)) != 0)
+ return SBI_EINVAL;
+
+ pma_cfg_addr = entry_id / 8 ? ANDES45_PMACFG_0 + 2 : ANDES45_PMACFG_0;
+ pmacfg_val = andes45_pma_read_cfg(pma_cfg_addr);
+ pmaxcfg = (char *)&pmacfg_val + (entry_id % 8);
+ *pmaxcfg = 0;
+ *pmaxcfg = pma_region->flags;
+
+ andes45_pma_write_cfg(pma_cfg_addr, pmacfg_val);
+
+ pmaaddr = (addr >> 2) + (size >> 3) - 1;
+
+ andes45_pma_write_addr(ANDES45_PMAADDR_0 + entry_id, pmaaddr);
+
+ return andes45_pma_read_addr(ANDES45_PMAADDR_0 + entry_id) == pmaaddr ?
+ pmaaddr : SBI_EINVAL;
+}
+
+static int andes45_fdt_pma_resv(void *fdt, const struct andes45_pma_region *pma,
+ unsigned int index, int parent)
+{
+ int na = fdt_address_cells(fdt, 0);
+ int ns = fdt_size_cells(fdt, 0);
+ static bool dma_default = false;
+ fdt32_t addr_high, addr_low;
+ fdt32_t size_high, size_low;
+ int subnode, err;
+ fdt32_t reg[4];
+ fdt32_t *val;
+ char name[32];
+
+ addr_high = (u64)pma->pa >> 32;
+ addr_low = pma->pa;
+ size_high = (u64)pma->size >> 32;
+ size_low = pma->size;
+
+ if (na > 1 && addr_high)
+ sbi_snprintf(name, sizeof(name),
+ "pma_resv%d@%x,%x", index,
+ addr_high, addr_low);
+ else
+ sbi_snprintf(name, sizeof(name),
+ "pma_resv%d@%x", index,
+ addr_low);
+
+ subnode = fdt_add_subnode(fdt, parent, name);
+ if (subnode < 0)
+ return subnode;
+
+ if (pma->shared_dma) {
+ err = fdt_setprop_string(fdt, subnode, "compatible", "shared-dma-pool");
+ if (err < 0)
+ return err;
+ }
+
+ if (pma->no_map) {
+ err = fdt_setprop_empty(fdt, subnode, "no-map");
+ if (err < 0)
+ return err;
+ }
+
+ /* Linux allows single linux,dma-default region. */
+ if (pma->dma_default) {
+ if (dma_default)
+ return SBI_EINVAL;
+
+ err = fdt_setprop_empty(fdt, subnode, "linux,dma-default");
+ if (err < 0)
+ return err;
+ dma_default = true;
+ }
+
+ /* encode the <reg> property value */
+ val = reg;
+ if (na > 1)
+ *val++ = cpu_to_fdt32(addr_high);
+ *val++ = cpu_to_fdt32(addr_low);
+ if (ns > 1)
+ *val++ = cpu_to_fdt32(size_high);
+ *val++ = cpu_to_fdt32(size_low);
+
+ err = fdt_setprop(fdt, subnode, "reg", reg,
+ (na + ns) * sizeof(fdt32_t));
+ if (err < 0)
+ return err;
+
+ return 0;
+}
+
+static int andes45_fdt_reserved_memory_fixup(void *fdt,
+ const struct andes45_pma_region *pma,
+ unsigned int entry)
+{
+ int parent;
+
+ /* try to locate the reserved memory node */
+ parent = fdt_path_offset(fdt, "/reserved-memory");
+ if (parent < 0) {
+ int na = fdt_address_cells(fdt, 0);
+ int ns = fdt_size_cells(fdt, 0);
+ int err;
+
+ /* if such node does not exist, create one */
+ parent = fdt_add_subnode(fdt, 0, "reserved-memory");
+ if (parent < 0)
+ return parent;
+
+ err = fdt_setprop_empty(fdt, parent, "ranges");
+ if (err < 0)
+ return err;
+
+ err = fdt_setprop_u32(fdt, parent, "#size-cells", ns);
+ if (err < 0)
+ return err;
+
+ err = fdt_setprop_u32(fdt, parent, "#address-cells", na);
+ if (err < 0)
+ return err;
+ }
+
+ return andes45_fdt_pma_resv(fdt, pma, entry, parent);
+}
+
+int andes45_pma_setup_regions(const struct andes45_pma_region *pma_regions,
+ unsigned int pma_regions_count)
+{
+ unsigned long mmsc = csr_read(ANDES45_CSR_MMSC_CFG);
+ unsigned int dt_populate_cnt;
+ unsigned int i, j;
+ unsigned long pa;
+ void *fdt;
+ int ret;
+
+ if (!pma_regions || !pma_regions_count)
+ return 0;
+
+ if (pma_regions_count > ANDES45_MAX_PMA_REGIONS)
+ return SBI_EINVAL;
+
+ if ((mmsc & ANDES45_CSR_MMSC_PPMA_OFFSET) == 0)
+ return SBI_ENOTSUPP;
+
+ /* Configure the PMA regions */
+ for (i = 0; i < pma_regions_count; i++) {
+ pa = andes45_pma_setup(&pma_regions[i], i);
+ if (pa == SBI_EINVAL)
+ return SBI_EINVAL;
+ }
+
+ dt_populate_cnt = 0;
+ for (i = 0; i < pma_regions_count; i++) {
+ if (!pma_regions[i].dt_populate)
+ continue;
+ dt_populate_cnt++;
+ }
+
+ if (!dt_populate_cnt)
+ return 0;
+
+ fdt = fdt_get_address();
+
+ ret = fdt_open_into(fdt, fdt, fdt_totalsize(fdt) + (64 * dt_populate_cnt));
+ if (ret < 0)
+ return ret;
+
+ for (i = 0, j = 0; i < pma_regions_count; i++) {
+ if (!pma_regions[i].dt_populate)
+ continue;
+
+ ret = andes45_fdt_reserved_memory_fixup(fdt, &pma_regions[i], j++);
+ if (ret)
+ return ret;
+ }
+
+ return 0;
+}
diff --git a/platform/generic/andes/objects.mk b/platform/generic/andes/objects.mk
index 28275ef..ea6b561 100644
--- a/platform/generic/andes/objects.mk
+++ b/platform/generic/andes/objects.mk
@@ -4,3 +4,5 @@
carray-platform_override_modules-$(CONFIG_PLATFORM_ANDES_AE350) += andes_ae350
platform-objs-$(CONFIG_PLATFORM_ANDES_AE350) += andes/ae350.o andes/sleep.o
+
+platform-objs-$(CONFIG_ANDES45_PMA) += andes/andes45-pma.o
diff --git a/platform/generic/include/andes/andes45_pma.h b/platform/generic/include/andes/andes45_pma.h
new file mode 100644
index 0000000..37ec77c
--- /dev/null
+++ b/platform/generic/include/andes/andes45_pma.h
@@ -0,0 +1,48 @@
+/* SPDX-License-Identifier: GPL-2.0 */
+/*
+ * Copyright (C) 2023 Renesas Electronics Corp.
+ */
+
+#ifndef _ANDES45_PMA_H_
+#define _ANDES45_PMA_H_
+
+#include <sbi/sbi_types.h>
+
+#define ANDES45_MAX_PMA_REGIONS 16
+
+/* Naturally aligned power of 2 region */
+#define ANDES45_PMACFG_ETYP_NAPOT 3
+
+/* Memory, Non-cacheable, Bufferable */
+#define ANDES45_PMACFG_MTYP_MEM_NON_CACHE_BUF (3 << 2)
+
+/**
+ * struct andes45_pma_region - Describes PMA regions
+ *
+ * @pa: Address to be configured in the PMA
+ * @size: Size of the region
+ * @flags: Flags to be set for the PMA region
+ * @dt_populate: Boolean flag indicating if the DT entry should be
+ * populated for the given PMA region
+ * @shared_dma: Boolean flag if set "shared-dma-pool" property will
+ * be set in the DT node
+ * @no_map: Boolean flag if set "no-map" property will be set in the
+ * DT node
+ * @dma_default: Boolean flag if set "linux,dma-default" property will
+ * be set in the DT node. Note Linux expects single node
+ * with this property set.
+ */
+struct andes45_pma_region {
+ unsigned long pa;
+ unsigned long size;
+ u8 flags:7;
+ bool dt_populate;
+ bool shared_dma;
+ bool no_map;
+ bool dma_default;
+};
+
+int andes45_pma_setup_regions(const struct andes45_pma_region *pma_regions,
+ unsigned int pma_regions_count);
+
+#endif /* _ANDES45_PMA_H_ */
--
2.17.1
More information about the opensbi
mailing list