Updated ARM Exception handler to print out text values for CPSR register
authorAJFISH <AJFISH@6f19259b-4bc3-4df7-8a09-765794883524>
Fri, 15 Jan 2010 17:30:25 +0000 (17:30 +0000)
committerAJFISH <AJFISH@6f19259b-4bc3-4df7-8a09-765794883524>
Fri, 15 Jan 2010 17:30:25 +0000 (17:30 +0000)
git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@9777 6f19259b-4bc3-4df7-8a09-765794883524

ArmPkg/Drivers/CpuDxe/Exception.c

index 92faaa3..bc67fc4 100644 (file)
@@ -159,7 +159,79 @@ GetImageName (
   return NULL;\r
 }\r
 \r
+typedef struct {\r
+  UINT32  Bit;\r
+  CHAR8   Char;\r
+} CPSR_CHAR;\r
+\r
+CPSR_CHAR gCpsrChar[] = {\r
+  { 31, 'n' },\r
+  { 30, 'z' },\r
+  { 29, 'c' },\r
+  { 28, 'v' },\r
+  { 27, 'q' },\r
+\r
+  { 8, 'a' },\r
+  { 7, 'i' },\r
+  { 6, 'f' },\r
+  { 5, 't' },\r
+  { 0, '?' }\r
+};\r
+\r
 \r
+VOID\r
+CpsrString (\r
+  IN  UINT32  Cpsr,\r
+  OUT CHAR8   *ReturnStr\r
+  )\r
+{\r
+  UINTN Index;\r
+  CHAR8 *Str = ReturnStr;\r
+  CHAR8 *ModeStr;\r
+  \r
+  for (Index = 0; gCpsrChar[Index].Bit != 0; Index++, Str++) {\r
+    *Str = gCpsrChar[Index].Char;\r
+    if ((Cpsr & (1 << gCpsrChar[Index].Bit)) != 0) {\r
+      // Concert to upper case if bit is set\r
+      *Str &= ~0x20;\r
+    }\r
+  }\r
+  \r
+  *Str++ = '_';\r
+  *Str = '\0';\r
+  \r
+  switch (Cpsr & 0x1f) {\r
+  case 0x17:\r
+    ModeStr = "abt";\r
+    break;\r
+  case 0x011:\r
+    ModeStr = "fiq";\r
+    break;\r
+  case 0x12:\r
+    ModeStr = "irq";\r
+    break;\r
+  case 0x13:\r
+    ModeStr = "svc";\r
+    break;\r
+  case 0x1f:\r
+    ModeStr = "sys";\r
+    break;\r
+  case 0x1b:\r
+    ModeStr = "und";\r
+    break;\r
+  case 0x10:\r
+    ModeStr = "usr";\r
+    break;\r
+  \r
+  default:\r
+    ModeStr = "???";\r
+    break;\r
+  }\r
+  \r
+  AsciiStrCat (Str, ModeStr);\r
+  return;\r
+}  \r
+  \r
 CHAR8 *gExceptionTypeString[] = {\r
   "Reset",\r
   "Undefined Instruction",\r
@@ -216,12 +288,16 @@ CommonCExceptionHandler (
   //\r
   // Code after here is the default exception handler... Dump the context\r
   //\r
-  DEBUG ((EFI_D_ERROR, "\n%a Exception from instruction at 0x%08x  CPSR 0x%08x\n", gExceptionTypeString[ExceptionType], SystemContext.SystemContextArm->PC, SystemContext.SystemContextArm->CPSR));\r
+  DEBUG ((EFI_D_ERROR, "\n%a Exception PC at 0x%08x  CPSR 0x%08x ", gExceptionTypeString[ExceptionType], SystemContext.SystemContextArm->PC, SystemContext.SystemContextArm->CPSR));\r
   DEBUG_CODE_BEGIN ();\r
     CHAR8   *Pdb;\r
     UINT32  ImageBase;\r
     UINT32  PeCoffSizeOfHeader;\r
     UINT32  Offset;\r
+    CHAR8   CpsrStr[32];  // char per bit. Lower 5-bits are mode that is a 3 char string\r
+    \r
+    CpsrString (SystemContext.SystemContextArm->CPSR, CpsrStr);\r
+    DEBUG ((EFI_D_ERROR, "%a\n", CpsrStr));\r
   \r
     Pdb = GetImageName (SystemContext.SystemContextArm->PC, &ImageBase, &PeCoffSizeOfHeader);\r
     Offset = SystemContext.SystemContextArm->PC - ImageBase;\r
@@ -236,19 +312,16 @@ CommonCExceptionHandler (
       // you need to subtact out the size of the PE/COFF header to get\r
       // get the offset that matches the link map. \r
       //\r
-      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));\r
+      DEBUG ((EFI_D_ERROR, "loadded at 0x%08x (PE/COFF offset) 0x%x (ELF or Mach-O offset) 0x%x", ImageBase, Offset, Offset - PeCoffSizeOfHeader));\r
     }\r
   DEBUG_CODE_END ();\r
-  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));\r
-  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
-  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
-  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
-  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));\r
+  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
+  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
+  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
+  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
+  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));\r
 \r
   ASSERT (FALSE);\r
-//  while (TRUE) {\r
-//    CpuSleep ();\r
-//  }\r
 }\r
 \r
 \r