1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
|
/** @file Exception.c
CPU DXE Module initialization exception instance.
Copyright (c) 2024, Loongson Technology Corporation Limited. All rights reserved.<BR>
SPDX-License-Identifier: BSD-2-Clause-Patent
**/
#include "CpuDxe.h"
#include <Guid/VectorHandoffTable.h>
#include <Library/CpuExceptionHandlerLib.h>
#include <Register/LoongArch64/Csr.h>
VOID
ExceptionEntryStart (
VOID
);
VOID
ExceptionEntryEnd (
VOID
);
/**
This function registers and enables the handler specified by InterruptHandler for a processor
interrupt or exception type specified by InterruptType. If InterruptHandler is NULL, then the
handler for the processor interrupt or exception type specified by InterruptType is uninstalled.
The installed handler is called once for each processor interrupt or exception.
@param InterruptType A pointer to the processor's current interrupt state. Set to TRUE if interrupts
are enabled and FALSE if interrupts are disabled.
@param 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 InterruptType was
previously installed.
@retval EFI_INVALID_PARAMETER InterruptHandler is NULL, and a handler for InterruptType was not
previously installed.
@retval EFI_UNSUPPORTED The interrupt specified by InterruptType is not supported.
**/
EFI_STATUS
RegisterInterruptHandler (
IN EFI_EXCEPTION_TYPE InterruptType,
IN EFI_CPU_INTERRUPT_HANDLER InterruptHandler
)
{
return (EFI_STATUS)RegisterCpuInterruptHandler (InterruptType, InterruptHandler);
}
/**
Update the exception start entry code.
@retval EFI_SUCCESS Update the exception start entry code down.
@retval EFI_OUT_OF_RESOURCES The start entry code size out of bounds.
**/
EFI_STATUS
EFIAPI
UpdateExceptionStartEntry (
VOID
)
{
EFI_PHYSICAL_ADDRESS ExceptionStartEntry;
UINTN VectorLength;
UINTN MaxLength;
UINTN MaxSizeOfVector;
VectorLength = (UINTN)ExceptionEntryEnd - (UINTN)ExceptionEntryStart;
//
// A vector is up to 512 bytes.
//
MaxSizeOfVector = 512;
MaxLength = (MAX_LOONGARCH_EXCEPTION + MAX_LOONGARCH_INTERRUPT) * MaxSizeOfVector;
if (VectorLength > MaxLength) {
return EFI_OUT_OF_RESOURCES;
}
ExceptionStartEntry = PcdGet64 (PcdLoongArchExceptionVectorBaseAddress);
InvalidateInstructionCacheRange ((VOID *)ExceptionStartEntry, VectorLength);
CopyMem ((VOID *)ExceptionStartEntry, (VOID *)ExceptionEntryStart, VectorLength);
InvalidateInstructionCacheRange ((VOID *)ExceptionStartEntry, VectorLength);
InvalidateDataCache ();
//
// If PcdLoongArchExceptionVectorBaseAddress is not used during SEC and PEI stages, the exception
// base addres is set to PcdLoongArchExceptionVectorBaseAddress.
//
if (CsrRead (LOONGARCH_CSR_EBASE) != ExceptionStartEntry) {
SetExceptionBaseAddress (ExceptionStartEntry);
}
return EFI_SUCCESS;
}
/**
Initialize interrupt handling for DXE phase.
@param Cpu A pointer of EFI_CPU_ARCH_PROTOCOL instance.
@return VOID.
**/
VOID
InitializeExceptions (
IN EFI_CPU_ARCH_PROTOCOL *Cpu
)
{
EFI_STATUS Status;
EFI_VECTOR_HANDOFF_INFO *VectorInfoList;
EFI_VECTOR_HANDOFF_INFO *VectorInfo;
BOOLEAN IrqEnabled;
VectorInfo = (EFI_VECTOR_HANDOFF_INFO *)NULL;
Status = EfiGetSystemConfigurationTable (&gEfiVectorHandoffTableGuid, (VOID **)&VectorInfoList);
if ((Status == EFI_SUCCESS) && (VectorInfoList != NULL)) {
VectorInfo = VectorInfoList;
}
//
// Disable interrupts
//
Cpu->GetInterruptState (Cpu, &IrqEnabled);
if (IrqEnabled) {
Cpu->DisableInterrupt (Cpu);
}
//
// Update the Exception Start Entry code to point into CpuDxe.
//
Status = UpdateExceptionStartEntry ();
if (EFI_ERROR (Status)) {
DebugPrint (EFI_D_ERROR, "[%a]: Exception start entry code out of bounds!\n", __func__);
ASSERT_EFI_ERROR (Status);
}
//
// Intialize the CpuExceptionHandlerLib so we take over the exception vector table from the DXE Core
//
Status = InitializeCpuExceptionHandlers (VectorInfo);
ASSERT_EFI_ERROR (Status);
//
// Enable interrupts
//
DebugPrint (EFI_D_INFO, "InitializeExceptions,IrqEnabled = %x\n", IrqEnabled);
if (!IrqEnabled) {
Status = Cpu->EnableInterrupt (Cpu);
}
ASSERT_EFI_ERROR (Status);
}
|
