contrib: import sbi from freebsd 15.0.0

Upstream version: 15.0.0 Upstream source: https://cgit.freebsd.org/src/ https://cgit.freebsd.org/src/tag/?h=release/15.0.0 Files from sys/riscv/riscv/ and sys/riscv/include
2026-08-21 04:08:28 +08:00 · 2026-03-06 11:31:08 -06:00
parent ddd6f3d962
commit cee307c60f
3 changed files with 686 additions and 0 deletions
@@ -52,6 +52,7 @@ Git log in order to find out version and update details
 | bsps/arm/stm32h7/cmsis-device-h7/     | https://github.com/STMicroelectronics/cmsis_device_h7.git      |
 | bsps/arm/stm32h7/stm32h7xx_hal_driver | https://github.com/STMicroelectronics/stm32u5xx-hal-driver     |
 | bsps/arm/stm32u5/stm32u5xx-hal-driver | https://github.com/STMicroelectronics/stm32h7xx_hal_driver.git |
+| bsps/riscv/sbi         |              | https://cgit.freebsd.org/src/ |
 | cpukit/fastlz                         | https://github.com/ariya/FastLZ                                |
 | cpukit/utf8proc                       | https://juliastrings.github.io/utf8proc/releases/              |
 | cpukit/libz                           | https://github.com/madler/zlib                                 |
