diff options
author | Anup Patel <apatel@ventanamicro.com> | 2021-06-15 08:49:40 +0300 |
---|---|---|
committer | Anup Patel <anup@brainfault.org> | 2022-02-15 18:07:27 +0300 |
commit | 7127aaaaf709c0a5a08b70e993a135b27eb50006 (patch) | |
tree | 286cb1fcf562e425972cf8105204996e2930d313 | |
parent | 811da5c54180aafde6cb7740b1ccaf92d1017f24 (diff) | |
download | opensbi-7127aaaaf709c0a5a08b70e993a135b27eb50006.tar.xz |
lib: utils: Disable appropriate IMSIC DT nodes in fdt_fixups()
We should disable IMSIC DT nodes in fdt_fixups() which are not
accessible to the next booting stage based on currently assigned
domain.
Signed-off-by: Anup Patel <anup.patel@wdc.com>
Signed-off-by: Anup Patel <apatel@ventanamicro.com>
Reviewed-by: Atish Patra <atishp@rivosinc.com>
-rw-r--r-- | include/sbi_utils/fdt/fdt_fixup.h | 17 | ||||
-rw-r--r-- | lib/utils/fdt/fdt_fixup.c | 32 |
2 files changed, 45 insertions, 4 deletions
diff --git a/include/sbi_utils/fdt/fdt_fixup.h b/include/sbi_utils/fdt/fdt_fixup.h index c38e5d9..77575bb 100644 --- a/include/sbi_utils/fdt/fdt_fixup.h +++ b/include/sbi_utils/fdt/fdt_fixup.h @@ -22,6 +22,18 @@ void fdt_cpu_fixup(void *fdt); /** + * Fix up the IMSIC nodes in the device tree + * + * This routine disables IMSIC nodes which are not accessible to the next + * booting stage based on currently assigned domain. + * + * It is recommended that platform codes call this helper in their final_init() + * + * @param fdt: device tree blob + */ +void fdt_imsic_fixup(void *fdt); + +/** * Fix up the PLIC node in the device tree * * This routine updates the "interrupt-extended" property of the PLIC node in @@ -64,8 +76,9 @@ int fdt_reserved_memory_nomap_fixup(void *fdt); * General device tree fix-up * * This routine do all required device tree fix-ups for a typical platform. - * It fixes up the PLIC node and the reserved memory node in the device tree - * by calling the corresponding helper routines to accomplish the task. + * It fixes up the PLIC node, IMSIC nodes, and the reserved memory node in + * the device tree by calling the corresponding helper routines to accomplish + * the task. * * It is recommended that platform codes call this helper in their final_init() * diff --git a/lib/utils/fdt/fdt_fixup.c b/lib/utils/fdt/fdt_fixup.c index ac01ba3..c2460b8 100644 --- a/lib/utils/fdt/fdt_fixup.c +++ b/lib/utils/fdt/fdt_fixup.c @@ -52,6 +52,34 @@ void fdt_cpu_fixup(void *fdt) } } +static void fdt_domain_based_fixup_one(void *fdt, int nodeoff) +{ + int rc; + uint64_t reg_addr, reg_size; + struct sbi_domain *dom = sbi_domain_thishart_ptr(); + + rc = fdt_get_node_addr_size(fdt, nodeoff, 0, ®_addr, ®_size); + if (rc < 0 || !reg_addr || !reg_size) + return; + + if (!sbi_domain_check_addr(dom, reg_addr, dom->next_mode, + SBI_DOMAIN_READ | SBI_DOMAIN_WRITE)) { + rc = fdt_open_into(fdt, fdt, fdt_totalsize(fdt) + 32); + if (rc < 0) + return; + fdt_setprop_string(fdt, nodeoff, "status", "disabled"); + } +} + +void fdt_imsic_fixup(void *fdt) +{ + int noff = 0; + + while ((noff = fdt_node_offset_by_compatible(fdt, noff, + "riscv,imsics")) >= 0) + fdt_domain_based_fixup_one(fdt, noff); +} + void fdt_plic_fixup(void *fdt) { u32 *cells; @@ -261,10 +289,10 @@ int fdt_reserved_memory_nomap_fixup(void *fdt) void fdt_fixups(void *fdt) { + fdt_imsic_fixup(fdt); + fdt_plic_fixup(fdt); fdt_reserved_memory_fixup(fdt); fdt_pmu_fixup(fdt); } - - |