Adding slightly better exception handlers.

1 files changed, 50 insertions, 0 deletions

diff --git a/arch/arm/lpc17xx/handlers.c b/arch/arm/lpc17xx/handlers.c
new file mode 100644
index 0000000..444c0c1
--- /dev/null
+++ b/arch/arm/lpc17xx/handlers.c
@@ -0,0 +1,50 @@
+#include <osdebug.h>
+#include "LPC17xx.h"
+
+enum FaultType {
+    NMI, HardFault, MemManage, BusFault, UsageFault,
+};
+
+static inline void traceme() {
+    unsigned int i;
+    void * frame, * pc;
+    
+    i = 0;
+    frame = __builtin_frame_address(i);
+    pc = frame ? __builtin_return_address(i) : 0;
+    DBGOUT("lv%u; PC = %p, frame = %p\r\n", i, pc, frame);
+}
+
+static int general_Handler(enum FaultType fault) {
+    DBGOUT("***FAULT***\r\n");
+    
+    traceme();
+    
+    switch (fault) {
+    case NMI:
+        DBGOUT("NMI\r\n");
+        break;
+    case HardFault:
+        DBGOUT("HardFault\r\nHFSR: %p\r\n", SCB->HFSR);
+        break;
+    case MemManage:
+        DBGOUT("MemManage\r\nCSFR: %p\r\nMMFAR: %p\r\n", SCB->CFSR, SCB->MMFAR);
+        break;
+    case BusFault:
+        DBGOUT("BusFault\r\nCFSR: %p\r\nBFAR: %p\r\n", SCB->CFSR, SCB->BFAR);
+        break;
+    case UsageFault:
+        DBGOUT("UsageFault\r\nCFSR: %p\r\nBFAR: %p\r\n", SCB->CFSR, SCB->BFAR);
+        break;
+    }
+    
+    while(1);
+    
+    return 0;
+}
+
+int NMI_Handler() { return general_Handler(NMI); }
+int HardFault_Handler() { return general_Handler(HardFault); }
+int MemManage_Handler() { return general_Handler(MemManage); }
+int BusFault_Handler() { return general_Handler(BusFault); }
+int UsageFault_Handler() { return general_Handler(UsageFault); }