]>
Commit | Line | Data |
---|---|---|
1 | /** @file\r | |
2 | Default exception handler\r | |
3 | \r | |
4 | Copyright (c) 2008 - 2010, Apple Inc. All rights reserved.<BR>\r | |
5 | Copyright (c) 2012, ARM Ltd. All rights reserved.<BR>\r | |
6 | \r | |
7 | This program and the accompanying materials\r | |
8 | are licensed and made available under the terms and conditions of the BSD License\r | |
9 | which accompanies this distribution. The full text of the license may be found at\r | |
10 | http://opensource.org/licenses/bsd-license.php\r | |
11 | \r | |
12 | THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r | |
13 | WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r | |
14 | \r | |
15 | **/\r | |
16 | \r | |
17 | #include <Uefi.h>\r | |
18 | #include <Library/BaseLib.h>\r | |
19 | #include <Library/DebugLib.h>\r | |
20 | #include <Library/PeCoffGetEntryPointLib.h>\r | |
21 | #include <Library/PrintLib.h>\r | |
22 | #include <Library/ArmDisassemblerLib.h>\r | |
23 | #include <Library/SerialPortLib.h>\r | |
24 | \r | |
25 | #include <Guid/DebugImageInfoTable.h>\r | |
26 | \r | |
27 | #include <Protocol/DebugSupport.h>\r | |
28 | #include <Library/DefaultExceptionHandlerLib.h>\r | |
29 | \r | |
30 | typedef struct {\r | |
31 | UINT32 BIT;\r | |
32 | CHAR8 Char;\r | |
33 | } CPSR_CHAR;\r | |
34 | \r | |
35 | CHAR8 *\r | |
36 | GetImageName (\r | |
37 | IN UINTN FaultAddress,\r | |
38 | OUT UINTN *ImageBase,\r | |
39 | OUT UINTN *PeCoffSizeOfHeaders\r | |
40 | );\r | |
41 | \r | |
42 | /**\r | |
43 | Convert the Current Program Status Register (CPSR) to a string. The string is\r | |
44 | a defacto standard in the ARM world.\r | |
45 | \r | |
46 | It is possible to add extra bits by adding them to CpsrChar array.\r | |
47 | \r | |
48 | @param Cpsr ARM CPSR register value\r | |
49 | @param ReturnStr 32 byte string that contains string version of CPSR\r | |
50 | \r | |
51 | **/\r | |
52 | VOID\r | |
53 | CpsrString (\r | |
54 | IN UINT32 Cpsr,\r | |
55 | OUT CHAR8 *ReturnStr\r | |
56 | )\r | |
57 | {\r | |
58 | UINTN Index;\r | |
59 | CHAR8* Str;\r | |
60 | CHAR8* ModeStr;\r | |
61 | CPSR_CHAR CpsrChar[] = {\r | |
62 | { 31, 'n' },\r | |
63 | { 30, 'z' },\r | |
64 | { 29, 'c' },\r | |
65 | { 28, 'v' },\r | |
66 | \r | |
67 | { 9, 'e' },\r | |
68 | { 8, 'a' },\r | |
69 | { 7, 'i' },\r | |
70 | { 6, 'f' },\r | |
71 | { 5, 't' },\r | |
72 | { 0, '?' }\r | |
73 | };\r | |
74 | \r | |
75 | Str = ReturnStr;\r | |
76 | \r | |
77 | for (Index = 0; CpsrChar[Index].BIT != 0; Index++, Str++) {\r | |
78 | *Str = CpsrChar[Index].Char;\r | |
79 | if ((Cpsr & (1 << CpsrChar[Index].BIT)) != 0) {\r | |
80 | // Concert to upper case if bit is set\r | |
81 | *Str &= ~0x20;\r | |
82 | }\r | |
83 | }\r | |
84 | \r | |
85 | *Str++ = '_';\r | |
86 | *Str = '\0';\r | |
87 | \r | |
88 | switch (Cpsr & 0x1f) {\r | |
89 | case 0x10:\r | |
90 | ModeStr = "usr";\r | |
91 | break;\r | |
92 | case 0x011:\r | |
93 | ModeStr = "fiq";\r | |
94 | break;\r | |
95 | case 0x12:\r | |
96 | ModeStr = "irq";\r | |
97 | break;\r | |
98 | case 0x13:\r | |
99 | ModeStr = "svc";\r | |
100 | break;\r | |
101 | case 0x16:\r | |
102 | ModeStr = "mon";\r | |
103 | break;\r | |
104 | case 0x17:\r | |
105 | ModeStr = "abt";\r | |
106 | break;\r | |
107 | case 0x1b:\r | |
108 | ModeStr = "und";\r | |
109 | break;\r | |
110 | case 0x1f:\r | |
111 | ModeStr = "sys";\r | |
112 | break;\r | |
113 | \r | |
114 | default:\r | |
115 | ModeStr = "???";\r | |
116 | break;\r | |
117 | }\r | |
118 | \r | |
119 | AsciiStrCat (Str, ModeStr);\r | |
120 | return;\r | |
121 | }\r | |
122 | \r | |
123 | CHAR8 *\r | |
124 | FaultStatusToString (\r | |
125 | IN UINT32 Status\r | |
126 | )\r | |
127 | {\r | |
128 | CHAR8 *FaultSource;\r | |
129 | \r | |
130 | switch (Status) {\r | |
131 | case 0x01: FaultSource = "Alignment fault"; break;\r | |
132 | case 0x02: FaultSource = "Debug event fault"; break;\r | |
133 | case 0x03: FaultSource = "Access Flag fault on Section"; break;\r | |
134 | case 0x04: FaultSource = "Cache maintenance operation fault[2]"; break;\r | |
135 | case 0x05: FaultSource = "Translation fault on Section"; break;\r | |
136 | case 0x06: FaultSource = "Access Flag fault on Page"; break;\r | |
137 | case 0x07: FaultSource = "Translation fault on Page"; break;\r | |
138 | case 0x08: FaultSource = "Precise External Abort"; break;\r | |
139 | case 0x09: FaultSource = "Domain fault on Section"; break;\r | |
140 | case 0x0b: FaultSource = "Domain fault on Page"; break;\r | |
141 | case 0x0c: FaultSource = "External abort on translation, first level"; break;\r | |
142 | case 0x0d: FaultSource = "Permission fault on Section"; break;\r | |
143 | case 0x0e: FaultSource = "External abort on translation, second level"; break;\r | |
144 | case 0x0f: FaultSource = "Permission fault on Page"; break;\r | |
145 | case 0x16: FaultSource = "Imprecise External Abort"; break;\r | |
146 | default: FaultSource = "No function"; break;\r | |
147 | }\r | |
148 | \r | |
149 | return FaultSource;\r | |
150 | }\r | |
151 | \r | |
152 | STATIC CHAR8 *gExceptionTypeString[] = {\r | |
153 | "Reset",\r | |
154 | "Undefined OpCode",\r | |
155 | "SVC",\r | |
156 | "Prefetch Abort",\r | |
157 | "Data Abort",\r | |
158 | "Undefined",\r | |
159 | "IRQ",\r | |
160 | "FIQ"\r | |
161 | };\r | |
162 | \r | |
163 | /**\r | |
164 | This is the default action to take on an unexpected exception\r | |
165 | \r | |
166 | Since this is exception context don't do anything crazy like try to allcoate memory.\r | |
167 | \r | |
168 | @param ExceptionType Type of the exception\r | |
169 | @param SystemContext Register state at the time of the Exception\r | |
170 | \r | |
171 | \r | |
172 | **/\r | |
173 | VOID\r | |
174 | DefaultExceptionHandler (\r | |
175 | IN EFI_EXCEPTION_TYPE ExceptionType,\r | |
176 | IN OUT EFI_SYSTEM_CONTEXT SystemContext\r | |
177 | )\r | |
178 | {\r | |
179 | CHAR8 Buffer[100];\r | |
180 | UINTN CharCount;\r | |
181 | UINT32 DfsrStatus;\r | |
182 | UINT32 IfsrStatus;\r | |
183 | BOOLEAN DfsrWrite;\r | |
184 | UINT32 PcAdjust = 0;\r | |
185 | \r | |
186 | CharCount = AsciiSPrint (Buffer,sizeof (Buffer),"\n%a Exception PC at 0x%08x CPSR 0x%08x ",\r | |
187 | gExceptionTypeString[ExceptionType], SystemContext.SystemContextArm->PC, SystemContext.SystemContextArm->CPSR);\r | |
188 | SerialPortWrite ((UINT8 *) Buffer, CharCount);\r | |
189 | \r | |
190 | DEBUG_CODE_BEGIN ();\r | |
191 | CHAR8 *Pdb;\r | |
192 | UINT32 ImageBase;\r | |
193 | UINT32 PeCoffSizeOfHeader;\r | |
194 | UINT32 Offset;\r | |
195 | CHAR8 CpsrStr[32]; // char per bit. Lower 5-bits are mode that is a 3 char string\r | |
196 | CHAR8 Buffer[80];\r | |
197 | UINT8 *DisAsm;\r | |
198 | UINT32 ItBlock;\r | |
199 | \r | |
200 | CpsrString (SystemContext.SystemContextArm->CPSR, CpsrStr);\r | |
201 | DEBUG ((EFI_D_ERROR, "%a\n", CpsrStr));\r | |
202 | \r | |
203 | Pdb = GetImageName (SystemContext.SystemContextArm->PC, &ImageBase, &PeCoffSizeOfHeader);\r | |
204 | Offset = SystemContext.SystemContextArm->PC - ImageBase;\r | |
205 | if (Pdb != NULL) {\r | |
206 | DEBUG ((EFI_D_ERROR, "%a\n", Pdb));\r | |
207 | \r | |
208 | //\r | |
209 | // A PE/COFF image loads its headers into memory so the headers are\r | |
210 | // included in the linked addresses. ELF and Mach-O images do not\r | |
211 | // include the headers so the first byte of the image is usually\r | |
212 | // text (code). If you look at link maps from ELF or Mach-O images\r | |
213 | // you need to subtract out the size of the PE/COFF header to get\r | |
214 | // get the offset that matches the link map.\r | |
215 | //\r | |
216 | DEBUG ((EFI_D_ERROR, "loaded at 0x%08x (PE/COFF offset) 0x%x (ELF or Mach-O offset) 0x%x", ImageBase, Offset, Offset - PeCoffSizeOfHeader));\r | |
217 | \r | |
218 | // If we come from an image it is safe to show the instruction. We know it should not fault\r | |
219 | DisAsm = (UINT8 *)(UINTN)SystemContext.SystemContextArm->PC;\r | |
220 | ItBlock = 0;\r | |
221 | DisassembleInstruction (&DisAsm, (SystemContext.SystemContextArm->CPSR & BIT5) == BIT5, TRUE, &ItBlock, Buffer, sizeof (Buffer));\r | |
222 | DEBUG ((EFI_D_ERROR, "\n%a", Buffer));\r | |
223 | \r | |
224 | switch (ExceptionType) {\r | |
225 | case EXCEPT_ARM_UNDEFINED_INSTRUCTION:\r | |
226 | case EXCEPT_ARM_SOFTWARE_INTERRUPT:\r | |
227 | case EXCEPT_ARM_PREFETCH_ABORT:\r | |
228 | case EXCEPT_ARM_DATA_ABORT:\r | |
229 | // advance PC past the faulting instruction\r | |
230 | PcAdjust = (UINTN)DisAsm - SystemContext.SystemContextArm->PC;\r | |
231 | break;\r | |
232 | \r | |
233 | default:\r | |
234 | break;\r | |
235 | }\r | |
236 | \r | |
237 | }\r | |
238 | DEBUG_CODE_END ();\r | |
239 | DEBUG ((EFI_D_ERROR, "\n 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));\r | |
240 | 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));\r | |
241 | 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));\r | |
242 | 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));\r | |
243 | DEBUG ((EFI_D_ERROR, "DFSR 0x%08x DFAR 0x%08x IFSR 0x%08x IFAR 0x%08x\n", SystemContext.SystemContextArm->DFSR, SystemContext.SystemContextArm->DFAR, SystemContext.SystemContextArm->IFSR, SystemContext.SystemContextArm->IFAR));\r | |
244 | \r | |
245 | // Bit10 is Status[4] Bit3:0 is Status[3:0]\r | |
246 | DfsrStatus = (SystemContext.SystemContextArm->DFSR & 0xf) | ((SystemContext.SystemContextArm->DFSR >> 6) & 0x10);\r | |
247 | DfsrWrite = (SystemContext.SystemContextArm->DFSR & BIT11) != 0;\r | |
248 | if (DfsrStatus != 0x00) {\r | |
249 | DEBUG ((EFI_D_ERROR, " %a: %a 0x%08x\n", FaultStatusToString (DfsrStatus), DfsrWrite ? "write to" : "read from", SystemContext.SystemContextArm->DFAR));\r | |
250 | }\r | |
251 | \r | |
252 | IfsrStatus = (SystemContext.SystemContextArm->IFSR & 0xf) | ((SystemContext.SystemContextArm->IFSR >> 6) & 0x10);\r | |
253 | if (IfsrStatus != 0) {\r | |
254 | DEBUG ((EFI_D_ERROR, " Instruction %a at 0x%08x\n", FaultStatusToString (SystemContext.SystemContextArm->IFSR & 0xf), SystemContext.SystemContextArm->IFAR));\r | |
255 | }\r | |
256 | \r | |
257 | DEBUG ((EFI_D_ERROR, "\n"));\r | |
258 | ASSERT (FALSE);\r | |
259 | \r | |
260 | // Clear the error registers that we have already displayed incase some one wants to keep going\r | |
261 | SystemContext.SystemContextArm->DFSR = 0;\r | |
262 | SystemContext.SystemContextArm->IFSR = 0;\r | |
263 | \r | |
264 | // If some one is stepping past the exception handler adjust the PC to point to the next instruction\r | |
265 | SystemContext.SystemContextArm->PC += PcAdjust;\r | |
266 | }\r |