diff --git a/include/sbi/sbi_console.h b/include/sbi/sbi_console.h index 28b4a79..e15b55d 100644 --- a/include/sbi/sbi_console.h +++ b/include/sbi/sbi_console.h @@ -11,7 +11,6 @@ #define __SBI_CONSOLE_H__ #include -#include struct sbi_console_device { /** Name of the console device */ @@ -44,6 +43,8 @@ int __printf(1, 2) sbi_printf(const char *format, ...); int __printf(1, 2) sbi_dprintf(const char *format, ...); +void __printf(1, 2) __attribute__((noreturn)) sbi_panic(const char *format, ...); + const struct sbi_console_device *sbi_console_get_device(void); void sbi_console_set_device(const struct sbi_console_device *dev); @@ -52,23 +53,9 @@ struct sbi_scratch; int sbi_console_init(struct sbi_scratch *scratch); -#define BUG() do { \ - sbi_printf("BUG: failure at %s:%d/%s()!\n", \ - __FILE__, __LINE__, __func__); \ - sbi_hart_hang(); \ -} while (0) - -#define BUG_ON(cond) do { \ - if (cond) \ - BUG(); \ -} while (0) - -#define SBI_ASSERT(cond) do { \ - if (!(cond)) { \ - sbi_printf("ASSERT: %s:%d/%s(): Assertion `%s` failed.\n", \ - __FILE__,__LINE__,__func__, #cond);\ - sbi_hart_hang(); \ - } \ +#define SBI_ASSERT(cond, args) do { \ + if (unlikely(!(cond))) \ + sbi_panic args; \ } while (0) #endif diff --git a/lib/sbi/riscv_asm.c b/lib/sbi/riscv_asm.c index 1642ac6..2e2e148 100644 --- a/lib/sbi/riscv_asm.c +++ b/lib/sbi/riscv_asm.c @@ -76,7 +76,8 @@ void misa_string(int xlen, char *out, unsigned int out_sz) out[pos++] = '8'; break; default: - BUG(); + sbi_panic("%s: Unknown misa.MXL encoding %d", + __func__, xlen); return; } } @@ -145,7 +146,7 @@ unsigned long csr_read_num(int csr_num) #endif default: - BUG(); + sbi_panic("%s: Unknown CSR %#x", __func__, csr_num); break; }; @@ -213,7 +214,7 @@ void csr_write_num(int csr_num, unsigned long val) switchcase_csr_write_16(CSR_MHPMEVENT16, val) default: - BUG(); + sbi_panic("%s: Unknown CSR %#x", __func__, csr_num); break; }; diff --git a/lib/sbi/sbi_console.c b/lib/sbi/sbi_console.c index 29eede3..34c843d 100644 --- a/lib/sbi/sbi_console.c +++ b/lib/sbi/sbi_console.c @@ -9,6 +9,7 @@ #include #include +#include #include #include @@ -397,6 +398,19 @@ int sbi_dprintf(const char *format, ...) return retval; } +void sbi_panic(const char *format, ...) +{ + va_list args; + + spin_lock(&console_out_lock); + va_start(args, format); + print(NULL, NULL, format, args); + va_end(args); + spin_unlock(&console_out_lock); + + sbi_hart_hang(); +} + const struct sbi_console_device *sbi_console_get_device(void) { return console_dev; diff --git a/platform/generic/sifive_fu740.c b/platform/generic/sifive_fu740.c index 3152152..333b3fb 100644 --- a/platform/generic/sifive_fu740.c +++ b/platform/generic/sifive_fu740.c @@ -12,6 +12,7 @@ #include #include #include +#include #include #include #include