3 Copyright (c) 2008-2009, Apple Inc. All rights reserved.
5 All rights reserved. This program and the accompanying materials
6 are licensed and made available under the terms and conditions of the BSD License
7 which accompanies this distribution. The full text of the license may be found at
8 http://opensource.org/licenses/bsd-license.php
10 THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
11 WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
17 EFI_DEBUG_IMAGE_INFO_TABLE_HEADER
*gDebugImageTableHeader
= NULL
;
20 ExceptionHandlersStart (
25 ExceptionHandlersEnd (
30 CommonExceptionEntry (
35 AsmCommonExceptionEntry (
40 EFI_EXCEPTION_CALLBACK gExceptionHandlers
[MAX_ARM_EXCEPTION
+ 1];
41 EFI_EXCEPTION_CALLBACK gDebuggerExceptionHandlers
[MAX_ARM_EXCEPTION
+ 1];
46 This function registers and enables the handler specified by InterruptHandler for a processor
47 interrupt or exception type specified by InterruptType. If InterruptHandler is NULL, then the
48 handler for the processor interrupt or exception type specified by InterruptType is uninstalled.
49 The installed handler is called once for each processor interrupt or exception.
51 @param InterruptType A pointer to the processor's current interrupt state. Set to TRUE if interrupts
52 are enabled and FALSE if interrupts are disabled.
53 @param InterruptHandler A pointer to a function of type EFI_CPU_INTERRUPT_HANDLER that is called
54 when a processor interrupt occurs. If this parameter is NULL, then the handler
57 @retval EFI_SUCCESS The handler for the processor interrupt was successfully installed or uninstalled.
58 @retval EFI_ALREADY_STARTED InterruptHandler is not NULL, and a handler for InterruptType was
60 @retval EFI_INVALID_PARAMETER InterruptHandler is NULL, and a handler for InterruptType was not
62 @retval EFI_UNSUPPORTED The interrupt specified by InterruptType is not supported.
66 RegisterInterruptHandler (
67 IN EFI_EXCEPTION_TYPE InterruptType
,
68 IN EFI_CPU_INTERRUPT_HANDLER InterruptHandler
71 if (InterruptType
> MAX_ARM_EXCEPTION
) {
72 return EFI_UNSUPPORTED
;
75 if ((InterruptHandler
!= NULL
) && (gExceptionHandlers
[InterruptType
] != NULL
)) {
76 return EFI_ALREADY_STARTED
;
79 gExceptionHandlers
[InterruptType
] = InterruptHandler
;
86 This function registers and enables the handler specified by InterruptHandler for a processor
87 interrupt or exception type specified by InterruptType. If InterruptHandler is NULL, then the
88 handler for the processor interrupt or exception type specified by InterruptType is uninstalled.
89 The installed handler is called once for each processor interrupt or exception.
91 @param InterruptType A pointer to the processor's current interrupt state. Set to TRUE if interrupts
92 are enabled and FALSE if interrupts are disabled.
93 @param InterruptHandler A pointer to a function of type EFI_CPU_INTERRUPT_HANDLER that is called
94 when a processor interrupt occurs. If this parameter is NULL, then the handler
97 @retval EFI_SUCCESS The handler for the processor interrupt was successfully installed or uninstalled.
98 @retval EFI_ALREADY_STARTED InterruptHandler is not NULL, and a handler for InterruptType was
100 @retval EFI_INVALID_PARAMETER InterruptHandler is NULL, and a handler for InterruptType was not
101 previously installed.
102 @retval EFI_UNSUPPORTED The interrupt specified by InterruptType is not supported.
106 RegisterDebuggerInterruptHandler (
107 IN EFI_EXCEPTION_TYPE InterruptType
,
108 IN EFI_CPU_INTERRUPT_HANDLER InterruptHandler
111 if (InterruptType
> MAX_ARM_EXCEPTION
) {
112 return EFI_UNSUPPORTED
;
115 if ((InterruptHandler
!= NULL
) && (gDebuggerExceptionHandlers
[InterruptType
] != NULL
)) {
116 return EFI_ALREADY_STARTED
;
119 gDebuggerExceptionHandlers
[InterruptType
] = InterruptHandler
;
127 PeCoffGetSizeOfHeaders (
131 EFI_IMAGE_DOS_HEADER
*DosHdr
;
132 EFI_IMAGE_OPTIONAL_HEADER_PTR_UNION Hdr
;
135 DosHdr
= (EFI_IMAGE_DOS_HEADER
*)Pe32Data
;
136 if (DosHdr
->e_magic
== EFI_IMAGE_DOS_SIGNATURE
) {
138 // DOS image header is present, so read the PE header after the DOS image header.
140 Hdr
.Pe32
= (EFI_IMAGE_NT_HEADERS32
*)((UINTN
) Pe32Data
+ (UINTN
) ((DosHdr
->e_lfanew
) & 0x0ffff));
143 // DOS image header is not present, so PE header is at the image base.
145 Hdr
.Pe32
= (EFI_IMAGE_NT_HEADERS32
*)Pe32Data
;
148 if (Hdr
.Te
->Signature
== EFI_TE_IMAGE_HEADER_SIGNATURE
) {
149 SizeOfHeaders
= sizeof (EFI_TE_IMAGE_HEADER
) + (UINTN
)Hdr
.Te
->BaseOfCode
- (UINTN
)Hdr
.Te
->StrippedSize
;
150 } else if (Hdr
.Pe32
->Signature
== EFI_IMAGE_NT_SIGNATURE
) {
151 SizeOfHeaders
= Hdr
.Pe32
->OptionalHeader
.SizeOfHeaders
;
156 return SizeOfHeaders
;
162 IN UINT32 FaultAddress
,
163 OUT UINT32
*ImageBase
,
164 OUT UINT32
*PeCoffSizeOfHeaders
167 EFI_DEBUG_IMAGE_INFO
*DebugTable
;
172 DebugTable
= gDebugImageTableHeader
->EfiDebugImageInfoTable
;
173 if (DebugTable
== NULL
) {
177 Address
= (CHAR8
*)(UINTN
)FaultAddress
;
178 for (Entry
= 0; Entry
< gDebugImageTableHeader
->TableSize
; Entry
++, DebugTable
++) {
179 if (DebugTable
->NormalImage
!= NULL
) {
180 if ((DebugTable
->NormalImage
->ImageInfoType
== EFI_DEBUG_IMAGE_INFO_TYPE_NORMAL
) &&
181 (DebugTable
->NormalImage
->LoadedImageProtocolInstance
!= NULL
)) {
182 if ((Address
>= (CHAR8
*)DebugTable
->NormalImage
->LoadedImageProtocolInstance
->ImageBase
) &&
183 (Address
<= ((CHAR8
*)DebugTable
->NormalImage
->LoadedImageProtocolInstance
->ImageBase
+ DebugTable
->NormalImage
->LoadedImageProtocolInstance
->ImageSize
))) {
184 *ImageBase
= (UINT32
)DebugTable
->NormalImage
->LoadedImageProtocolInstance
->ImageBase
;
185 *PeCoffSizeOfHeaders
= PeCoffGetSizeOfHeaders ((VOID
*)(UINTN
)*ImageBase
);
186 return PeCoffLoaderGetPdbPointer (DebugTable
->NormalImage
->LoadedImageProtocolInstance
->ImageBase
);
196 CHAR8
*gExceptionTypeString
[] = {
198 "Undefined Instruction",
209 CommonCExceptionHandler (
210 IN EFI_EXCEPTION_TYPE ExceptionType
,
211 IN OUT EFI_SYSTEM_CONTEXT SystemContext
214 BOOLEAN Dispatched
= FALSE
;
217 if (ExceptionType
<= MAX_ARM_EXCEPTION
) {
218 if (gDebuggerExceptionHandlers
[ExceptionType
]) {
220 // If DebugSupport hooked the interrupt call the handler. This does not disable
221 // the normal handler.
223 gDebuggerExceptionHandlers
[ExceptionType
] (ExceptionType
, SystemContext
);
226 if (gExceptionHandlers
[ExceptionType
]) {
227 gExceptionHandlers
[ExceptionType
] (ExceptionType
, SystemContext
);
231 DEBUG ((EFI_D_ERROR
, "Unknown exception type %d from %08x\n", ExceptionType
, SystemContext
.SystemContextArm
->PC
));
237 // We did work so this was an expected ExceptionType
242 if (ExceptionType
== EXCEPT_ARM_SOFTWARE_INTERRUPT
) {
244 // ARM JTAG debuggers some times use this vector, so it is not an error to get one
250 // Code after here is the default exception handler... Dump the context
252 DEBUG ((EFI_D_ERROR
, "\n%a Exception from instruction at 0x%08x CPSR 0x%08x\n", gExceptionTypeString
[ExceptionType
], SystemContext
.SystemContextArm
->PC
, SystemContext
.SystemContextArm
->CPSR
));
256 UINT32 PeCoffSizeOfHeader
;
259 Pdb
= GetImageName (SystemContext
.SystemContextArm
->PC
, &ImageBase
, &PeCoffSizeOfHeader
);
260 Offset
= SystemContext
.SystemContextArm
->PC
- ImageBase
;
262 DEBUG ((EFI_D_ERROR
, "%a\n", Pdb
));
265 // A PE/COFF image loads its headers into memory so the headers are
266 // included in the linked addressess. ELF and Mach-O images do not
267 // include the headers so the first byte of the image is usually
268 // text (code). If you look at link maps from ELF or Mach-O images
269 // you need to subtact out the size of the PE/COFF header to get
270 // get the offset that matches the link map.
272 DEBUG ((EFI_D_ERROR
, "loadded at 0x%08x (PE/COFF offset) 0x%08x (ELF or Mach-O offset) 0x%08x\n", ImageBase
, Offset
, Offset
- PeCoffSizeOfHeader
));
275 DEBUG ((EFI_D_ERROR
, " R0 0x%08x R1 0x%08x R2 0x%08x R3 0x%08x\n", SystemContext
.SystemContextArm
->R0
, SystemContext
.SystemContextArm
->R1
, SystemContext
.SystemContextArm
->R2
, SystemContext
.SystemContextArm
->R3
));
276 DEBUG ((EFI_D_ERROR
, " R4 0x%08x R5 0x%08x R6 0x%08x R7 0x%08x\n", SystemContext
.SystemContextArm
->R4
, SystemContext
.SystemContextArm
->R5
, SystemContext
.SystemContextArm
->R6
, SystemContext
.SystemContextArm
->R7
));
277 DEBUG ((EFI_D_ERROR
, " R8 0x%08x R9 0x%08x R10 0x%08x R11 0x%08x\n", SystemContext
.SystemContextArm
->R8
, SystemContext
.SystemContextArm
->R9
, SystemContext
.SystemContextArm
->R10
, SystemContext
.SystemContextArm
->R11
));
278 DEBUG ((EFI_D_ERROR
, "R12 0x%08x SP 0x%08x LR 0x%08x PC 0x%08x\n", SystemContext
.SystemContextArm
->R12
, SystemContext
.SystemContextArm
->SP
, SystemContext
.SystemContextArm
->LR
, SystemContext
.SystemContextArm
->PC
));
279 DEBUG ((EFI_D_ERROR
, "DFSR 0x%08x DFAR 0x%08x IFSR 0x%08x IFAR 0x%08x\n\n", SystemContext
.SystemContextArm
->DFSR
, SystemContext
.SystemContextArm
->DFAR
, SystemContext
.SystemContextArm
->IFSR
, SystemContext
.SystemContextArm
->IFAR
));
290 InitializeExceptions (
291 IN EFI_CPU_ARCH_PROTOCOL
*Cpu
299 EFI_PHYSICAL_ADDRESS Base
;
301 Status
= EfiGetSystemConfigurationTable (&gEfiDebugImageInfoTableGuid
, (VOID
**)&gDebugImageTableHeader
);
302 if (EFI_ERROR (Status
)) {
303 gDebugImageTableHeader
= NULL
;
307 // Disable interrupts
309 Cpu
->GetInterruptState (Cpu
, &Enabled
);
310 Cpu
->DisableInterrupt (Cpu
);
313 // Initialize the C entry points for interrupts
315 for (Index
= 0; Index
<= MAX_ARM_EXCEPTION
; Index
++) {
316 Status
= RegisterInterruptHandler (Index
, NULL
);
317 ASSERT_EFI_ERROR (Status
);
319 Status
= RegisterDebuggerInterruptHandler (Index
, NULL
);
320 ASSERT_EFI_ERROR (Status
);
324 // Copy an implementation of the ARM exception vectors to PcdCpuVectorBaseAddress.
326 Length
= (UINTN
)ExceptionHandlersEnd
- (UINTN
)ExceptionHandlersStart
;
329 // Reserve space for the exception handlers
331 Base
= (EFI_PHYSICAL_ADDRESS
)PcdGet32 (PcdCpuVectorBaseAddress
);
332 Status
= gBS
->AllocatePages (AllocateAddress
, EfiBootServicesCode
, EFI_SIZE_TO_PAGES (Length
), &Base
);
333 // If the request was for memory that's not in the memory map (which is often the case for 0x00000000
334 // on embedded systems, for example, we don't want to hang up. So we'll check here for a status of
335 // EFI_NOT_FOUND, and continue in that case.
336 if (EFI_ERROR(Status
) && (Status
!= EFI_NOT_FOUND
)) {
337 ASSERT_EFI_ERROR (Status
);
340 CopyMem ((VOID
*)(UINTN
)PcdGet32 (PcdCpuVectorBaseAddress
), (VOID
*)ExceptionHandlersStart
, Length
);
343 // Patch in the common Assembly exception handler
345 Offset
= (UINTN
)CommonExceptionEntry
- (UINTN
)ExceptionHandlersStart
;
346 *(UINTN
*) ((UINT8
*)(UINTN
)PcdGet32 (PcdCpuVectorBaseAddress
) + Offset
) = (UINTN
)AsmCommonExceptionEntry
;
348 // Flush Caches since we updated executable stuff
349 InvalidateInstructionCacheRange ((VOID
*)PcdGet32(PcdCpuVectorBaseAddress
), Length
);
353 // Restore interrupt state
355 Status
= Cpu
->EnableInterrupt (Cpu
);