Firmware/opensbi
8
0
Fork 0
forked from Mirrors/opensbi
Code Pull Requests Activity

lib: sbi: Improve PMP CSR detection and progamming

Browse Source 
As-per latest RISC-V privilege spec up to 64 PMP entries are supported.
Implementations may implement zero, 16, or 64 PMP CSRs. All PMP CSR
fields are WARL and may be hardwired to zero.

This patch improves PMP CSR detection and progamming considering
above facts.

Signed-off-by: Anup Patel <anup.patel@wdc.com>
Reviewed-by: Atish Patra <atish.patra@wdc.com>
This commit is contained in:
Anup Patel
2020-08-18 13:28:08 +05:30
committed by Anup Patel
parent 7b0b289887
commit 74d1db7062
3 changed files with 180 additions and 145 deletions
Download Patch File Download Diff File Expand all files Collapse all files

72
lib/sbi/sbi_hart.c
View File

@@ -340,31 +340,55 @@ static void hart_detect_features(struct sbi_scratch *scratch)
hfeatures->features = 0;
hfeatures->pmp_count = 0;
/* Detect if hart supports PMP feature */
#define __detect_pmp(__pmp_csr) \
val = csr_read_allowed(__pmp_csr, (ulong)&trap); \
if (!trap.cause) { \
csr_write_allowed(__pmp_csr, (ulong)&trap, val);\
if (!trap.cause) \
hfeatures->pmp_count++; \
#define __check_csr(__csr, __rdonly, __wrval, __field, __skip) \
val = csr_read_allowed(__csr, (ulong)&trap); \
if (!trap.cause) { \
if (__rdonly) { \
(hfeatures->__field)++; \
} else { \
csr_write_allowed(__csr, (ulong)&trap, __wrval);\
if (!trap.cause) { \
if (csr_swap(__csr, val) == __wrval) \
(hfeatures->__field)++; \
else \
goto __skip; \
} else { \
goto __skip; \
} \
} \
} else { \
goto __skip; \
}
__detect_pmp(CSR_PMPADDR0);
__detect_pmp(CSR_PMPADDR1);
__detect_pmp(CSR_PMPADDR2);
__detect_pmp(CSR_PMPADDR3);
__detect_pmp(CSR_PMPADDR4);
__detect_pmp(CSR_PMPADDR5);
__detect_pmp(CSR_PMPADDR6);
__detect_pmp(CSR_PMPADDR7);
__detect_pmp(CSR_PMPADDR8);
__detect_pmp(CSR_PMPADDR9);
__detect_pmp(CSR_PMPADDR10);
__detect_pmp(CSR_PMPADDR11);
__detect_pmp(CSR_PMPADDR12);
__detect_pmp(CSR_PMPADDR13);
__detect_pmp(CSR_PMPADDR14);
__detect_pmp(CSR_PMPADDR15);
#undef __detect_pmp
#define __check_csr_2(__csr, __rdonly, __wrval, __field, __skip) \
__check_csr(__csr + 0, __rdonly, __wrval, __field, __skip) \
__check_csr(__csr + 1, __rdonly, __wrval, __field, __skip)
#define __check_csr_4(__csr, __rdonly, __wrval, __field, __skip) \
__check_csr_2(__csr + 0, __rdonly, __wrval, __field, __skip) \
__check_csr_2(__csr + 2, __rdonly, __wrval, __field, __skip)
#define __check_csr_8(__csr, __rdonly, __wrval, __field, __skip) \
__check_csr_4(__csr + 0, __rdonly, __wrval, __field, __skip) \
__check_csr_4(__csr + 4, __rdonly, __wrval, __field, __skip)
#define __check_csr_16(__csr, __rdonly, __wrval, __field, __skip) \
__check_csr_8(__csr + 0, __rdonly, __wrval, __field, __skip) \
__check_csr_8(__csr + 8, __rdonly, __wrval, __field, __skip)
#define __check_csr_32(__csr, __rdonly, __wrval, __field, __skip) \
__check_csr_16(__csr + 0, __rdonly, __wrval, __field, __skip) \
__check_csr_16(__csr + 16, __rdonly, __wrval, __field, __skip)
#define __check_csr_64(__csr, __rdonly, __wrval, __field, __skip) \
__check_csr_32(__csr + 0, __rdonly, __wrval, __field, __skip) \
__check_csr_32(__csr + 32, __rdonly, __wrval, __field, __skip)
/* Detect number of PMP regions */
__check_csr_64(CSR_PMPADDR0, 0, PMP_ADDR_MASK, pmp_count, __pmp_skip);
__pmp_skip:
#undef __check_csr_64
#undef __check_csr_32
#undef __check_csr_16
#undef __check_csr_8
#undef __check_csr_4
#undef __check_csr_2
#undef __check_csr
/* Detect if hart supports SCOUNTEREN feature */
trap.cause = 0;