diff options
Diffstat (limited to 'UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib')
5 files changed, 0 insertions, 595 deletions
diff --git a/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/BaseRiscV64CpuExceptionHandlerLib.inf b/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/BaseRiscV64CpuExceptionHandlerLib.inf deleted file mode 100644 index d804629..0000000 --- a/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/BaseRiscV64CpuExceptionHandlerLib.inf +++ /dev/null @@ -1,42 +0,0 @@ -## @file
-# RISC-V CPU Exception Handler Library
-#
-# Copyright (c) 2022-2023, Ventana Micro Systems Inc. All rights reserved.<BR>
-#
-# SPDX-License-Identifier: BSD-2-Clause-Patent
-#
-##
-
-[Defines]
- INF_VERSION = 0x0001001B
- BASE_NAME = BaseRiscV64CpuExceptionHandlerLib
- MODULE_UNI_FILE = BaseRiscV64CpuExceptionHandlerLib.uni
- FILE_GUID = 6AB0D5FD-E615-45A3-9374-E284FB061FC9
- MODULE_TYPE = BASE
- VERSION_STRING = 1.0
- LIBRARY_CLASS = CpuExceptionHandlerLib
-
-#
-# The following information is for reference only and not required by the build tools.
-#
-# VALID_ARCHITECTURES = RISCV64
-#
-
-[Sources]
- SupervisorTrapHandler.S
- CpuExceptionHandlerLib.c
- CpuExceptionHandlerLib.h
-
-[Packages]
- MdePkg/MdePkg.dec
- MdeModulePkg/MdeModulePkg.dec
- UefiCpuPkg/UefiCpuPkg.dec
-
-[LibraryClasses]
- BaseLib
- SerialPortLib
- PrintLib
- SynchronizationLib
- PeCoffGetEntryPointLib
- MemoryAllocationLib
- DebugLib
diff --git a/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/BaseRiscV64CpuExceptionHandlerLib.uni b/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/BaseRiscV64CpuExceptionHandlerLib.uni deleted file mode 100644 index 00cca22..0000000 --- a/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/BaseRiscV64CpuExceptionHandlerLib.uni +++ /dev/null @@ -1,13 +0,0 @@ -// /** @file
-//
-// Copyright (c) 2016 - 2019, Hewlett Packard Enterprise Development LP. All rights reserved.<BR>
-//
-// SPDX-License-Identifier: BSD-2-Clause-Patent
-//
-// **/
-
-
-#string STR_MODULE_ABSTRACT #language en-US "RISC-V CPU Exception Handler Librarys."
-
-#string STR_MODULE_DESCRIPTION #language en-US "RISC-V CPU Exception Handler Librarys."
-
diff --git a/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/CpuExceptionHandlerLib.c b/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/CpuExceptionHandlerLib.c deleted file mode 100644 index 73a9dd5..0000000 --- a/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/CpuExceptionHandlerLib.c +++ /dev/null @@ -1,325 +0,0 @@ -/** @file
- RISC-V Exception Handler library implementation.
-
- Copyright (c) 2016 - 2022, Hewlett Packard Enterprise Development LP. All rights reserved.<BR>
-
- SPDX-License-Identifier: BSD-2-Clause-Patent
-
-**/
-
-#include <PiPei.h>
-#include <Library/CpuExceptionHandlerLib.h>
-#include <Library/DebugLib.h>
-#include <Library/BaseLib.h>
-#include <Library/SerialPortLib.h>
-#include <Library/PrintLib.h>
-#include <Register/RiscV64/RiscVEncoding.h>
-#include "CpuExceptionHandlerLib.h"
-
-//
-// Define the maximum message length
-//
-#define MAX_DEBUG_MESSAGE_LENGTH 0x100
-
-STATIC EFI_CPU_INTERRUPT_HANDLER mExceptionHandlers[EXCEPT_RISCV_MAX_EXCEPTIONS + 1];
-STATIC EFI_CPU_INTERRUPT_HANDLER mIrqHandlers[EXCEPT_RISCV_MAX_IRQS + 1];
-
-STATIC CONST CHAR8 mExceptionOrIrqUnknown[] = "Unknown";
-STATIC CONST CHAR8 *mExceptionNameStr[EXCEPT_RISCV_MAX_EXCEPTIONS + 1] = {
- "EXCEPT_RISCV_INST_MISALIGNED",
- "EXCEPT_RISCV_INST_ACCESS_FAULT",
- "EXCEPT_RISCV_ILLEGAL_INST",
- "EXCEPT_RISCV_BREAKPOINT",
- "EXCEPT_RISCV_LOAD_ADDRESS_MISALIGNED",
- "EXCEPT_RISCV_LOAD_ACCESS_FAULT",
- "EXCEPT_RISCV_STORE_AMO_ADDRESS_MISALIGNED",
- "EXCEPT_RISCV_STORE_AMO_ACCESS_FAULT",
- "EXCEPT_RISCV_ENV_CALL_FROM_UMODE",
- "EXCEPT_RISCV_ENV_CALL_FROM_SMODE",
- "EXCEPT_RISCV_ENV_CALL_FROM_VS_MODE",
- "EXCEPT_RISCV_ENV_CALL_FROM_MMODE",
- "EXCEPT_RISCV_INST_ACCESS_PAGE_FAULT",
- "EXCEPT_RISCV_LOAD_ACCESS_PAGE_FAULT",
- "EXCEPT_RISCV_14",
- "EXCEPT_RISCV_STORE_ACCESS_PAGE_FAULT",
- "EXCEPT_RISCV_16",
- "EXCEPT_RISCV_17",
- "EXCEPT_RISCV_18",
- "EXCEPT_RISCV_19",
- "EXCEPT_RISCV_INST_GUEST_PAGE_FAULT",
- "EXCEPT_RISCV_LOAD_GUEST_PAGE_FAULT",
- "EXCEPT_RISCV_VIRTUAL_INSTRUCTION",
- "EXCEPT_RISCV_STORE_GUEST_PAGE_FAULT"
-};
-
-STATIC CONST CHAR8 *mIrqNameStr[EXCEPT_RISCV_MAX_IRQS + 1] = {
- "EXCEPT_RISCV_IRQ_0",
- "EXCEPT_RISCV_IRQ_SOFT_FROM_SMODE",
- "EXCEPT_RISCV_IRQ_SOFT_FROM_VSMODE",
- "EXCEPT_RISCV_IRQ_SOFT_FROM_MMODE",
- "EXCEPT_RISCV_IRQ_4",
- "EXCEPT_RISCV_IRQ_TIMER_FROM_SMODE",
-};
-
-/**
- Prints a message to the serial port.
-
- @param Format Format string for the message to print.
- @param ... Variable argument list whose contents are accessed
- based on the format string specified by Format.
-
-**/
-STATIC
-VOID
-EFIAPI
-InternalPrintMessage (
- IN CONST CHAR8 *Format,
- ...
- )
-{
- CHAR8 Buffer[MAX_DEBUG_MESSAGE_LENGTH];
- VA_LIST Marker;
-
- //
- // Convert the message to an ASCII String
- //
- VA_START (Marker, Format);
- AsciiVSPrint (Buffer, sizeof (Buffer), Format, Marker);
- VA_END (Marker);
-
- //
- // Send the print string to a Serial Port
- //
- SerialPortWrite ((UINT8 *)Buffer, AsciiStrLen (Buffer));
-}
-
-/**
- Get ASCII format string exception name by exception type.
-
- @param ExceptionType Exception type.
-
- @return ASCII format string exception name.
-**/
-STATIC
-CONST CHAR8 *
-GetExceptionNameStr (
- IN EFI_EXCEPTION_TYPE ExceptionType
- )
-{
- if (EXCEPT_RISCV_IS_IRQ (ExceptionType)) {
- if (EXCEPT_RISCV_IRQ_INDEX (ExceptionType) > EXCEPT_RISCV_MAX_IRQS) {
- return mExceptionOrIrqUnknown;
- }
-
- return mIrqNameStr[EXCEPT_RISCV_IRQ_INDEX (ExceptionType)];
- }
-
- if (ExceptionType > EXCEPT_RISCV_MAX_EXCEPTIONS) {
- return mExceptionOrIrqUnknown;
- }
-
- return mExceptionNameStr[ExceptionType];
-}
-
-/**
- Display CPU information. This can be called by 3rd-party handlers
- set by RegisterCpuInterruptHandler.
-
- @param ExceptionType Exception type.
- @param SystemContext Pointer to EFI_SYSTEM_CONTEXT.
-**/
-VOID
-EFIAPI
-DumpCpuContext (
- IN EFI_EXCEPTION_TYPE ExceptionType,
- IN EFI_SYSTEM_CONTEXT SystemContext
- )
-{
- UINTN Printed;
- SMODE_TRAP_REGISTERS *Regs;
-
- Printed = 0;
- Regs = (SMODE_TRAP_REGISTERS *)SystemContext.SystemContextRiscV64;
-
- InternalPrintMessage (
- "!!!! RISCV64 Exception Type - %016x(%a) !!!!\n",
- ExceptionType,
- GetExceptionNameStr (ExceptionType)
- );
-
- DEBUG_CODE_BEGIN ();
-
- #define REGS() \
- REG (t0); REG (t1); REG (t2); REG (t3); REG (t4); REG (t5); REG (t6); \
- REG (s0); REG (s1); REG (s2); REG (s3); REG (s4); REG (s5); REG (s6); \
- REG (s7); REG (s8); REG (s9); REG (s10); REG (s11); \
- REG (a0); REG (a1); REG (a2); REG (a3); REG (a4); REG (a5); REG (a6); \
- REG (a7); \
- REG (zero); REG (ra); REG (sp); REG (gp); REG (tp); \
- REG (sepc); REG (sstatus); REG (stval);
-
- #define REG(x) do { \
- InternalPrintMessage ("%7a = 0x%017lx%c", #x, Regs->x, \
- (++Printed % 2) ? L'\t' : L'\n'); \
- } while (0);
-
- REGS ();
- if (Printed % 2 != 0) {
- InternalPrintMessage ("\n");
- }
-
- #undef REG
- #undef REGS
-
- DEBUG_CODE_END ();
-}
-
-/**
- Initializes all CPU exceptions entries and provides the default exception handlers.
-
- Caller should try to get an array of interrupt and/or exception vectors that are in use and need to
- persist by EFI_VECTOR_HANDOFF_INFO defined in PI 1.3 specification.
- If caller cannot get reserved vector list or it does not exists, set VectorInfo to NULL.
- If VectorInfo is not NULL, the exception vectors will be initialized per vector attribute accordingly.
-
- @param[in] VectorInfo Pointer to reserved vector list.
-
- @retval EFI_SUCCESS CPU Exception Entries have been successfully initialized
- with default exception handlers.
- @retval EFI_INVALID_PARAMETER VectorInfo includes the invalid content if VectorInfo is not NULL.
- @retval EFI_UNSUPPORTED This function is not supported.
-
-**/
-EFI_STATUS
-EFIAPI
-InitializeCpuExceptionHandlers (
- IN EFI_VECTOR_HANDOFF_INFO *VectorInfo OPTIONAL
- )
-{
- RiscVSetSupervisorStvec ((UINT64)SupervisorModeTrap);
- return EFI_SUCCESS;
-}
-
-/**
- Registers a function to be called from the processor interrupt handler.
-
- This function registers and enables the handler specified by InterruptHandler for a processor
- interrupt or exception type specified by ExceptionType. If InterruptHandler is NULL, then the
- handler for the processor interrupt or exception type specified by ExceptionType is uninstalled.
- The installed handler is called once for each processor interrupt or exception.
- NOTE: This function should be invoked after InitializeCpuExceptionHandlers() or
- InitializeCpuInterruptHandlers() invoked, otherwise EFI_UNSUPPORTED returned.
-
- @param[in] ExceptionType Defines which interrupt or exception to hook.
- @param[in] InterruptHandler A pointer to a function of type EFI_CPU_INTERRUPT_HANDLER that is called
- when a processor interrupt occurs. If this parameter is NULL, then the handler
- will be uninstalled.
-
- @retval EFI_SUCCESS The handler for the processor interrupt was successfully installed or uninstalled.
- @retval EFI_ALREADY_STARTED InterruptHandler is not NULL, and a handler for ExceptionType was
- previously installed.
- @retval EFI_INVALID_PARAMETER InterruptHandler is NULL, and a handler for ExceptionType was not
- previously installed.
- @retval EFI_UNSUPPORTED The interrupt specified by ExceptionType is not supported,
- or this function is not supported.
-**/
-EFI_STATUS
-EFIAPI
-RegisterCpuInterruptHandler (
- IN EFI_EXCEPTION_TYPE ExceptionType,
- IN EFI_CPU_INTERRUPT_HANDLER InterruptHandler
- )
-{
- DEBUG ((DEBUG_INFO, "%a: Type:%x Handler: %x\n", __func__, ExceptionType, InterruptHandler));
- if (EXCEPT_RISCV_IS_IRQ (ExceptionType)) {
- if (EXCEPT_RISCV_IRQ_INDEX (ExceptionType) > EXCEPT_RISCV_MAX_IRQS) {
- return EFI_UNSUPPORTED;
- }
-
- if (mIrqHandlers[EXCEPT_RISCV_IRQ_INDEX (ExceptionType)] != NULL) {
- return EFI_ALREADY_STARTED;
- } else if (InterruptHandler == NULL) {
- return EFI_INVALID_PARAMETER;
- }
-
- mIrqHandlers[EXCEPT_RISCV_IRQ_INDEX (ExceptionType)] = InterruptHandler;
- } else {
- if (ExceptionType > EXCEPT_RISCV_MAX_EXCEPTIONS) {
- return EFI_UNSUPPORTED;
- }
-
- if (mExceptionHandlers[ExceptionType] != NULL) {
- return EFI_ALREADY_STARTED;
- } else if (InterruptHandler == NULL) {
- return EFI_INVALID_PARAMETER;
- }
-
- mExceptionHandlers[ExceptionType] = InterruptHandler;
- }
-
- return EFI_SUCCESS;
-}
-
-/**
- Setup separate stacks for certain exception handlers.
- If the input Buffer and BufferSize are both NULL, use global variable if possible.
-
- @param[in] Buffer Point to buffer used to separate exception stack.
- @param[in, out] BufferSize On input, it indicates the byte size of Buffer.
- If the size is not enough, the return status will
- be EFI_BUFFER_TOO_SMALL, and output BufferSize
- will be the size it needs.
-
- @retval EFI_SUCCESS The stacks are assigned successfully.
- @retval EFI_UNSUPPORTED This function is not supported.
- @retval EFI_BUFFER_TOO_SMALL This BufferSize is too small.
-**/
-EFI_STATUS
-EFIAPI
-InitializeSeparateExceptionStacks (
- IN VOID *Buffer,
- IN OUT UINTN *BufferSize
- )
-{
- return EFI_SUCCESS;
-}
-
-/**
- Supervisor mode trap handler.
-
- @param[in] SmodeTrapReg Registers before trap occurred.
-
-**/
-VOID
-RiscVSupervisorModeTrapHandler (
- SMODE_TRAP_REGISTERS *SmodeTrapReg
- )
-{
- EFI_EXCEPTION_TYPE ExceptionType;
- EFI_SYSTEM_CONTEXT RiscVSystemContext;
- UINTN IrqIndex;
-
- RiscVSystemContext.SystemContextRiscV64 = (EFI_SYSTEM_CONTEXT_RISCV64 *)SmodeTrapReg;
- ExceptionType = (UINTN)RiscVGetSupervisorTrapCause ();
-
- if (EXCEPT_RISCV_IS_IRQ (ExceptionType)) {
- IrqIndex = EXCEPT_RISCV_IRQ_INDEX (ExceptionType);
-
- if ((IrqIndex <= EXCEPT_RISCV_MAX_IRQS) &&
- (mIrqHandlers[IrqIndex] != NULL))
- {
- mIrqHandlers[IrqIndex](ExceptionType, RiscVSystemContext);
- return;
- }
- } else {
- if ((ExceptionType <= EXCEPT_RISCV_MAX_EXCEPTIONS) &&
- (mExceptionHandlers[ExceptionType] != 0))
- {
- mExceptionHandlers[ExceptionType](ExceptionType, RiscVSystemContext);
- return;
- }
- }
-
- DumpCpuContext (ExceptionType, RiscVSystemContext);
- CpuDeadLoop ();
-}
diff --git a/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/CpuExceptionHandlerLib.h b/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/CpuExceptionHandlerLib.h deleted file mode 100644 index 9b7e130..0000000 --- a/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/CpuExceptionHandlerLib.h +++ /dev/null @@ -1,111 +0,0 @@ -/** @file
-
- RISC-V Exception Handler library definition file.
-
- Copyright (c) 2019-2022, Hewlett Packard Enterprise Development LP. All rights reserved.<BR>
-
- SPDX-License-Identifier: BSD-2-Clause-Patent
-
-**/
-
-#ifndef RISCV_CPU_EXECPTION_HANDLER_LIB_H_
-#define RISCV_CPU_EXECPTION_HANDLER_LIB_H_
-
-#include <Register/RiscV64/RiscVImpl.h>
-
-/**
- Trap Handler for S-mode
-
-**/
-VOID
-SupervisorModeTrap (
- VOID
- );
-
-//
-// Index of SMode trap register
-//
-#define SMODE_TRAP_REGS_zero 0
-#define SMODE_TRAP_REGS_ra 1
-#define SMODE_TRAP_REGS_sp 2
-#define SMODE_TRAP_REGS_gp 3
-#define SMODE_TRAP_REGS_tp 4
-#define SMODE_TRAP_REGS_t0 5
-#define SMODE_TRAP_REGS_t1 6
-#define SMODE_TRAP_REGS_t2 7
-#define SMODE_TRAP_REGS_s0 8
-#define SMODE_TRAP_REGS_s1 9
-#define SMODE_TRAP_REGS_a0 10
-#define SMODE_TRAP_REGS_a1 11
-#define SMODE_TRAP_REGS_a2 12
-#define SMODE_TRAP_REGS_a3 13
-#define SMODE_TRAP_REGS_a4 14
-#define SMODE_TRAP_REGS_a5 15
-#define SMODE_TRAP_REGS_a6 16
-#define SMODE_TRAP_REGS_a7 17
-#define SMODE_TRAP_REGS_s2 18
-#define SMODE_TRAP_REGS_s3 19
-#define SMODE_TRAP_REGS_s4 20
-#define SMODE_TRAP_REGS_s5 21
-#define SMODE_TRAP_REGS_s6 22
-#define SMODE_TRAP_REGS_s7 23
-#define SMODE_TRAP_REGS_s8 24
-#define SMODE_TRAP_REGS_s9 25
-#define SMODE_TRAP_REGS_s10 26
-#define SMODE_TRAP_REGS_s11 27
-#define SMODE_TRAP_REGS_t3 28
-#define SMODE_TRAP_REGS_t4 29
-#define SMODE_TRAP_REGS_t5 30
-#define SMODE_TRAP_REGS_t6 31
-#define SMODE_TRAP_REGS_sepc 32
-#define SMODE_TRAP_REGS_sstatus 33
-#define SMODE_TRAP_REGS_stval 34
-#define SMODE_TRAP_REGS_last 35
-
-#define SMODE_TRAP_REGS_OFFSET(x) ((SMODE_TRAP_REGS_##x) * __SIZEOF_POINTER__)
-#define SMODE_TRAP_REGS_SIZE SMODE_TRAP_REGS_OFFSET(last)
-
-#pragma pack(1)
-typedef struct {
- //
- // Below follow the format of EFI_SYSTEM_CONTEXT.
- //
- UINT64 zero;
- UINT64 ra;
- UINT64 sp;
- UINT64 gp;
- UINT64 tp;
- UINT64 t0;
- UINT64 t1;
- UINT64 t2;
- UINT64 s0;
- UINT64 s1;
- UINT64 a0;
- UINT64 a1;
- UINT64 a2;
- UINT64 a3;
- UINT64 a4;
- UINT64 a5;
- UINT64 a6;
- UINT64 a7;
- UINT64 s2;
- UINT64 s3;
- UINT64 s4;
- UINT64 s5;
- UINT64 s6;
- UINT64 s7;
- UINT64 s8;
- UINT64 s9;
- UINT64 s10;
- UINT64 s11;
- UINT64 t3;
- UINT64 t4;
- UINT64 t5;
- UINT64 t6;
- UINT64 sepc;
- UINT64 sstatus;
- UINT64 stval;
-} SMODE_TRAP_REGISTERS;
-#pragma pack()
-
-#endif
diff --git a/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/SupervisorTrapHandler.S b/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/SupervisorTrapHandler.S deleted file mode 100644 index 45070b5..0000000 --- a/UefiCpuPkg/Library/BaseRiscV64CpuExceptionHandlerLib/SupervisorTrapHandler.S +++ /dev/null @@ -1,104 +0,0 @@ -/** @file
- RISC-V Processor supervisor mode trap handler
-
- Copyright (c) 2019, Hewlett Packard Enterprise Development LP. All rights reserved.<BR>
-
- SPDX-License-Identifier: BSD-2-Clause-Patent
-
-**/
-
-#include <Base.h>
-#include "CpuExceptionHandlerLib.h"
-
- .align 3
- .section .entry, "ax", %progbits
- .globl SupervisorModeTrap
-SupervisorModeTrap:
- addi sp, sp, -SMODE_TRAP_REGS_SIZE
-
- /* Save all general regisers except SP */
- sd t0, SMODE_TRAP_REGS_OFFSET(t0)(sp)
-
- csrr t0, CSR_SSTATUS
- sd t0, SMODE_TRAP_REGS_OFFSET(sstatus)(sp)
- csrr t0, CSR_SEPC
- sd t0, SMODE_TRAP_REGS_OFFSET(sepc)(sp)
- csrr t0, CSR_STVAL
- sd t0, SMODE_TRAP_REGS_OFFSET(stval)(sp)
- ld t0, SMODE_TRAP_REGS_OFFSET(t0)(sp)
-
- sd zero, SMODE_TRAP_REGS_OFFSET(zero)(sp)
- sd ra, SMODE_TRAP_REGS_OFFSET(ra)(sp)
- sd gp, SMODE_TRAP_REGS_OFFSET(gp)(sp)
- sd tp, SMODE_TRAP_REGS_OFFSET(tp)(sp)
- sd t1, SMODE_TRAP_REGS_OFFSET(t1)(sp)
- sd t2, SMODE_TRAP_REGS_OFFSET(t2)(sp)
- sd s0, SMODE_TRAP_REGS_OFFSET(s0)(sp)
- sd s1, SMODE_TRAP_REGS_OFFSET(s1)(sp)
- sd a0, SMODE_TRAP_REGS_OFFSET(a0)(sp)
- sd a1, SMODE_TRAP_REGS_OFFSET(a1)(sp)
- sd a2, SMODE_TRAP_REGS_OFFSET(a2)(sp)
- sd a3, SMODE_TRAP_REGS_OFFSET(a3)(sp)
- sd a4, SMODE_TRAP_REGS_OFFSET(a4)(sp)
- sd a5, SMODE_TRAP_REGS_OFFSET(a5)(sp)
- sd a6, SMODE_TRAP_REGS_OFFSET(a6)(sp)
- sd a7, SMODE_TRAP_REGS_OFFSET(a7)(sp)
- sd s2, SMODE_TRAP_REGS_OFFSET(s2)(sp)
- sd s3, SMODE_TRAP_REGS_OFFSET(s3)(sp)
- sd s4, SMODE_TRAP_REGS_OFFSET(s4)(sp)
- sd s5, SMODE_TRAP_REGS_OFFSET(s5)(sp)
- sd s6, SMODE_TRAP_REGS_OFFSET(s6)(sp)
- sd s7, SMODE_TRAP_REGS_OFFSET(s7)(sp)
- sd s8, SMODE_TRAP_REGS_OFFSET(s8)(sp)
- sd s9, SMODE_TRAP_REGS_OFFSET(s9)(sp)
- sd s10, SMODE_TRAP_REGS_OFFSET(s10)(sp)
- sd s11, SMODE_TRAP_REGS_OFFSET(s11)(sp)
- sd t3, SMODE_TRAP_REGS_OFFSET(t3)(sp)
- sd t4, SMODE_TRAP_REGS_OFFSET(t4)(sp)
- sd t5, SMODE_TRAP_REGS_OFFSET(t5)(sp)
- sd t6, SMODE_TRAP_REGS_OFFSET(t6)(sp)
-
- /* Call to Supervisor mode trap handler in CpuExceptionHandlerLib.c */
- mv a0, sp
- call RiscVSupervisorModeTrapHandler
-
- /* Restore all general regisers except SP */
- ld ra, SMODE_TRAP_REGS_OFFSET(ra)(sp)
- ld gp, SMODE_TRAP_REGS_OFFSET(gp)(sp)
- ld tp, SMODE_TRAP_REGS_OFFSET(tp)(sp)
- ld t2, SMODE_TRAP_REGS_OFFSET(t2)(sp)
- ld t1, SMODE_TRAP_REGS_OFFSET(t1)(sp)
- ld s0, SMODE_TRAP_REGS_OFFSET(s0)(sp)
- ld s1, SMODE_TRAP_REGS_OFFSET(s1)(sp)
- ld a0, SMODE_TRAP_REGS_OFFSET(a0)(sp)
- ld a1, SMODE_TRAP_REGS_OFFSET(a1)(sp)
- ld a2, SMODE_TRAP_REGS_OFFSET(a2)(sp)
- ld a3, SMODE_TRAP_REGS_OFFSET(a3)(sp)
- ld a4, SMODE_TRAP_REGS_OFFSET(a4)(sp)
- ld a5, SMODE_TRAP_REGS_OFFSET(a5)(sp)
- ld a6, SMODE_TRAP_REGS_OFFSET(a6)(sp)
- ld a7, SMODE_TRAP_REGS_OFFSET(a7)(sp)
- ld s2, SMODE_TRAP_REGS_OFFSET(s2)(sp)
- ld s3, SMODE_TRAP_REGS_OFFSET(s3)(sp)
- ld s4, SMODE_TRAP_REGS_OFFSET(s4)(sp)
- ld s5, SMODE_TRAP_REGS_OFFSET(s5)(sp)
- ld s6, SMODE_TRAP_REGS_OFFSET(s6)(sp)
- ld s7, SMODE_TRAP_REGS_OFFSET(s7)(sp)
- ld s8, SMODE_TRAP_REGS_OFFSET(s8)(sp)
- ld s9, SMODE_TRAP_REGS_OFFSET(s9)(sp)
- ld s10, SMODE_TRAP_REGS_OFFSET(s10)(sp)
- ld s11, SMODE_TRAP_REGS_OFFSET(s11)(sp)
- ld t3, SMODE_TRAP_REGS_OFFSET(t3)(sp)
- ld t4, SMODE_TRAP_REGS_OFFSET(t4)(sp)
- ld t5, SMODE_TRAP_REGS_OFFSET(t5)(sp)
- ld t6, SMODE_TRAP_REGS_OFFSET(t6)(sp)
-
- ld t0, SMODE_TRAP_REGS_OFFSET(sepc)(sp)
- csrw CSR_SEPC, t0
- ld t0, SMODE_TRAP_REGS_OFFSET(sstatus)(sp)
- csrw CSR_SSTATUS, t0
- ld t0, SMODE_TRAP_REGS_OFFSET(stval)(sp)
- csrw CSR_STVAL, t0
- ld t0, SMODE_TRAP_REGS_OFFSET(t0)(sp)
- addi sp, sp, SMODE_TRAP_REGS_SIZE
- sret
|