Add semihosting support in opensbi
cover Add semihosting support in opensbi
Semihosting is a mechanism that enables code running on a target to communicate and use the Input/Output facilities on a host computer that is running a debugger. This patchset adds support for semihosting in opensbi for RISCV64 targets.
Kautuk Consul (2):
include: types: add noinline macro
lib: utils/serial: add semihosting support
include/sbi/sbi_types.h | 1 + include/sbi_utils/serial/semihosting.h | 47 +++++++ lib/utils/serial/Kconfig | 4 + lib/utils/serial/objects.mk | 1 + lib/utils/serial/semihosting.c | 176 +++++++++++++++++++++++++ platform/generic/configs/defconfig | 1 + platform/generic/platform.c | 11 +- 7 files changed, 240 insertions(+), 1 deletion(-) create mode 100644 include/sbi_utils/serial/semihosting.h create mode 100644 lib/utils/serial/semihosting.c
Signature · 1 line
2.34.1
PATCH 1/2 include: types: add __noinline macro
Add noinline macro to sbi_types.h similar to the Linux kernel.
--- include/sbi/sbi_types.h | 1 + 1 file changed, 1 insertion(+)
include/sbi/sbi_types.h +1 -0
@@ -64,6 +64,7 @@ typedef unsigned long physical_size_t;#define __packed __attribute__((packed))#define __noreturn __attribute__((noreturn))#define __aligned (x) __attribute__((aligned(x))) +#define __noinline __attribute__((__noinline__))#define likely (x) __builtin_expect((x), 1)#define unlikely (x) __builtin_expect((x), 0)
Signature · 1 line
2.34.1
PATCH 2/2 lib: utils/serial: add semihosting support
In reply to Kautuk ConsulWe add RISC-V semihosting based serial console for JTAG based early debugging.
The RISC-V semihosting specification is available at:
https://github.com/riscv/riscv-semihosting-spec/blob/main/riscv-semihosting-spec.adoc
--- include/sbi_utils/serial/semihosting.h | 47 +++++++ lib/utils/serial/Kconfig | 4 + lib/utils/serial/objects.mk | 1 + lib/utils/serial/semihosting.c | 176 +++++++++++++++++++++++++ platform/generic/configs/defconfig | 1 + platform/generic/platform.c | 11 +- 6 files changed, 239 insertions(+), 1 deletion(-) create mode 100644 include/sbi_utils/serial/semihosting.h create mode 100644 lib/utils/serial/semihosting.c
include/sbi_utils/serial/semihosting.h new file +47 -0
@@ -0,0 +1,47 @@ +/* +* SPDX-License-Identifier: BSD-2-Clause +* +* Copyright (c) 2022 Ventana Micro Systems Inc. +* +* Authors: +* Anup Patel <[email protected]> +* Kautuk Consul <[email protected]> +*/ + +#ifndef __SERIAL_SEMIHOSTING_H__ +#define __SERIAL_SEMIHOSTING_H__ + +#include <sbi/sbi_types.h> + +/** +* enum semihosting_open_mode - Numeric file modes for use with semihosting_open() +* MODE_READ: 'r' +* MODE_BINARY: 'b' +* MODE_PLUS: '+' +* MODE_WRITE: 'w' +* MODE_APPEND: 'a' +* +* These modes represent the mode string used by fopen(3) in a form which can +* be passed to semihosting_open(). These do NOT correspond directly to %O_RDONLY, +* %O_CREAT, etc; see fopen(3) for details. In particular, @MODE_PLUS +* effectively results in adding %O_RDWR, and @MODE_WRITE will add %O_TRUNC. +* For compatibility, @MODE_BINARY should be added when opening non-text files +* (such as images). +*/ +enum semihosting_open_mode { +MODE_READ =0x0 , +MODE_BINARY =0x1 , +MODE_PLUS =0x2 , +MODE_WRITE =0x4 , +MODE_APPEND =0x8 , +}; + +#ifdef CONFIG_SERIAL_SEMIHOSTING +int semihosting_init (void ); +int semihosting_enabled (void ); +#else +static inline int semihosting_init (void ) {return SBI_ENODEV ; } +static inline int semihosting_enabled (void ) {return 0 ; } +#endif + +#endif
lib/utils/serial/Kconfig +4 -0
@@ -79,4 +79,8 @@ config SERIAL_XILINX_UARTLITE bool "Xilinx UART Lite support" default n +config SERIAL_SEMIHOSTING + bool "Semihosting support" + default n + endmenu
lib/utils/serial/objects.mk +1 -0
@@ -41,3 +41,4 @@ libsbiutils-objs-$(CONFIG_SERIAL_SIFIVE) += serial/sifive-uart.o libsbiutils-objs-$(CONFIG_SERIAL_LITEX) += serial/litex-uart.o libsbiutils-objs-$(CONFIG_SERIAL_UART8250) += serial/uart8250.o libsbiutils-objs-$(CONFIG_SERIAL_XILINX_UARTLITE) += serial/xlnx-uartlite.o +libsbiutils-objs-$(CONFIG_SERIAL_SEMIHOSTING) += serial/semihosting.o
lib/utils/serial/semihosting.c new file +176 -0
176 lines not on this page · raw message
platform/generic/configs/defconfig +1 -0
@@ -28,3 +28,4 @@ CONFIG_FDT_SERIAL_UART8250=y CONFIG_FDT_SERIAL_XILINX_UARTLITE=y CONFIG_FDT_TIMER=y CONFIG_FDT_TIMER_MTIMER=y +CONFIG_SERIAL_SEMIHOSTING=y
platform/generic/platform.c +10 -1
@@ -23,6 +23,7 @@#include <sbi_utils/timer/fdt_timer.h> #include <sbi_utils/ipi/fdt_ipi.h> #include <sbi_utils/reset/fdt_reset.h> +#include <sbi_utils/serial/semihosting.h> /* List of platform override modules generated at compile time */ extern const struct platform_override *platform_override_modules[];
@@ -242,6 +243,14 @@ static uint64_t generic_pmu_xlate_to_mhpmevent(uint32_t event_idx,return evt_val; } +static int generic_console_init (void ) +{ +if (semihosting_enabled ()) +return semihosting_init (); +else +return fdt_serial_init (); +} +const struct sbi_platform_operations platform_ops = { .nascent_init = generic_nascent_init, .early_init = generic_early_init,
@@ -249,7 +258,7 @@ const struct sbi_platform_operations platform_ops = { .early_exit = generic_early_exit, .final_exit = generic_final_exit, .domains_init = generic_domains_init, - .console_init = fdt_serial_init, + .console_init = generic_console_init, .irqchip_init = fdt_irqchip_init, .irqchip_exit = fdt_irqchip_exit, .ipi_init = fdt_ipi_init,
Signature · 1 line
2.34.1
PATCH 2/2 lib: utils/serial: add semihosting support
Quoted 117 lines · Kautuk Consul
We add RISC-V semihosting based serial console for JTAG based early debugging.
The RISC-V semihosting specification is available at:
https://github.com/riscv/riscv-semihosting-spec/blob/main/riscv-semihosting-spec.adocSigned-off-by Anup Patel <[email protected]>Signed-off-by Kautuk Consul <[email protected]>---
include/sbi_utils/serial/semihosting.h | 47 +++++++ lib/utils/serial/Kconfig | 4 + lib/utils/serial/objects.mk | 1 + lib/utils/serial/semihosting.c | 176 +++++++++++++++++++++++++ platform/generic/configs/defconfig | 1 + platform/generic/platform.c | 11 +- 6 files changed, 239 insertions(+), 1 deletion(-)create mode 100644
include/sbi_utils/serial/semihosting.hcreate mode 100644lib/utils/serial/semihosting.cinclude/sbi_utils/serial/semihosting.h new file +47
-0@@ -0,0 +1,47 @@ +/* +* SPDX-License-Identifier: BSD-2-Clause +* +* Copyright (c) 2022 Ventana Micro Systems Inc. +* +* Authors: +* Anup Patel <[email protected]> +* Kautuk Consul <[email protected]> +*/ + +#ifndef __SERIAL_SEMIHOSTING_H__ +#define __SERIAL_SEMIHOSTING_H__ + +#include <sbi/sbi_types.h> + +/** +* enum semihosting_open_mode - Numeric file modes for use with semihosting_open() +* MODE_READ: 'r' +* MODE_BINARY: 'b' +* MODE_PLUS: '+' +* MODE_WRITE: 'w' +* MODE_APPEND: 'a' +* +* These modes represent the mode string used by fopen(3) in a form which can +* be passed to semihosting_open(). These do NOT correspond directly to %O_RDONLY, +* %O_CREAT, etc; see fopen(3) for details. In particular, @MODE_PLUS +* effectively results in adding %O_RDWR, and @MODE_WRITE will add %O_TRUNC. +* For compatibility, @MODE_BINARY should be added when opening non-text files +* (such as images). +*/ +enum semihosting_open_mode { +MODE_READ =0x0 , +MODE_BINARY =0x1 , +MODE_PLUS =0x2 , +MODE_WRITE =0x4 , +MODE_APPEND =0x8 , +}; + +#ifdef CONFIG_SERIAL_SEMIHOSTING +int semihosting_init (void ); +int semihosting_enabled (void ); +#else +static inline int semihosting_init (void ) {return SBI_ENODEV ; } +static inline int semihosting_enabled (void ) {return 0 ; } +#endif + +#endif lib/utils/serial/Kconfig +4
-0@@ -79,4 +79,8 @@ config SERIAL_XILINX_UARTLITE bool "Xilinx UART Lite support" default n +config SERIAL_SEMIHOSTING + bool "Semihosting support" + default n +endmenu
lib/utils/serial/objects.mk +0
-0@@ -41,3 +41,4 @@ libsbiutils-objs-$(CONFIG_SERIAL_SIFIVE) += serial/sifive-uart.olibsbiutils-objs-$(CONFIG_SERIAL_LITEX) +=
serial/litex-uart.olibsbiutils-objs-$(CONFIG_SERIAL_UART8250) +=serial/uart8250.olibsbiutils-objs-$(CONFIG_SERIAL_XILINX_UARTLITE) +=serial/xlnx-uartlite.olib/utils/serial/objects.mk +1
-0+libsbiutils-objs-$(CONFIG_SERIAL_SEMIHOSTING) += serial/semihosting.olib/utils/serial/semihosting.c new file +16
-0@@ -0,0 +1,176 @@ +/* +* SPDX-License-Identifier: BSD-2-Clause +* +* Copyright (c) 2022 Ventana Micro Systems Inc. +* +* Authors: +* Anup Patel <[email protected]> +* Kautuk Consul <[email protected]> +*/ + +#include <sbi/sbi_console.h> +#include <limits.h> +#include <sbi/sbi_string.h> +#include <sbi/sbi_error.h> +#include <sbi_utils/serial/semihosting.h> +
lib/utils/serial/semihosting.c line 26
Quoted 10 lines
lib/utils/serial/semihosting.c new file +10
-0+#define SYSOPEN 0x01 +#define SYSWRITEC 0x03 +#define SYSREAD 0x06 +#define SYSREADC 0x07 +#define SYSERRNO 0x13 + +/* +* Note: This function is intentionally noinline and 256 bytes aligned to +* ensure that semihosting instruction sequence is within same 4K page. +*/
I don?t think this is relevant for M-mode, and really the spec is inaccurate. The point is that it must be able to look before and after the ebreak to check that it?s a semihosting sequence but that there?s a risk of a page fault if you straddle a page boundary. However, in M-mode we don?t have paging enabled, even though this is a system that supports (and, at less-privileged modes, uses) paging.
Even if the sequence were required to not cross a page boundary, this is not a good way to do it, as aligning the function to 256 bytes is rather overkill in practice (whilst not strictly guaranteed to even be sufficient). If you want to take the non-inlineable function approach it should be written in raw assembly, not C with inline assembly in the function, so that you can be much more precise with the alignment. That or don?t make the function inlineable and instead put the align directive in the inline assembly snippet.
Jess
Quoted 203 lines
lib/utils/serial/semihosting.c new file +150
-0+static __noinline __aligned(256) long semihosting_trap (int sysnum,void *addr) +{ + register int ret asm ("a0") = sysnum; + register void *param0 asm ("a1") = addr; + + asmvolatile ( +"\t.option push\n" +"\t.option norvc\n" +"\tslli zero, zero, 0x1f\n" +"\tebreak\n" +"\tsrai zero, zero, 7\n" +"\t.option pop\n" + :"+r" (ret) :"r" (param0) :"memory" ); + +return ret; +} + +static bool _semihosting_enabled = true; +static bool try_semihosting = true; + +bool __aligned(256) semihosting_enabled (void ) +{ + register int ret asm ("a0") = SYSERRNO; + register void *param0 asm ("a1") = NULL; +unsigned long tmp =0 ; + +if (!try_semihosting) +return _semihosting_enabled; + + asmvolatile ( +"\t.option push\n" +"\t.option norvc\n" + +"\tj _semihost_test_vector_next\n" +"\t.align 4\n" +"\t_semihost_test_vector:\n" +"\t\tcsrr %[en], mepc\n" +"\t\taddi %[en], %[en], 4\n" +"\t\tcsrw mepc, %[en]\n" +"\t\tadd %[en], zero, zero\n" +"\t\tmret\n" +"\t_semihost_test_vector_next:\n" + +"\tla %[tmp], _semihost_test_vector\n" +"\tcsrrw %[tmp], mtvec, %[tmp]\n" +"\tslli zero, zero, 0x1f\n" +"\tebreak\n" +"\tsrai zero, zero, 7\n" +"\tcsrw mtvec, %[tmp]\n" + +"\t.option pop\n" + : [tmp]"+r" (tmp), [en]"+r" (_semihosting_enabled), + [ret]"+r" (ret) + :"r" (param0) :"memory" ); + + try_semihosting = false; +return _semihosting_enabled; +} + +static int semihosting_errno (void ) +{ +long ret =semihosting_trap (SYSERRNO ,NULL ); + +if (ret >0 && ret <INT_MAX ) +return -ret; +return SBI_EIO ; +} + +static int infd =SBI_ENODEV ; + +static long semihosting_open (const char *fname,enum semihosting_open_mode mode) +{ +long fd; +struct semihosting_open_s { +const char *fname; +unsigned long mode; +size_t len; + } open; + + open.fname = fname; + open.len =sbi_strlen (fname); + open.mode = mode; + +/* Open the file on the host */ + fd =semihosting_trap (SYSOPEN , &open); +if (fd ==-1 ) +return semihosting_errno (); +return fd; +} + +/** +* struct semihosting_rdwr_s - Arguments for read and write +* @fd: A file descriptor returned from semihosting_open() +* @memp: Pointer to a buffer of memory of at least @len bytes +* @len: The number of bytes to read or write +*/ +struct semihosting_rdwr_s { +long fd; +void *memp; +size_t len; +}; + +static long semihosting_read (long fd,void *memp,size_t len) +{ +long ret; +struct semihosting_rdwr_s read; + + read.fd = fd; + read.memp = memp; + read.len = len; + + ret =semihosting_trap (SYSREAD , &read); +if (ret <0 ) +return semihosting_errno (); +return len - ret; +} + +/* clang-format on */ + +static void semihosting_putc (char ch) +{ +semihosting_trap (SYSWRITEC , &ch); +} + +static int semihosting_getc (void ) +{ +char ch =0 ; + +if (infd <0 ) +return semihosting_trap (SYSREADC ,NULL ); + +semihosting_read (infd, &ch,sizeof (ch)); + +return ch; +} + +static struct sbi_console_device semihosting_console = { + .name ="semihosting" , + .console_putc = semihosting_putc, + .console_getc = semihosting_getc +}; + +int semihosting_init (void ) +{ + infd =semihosting_open (":tt" ,MODE_READ ); + +sbi_console_set_device (&semihosting_console); + +return 0 ; +}platform/generic/configs/defconfig +0
-0@@ -28,3 +28,4 @@ CONFIG_FDT_SERIAL_UART8250=y
CONFIG_FDT_SERIAL_XILINX_UARTLITE=yCONFIG_FDT_TIMER=yCONFIG_FDT_TIMER_MTIMER=yplatform/generic/configs/defconfig +1
-0+CONFIG_SERIAL_SEMIHOSTING=yplatform/generic/platform.c +10
-1@@ -23,6 +23,7 @@#include <sbi_utils/timer/fdt_timer.h> #include <sbi_utils/ipi/fdt_ipi.h> #include <sbi_utils/reset/fdt_reset.h> +#include <sbi_utils/serial/semihosting.h> /* List of platform override modules generated at compile time */ extern const struct platform_override *platform_override_modules[];@@ -242,6 +243,14 @@ static uint64_t generic_pmu_xlate_to_mhpmevent(uint32_t event_idx,return evt_val; } +static int generic_console_init (void ) +{ +if (semihosting_enabled ()) +return semihosting_init (); +else +return fdt_serial_init (); +} +const struct sbi_platform_operations platform_ops = { .nascent_init = generic_nascent_init, .early_init = generic_early_init,@@ -249,7 +258,7 @@ const struct sbi_platform_operations platform_ops = { .early_exit = generic_early_exit, .final_exit = generic_final_exit, .domains_init = generic_domains_init, - .console_init = fdt_serial_init, + .console_init = generic_console_init, .irqchip_init = fdt_irqchip_init, .irqchip_exit = fdt_irqchip_exit, .ipi_init = fdt_ipi_init,Signature · 7 lines
2.34.1 -- opensbi mailing list opensbi at lists.infradead.org http://lists.infradead.org/mailman/listinfo/opensbi