[S] Change in coreboot[main]: arch/riscv: Add PMP print function

[Felix Held (Code Review)]

Felix Held has submitted this change. ( https://review.coreboot.org/c/coreboot/+/83283?usp=email )

Change subject: arch/riscv: Add PMP print function
......................................................................

arch/riscv: Add PMP print function

For easier debugging it is useful to have a function that prints the PMP
regions.

Signed-off-by: Maximilian Brune 
Change-Id: I6ab1531c65b14690e37aecf57ff441bf22db1ce5
Reviewed-on: https://review.coreboot.org/c/coreboot/+/83283
Tested-by: build bot (Jenkins) 
Reviewed-by: Elyes Haouas 
Reviewed-by: ron minnich 
---
M src/arch/riscv/include/arch/pmp.h
M src/arch/riscv/pmp.c
2 files changed, 48 insertions(+), 0 deletions(-)

Approvals:
  build bot (Jenkins): Verified
  Elyes Haouas: Looks good to me, but someone else must approve
  ron minnich: Looks good to me, approved

diff --git a/src/arch/riscv/include/arch/pmp.h b/src/arch/riscv/include/arch/pmp.h
index f98adf7..273ccfe 100644
--- a/src/arch/riscv/include/arch/pmp.h
+++ b/src/arch/riscv/include/arch/pmp.h
@@ -11,6 +11,8 @@
  */
 int pmp_entries_num(void);

+void print_pmp_regions(void);
+
 /* reset PMP setting */
 void reset_pmp(void);

diff --git a/src/arch/riscv/pmp.c b/src/arch/riscv/pmp.c
index b643441..cb605cb 100644
--- a/src/arch/riscv/pmp.c
+++ b/src/arch/riscv/pmp.c
@@ -314,6 +314,52 @@
    pmp_entry_used_mask |= 1 << idx;
 }

+/* prints the pmp regions by reading the PMP address and configuration registers */
+void print_pmp_regions(void)
+{
+	uintptr_t prev_pmpaddr = 0;
+	uintptr_t base = 0;
+	uintptr_t size = 0;
+	const char *mode;
+	for (int i = 0; i < pmp_entries_num(); i++) {
+		uintptr_t pmpcfg = read_pmpcfg(i);
+		uintptr_t pmpaddr = read_pmpaddr(i);
+		if ((pmpcfg & PMP_A) == 0) {
+			continue; // PMP entry is disabled
+		} else if (pmpcfg & PMP_NA4) {
+			base = pmpaddr << PMP_SHIFT;
+			size = 4;
+			mode = "NA4";
+		} else if (pmpcfg & PMP_NAPOT) {
+			unsigned int count_trailing_ones = 0;
+			base = pmpaddr;
+			while (base) {
+				if ((base & 1) == 0)
+					break; // we got a zero
+				count_trailing_ones++;
+				base >>= 1;
+			}
+			size = 8 << count_trailing_ones;
+			base = (pmpaddr & ~((2 << count_trailing_ones) - 1)) >> PMP_SHIFT;
+			mode = "NAPOT";
+		} else if (pmpcfg & PMP_TOR) {
+			base = pmpaddr;
+			size = pmpaddr - prev_pmpaddr;
+			mode = "TOR";
+		}
+
+		printk(BIOS_DEBUG, "base: 0x%lx, size: 0x%lx, perm: %c%c%c, mode: %s, locked: %d\n",
+			base, size,
+			(pmpcfg & PMP_R) ? 'r' : ' ',
+			(pmpcfg & PMP_W) ? 'w' : ' ',
+			(pmpcfg & PMP_X) ? 'x' : ' ',
+			mode,
+			(pmpcfg & PMP_L) ? 1 : 0);
+
+		prev_pmpaddr = pmpaddr;
+	}
+}
+
 /* reset PMP setting */
 void reset_pmp(void)
 {