@@ -0,0 +1,248 @@
+/*-
+ * Copyright (c) 2016-2017 Ruslan Bukin <br@bsdpad.com>
+ * All rights reserved.
+ * Copyright (c) 2019 Mitchell Horne <mhorne@FreeBSD.org>
+ *
+ * Portions of this software were developed by SRI International and the
+ * University of Cambridge Computer Laboratory under DARPA/AFRL contract
+ * FA8750-10-C-0237 ("CTSRD"), as part of the DARPA CRASH research programme.
+ *
+ * Portions of this software were developed by the University of Cambridge
+ * Computer Laboratory as part of the CTSRD Project, with support from the
+ * UK Higher Education Innovation Fund (HEIF).
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#ifndef _MACHINE_SBI_H_
+#define	_MACHINE_SBI_H_
+
+/* SBI Specification Version */
+#define	SBI_SPEC_VERS_MAJOR_OFFSET	24
+#define	SBI_SPEC_VERS_MAJOR_MASK	(0x7F << SBI_SPEC_VERS_MAJOR_OFFSET)
+#define	SBI_SPEC_VERS_MINOR_OFFSET	0
+#define	SBI_SPEC_VERS_MINOR_MASK	(0xFFFFFF << SBI_SPEC_VERS_MINOR_OFFSET)
+
+/* SBI Implementation IDs */
+#define	SBI_IMPL_ID_BBL			0
+#define	SBI_IMPL_ID_OPENSBI		1
+#define	SBI_IMPL_ID_XVISOR		2
+#define	SBI_IMPL_ID_KVM			3
+#define	SBI_IMPL_ID_RUSTSBI		4
+#define	SBI_IMPL_ID_DIOSIX		5
+#define	SBI_IMPL_ID_COFFER		6
+#define	SBI_IMPL_ID_XEN_PROJECT		7
+#define	SBI_IMPL_ID_POLARFIRE_HSS	8
+#define	SBI_IMPL_ID_COREBOOT		9
+#define	SBI_IMPL_ID_OREBOOT		10
+#define	SBI_IMPL_ID_BHYVE		11
+
+/* SBI Error Codes */
+#define	SBI_SUCCESS			0
+#define	SBI_ERR_FAILURE			-1
+#define	SBI_ERR_NOT_SUPPORTED		-2
+#define	SBI_ERR_INVALID_PARAM		-3
+#define	SBI_ERR_DENIED			-4
+#define	SBI_ERR_INVALID_ADDRESS		-5
+#define	SBI_ERR_ALREADY_AVAILABLE	-6
+
+/* SBI Base Extension */
+#define	SBI_EXT_ID_BASE			0x10
+#define	SBI_BASE_GET_SPEC_VERSION	0
+#define	SBI_BASE_GET_IMPL_ID		1
+#define	SBI_BASE_GET_IMPL_VERSION	2
+#define	SBI_BASE_PROBE_EXTENSION	3
+#define	SBI_BASE_GET_MVENDORID		4
+#define	SBI_BASE_GET_MARCHID		5
+#define	SBI_BASE_GET_MIMPID		6
+
+/* Timer (TIME) Extension */
+#define	SBI_EXT_ID_TIME			0x54494D45
+#define	SBI_TIME_SET_TIMER		0
+
+/* IPI (IPI) Extension */
+#define	SBI_EXT_ID_IPI			0x735049
+#define	SBI_IPI_SEND_IPI		0
+
+/* RFENCE (RFNC) Extension */
+#define	SBI_EXT_ID_RFNC				0x52464E43
+#define	SBI_RFNC_REMOTE_FENCE_I			0
+#define	SBI_RFNC_REMOTE_SFENCE_VMA		1
+#define	SBI_RFNC_REMOTE_SFENCE_VMA_ASID		2
+#define	SBI_RFNC_REMOTE_HFENCE_GVMA_VMID	3
+#define	SBI_RFNC_REMOTE_HFENCE_GVMA		4
+#define	SBI_RFNC_REMOTE_HFENCE_VVMA_ASID	5
+#define	SBI_RFNC_REMOTE_HFENCE_VVMA		6
+
+/* Hart State Management (HSM) Extension */
+#define	SBI_EXT_ID_HSM			0x48534D
+#define	SBI_HSM_HART_START		0
+#define	SBI_HSM_HART_STOP		1
+#define	SBI_HSM_HART_STATUS		2
+#define	 SBI_HSM_STATUS_STARTED		0
+#define	 SBI_HSM_STATUS_STOPPED		1
+#define	 SBI_HSM_STATUS_START_PENDING	2
+#define	 SBI_HSM_STATUS_STOP_PENDING	3
+
+/* System Reset (SRST) Extension */
+#define	SBI_EXT_ID_SRST			0x53525354
+#define	SBI_SRST_SYSTEM_RESET		0
+#define	 SBI_SRST_TYPE_SHUTDOWN		0
+#define	 SBI_SRST_TYPE_COLD_REBOOT	1
+#define	 SBI_SRST_TYPE_WARM_REBOOT	2
+#define	 SBI_SRST_REASON_NONE		0
+#define	 SBI_SRST_REASON_SYSTEM_FAILURE	1
+
+/* Legacy Extensions */
+#define	SBI_SET_TIMER			0
+#define	SBI_CONSOLE_PUTCHAR		1
+#define	SBI_CONSOLE_GETCHAR		2
+#define	SBI_CLEAR_IPI			3
+#define	SBI_SEND_IPI			4
+#define	SBI_REMOTE_FENCE_I		5
+#define	SBI_REMOTE_SFENCE_VMA		6
+#define	SBI_REMOTE_SFENCE_VMA_ASID	7
+#define	SBI_SHUTDOWN			8
+
+#ifndef LOCORE
+
+#define	SBI_CALL0(e, f)				SBI_CALL5(e, f, 0, 0, 0, 0, 0)
+#define	SBI_CALL1(e, f, p1)			SBI_CALL5(e, f, p1, 0, 0, 0, 0)
+#define	SBI_CALL2(e, f, p1, p2)			SBI_CALL5(e, f, p1, p2, 0, 0, 0)
+#define	SBI_CALL3(e, f, p1, p2, p3)		SBI_CALL5(e, f, p1, p2, p3, 0, 0)
+#define	SBI_CALL4(e, f, p1, p2, p3, p4)		SBI_CALL5(e, f, p1, p2, p3, p4, 0)
+#define	SBI_CALL5(e, f, p1, p2, p3, p4, p5)	sbi_call(e, f, p1, p2, p3, p4, p5)
+
+/*
+ * Documentation available at
+ * https://github.com/riscv/riscv-sbi-doc/blob/master/riscv-sbi.adoc
+ */
+
+struct sbi_ret {
+	long error;
+	long value;
+};
+
+static __inline struct sbi_ret
+sbi_call(uint64_t arg7, uint64_t arg6, uint64_t arg0, uint64_t arg1,
+    uint64_t arg2, uint64_t arg3, uint64_t arg4)
+{
+	struct sbi_ret ret;
+
+	register uintptr_t a0 __asm ("a0") = (uintptr_t)(arg0);
+	register uintptr_t a1 __asm ("a1") = (uintptr_t)(arg1);
+	register uintptr_t a2 __asm ("a2") = (uintptr_t)(arg2);
+	register uintptr_t a3 __asm ("a3") = (uintptr_t)(arg3);
+	register uintptr_t a4 __asm ("a4") = (uintptr_t)(arg4);
+	register uintptr_t a6 __asm ("a6") = (uintptr_t)(arg6);
+	register uintptr_t a7 __asm ("a7") = (uintptr_t)(arg7);
+
+	__asm __volatile(			\
+		"ecall"				\
+		:"+r"(a0), "+r"(a1)		\
+		:"r"(a2), "r"(a3), "r"(a4), "r"(a6), "r"(a7)	\
+		:"memory");
+
+	ret.error = a0;
+	ret.value = a1;
+	return (ret);
+}
+
+/* Base extension functions. */
+static __inline long
+sbi_probe_extension(long id)
+{
+	return (SBI_CALL1(SBI_EXT_ID_BASE, SBI_BASE_PROBE_EXTENSION, id).value);
+}
+
+/* TIME extension functions. */
+void sbi_set_timer(uint64_t val);
+
+/* IPI extension functions. */
+void sbi_send_ipi(const u_long *hart_mask);
+
+/* RFENCE extension functions. */
+void sbi_remote_fence_i(const u_long *hart_mask);
+void sbi_remote_sfence_vma(const u_long *hart_mask, u_long start, u_long size);
+void sbi_remote_sfence_vma_asid(const u_long *hart_mask, u_long start,
+    u_long size, u_long asid);
+
+/* Hart State Management extension functions. */
+
+/*
+ * Start execution on the specified hart at physical address start_addr. The
+ * register a0 will contain the hart's ID, and a1 will contain the value of
+ * priv.
+ */
+int sbi_hsm_hart_start(u_long hart, u_long start_addr, u_long priv);
+
+/*
+ * Stop execution on the current hart. Interrupts should be disabled, or this
+ * function may return.
+ */
+void sbi_hsm_hart_stop(void);
+
+/*
+ * Get the execution status of the specified hart. The status will be one of:
+ *  - SBI_HSM_STATUS_STARTED
+ *  - SBI_HSM_STATUS_STOPPED
+ *  - SBI_HSM_STATUS_START_PENDING
+ *  - SBI_HSM_STATUS_STOP_PENDING
+ */
+int sbi_hsm_hart_status(u_long hart);
+
+/* System Reset extension functions. */
+
+/*
+ * Reset the system based on the following 'type' and 'reason' chosen from:
+ *  - SBI_SRST_TYPE_SHUTDOWN
+ *  - SBI_SRST_TYPE_COLD_REBOOT
+ *  - SBI_SRST_TYPE_WARM_REBOOT
+ *  - SBI_SRST_REASON_NONE
+ *  - SBI_SRST_REASON_SYSTEM_FAILURE
+ */
+void sbi_system_reset(u_long reset_type, u_long reset_reason);
+
+/* Legacy extension functions. */
+static __inline void
+sbi_console_putchar(int ch)
+{
+
+	(void)SBI_CALL1(SBI_CONSOLE_PUTCHAR, 0, ch);
+}
+
+static __inline int
+sbi_console_getchar(void)
+{
+
+	/*
+	 * XXX: The "error" is returned here because legacy SBI functions
+	 * continue to return their value in a0.
+	 */
+	return (SBI_CALL0(SBI_CONSOLE_GETCHAR, 0).error);
+}
+
+void sbi_print_version(void);
+void sbi_init(void);
+
+#endif /* !LOCORE */
+#endif /* !_MACHINE_SBI_H_ */
@@ -0,0 +1,437 @@
+/*-
+ * SPDX-License-Identifier: BSD-2-Clause
+ *
+ * Copyright (c) 2019 Mitchell Horne <mhorne@FreeBSD.org>
+ * Copyright (c) 2021 Jessica Clarke <jrtc27@FreeBSD.org>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/bus.h>
+#include <sys/eventhandler.h>
+#include <sys/kernel.h>
+#include <sys/malloc.h>
+#include <sys/module.h>
+#include <sys/reboot.h>
+
+#include <machine/md_var.h>
+#include <machine/sbi.h>
+
+/* SBI Implementation-Specific Definitions */
+#define	OPENSBI_VERSION_MAJOR_OFFSET	16
+#define	OPENSBI_VERSION_MINOR_MASK	0xFFFF
+
+struct sbi_softc {
+	device_t		dev;
+};
+
+struct sbi_devinfo {
+	struct resource_list	rl;
+};
+
+static struct sbi_softc *sbi_softc = NULL;
+
+static u_long sbi_spec_version;
+static u_long sbi_impl_id;
+static u_long sbi_impl_version;
+
+static bool has_time_extension = false;
+static bool has_ipi_extension = false;
+static bool has_rfnc_extension = false;
+static bool has_srst_extension = false;
+
+static struct sbi_ret
+sbi_get_spec_version(void)
+{
+	return (SBI_CALL0(SBI_EXT_ID_BASE, SBI_BASE_GET_SPEC_VERSION));
+}
+
+static struct sbi_ret
+sbi_get_impl_id(void)
+{
+	return (SBI_CALL0(SBI_EXT_ID_BASE, SBI_BASE_GET_IMPL_ID));
+}
+
+static struct sbi_ret
+sbi_get_impl_version(void)
+{
+	return (SBI_CALL0(SBI_EXT_ID_BASE, SBI_BASE_GET_IMPL_VERSION));
+}
+
+static struct sbi_ret
+sbi_get_mvendorid(void)
+{
+	return (SBI_CALL0(SBI_EXT_ID_BASE, SBI_BASE_GET_MVENDORID));
+}
+
+static struct sbi_ret
+sbi_get_marchid(void)
+{
+	return (SBI_CALL0(SBI_EXT_ID_BASE, SBI_BASE_GET_MARCHID));
+}
+
+static struct sbi_ret
+sbi_get_mimpid(void)
+{
+	return (SBI_CALL0(SBI_EXT_ID_BASE, SBI_BASE_GET_MIMPID));
+}
+
+static void
+sbi_shutdown_final(void *dummy __unused, int howto)
+{
+	if ((howto & RB_POWEROFF) != 0)
+		sbi_system_reset(SBI_SRST_TYPE_SHUTDOWN, SBI_SRST_REASON_NONE);
+}
+
+void
+sbi_system_reset(u_long reset_type, u_long reset_reason)
+{
+	/* Use the SRST extension, if available. */
+	if (has_srst_extension) {
+		(void)SBI_CALL2(SBI_EXT_ID_SRST, SBI_SRST_SYSTEM_RESET,
+		    reset_type, reset_reason);
+	}
+	(void)SBI_CALL0(SBI_SHUTDOWN, 0);
+}
+
+void
+sbi_print_version(void)
+{
+	u_int major;
+	u_int minor;
+
+	/* For legacy SBI implementations. */
+	if (sbi_spec_version == 0) {
+		printf("SBI: Unknown (Legacy) Implementation\n");
+		printf("SBI Specification Version: 0.1\n");
+		return;
+	}
+
+	switch (sbi_impl_id) {
+	case (SBI_IMPL_ID_BBL):
+		printf("SBI: Berkely Boot Loader %lu\n", sbi_impl_version);
+		break;
+	case (SBI_IMPL_ID_OPENSBI):
+		major = sbi_impl_version >> OPENSBI_VERSION_MAJOR_OFFSET;
+		minor = sbi_impl_version & OPENSBI_VERSION_MINOR_MASK;
+		printf("SBI: OpenSBI v%u.%u\n", major, minor);
+		break;
+	case (SBI_IMPL_ID_XVISOR):
+		printf("SBI: eXtensible Versatile hypervISOR %lu\n",
+		    sbi_impl_version);
+		break;
+	case (SBI_IMPL_ID_KVM):
+		printf("SBI: Kernel-based Virtual Machine %lu\n",
+		    sbi_impl_version);
+		break;
+	case (SBI_IMPL_ID_RUSTSBI):
+		printf("SBI: RustSBI %lu\n", sbi_impl_version);
+		break;
+	case (SBI_IMPL_ID_DIOSIX):
+		printf("SBI: Diosix %lu\n", sbi_impl_version);
+		break;
+	case (SBI_IMPL_ID_COFFER):
+		printf("SBI: Coffer %lu\n", sbi_impl_version);
+		break;
+	case (SBI_IMPL_ID_XEN_PROJECT):
+		printf("SBI: Xen Project %lu\n", sbi_impl_version);
+		break;
+	case (SBI_IMPL_ID_POLARFIRE_HSS):
+		printf("SBI: PolarFire Hart Software Services %lu\n",
+		    sbi_impl_version);
+		break;
+	case (SBI_IMPL_ID_COREBOOT):
+		printf("SBI: coreboot %lu\n", sbi_impl_version);
+		break;
+	case (SBI_IMPL_ID_OREBOOT):
+		printf("SBI: oreboot %lu\n", sbi_impl_version);
+		break;
+	case (SBI_IMPL_ID_BHYVE):
+		printf("SBI: bhyve %lu\n", sbi_impl_version);
+		break;
+	default:
+		printf("SBI: Unrecognized Implementation: %lu\n", sbi_impl_id);
+		break;
+	}
+
+	major = (sbi_spec_version & SBI_SPEC_VERS_MAJOR_MASK) >>
+	    SBI_SPEC_VERS_MAJOR_OFFSET;
+	minor = (sbi_spec_version & SBI_SPEC_VERS_MINOR_MASK);
+	printf("SBI Specification Version: %u.%u\n", major, minor);
+}
+
+void
+sbi_set_timer(uint64_t val)
+{
+	struct sbi_ret ret __diagused;
+
+	/* Use the TIME legacy replacement extension, if available. */
+	if (has_time_extension) {
+		ret = SBI_CALL1(SBI_EXT_ID_TIME, SBI_TIME_SET_TIMER, val);
+		MPASS(ret.error == SBI_SUCCESS);
+	} else {
+		(void)SBI_CALL1(SBI_SET_TIMER, 0, val);
+	}
+}
+
+void
+sbi_send_ipi(const u_long *hart_mask)
+{
+	struct sbi_ret ret __diagused;
+
+	/* Use the IPI legacy replacement extension, if available. */
+	if (has_ipi_extension) {
+		ret = SBI_CALL2(SBI_EXT_ID_IPI, SBI_IPI_SEND_IPI,
+		    *hart_mask, 0);
+		MPASS(ret.error == SBI_SUCCESS);
+	} else {
+		(void)SBI_CALL1(SBI_SEND_IPI, 0, (uint64_t)hart_mask);
+	}
+}
+
+void
+sbi_remote_fence_i(const u_long *hart_mask)
+{
+	struct sbi_ret ret __diagused;
+
+	/* Use the RFENCE legacy replacement extension, if available. */
+	if (has_rfnc_extension) {
+		ret = SBI_CALL2(SBI_EXT_ID_RFNC, SBI_RFNC_REMOTE_FENCE_I,
+		    *hart_mask, 0);
+		MPASS(ret.error == SBI_SUCCESS);
+	} else {
+		(void)SBI_CALL1(SBI_REMOTE_FENCE_I, 0, (uint64_t)hart_mask);
+	}
+}
+
+void
+sbi_remote_sfence_vma(const u_long *hart_mask, u_long start, u_long size)
+{
+	struct sbi_ret ret __diagused;
+
+	/* Use the RFENCE legacy replacement extension, if available. */
+	if (has_rfnc_extension) {
+		ret = SBI_CALL4(SBI_EXT_ID_RFNC, SBI_RFNC_REMOTE_SFENCE_VMA,
+		    *hart_mask, 0, start, size);
+		MPASS(ret.error == SBI_SUCCESS);
+	} else {
+		(void)SBI_CALL3(SBI_REMOTE_SFENCE_VMA, 0, (uint64_t)hart_mask,
+		    start, size);
+	}
+}
+
+void
+sbi_remote_sfence_vma_asid(const u_long *hart_mask, u_long start, u_long size,
+    u_long asid)
+{
+	struct sbi_ret ret __diagused;
+
+	/* Use the RFENCE legacy replacement extension, if available. */
+	if (has_rfnc_extension) {
+		ret = SBI_CALL5(SBI_EXT_ID_RFNC,
+		    SBI_RFNC_REMOTE_SFENCE_VMA_ASID, *hart_mask, 0, start,
+		    size, asid);
+		MPASS(ret.error == SBI_SUCCESS);
+	} else {
+		(void)SBI_CALL4(SBI_REMOTE_SFENCE_VMA_ASID, 0,
+		    (uint64_t)hart_mask, start, size, asid);
+	}
+}
+
+int
+sbi_hsm_hart_start(u_long hart, u_long start_addr, u_long priv)
+{
+	struct sbi_ret ret;
+
+	ret = SBI_CALL3(SBI_EXT_ID_HSM, SBI_HSM_HART_START, hart, start_addr,
+	    priv);
+	return (ret.error != 0 ? (int)ret.error : 0);
+}
+
+void
+sbi_hsm_hart_stop(void)
+{
+	(void)SBI_CALL0(SBI_EXT_ID_HSM, SBI_HSM_HART_STOP);
+}
+
+int
+sbi_hsm_hart_status(u_long hart)
+{
+	struct sbi_ret ret;
+
+	ret = SBI_CALL1(SBI_EXT_ID_HSM, SBI_HSM_HART_STATUS, hart);
+
+	return (ret.error != 0 ? (int)ret.error : (int)ret.value);
+}
+
+void
+sbi_init(void)
+{
+	struct sbi_ret sret;
+
+	/*
+	 * Get the spec version. For legacy SBI implementations this will
+	 * return an error, otherwise it is guaranteed to succeed.
+	 */
+	sret = sbi_get_spec_version();
+	if (sret.error != 0) {
+		/* We are running a legacy SBI implementation. */
+		sbi_spec_version = 0;
+		return;
+	}
+
+	/* Set the SBI implementation info. */
+	sbi_spec_version = sret.value;
+	sbi_impl_id = sbi_get_impl_id().value;
+	sbi_impl_version = sbi_get_impl_version().value;
+
+	/* Set the hardware implementation info. */
+	mvendorid = sbi_get_mvendorid().value;
+	marchid = sbi_get_marchid().value;
+	mimpid = sbi_get_mimpid().value;
+
+	/* Probe for legacy replacement extensions. */
+	if (sbi_probe_extension(SBI_EXT_ID_TIME) != 0)
+		has_time_extension = true;
+	if (sbi_probe_extension(SBI_EXT_ID_IPI) != 0)
+		has_ipi_extension = true;
+	if (sbi_probe_extension(SBI_EXT_ID_RFNC) != 0)
+		has_rfnc_extension = true;
+	if (sbi_probe_extension(SBI_EXT_ID_SRST) != 0)
+		has_srst_extension = true;
+
+	/*
+	 * Probe for legacy extensions. We still rely on many of them to be
+	 * implemented, but this is not guaranteed by the spec.
+	 */
+	KASSERT(has_time_extension || sbi_probe_extension(SBI_SET_TIMER) != 0,
+	    ("SBI doesn't implement sbi_set_timer()"));
+	KASSERT(sbi_probe_extension(SBI_CONSOLE_PUTCHAR) != 0,
+	    ("SBI doesn't implement sbi_console_putchar()"));
+	KASSERT(sbi_probe_extension(SBI_CONSOLE_GETCHAR) != 0,
+	    ("SBI doesn't implement sbi_console_getchar()"));
+	KASSERT(has_ipi_extension || sbi_probe_extension(SBI_SEND_IPI) != 0,
+	    ("SBI doesn't implement sbi_send_ipi()"));
+	KASSERT(has_rfnc_extension ||
+	    sbi_probe_extension(SBI_REMOTE_FENCE_I) != 0,
+	    ("SBI doesn't implement sbi_remote_fence_i()"));
+	KASSERT(has_rfnc_extension ||
+	    sbi_probe_extension(SBI_REMOTE_SFENCE_VMA) != 0,
+	    ("SBI doesn't implement sbi_remote_sfence_vma()"));
+	KASSERT(has_rfnc_extension ||
+	    sbi_probe_extension(SBI_REMOTE_SFENCE_VMA_ASID) != 0,
+	    ("SBI doesn't implement sbi_remote_sfence_vma_asid()"));
+	KASSERT(has_srst_extension || sbi_probe_extension(SBI_SHUTDOWN) != 0,
+	    ("SBI doesn't implement a shutdown or reset extension"));
+}
+
+static void
+sbi_identify(driver_t *driver, device_t parent)
+{
+	device_t dev;
+
+	if (device_find_child(parent, "sbi", DEVICE_UNIT_ANY) != NULL)
+		return;
+
+	dev = BUS_ADD_CHILD(parent, 0, "sbi", DEVICE_UNIT_ANY);
+	if (dev == NULL)
+		device_printf(parent, "Can't add sbi child\n");
+}
+
+static int
+sbi_probe(device_t dev)
+{
+	device_set_desc(dev, "RISC-V Supervisor Binary Interface");
+
+	return (BUS_PROBE_NOWILDCARD);
+}
+
+static int
+sbi_attach(device_t dev)
+{
+	struct sbi_softc *sc;
+#ifdef SMP
+	device_t child;
+	struct sbi_devinfo *di;
+#endif
+
+	if (sbi_softc != NULL)
+		return (ENXIO);
+
+	sc = device_get_softc(dev);
+	sc->dev = dev;
+	sbi_softc = sc;
+
+	EVENTHANDLER_REGISTER(shutdown_final, sbi_shutdown_final, NULL,
+	    SHUTDOWN_PRI_LAST);
+
+#ifdef SMP
+	di = malloc(sizeof(*di), M_DEVBUF, M_WAITOK | M_ZERO);
+	resource_list_init(&di->rl);
+	child = device_add_child(dev, "sbi_ipi", DEVICE_UNIT_ANY);
+	if (child == NULL) {
+		device_printf(dev, "Could not add sbi_ipi child\n");
+		return (ENXIO);
+	}
+
+	device_set_ivars(child, di);
+#endif
+
+	return (0);
+}
+
+static struct resource_list *
+sbi_get_resource_list(device_t bus, device_t child)
+{
+	struct sbi_devinfo *di;
+
+	di = device_get_ivars(child);
+	KASSERT(di != NULL, ("%s: No devinfo", __func__));
+
+	return (&di->rl);
+}
+
+static device_method_t sbi_methods[] = {
+	/* Device interface */
+	DEVMETHOD(device_identify,	sbi_identify),
+	DEVMETHOD(device_probe,		sbi_probe),
+	DEVMETHOD(device_attach,	sbi_attach),
+
+	/* Bus interface */
+	DEVMETHOD(bus_alloc_resource,	bus_generic_rl_alloc_resource),
+	DEVMETHOD(bus_activate_resource, bus_generic_activate_resource),
+	DEVMETHOD(bus_deactivate_resource, bus_generic_deactivate_resource),
+	DEVMETHOD(bus_release_resource,	bus_generic_rl_release_resource),
+	DEVMETHOD(bus_setup_intr,	bus_generic_setup_intr),
+	DEVMETHOD(bus_teardown_intr,	bus_generic_teardown_intr),
+	DEVMETHOD(bus_get_resource_list, sbi_get_resource_list),
+	DEVMETHOD(bus_set_resource,	bus_generic_rl_set_resource),
+	DEVMETHOD(bus_get_resource,	bus_generic_rl_get_resource),
+
+	DEVMETHOD_END
+};
+
+DEFINE_CLASS_0(sbi, sbi_driver, sbi_methods, sizeof(struct sbi_softc));
+EARLY_DRIVER_MODULE(sbi, nexus, sbi_driver, 0, 0,
+    BUS_PASS_CPU + BUS_PASS_ORDER_FIRST);