We can't currently mix S-Mode and M-Mode images in the same build and there's no straight-forward way to determine which mode we are in. Move the decision on which mode barebox is targeted at out of Kconfig and into the PBL. PBL code can call either barebox_riscv_supervisor_entry or barebox_riscv_machine_entry to signal to barebox proper which mode it's running in. Currently the only user of this information is the RISC-V timer clocksource driver. Any new code that does IS_ENABLED(CONFIG_RISCV_SBI) or IS_ENABLED(CONFIG_RISCV_M_MODE) should also be adapted to use riscv_mode(). Signed-off-by: Ahmad Fatoum <a.fatoum@pengutronix.de> --- v1 -> v2: - make riscv_mode a pure static inline function for single-mode builds, so e.g. building only erizo can discard code for other modes --- arch/riscv/Kconfig | 14 ++++++++----- arch/riscv/Kconfig.socs | 2 ++ arch/riscv/boards/erizo/lowlevel.c | 6 ++++-- arch/riscv/boards/hifive/lowlevel.c | 17 ++++++++-------- arch/riscv/boot/board-dt-2nd.c | 2 +- arch/riscv/boot/entry.c | 5 +++-- arch/riscv/boot/entry.h | 6 ++++-- arch/riscv/boot/start.c | 12 +++++++---- arch/riscv/boot/uncompress.c | 6 +++--- arch/riscv/include/asm/barebox-riscv.h | 10 ++++++++- arch/riscv/include/asm/system.h | 28 ++++++++++++++++++++++++++ drivers/clocksource/timer-riscv.c | 3 ++- 12 files changed, 82 insertions(+), 29 deletions(-) create mode 100644 arch/riscv/include/asm/system.h diff --git a/arch/riscv/Kconfig b/arch/riscv/Kconfig index a4aa799acf01..bbafdea1b959 100644 --- a/arch/riscv/Kconfig +++ b/arch/riscv/Kconfig @@ -97,14 +97,18 @@ config NMON_HELP Say yes here to get the nmon commands message on every nmon start. -# set if we run in machine mode, cleared if we run in supervisor mode +# selected by boards where barebox runs in machine mode config RISCV_M_MODE bool -# set if we are running in S-mode and can use SBI calls -config RISCV_SBI +# selected by boards where barebox runs in supervisor mode +config RISCV_S_MODE bool - depends on !RISCV_M_MODE - default y + +config RISCV_MULTI_MODE + def_bool RISCV_S_MODE && RISCV_M_MODE + +config RISCV_SBI + def_bool RISCV_S_MODE endmenu diff --git a/arch/riscv/Kconfig.socs b/arch/riscv/Kconfig.socs index c6875738d05c..67d19caeb3b0 100644 --- a/arch/riscv/Kconfig.socs +++ b/arch/riscv/Kconfig.socs @@ -15,6 +15,7 @@ config BOARD_ERIZO_GENERIC config SOC_VIRT bool "QEMU Virt Machine" + select RISCV_S_MODE select BOARD_RISCV_GENERIC_DT select CLINT_TIMER help @@ -23,6 +24,7 @@ config SOC_VIRT config SOC_SIFIVE bool "SiFive SoCs" + select RISCV_S_MODE select CLK_SIFIVE select CLK_SIFIVE_PRCI select RISCV_TIMER diff --git a/arch/riscv/boards/erizo/lowlevel.c b/arch/riscv/boards/erizo/lowlevel.c index 6acf15931cdf..fc262ed61b56 100644 --- a/arch/riscv/boards/erizo/lowlevel.c +++ b/arch/riscv/boards/erizo/lowlevel.c @@ -7,12 +7,14 @@ ENTRY_FUNCTION(start_erizo_generic, a0, a1, a2) { extern char __dtb_z_erizo_generic_start[]; + void *fdt; debug_ll_init(); putc_ll('>'); /* On POR, we are running from read-only memory here. */ - barebox_riscv_entry(0x80000000, SZ_8M, - __dtb_z_erizo_generic_start + get_runtime_offset()); + fdt = __dtb_z_erizo_generic_start + get_runtime_offset(); + + barebox_riscv_machine_entry(0x80000000, SZ_8M, fdt); } diff --git a/arch/riscv/boards/hifive/lowlevel.c b/arch/riscv/boards/hifive/lowlevel.c index 1de13cac1688..8a20f3c51d40 100644 --- a/arch/riscv/boards/hifive/lowlevel.c +++ b/arch/riscv/boards/hifive/lowlevel.c @@ -4,22 +4,23 @@ #include <asm/barebox-riscv.h> #include <debug_ll.h> +static __always_inline void start_hifive(void *fdt) +{ + putc_ll('>'); + + barebox_riscv_supervisor_entry(0x80000000, SZ_128M, fdt); +} + ENTRY_FUNCTION(start_hifive_unmatched, a0, a1, a2) { extern char __dtb_z_hifive_unmatched_a00_start[]; - putc_ll('>'); - - barebox_riscv_entry(0x80000000, SZ_128M, - __dtb_z_hifive_unmatched_a00_start + get_runtime_offset()); + start_hifive(__dtb_z_hifive_unmatched_a00_start + get_runtime_offset()); } ENTRY_FUNCTION(start_hifive_unleashed, a0, a1, a2) { extern char __dtb_z_hifive_unleashed_a00_start[]; - putc_ll('>'); - - barebox_riscv_entry(0x80000000, SZ_128M, - __dtb_z_hifive_unleashed_a00_start + get_runtime_offset()); + start_hifive(__dtb_z_hifive_unleashed_a00_start + get_runtime_offset()); } diff --git a/arch/riscv/boot/board-dt-2nd.c b/arch/riscv/boot/board-dt-2nd.c index e9810f8add97..48cb23ae5e92 100644 --- a/arch/riscv/boot/board-dt-2nd.c +++ b/arch/riscv/boot/board-dt-2nd.c @@ -73,5 +73,5 @@ ENTRY_FUNCTION(start_dt_2nd, a0, _fdt, a2) _fdt < riscv_mem_stack_top(membase, endmem)) memsize = ALIGN_DOWN(_fdt - membase, SZ_1M); - barebox_riscv_entry(membase, memsize, fdt); + barebox_riscv_supervisor_entry(membase, memsize, fdt); } diff --git a/arch/riscv/boot/entry.c b/arch/riscv/boot/entry.c index eb286423d875..e4a5c2208df3 100644 --- a/arch/riscv/boot/entry.c +++ b/arch/riscv/boot/entry.c @@ -20,10 +20,11 @@ */ void __noreturn __naked barebox_riscv_entry(unsigned long membase, - unsigned long memsize, void *boarddata) + unsigned long memsize, void *boarddata, + unsigned flags) { unsigned long stack_top = riscv_mem_stack_top(membase, membase + memsize); asm volatile ("move sp, %0" : : "r"(stack_top)); - barebox_pbl_start(membase, memsize, boarddata); + barebox_pbl_start(membase, memsize, boarddata, flags); } diff --git a/arch/riscv/boot/entry.h b/arch/riscv/boot/entry.h index b3a24d2783f7..fb4af5eae558 100644 --- a/arch/riscv/boot/entry.h +++ b/arch/riscv/boot/entry.h @@ -6,10 +6,12 @@ void __noreturn barebox_non_pbl_start(unsigned long membase, unsigned long memsize, - void *boarddata); + void *boarddata, + unsigned flags); void __noreturn barebox_pbl_start(unsigned long membase, unsigned long memsize, - void *boarddata); + void *boarddata, + unsigned flags); #endif diff --git a/arch/riscv/boot/start.c b/arch/riscv/boot/start.c index 05f6c6231f7e..82bd02d0a0d0 100644 --- a/arch/riscv/boot/start.c +++ b/arch/riscv/boot/start.c @@ -26,6 +26,7 @@ static unsigned long riscv_barebox_size; static unsigned long riscv_endmem; static void *barebox_boarddata; static unsigned long barebox_boarddata_size; +unsigned barebox_riscv_pbl_flags; void *barebox_riscv_boot_dtb(void) { @@ -107,7 +108,8 @@ device_initcall(barebox_memory_areas_init); * the pbl. The stack already has been set up by the pbl. */ __noreturn __no_sanitize_address __section(.text_entry) -void barebox_non_pbl_start(unsigned long membase, unsigned long memsize, void *boarddata) +void barebox_non_pbl_start(unsigned long membase, unsigned long memsize, + void *boarddata, unsigned flags) { unsigned long endmem = membase + memsize; unsigned long malloc_start, malloc_end; @@ -168,18 +170,20 @@ void barebox_non_pbl_start(unsigned long membase, unsigned long memsize, void *b mem_malloc_init((void *)malloc_start, (void *)malloc_end - 1); + barebox_riscv_pbl_flags = flags; + pr_debug("starting barebox...\n"); start_barebox(); } -void start(unsigned long membase, unsigned long memsize, void *boarddata); +void start(unsigned long membase, unsigned long memsize, void *boarddata, unsigned flags); /* * First function in the uncompressed image. We get here from * the pbl. The stack already has been set up by the pbl. */ void __no_sanitize_address __section(.text_entry) start(unsigned long membase, - unsigned long memsize, void *boarddata) + unsigned long memsize, void *boarddata, unsigned flags) { - barebox_non_pbl_start(membase, memsize, boarddata); + barebox_non_pbl_start(membase, memsize, boarddata, flags); } diff --git a/arch/riscv/boot/uncompress.c b/arch/riscv/boot/uncompress.c index b4e010998a4a..35a91e8cb62a 100644 --- a/arch/riscv/boot/uncompress.c +++ b/arch/riscv/boot/uncompress.c @@ -23,10 +23,10 @@ unsigned long free_mem_ptr; unsigned long free_mem_end_ptr; void __noreturn barebox_pbl_start(unsigned long membase, unsigned long memsize, - void *fdt) + void *fdt, unsigned flags) { uint32_t pg_len, uncompressed_len; - void __noreturn (*barebox)(unsigned long, unsigned long, void *); + void __noreturn (*barebox)(unsigned long, unsigned long, void *, unsigned); unsigned long endmem = membase + memsize; unsigned long barebox_base; void *pg_start, *pg_end; @@ -67,5 +67,5 @@ void __noreturn barebox_pbl_start(unsigned long membase, unsigned long memsize, pr_debug("jumping to uncompressed image at 0x%p. dtb=0x%p\n", barebox, fdt); - barebox(membase, memsize, fdt); + barebox(membase, memsize, fdt, flags); } diff --git a/arch/riscv/include/asm/barebox-riscv.h b/arch/riscv/include/asm/barebox-riscv.h index bb1d15308b48..f4081a71f00e 100644 --- a/arch/riscv/include/asm/barebox-riscv.h +++ b/arch/riscv/include/asm/barebox-riscv.h @@ -19,14 +19,22 @@ #include <linux/compiler.h> #include <asm/sections.h> #include <asm/barebox-riscv-head.h> +#include <asm/system.h> unsigned long get_runtime_offset(void); void setup_c(void); void relocate_to_current_adr(void); void relocate_to_adr(unsigned long target); + void __noreturn __naked barebox_riscv_entry(unsigned long membase, unsigned long memsize, - void *boarddata); + void *boarddata, unsigned int flags); + +#define barebox_riscv_machine_entry(membase, memsize, boarddata) \ + barebox_riscv_entry(membase, memsize, boarddata, RISCV_M_MODE) + +#define barebox_riscv_supervisor_entry(membase, memsize, boarddata) \ + barebox_riscv_entry(membase, memsize, boarddata, RISCV_S_MODE) unsigned long riscv_mem_ramoops_get(void); unsigned long riscv_mem_endmem_get(void); diff --git a/arch/riscv/include/asm/system.h b/arch/riscv/include/asm/system.h new file mode 100644 index 000000000000..95a22fb88062 --- /dev/null +++ b/arch/riscv/include/asm/system.h @@ -0,0 +1,28 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +#ifndef __ASM_SYSTEM_H_ + +#define RISCV_MODE_MASK 0x3 +enum riscv_mode { + RISCV_U_MODE = 0, + RISCV_S_MODE = 1, + RISCV_HS_MODE = 2, + RISCV_M_MODE = 3, +}; + +extern unsigned barebox_riscv_pbl_flags; + +static inline enum riscv_mode riscv_mode(void) +{ + /* allow non-LTO builds to discard code for unused modes */ + if (!IS_ENABLED(CONFIG_RISCV_MULTI_MODE)) { + if (IS_ENABLED(CONFIG_RISCV_M_MODE)) + return RISCV_M_MODE; + if (IS_ENABLED(CONFIG_RISCV_S_MODE)) + return RISCV_S_MODE; + } + + return barebox_riscv_pbl_flags & RISCV_MODE_MASK; +} + +#endif diff --git a/drivers/clocksource/timer-riscv.c b/drivers/clocksource/timer-riscv.c index ef67cff47555..cbbe18d9a693 100644 --- a/drivers/clocksource/timer-riscv.c +++ b/drivers/clocksource/timer-riscv.c @@ -12,6 +12,7 @@ #include <clock.h> #include <asm/timer.h> #include <asm/csr.h> +#include <asm/system.h> static u64 notrace riscv_timer_get_count_sbi(void) { @@ -45,7 +46,7 @@ static u64 notrace riscv_timer_get_count_rdcycle(void) static u64 notrace riscv_timer_get_count(void) { - if (IS_ENABLED(CONFIG_RISCV_SBI)) + if (riscv_mode() == RISCV_S_MODE) return riscv_timer_get_count_sbi(); else return riscv_timer_get_count_rdcycle(); -- 2.29.2 _______________________________________________ barebox mailing list barebox@lists.infradead.org http://lists.infradead.org/mailman/listinfo/barebox
If barebox managed to actually execute the cpuinfo command, it probably means that it's assumption which instructon set is being used and whether it runs in machine or supervisor mode is correct. Add that output to cpuinfo, so it shows at least something for non-SBI configurations. Signed-off-by: Ahmad Fatoum <a.fatoum@pengutronix.de> --- v1 -> v2: - new patch after feedback from Antony --- arch/riscv/include/asm/sbi.h | 8 ++---- arch/riscv/lib/cpuinfo.c | 55 +++++++++++++++++++++++++----------- commands/Kconfig | 4 +-- 3 files changed, 43 insertions(+), 24 deletions(-) diff --git a/arch/riscv/include/asm/sbi.h b/arch/riscv/include/asm/sbi.h index ab1fc9a128e5..eb4018de382e 100644 --- a/arch/riscv/include/asm/sbi.h +++ b/arch/riscv/include/asm/sbi.h @@ -9,9 +9,7 @@ #include <linux/types.h> -#ifdef CONFIG_RISCV_SBI enum sbi_ext_id { -#ifdef CONFIG_RISCV_SBI_V01 SBI_EXT_0_1_SET_TIMER = 0x0, SBI_EXT_0_1_CONSOLE_PUTCHAR = 0x1, SBI_EXT_0_1_CONSOLE_GETCHAR = 0x2, @@ -21,7 +19,7 @@ enum sbi_ext_id { SBI_EXT_0_1_REMOTE_SFENCE_VMA = 0x6, SBI_EXT_0_1_REMOTE_SFENCE_VMA_ASID = 0x7, SBI_EXT_0_1_SHUTDOWN = 0x8, -#endif + SBI_EXT_BASE = 0x10, SBI_EXT_TIME = 0x54494D45, SBI_EXT_IPI = 0x735049, @@ -167,7 +165,5 @@ static inline unsigned long sbi_minor_version(void) } int sbi_err_map_linux_errno(int err); -#else /* CONFIG_RISCV_SBI */ -static inline int sbi_remote_fence_i(const unsigned long *hart_mask) { return -1; } -#endif /* CONFIG_RISCV_SBI */ + #endif /* _ASM_RISCV_SBI_H */ diff --git a/arch/riscv/lib/cpuinfo.c b/arch/riscv/lib/cpuinfo.c index 21b99a990a1a..16305e6c4d96 100644 --- a/arch/riscv/lib/cpuinfo.c +++ b/arch/riscv/lib/cpuinfo.c @@ -2,6 +2,7 @@ #include <common.h> #include <command.h> #include <asm/sbi.h> +#include <asm/system.h> static const char *implementations[] = { [0] = "\"Berkeley Boot Loader (BBL)\" ", @@ -12,34 +13,56 @@ static const char *implementations[] = { [5] = "\"Diosix\" ", }; +static const char *modes[] = { + [RISCV_U_MODE] = "U", + [RISCV_S_MODE] = "S", + [RISCV_HS_MODE] = "HS", + [RISCV_M_MODE] = "M", +}; + static int do_cpuinfo(int argc, char *argv[]) { const char *implementation = ""; + enum riscv_mode mode; unsigned long impid; - printf("SBI specification v%lu.%lu detected\n", - sbi_major_version(), sbi_minor_version()); + mode = riscv_mode() & RISCV_MODE_MASK; + + printf("%s barebox for %s-Mode\n", + IS_ENABLED(CONFIG_ARCH_RV64I) ? "RV64I" : "RV32I", + modes[mode]); + + switch (mode) { + case RISCV_S_MODE: + if (!IS_ENABLED(CONFIG_RISCV_SBI)) + break; + printf("SBI specification v%lu.%lu detected\n", + sbi_major_version(), sbi_minor_version()); - if (sbi_spec_is_0_1()) - return 0; + if (sbi_spec_is_0_1()) + return 0; - impid = __sbi_base_ecall(SBI_EXT_BASE_GET_IMP_ID); - if (impid < ARRAY_SIZE(implementations)) - implementation = implementations[impid]; + impid = __sbi_base_ecall(SBI_EXT_BASE_GET_IMP_ID); + if (impid < ARRAY_SIZE(implementations)) + implementation = implementations[impid]; - printf("SBI implementation ID=0x%lx %sVersion=0x%lx\n", - impid, implementation, __sbi_base_ecall(SBI_EXT_BASE_GET_IMP_VERSION)); + printf("SBI implementation ID=0x%lx %sVersion=0x%lx\n", + impid, implementation, __sbi_base_ecall(SBI_EXT_BASE_GET_IMP_VERSION)); - printf("SBI Machine VENDORID=0x%lx ARCHID=0x%lx MIMPID=0x%lx\n", - __sbi_base_ecall(SBI_EXT_BASE_GET_MVENDORID), - __sbi_base_ecall(SBI_EXT_BASE_GET_MARCHID), - __sbi_base_ecall(SBI_EXT_BASE_GET_MIMPID)); + printf("SBI Machine VENDORID=0x%lx ARCHID=0x%lx MIMPID=0x%lx\n", + __sbi_base_ecall(SBI_EXT_BASE_GET_MVENDORID), + __sbi_base_ecall(SBI_EXT_BASE_GET_MARCHID), + __sbi_base_ecall(SBI_EXT_BASE_GET_MIMPID)); + break; + default: + break; + } return 0; } BAREBOX_CMD_START(cpuinfo) .cmd = do_cpuinfo, -BAREBOX_CMD_DESC("show CPU information") -BAREBOX_CMD_GROUP(CMD_GRP_INFO) - BAREBOX_CMD_END + BAREBOX_CMD_DESC("show CPU information") + BAREBOX_CMD_GROUP(CMD_GRP_INFO) +BAREBOX_CMD_END diff --git a/commands/Kconfig b/commands/Kconfig index 5ae3cb3dd145..6da68a7f1467 100644 --- a/commands/Kconfig +++ b/commands/Kconfig @@ -47,9 +47,9 @@ config CMD_ARM_CPUINFO config CMD_RISCV_CPUINFO bool "cpuinfo command" default y - depends on RISCV_SBI + depends on RISCV help - Show SBI info about RISC-V CPU + Show info about RISC-V CPU config CMD_DEVINFO tristate -- 2.29.2 _______________________________________________ barebox mailing list barebox@lists.infradead.org http://lists.infradead.org/mailman/listinfo/barebox
There's always some clocksource driver loaded, so reporting it probed successfully doesn't add much value. timebase-frequency can be read from the device tree if needed and which driver were probed successfully can be seen in drvinfo output, so demote both riscv and clint timer messages to debug level. Signed-off-by: Ahmad Fatoum <a.fatoum@pengutronix.de> --- v1 -> v2: - new patch --- drivers/clocksource/timer-clint.c | 2 +- drivers/clocksource/timer-riscv.c | 2 +- 2 files changed, 2 insertions(+), 2 deletions(-) diff --git a/drivers/clocksource/timer-clint.c b/drivers/clocksource/timer-clint.c index b7360010bdb6..4eeb9cf7ffc9 100644 --- a/drivers/clocksource/timer-clint.c +++ b/drivers/clocksource/timer-clint.c @@ -72,7 +72,7 @@ static int clint_timer_init_dt(struct device_d* dev) return PTR_ERR(iores); clint_timer_val = IOMEM(iores->start) + CLINT_TIMER_VAL_OFF; - dev_info(dev, "running at %lu Hz\n", riscv_timebase); + dev_dbg(dev, "running at %lu Hz\n", riscv_timebase); clint_clocksource.mult = clocksource_hz2mult(riscv_timebase, clint_clocksource.shift); diff --git a/drivers/clocksource/timer-riscv.c b/drivers/clocksource/timer-riscv.c index cbbe18d9a693..5a517fe6b43d 100644 --- a/drivers/clocksource/timer-riscv.c +++ b/drivers/clocksource/timer-riscv.c @@ -60,7 +60,7 @@ static struct clocksource riscv_clocksource = { static int riscv_timer_init(struct device_d* dev) { - dev_info(dev, "running at %lu Hz\n", riscv_timebase); + dev_dbg(dev, "running at %lu Hz\n", riscv_timebase); riscv_clocksource.mult = clocksource_hz2mult(riscv_timebase, riscv_clocksource.shift); -- 2.29.2 _______________________________________________ barebox mailing list barebox@lists.infradead.org http://lists.infradead.org/mailman/listinfo/barebox
Unlike other architectures we support, Linux must apparently be booted on all cores by the bootloader. To achieve this, the bootloaders running on the multiple cores synchronize via IPIs. We will get there eventually, but for now, let's restrict barebox to boot Linux on a single core. S-Mode firmware is passed hart (core) id in a0. This is propagated via the thread pointer register, which is unused by GCC and made available as: - cpuinfo output when running in S-Mode - $global.hartid - a0 when booting via bootm - /chosen/boot-hartid fixup: will come in handy when we gain EFI loading support - single /cpus/*/reg: All other CPU nodes are deleted via fixup For M-Mode, we can query hart id via CSR. It's unknown whether erizo supports it and we don't yet have exception support to handle it not being available, so changes are only done for S-Mode for now. Signed-off-by: Ahmad Fatoum <a.fatoum@pengutronix.de> --- v1 -> v2: - new patch --- arch/riscv/boards/hifive/lowlevel.c | 8 +++---- arch/riscv/boot/board-dt-2nd.c | 4 ++-- arch/riscv/cpu/core.c | 33 +++++++++++++++++++++++++- arch/riscv/include/asm/barebox-riscv.h | 6 +++-- arch/riscv/include/asm/system.h | 16 +++++++++++++ arch/riscv/lib/bootm.c | 4 +++- arch/riscv/lib/cpuinfo.c | 1 + common/globalvar.c | 21 ++++++++++++++++ common/oftree.c | 19 ++++++++++++++- include/globalvar.h | 8 +++++++ 10 files changed, 109 insertions(+), 11 deletions(-) diff --git a/arch/riscv/boards/hifive/lowlevel.c b/arch/riscv/boards/hifive/lowlevel.c index 8a20f3c51d40..5e8969bef1da 100644 --- a/arch/riscv/boards/hifive/lowlevel.c +++ b/arch/riscv/boards/hifive/lowlevel.c @@ -4,23 +4,23 @@ #include <asm/barebox-riscv.h> #include <debug_ll.h> -static __always_inline void start_hifive(void *fdt) +static __always_inline void start_hifive(unsigned long hartid, void *fdt) { putc_ll('>'); - barebox_riscv_supervisor_entry(0x80000000, SZ_128M, fdt); + barebox_riscv_supervisor_entry(0x80000000, SZ_128M, hartid, fdt); } ENTRY_FUNCTION(start_hifive_unmatched, a0, a1, a2) { extern char __dtb_z_hifive_unmatched_a00_start[]; - start_hifive(__dtb_z_hifive_unmatched_a00_start + get_runtime_offset()); + start_hifive(a0, __dtb_z_hifive_unmatched_a00_start + get_runtime_offset()); } ENTRY_FUNCTION(start_hifive_unleashed, a0, a1, a2) { extern char __dtb_z_hifive_unleashed_a00_start[]; - start_hifive(__dtb_z_hifive_unleashed_a00_start + get_runtime_offset()); + start_hifive(a0, __dtb_z_hifive_unleashed_a00_start + get_runtime_offset()); } diff --git a/arch/riscv/boot/board-dt-2nd.c b/arch/riscv/boot/board-dt-2nd.c index 48cb23ae5e92..f31c48a906c2 100644 --- a/arch/riscv/boot/board-dt-2nd.c +++ b/arch/riscv/boot/board-dt-2nd.c @@ -40,7 +40,7 @@ static const struct fdt_device_id console_ids[] = { { /* sentinel */ } }; -ENTRY_FUNCTION(start_dt_2nd, a0, _fdt, a2) +ENTRY_FUNCTION(start_dt_2nd, hartid, _fdt, a2) { unsigned long membase, memsize, endmem, endfdt, uncompressed_len; struct fdt_header *fdt = (void *)_fdt; @@ -73,5 +73,5 @@ ENTRY_FUNCTION(start_dt_2nd, a0, _fdt, a2) _fdt < riscv_mem_stack_top(membase, endmem)) memsize = ALIGN_DOWN(_fdt - membase, SZ_1M); - barebox_riscv_supervisor_entry(membase, memsize, fdt); + barebox_riscv_supervisor_entry(membase, memsize, hartid, fdt); } diff --git a/arch/riscv/cpu/core.c b/arch/riscv/cpu/core.c index 982d378eddec..62eb0ca87164 100644 --- a/arch/riscv/cpu/core.c +++ b/arch/riscv/cpu/core.c @@ -19,6 +19,8 @@ #include <linux/err.h> #include <memory.h> #include <asm-generic/memory_layout.h> +#include <globalvar.h> +#include <magicvar.h> #include <io.h> static int riscv_request_stack(void) @@ -30,6 +32,31 @@ coredevice_initcall(riscv_request_stack); static struct device_d timer_dev; +static s64 hartid; + +BAREBOX_MAGICVAR(global.hartid, "RISC-V hartid"); + +static int riscv_fixup_cpus(struct device_node *root, void *context) +{ + struct device_node *cpus_node, *np, *tmp; + + cpus_node = of_find_node_by_name(root, "cpus"); + if (!cpus_node) + return 0; + + for_each_child_of_node_safe(cpus_node, tmp, np) { + u32 cpu_index; + + if (of_property_read_u32(np, "reg", &cpu_index)) + continue; + + if (cpu_index != hartid) + of_delete_node(np); + } + + return 0; +} + static int riscv_probe(struct device_d *parent) { int ret; @@ -46,7 +73,11 @@ static int riscv_probe(struct device_d *parent) return ret; } - return 0; + hartid = riscv_hartid(); + if (hartid >= 0) + globalvar_add_simple_uint64("hartid", &hartid, "%llu"); + + return of_register_fixup(riscv_fixup_cpus, NULL); } static struct of_device_id riscv_dt_ids[] = { diff --git a/arch/riscv/include/asm/barebox-riscv.h b/arch/riscv/include/asm/barebox-riscv.h index f4081a71f00e..bbe6cd040642 100644 --- a/arch/riscv/include/asm/barebox-riscv.h +++ b/arch/riscv/include/asm/barebox-riscv.h @@ -33,8 +33,10 @@ void __noreturn __naked barebox_riscv_entry(unsigned long membase, unsigned long #define barebox_riscv_machine_entry(membase, memsize, boarddata) \ barebox_riscv_entry(membase, memsize, boarddata, RISCV_M_MODE) -#define barebox_riscv_supervisor_entry(membase, memsize, boarddata) \ - barebox_riscv_entry(membase, memsize, boarddata, RISCV_S_MODE) +#define barebox_riscv_supervisor_entry(membase, memsize, hartid, boarddata) do { \ + __asm__ volatile("mv tp, %0\n" : : "r"(hartid)); \ + barebox_riscv_entry(membase, memsize, boarddata, RISCV_S_MODE); \ +} while (0) unsigned long riscv_mem_ramoops_get(void); unsigned long riscv_mem_endmem_get(void); diff --git a/arch/riscv/include/asm/system.h b/arch/riscv/include/asm/system.h index 95a22fb88062..b91eeaf183e7 100644 --- a/arch/riscv/include/asm/system.h +++ b/arch/riscv/include/asm/system.h @@ -25,4 +25,20 @@ static inline enum riscv_mode riscv_mode(void) return barebox_riscv_pbl_flags & RISCV_MODE_MASK; } +static inline long riscv_hartid(void) +{ + long hartid = -1; + + switch (riscv_mode()) { + case RISCV_S_MODE: + __asm__ volatile("mv %0, tp\n" : "=r"(hartid) :); + break; + default: + /* unimplemented */ + break; + } + + return hartid; +} + #endif diff --git a/arch/riscv/lib/bootm.c b/arch/riscv/lib/bootm.c index b3e41de4a890..835ff345e347 100644 --- a/arch/riscv/lib/bootm.c +++ b/arch/riscv/lib/bootm.c @@ -3,11 +3,13 @@ #include <common.h> #include <bootm.h> +#include <asm/system.h> static int do_bootm_linux(struct image_data *data) { void (*fn)(unsigned long a0, unsigned long dtb, unsigned long a2); phys_addr_t devicetree; + long hartid = riscv_hartid(); fn = booti_load_image(data, &devicetree); if (IS_ERR(fn)) @@ -15,7 +17,7 @@ static int do_bootm_linux(struct image_data *data) shutdown_barebox(); - fn(0, devicetree, 0); + fn(hartid >= 0 ? hartid : 0, devicetree, 0); return -EINVAL; } diff --git a/arch/riscv/lib/cpuinfo.c b/arch/riscv/lib/cpuinfo.c index 16305e6c4d96..2d9cee2a6270 100644 --- a/arch/riscv/lib/cpuinfo.c +++ b/arch/riscv/lib/cpuinfo.c @@ -34,6 +34,7 @@ static int do_cpuinfo(int argc, char *argv[]) switch (mode) { case RISCV_S_MODE: + printf("Hart ID=%lu\n", riscv_hartid()); if (!IS_ENABLED(CONFIG_RISCV_SBI)) break; printf("SBI specification v%lu.%lu detected\n", diff --git a/common/globalvar.c b/common/globalvar.c index 8bb5015ce4e8..9e5a99f79353 100644 --- a/common/globalvar.c +++ b/common/globalvar.c @@ -565,6 +565,27 @@ int globalvar_add_simple_int(const char *name, int *value, return 0; } +int globalvar_add_simple_uint64(const char *name, u64 *value, + const char *format) +{ + struct param_d *p; + int ret; + + ret = globalvar_remove_unqualified(name); + if (ret) + return ret; + + p = dev_add_param_uint64(&global_device, name, NULL, NULL, + value, format, NULL); + + if (IS_ERR(p)) + return PTR_ERR(p); + + globalvar_nv_sync(name); + + return 0; +} + int globalvar_add_bool(const char *name, int (*set)(struct param_d *, void *), int *value, void *priv) diff --git a/common/oftree.c b/common/oftree.c index 5eaa63ad7ebc..1fcc5277c58d 100644 --- a/common/oftree.c +++ b/common/oftree.c @@ -232,7 +232,24 @@ static int of_fixup_bootargs(struct device_node *root, void *unused) return err; } - return of_fixup_bootargs_bootsource(root, node); + err = of_fixup_bootargs_bootsource(root, node); + if (err) + return err; + + if (IS_ENABLED(CONFIG_RISCV)) { + const char *hartid; + + hartid = getenv("global.hartid"); + if (hartid) { + unsigned long id; + + err = kstrtoul(hartid, 10, &id); + if (!err) + err = of_property_write_u32(node, "boot-hartid", id); + } + } + + return err; } static int of_register_bootargs_fixup(void) diff --git a/include/globalvar.h b/include/globalvar.h index 84bee9102cf3..476bb920f3e1 100644 --- a/include/globalvar.h +++ b/include/globalvar.h @@ -20,6 +20,8 @@ void globalvar_set(const char *name, const char *val); int globalvar_add_simple_string(const char *name, char **value); int globalvar_add_simple_int(const char *name, int *value, const char *format); +int globalvar_add_simple_uint64(const char *name, u64 *value, + const char *format); int globalvar_add_bool(const char *name, int (*set)(struct param_d *, void *), int *value, void *priv); @@ -55,6 +57,12 @@ static inline int globalvar_add_simple_int(const char *name, return 0; } +static inline int globalvar_add_simple_uint64(const char *name, + u64 *value, const char *format) +{ + return 0; +} + static inline int globalvar_add_bool(const char *name, int (*set)(struct param_d *, void *), int *value, void *priv) -- 2.29.2 _______________________________________________ barebox mailing list barebox@lists.infradead.org http://lists.infradead.org/mailman/listinfo/barebox
Incoming StarFive support also uses ns16550 compatibles as UART IP. Make reuse easier by making the two most likely parameters to change SoC-specific (base address and baud clock frequency) and move the rest behind the new CONFIG_DEBUG_LL_NS16550. Signed-off-by: Ahmad Fatoum <a.fatoum@pengutronix.de> --- v1 -> v2: - new patch --- arch/riscv/include/asm/debug_ll.h | 7 +++++-- common/Kconfig | 6 ++++++ 2 files changed, 11 insertions(+), 2 deletions(-) diff --git a/arch/riscv/include/asm/debug_ll.h b/arch/riscv/include/asm/debug_ll.h index 6904460af98f..13609d25c559 100644 --- a/arch/riscv/include/asm/debug_ll.h +++ b/arch/riscv/include/asm/debug_ll.h @@ -12,13 +12,16 @@ #include <linux/kconfig.h> -#ifdef CONFIG_DEBUG_ERIZO +#ifdef CONFIG_DEBUG_LL_NS16550 +#if defined CONFIG_DEBUG_ERIZO #define DEBUG_LL_UART_ADDR 0x90000000 +#define DEBUG_LL_UART_CLK (24000000 / 16) +#endif + #define DEBUG_LL_UART_SHIFT 2 #define DEBUG_LL_UART_IOSIZE32 -#define DEBUG_LL_UART_CLK (24000000 / 16) #define DEBUG_LL_UART_BPS CONFIG_BAUDRATE #define DEBUG_LL_UART_DIVISOR (DEBUG_LL_UART_CLK / DEBUG_LL_UART_BPS) diff --git a/common/Kconfig b/common/Kconfig index db7cc6713ae2..ce349d4ebbf6 100644 --- a/common/Kconfig +++ b/common/Kconfig @@ -1374,6 +1374,7 @@ config DEBUG_RPI3_MINI_UART config DEBUG_ERIZO bool "Erizo ns16550 port" depends on SOC_ERIZO + select DEBUG_LL_NS16550 config DEBUG_SIFIVE bool "SiFive serial0 port" @@ -1381,6 +1382,11 @@ config DEBUG_SIFIVE endchoice +config DEBUG_LL_NS16550 + bool + help + Selected by RISC-V platforms that use ns16550 for debug_ll + config DEBUG_IMX_UART_PORT int "i.MX Debug UART Port Selection" if DEBUG_IMX1_UART || \ DEBUG_IMX21_UART || \ -- 2.29.2 _______________________________________________ barebox mailing list barebox@lists.infradead.org http://lists.infradead.org/mailman/listinfo/barebox
Hello Antony, On 31.05.21 09:03, Ahmad Fatoum wrote: > For M-Mode, we can query hart id via CSR. It's unknown whether erizo > supports it and we don't yet have exception support to handle it not > being available, so changes are only done for S-Mode for now. Is it ok to use CSR_MHARTID on Erizo? How about sfence.i? U-Boot uses them unconditionally when built for M-Mode and booting Linux. Cheers, Ahmad -- Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 | _______________________________________________ barebox mailing list barebox@lists.infradead.org http://lists.infradead.org/mailman/listinfo/barebox
Hi, On 31.05.21 09:03, Ahmad Fatoum wrote: > We can't currently mix S-Mode and M-Mode images in the same build > and there's no straight-forward way to determine which mode we are in. > > Move the decision on which mode barebox is targeted at out of Kconfig > and into the PBL. PBL code can call either barebox_riscv_supervisor_entry > or barebox_riscv_machine_entry to signal to barebox proper which mode > it's running in. Currently the only user of this information is the > RISC-V timer clocksource driver. > > Any new code that does IS_ENABLED(CONFIG_RISCV_SBI) or > IS_ENABLED(CONFIG_RISCV_M_MODE) should also be adapted to use riscv_mode(). > > Signed-off-by: Ahmad Fatoum <a.fatoum@pengutronix.de> > --- sbi_init() should only run for S-Mode, but it doesn't. I will send a v3. > v1 -> v2: > - make riscv_mode a pure static inline function for single-mode > builds, so e.g. building only erizo can discard code for other modes > --- > arch/riscv/Kconfig | 14 ++++++++----- > arch/riscv/Kconfig.socs | 2 ++ > arch/riscv/boards/erizo/lowlevel.c | 6 ++++-- > arch/riscv/boards/hifive/lowlevel.c | 17 ++++++++-------- > arch/riscv/boot/board-dt-2nd.c | 2 +- > arch/riscv/boot/entry.c | 5 +++-- > arch/riscv/boot/entry.h | 6 ++++-- > arch/riscv/boot/start.c | 12 +++++++---- > arch/riscv/boot/uncompress.c | 6 +++--- > arch/riscv/include/asm/barebox-riscv.h | 10 ++++++++- > arch/riscv/include/asm/system.h | 28 ++++++++++++++++++++++++++ > drivers/clocksource/timer-riscv.c | 3 ++- > 12 files changed, 82 insertions(+), 29 deletions(-) > create mode 100644 arch/riscv/include/asm/system.h > > diff --git a/arch/riscv/Kconfig b/arch/riscv/Kconfig > index a4aa799acf01..bbafdea1b959 100644 > --- a/arch/riscv/Kconfig > +++ b/arch/riscv/Kconfig > @@ -97,14 +97,18 @@ config NMON_HELP > Say yes here to get the nmon commands message on > every nmon start. > > -# set if we run in machine mode, cleared if we run in supervisor mode > +# selected by boards where barebox runs in machine mode > config RISCV_M_MODE > bool > > -# set if we are running in S-mode and can use SBI calls > -config RISCV_SBI > +# selected by boards where barebox runs in supervisor mode > +config RISCV_S_MODE > bool > - depends on !RISCV_M_MODE > - default y > + > +config RISCV_MULTI_MODE > + def_bool RISCV_S_MODE && RISCV_M_MODE > + > +config RISCV_SBI > + def_bool RISCV_S_MODE > > endmenu > diff --git a/arch/riscv/Kconfig.socs b/arch/riscv/Kconfig.socs > index c6875738d05c..67d19caeb3b0 100644 > --- a/arch/riscv/Kconfig.socs > +++ b/arch/riscv/Kconfig.socs > @@ -15,6 +15,7 @@ config BOARD_ERIZO_GENERIC > > config SOC_VIRT > bool "QEMU Virt Machine" > + select RISCV_S_MODE > select BOARD_RISCV_GENERIC_DT > select CLINT_TIMER > help > @@ -23,6 +24,7 @@ config SOC_VIRT > > config SOC_SIFIVE > bool "SiFive SoCs" > + select RISCV_S_MODE > select CLK_SIFIVE > select CLK_SIFIVE_PRCI > select RISCV_TIMER > diff --git a/arch/riscv/boards/erizo/lowlevel.c b/arch/riscv/boards/erizo/lowlevel.c > index 6acf15931cdf..fc262ed61b56 100644 > --- a/arch/riscv/boards/erizo/lowlevel.c > +++ b/arch/riscv/boards/erizo/lowlevel.c > @@ -7,12 +7,14 @@ > ENTRY_FUNCTION(start_erizo_generic, a0, a1, a2) > { > extern char __dtb_z_erizo_generic_start[]; > + void *fdt; > > debug_ll_init(); > putc_ll('>'); > > /* On POR, we are running from read-only memory here. */ > > - barebox_riscv_entry(0x80000000, SZ_8M, > - __dtb_z_erizo_generic_start + get_runtime_offset()); > + fdt = __dtb_z_erizo_generic_start + get_runtime_offset(); > + > + barebox_riscv_machine_entry(0x80000000, SZ_8M, fdt); > } > diff --git a/arch/riscv/boards/hifive/lowlevel.c b/arch/riscv/boards/hifive/lowlevel.c > index 1de13cac1688..8a20f3c51d40 100644 > --- a/arch/riscv/boards/hifive/lowlevel.c > +++ b/arch/riscv/boards/hifive/lowlevel.c > @@ -4,22 +4,23 @@ > #include <asm/barebox-riscv.h> > #include <debug_ll.h> > > +static __always_inline void start_hifive(void *fdt) > +{ > + putc_ll('>'); > + > + barebox_riscv_supervisor_entry(0x80000000, SZ_128M, fdt); > +} > + > ENTRY_FUNCTION(start_hifive_unmatched, a0, a1, a2) > { > extern char __dtb_z_hifive_unmatched_a00_start[]; > > - putc_ll('>'); > - > - barebox_riscv_entry(0x80000000, SZ_128M, > - __dtb_z_hifive_unmatched_a00_start + get_runtime_offset()); > + start_hifive(__dtb_z_hifive_unmatched_a00_start + get_runtime_offset()); > } > > ENTRY_FUNCTION(start_hifive_unleashed, a0, a1, a2) > { > extern char __dtb_z_hifive_unleashed_a00_start[]; > > - putc_ll('>'); > - > - barebox_riscv_entry(0x80000000, SZ_128M, > - __dtb_z_hifive_unleashed_a00_start + get_runtime_offset()); > + start_hifive(__dtb_z_hifive_unleashed_a00_start + get_runtime_offset()); > } > diff --git a/arch/riscv/boot/board-dt-2nd.c b/arch/riscv/boot/board-dt-2nd.c > index e9810f8add97..48cb23ae5e92 100644 > --- a/arch/riscv/boot/board-dt-2nd.c > +++ b/arch/riscv/boot/board-dt-2nd.c > @@ -73,5 +73,5 @@ ENTRY_FUNCTION(start_dt_2nd, a0, _fdt, a2) > _fdt < riscv_mem_stack_top(membase, endmem)) > memsize = ALIGN_DOWN(_fdt - membase, SZ_1M); > > - barebox_riscv_entry(membase, memsize, fdt); > + barebox_riscv_supervisor_entry(membase, memsize, fdt); > } > diff --git a/arch/riscv/boot/entry.c b/arch/riscv/boot/entry.c > index eb286423d875..e4a5c2208df3 100644 > --- a/arch/riscv/boot/entry.c > +++ b/arch/riscv/boot/entry.c > @@ -20,10 +20,11 @@ > */ > > void __noreturn __naked barebox_riscv_entry(unsigned long membase, > - unsigned long memsize, void *boarddata) > + unsigned long memsize, void *boarddata, > + unsigned flags) > { > unsigned long stack_top = riscv_mem_stack_top(membase, membase + memsize); > asm volatile ("move sp, %0" : : "r"(stack_top)); > - barebox_pbl_start(membase, memsize, boarddata); > + barebox_pbl_start(membase, memsize, boarddata, flags); > } > > diff --git a/arch/riscv/boot/entry.h b/arch/riscv/boot/entry.h > index b3a24d2783f7..fb4af5eae558 100644 > --- a/arch/riscv/boot/entry.h > +++ b/arch/riscv/boot/entry.h > @@ -6,10 +6,12 @@ > > void __noreturn barebox_non_pbl_start(unsigned long membase, > unsigned long memsize, > - void *boarddata); > + void *boarddata, > + unsigned flags); > > void __noreturn barebox_pbl_start(unsigned long membase, > unsigned long memsize, > - void *boarddata); > + void *boarddata, > + unsigned flags); > > #endif > diff --git a/arch/riscv/boot/start.c b/arch/riscv/boot/start.c > index 05f6c6231f7e..82bd02d0a0d0 100644 > --- a/arch/riscv/boot/start.c > +++ b/arch/riscv/boot/start.c > @@ -26,6 +26,7 @@ static unsigned long riscv_barebox_size; > static unsigned long riscv_endmem; > static void *barebox_boarddata; > static unsigned long barebox_boarddata_size; > +unsigned barebox_riscv_pbl_flags; > > void *barebox_riscv_boot_dtb(void) > { > @@ -107,7 +108,8 @@ device_initcall(barebox_memory_areas_init); > * the pbl. The stack already has been set up by the pbl. > */ > __noreturn __no_sanitize_address __section(.text_entry) > -void barebox_non_pbl_start(unsigned long membase, unsigned long memsize, void *boarddata) > +void barebox_non_pbl_start(unsigned long membase, unsigned long memsize, > + void *boarddata, unsigned flags) > { > unsigned long endmem = membase + memsize; > unsigned long malloc_start, malloc_end; > @@ -168,18 +170,20 @@ void barebox_non_pbl_start(unsigned long membase, unsigned long memsize, void *b > > mem_malloc_init((void *)malloc_start, (void *)malloc_end - 1); > > + barebox_riscv_pbl_flags = flags; > + > pr_debug("starting barebox...\n"); > > start_barebox(); > } > > -void start(unsigned long membase, unsigned long memsize, void *boarddata); > +void start(unsigned long membase, unsigned long memsize, void *boarddata, unsigned flags); > /* > * First function in the uncompressed image. We get here from > * the pbl. The stack already has been set up by the pbl. > */ > void __no_sanitize_address __section(.text_entry) start(unsigned long membase, > - unsigned long memsize, void *boarddata) > + unsigned long memsize, void *boarddata, unsigned flags) > { > - barebox_non_pbl_start(membase, memsize, boarddata); > + barebox_non_pbl_start(membase, memsize, boarddata, flags); > } > diff --git a/arch/riscv/boot/uncompress.c b/arch/riscv/boot/uncompress.c > index b4e010998a4a..35a91e8cb62a 100644 > --- a/arch/riscv/boot/uncompress.c > +++ b/arch/riscv/boot/uncompress.c > @@ -23,10 +23,10 @@ unsigned long free_mem_ptr; > unsigned long free_mem_end_ptr; > > void __noreturn barebox_pbl_start(unsigned long membase, unsigned long memsize, > - void *fdt) > + void *fdt, unsigned flags) > { > uint32_t pg_len, uncompressed_len; > - void __noreturn (*barebox)(unsigned long, unsigned long, void *); > + void __noreturn (*barebox)(unsigned long, unsigned long, void *, unsigned); > unsigned long endmem = membase + memsize; > unsigned long barebox_base; > void *pg_start, *pg_end; > @@ -67,5 +67,5 @@ void __noreturn barebox_pbl_start(unsigned long membase, unsigned long memsize, > > pr_debug("jumping to uncompressed image at 0x%p. dtb=0x%p\n", barebox, fdt); > > - barebox(membase, memsize, fdt); > + barebox(membase, memsize, fdt, flags); > } > diff --git a/arch/riscv/include/asm/barebox-riscv.h b/arch/riscv/include/asm/barebox-riscv.h > index bb1d15308b48..f4081a71f00e 100644 > --- a/arch/riscv/include/asm/barebox-riscv.h > +++ b/arch/riscv/include/asm/barebox-riscv.h > @@ -19,14 +19,22 @@ > #include <linux/compiler.h> > #include <asm/sections.h> > #include <asm/barebox-riscv-head.h> > +#include <asm/system.h> > > unsigned long get_runtime_offset(void); > > void setup_c(void); > void relocate_to_current_adr(void); > void relocate_to_adr(unsigned long target); > + > void __noreturn __naked barebox_riscv_entry(unsigned long membase, unsigned long memsize, > - void *boarddata); > + void *boarddata, unsigned int flags); > + > +#define barebox_riscv_machine_entry(membase, memsize, boarddata) \ > + barebox_riscv_entry(membase, memsize, boarddata, RISCV_M_MODE) > + > +#define barebox_riscv_supervisor_entry(membase, memsize, boarddata) \ > + barebox_riscv_entry(membase, memsize, boarddata, RISCV_S_MODE) > > unsigned long riscv_mem_ramoops_get(void); > unsigned long riscv_mem_endmem_get(void); > diff --git a/arch/riscv/include/asm/system.h b/arch/riscv/include/asm/system.h > new file mode 100644 > index 000000000000..95a22fb88062 > --- /dev/null > +++ b/arch/riscv/include/asm/system.h > @@ -0,0 +1,28 @@ > +/* SPDX-License-Identifier: GPL-2.0 */ > + > +#ifndef __ASM_SYSTEM_H_ > + > +#define RISCV_MODE_MASK 0x3 > +enum riscv_mode { > + RISCV_U_MODE = 0, > + RISCV_S_MODE = 1, > + RISCV_HS_MODE = 2, > + RISCV_M_MODE = 3, > +}; > + > +extern unsigned barebox_riscv_pbl_flags; > + > +static inline enum riscv_mode riscv_mode(void) > +{ > + /* allow non-LTO builds to discard code for unused modes */ > + if (!IS_ENABLED(CONFIG_RISCV_MULTI_MODE)) { > + if (IS_ENABLED(CONFIG_RISCV_M_MODE)) > + return RISCV_M_MODE; > + if (IS_ENABLED(CONFIG_RISCV_S_MODE)) > + return RISCV_S_MODE; > + } > + > + return barebox_riscv_pbl_flags & RISCV_MODE_MASK; > +} > + > +#endif > diff --git a/drivers/clocksource/timer-riscv.c b/drivers/clocksource/timer-riscv.c > index ef67cff47555..cbbe18d9a693 100644 > --- a/drivers/clocksource/timer-riscv.c > +++ b/drivers/clocksource/timer-riscv.c > @@ -12,6 +12,7 @@ > #include <clock.h> > #include <asm/timer.h> > #include <asm/csr.h> > +#include <asm/system.h> > > static u64 notrace riscv_timer_get_count_sbi(void) > { > @@ -45,7 +46,7 @@ static u64 notrace riscv_timer_get_count_rdcycle(void) > > static u64 notrace riscv_timer_get_count(void) > { > - if (IS_ENABLED(CONFIG_RISCV_SBI)) > + if (riscv_mode() == RISCV_S_MODE) > return riscv_timer_get_count_sbi(); > else > return riscv_timer_get_count_rdcycle(); > -- Pengutronix e.K. | | Steuerwalder Str. 21 | http://www.pengutronix.de/ | 31137 Hildesheim, Germany | Phone: +49-5121-206917-0 | Amtsgericht Hildesheim, HRA 2686 | Fax: +49-5121-206917-5555 | _______________________________________________ barebox mailing list barebox@lists.infradead.org http://lists.infradead.org/mailman/listinfo/barebox