/* SPDX-License-Identifier: GPL-2.0-only */ #include <mcall.h> #include <stdint.h> #include <arch/exception.h> #include <sbi.h> #include <vm.h> #include <console/uart.h> #include <commonlib/helpers.h> static uintptr_t send_ipi(uintptr_t *pmask, intptr_t type) { uintptr_t mask = mprv_read_uintptr_t(pmask); for (int i = 0; mask; i++) { if (mask & 1) { OTHER_HLS(i)->ipi_pending |= type; /* send soft interrupt to target hart */ set_msip(i, 1); } mask = mask >> 1; } return 0; } static uintptr_t sbi_set_timer(uint64_t when) { clear_csr(mip, MIP_STIP); set_csr(mie, MIP_MTIP); *(HLS()->timecmp) = when; return 0; } #if CONFIG(CONSOLE_SERIAL) static uintptr_t sbi_console_putchar(uint8_t ch) { uart_tx_byte(CONFIG_UART_FOR_CONSOLE, ch); return 0; } static uintptr_t sbi_console_getchar(void) { return uart_rx_byte(CONFIG_UART_FOR_CONSOLE); } #endif static uintptr_t sbi_clear_ipi(void) { clear_csr(mip, MIP_SSIP); return 0; } /* * sbi is triggered by the s-mode ecall * parameter : register a0 a1 a2 * function : register a7 * return : register a0 */ void handle_sbi(trapframe *tf) { uintptr_t ret = 0; uintptr_t arg0 = tf->gpr[10]; __unused uintptr_t arg1 = tf->gpr[11]; uintptr_t which = tf->gpr[17]; switch (which) { case SBI_SET_TIMER: #if __riscv_xlen == 32 ret = sbi_set_timer(arg0 + ((uint64_t)arg1 << 32)); #else ret = sbi_set_timer(arg0); #endif break; #if CONFIG(CONSOLE_SERIAL) case SBI_CONSOLE_PUTCHAR: ret = sbi_console_putchar(arg0); break; case SBI_CONSOLE_GETCHAR: ret = sbi_console_getchar(); break; #endif case SBI_CLEAR_IPI: ret = sbi_clear_ipi(); break; case SBI_SEND_IPI: ret = send_ipi((uintptr_t *)arg0, IPI_SOFT); break; case SBI_REMOTE_FENCE_I: ret = send_ipi((uintptr_t *)arg0, IPI_FENCE_I); break; case SBI_REMOTE_SFENCE_VMA: ret = send_ipi((uintptr_t *)arg0, IPI_SFENCE_VMA); break; case SBI_REMOTE_SFENCE_VMA_ASID: ret = send_ipi((uintptr_t *)arg0, IPI_SFENCE_VMA_ASID); break; case SBI_SHUTDOWN: ret = send_ipi((uintptr_t *)arg0, IPI_SHUTDOWN); break; default: ret = -SBI_ENOSYS; break; } tf->gpr[10] = ret; write_csr(mepc, read_csr(mepc) + 4); }