Fix PLIC offsets for aux timer

This commit is contained in:
Rodrigo Arias 2024-08-29 17:14:04 +02:00
parent 58ddfd4720
commit 6be0f70c8d

View File

@ -1,5 +1,5 @@
diff --git a/lib/sbi/sbi_irqchip.c b/lib/sbi/sbi_irqchip.c diff --git a/lib/sbi/sbi_irqchip.c b/lib/sbi/sbi_irqchip.c
index 0ae604a..7b1d95e 100644 index 0ae604a..e34e90c 100644
--- a/lib/sbi/sbi_irqchip.c --- a/lib/sbi/sbi_irqchip.c
+++ b/lib/sbi/sbi_irqchip.c +++ b/lib/sbi/sbi_irqchip.c
@@ -9,6 +9,9 @@ @@ -9,6 +9,9 @@
@ -25,7 +25,7 @@ index 0ae604a..7b1d95e 100644
return 0; return 0;
} }
@@ -47,8 +52,163 @@ void sbi_irqchip_exit(struct sbi_scratch *scratch) @@ -47,8 +52,170 @@ void sbi_irqchip_exit(struct sbi_scratch *scratch)
{ {
const struct sbi_platform *plat = sbi_platform_ptr(scratch); const struct sbi_platform *plat = sbi_platform_ptr(scratch);
@ -46,12 +46,12 @@ index 0ae604a..7b1d95e 100644
+#define MIDELEG_SEIE (1UL << 9) // Delegate Machine External Interrupt to Supervisor +#define MIDELEG_SEIE (1UL << 9) // Delegate Machine External Interrupt to Supervisor
+#define PLIC_TIMER_PORT 4 +#define PLIC_TIMER_PORT 4
+// Base address of PLIC +// Base address of PLIC
+#define PLIC_BASE 0x0000000040800000UL +#define PLIC_BASE 0x40800000UL
+#define PLIC_PRIORITY_OFFSET 0x0UL +#define PLIC_PRIORITY_OFFSET 0x0UL
+#define PLIC_PENDING_OFFSET 0x1000UL +#define PLIC_PENDING_OFFSET 0x1000UL
+#define PLIC_ENABLE_OFFSET 0x2000UL +#define PLIC_ENABLE_OFFSET 0x2080UL
+#define PLIC_THRESHOLD_OFFSET 0x200000UL +#define PLIC_THRESHOLD_OFFSET 0x201000UL
+#define PLIC_CLAIM_OFFSET 0x200004UL +#define PLIC_CLAIM_OFFSET 0x201004UL
+ +
+// Aux timer +// Aux timer
+#define AUX_TIMER_BASE 0x40010000UL +#define AUX_TIMER_BASE 0x40010000UL
@ -86,6 +86,8 @@ index 0ae604a..7b1d95e 100644
+ prefix, suffix, csr_read(CSR_SIP)); + prefix, suffix, csr_read(CSR_SIP));
+ sbi_printf("%sSSTATUS%s: 0x%" PRILX "\n", + sbi_printf("%sSSTATUS%s: 0x%" PRILX "\n",
+ prefix, suffix, csr_read(CSR_SSTATUS)); + prefix, suffix, csr_read(CSR_SSTATUS));
+ sbi_printf("%sSTVEC%s: 0x%" PRILX "\n",
+ prefix, suffix, csr_read(CSR_STVEC));
+} +}
+ +
+static void __attribute__((optimize("O0"))) switch_to_supervisor_mode(int (*target_address)(void)) +static void __attribute__((optimize("O0"))) switch_to_supervisor_mode(int (*target_address)(void))
@ -129,9 +131,12 @@ index 0ae604a..7b1d95e 100644
+ return 0; + return 0;
+} +}
+ +
+static void supervisor_trap_entry(void) +static void __attribute__((aligned(4))) __attribute__((interrupt ("supervisor"))) supervisor_trap_entry(void)
+{ +{
+ sbi_printf("\nSupervisor Trap Entry Reached!\nTEST-RESULT-OK\n"); + sbi_printf("\nSupervisor Trap Entry Reached!\n");
+ sbi_printf("\nTEST-RESULT-OK\n");
+ while (1) {
+ }
+} +}
+ +
+static void do_plic_test(void) +static void do_plic_test(void)
@ -144,10 +149,12 @@ index 0ae604a..7b1d95e 100644
+ +
+ +
+ /* Enable supervisor interrupt delegation */ + /* Enable supervisor interrupt delegation */
+
+ csr_set(CSR_SIE, SIE_SEIE); // Enable supervisor external interrupts + csr_set(CSR_SIE, SIE_SEIE); // Enable supervisor external interrupts
+ csr_set(CSR_SSTATUS, SSTATUS_SIE); // Enable global interrupts in supervisor mode + csr_set(CSR_SSTATUS, SSTATUS_SIE); // Enable global interrupts in supervisor mode
+ csr_set(CSR_MIDELEG, MIDELEG_SEIE); // Delegate machine interrupts to supervisor mode + csr_set(CSR_MIDELEG, MIDELEG_SEIE); // Delegate machine interrupts to supervisor mode
+ csr_set(CSR_STVEC, &supervisor_trap_entry); + csr_write(CSR_STVEC, &supervisor_trap_entry);
+
+ sbi_printf("Enabled supervisor delegation:\n"); + sbi_printf("Enabled supervisor delegation:\n");
+ +
+ dumpregs(1); + dumpregs(1);