/* * File: exceptions.c * Purpose: Generic exception handling for ColdFire processors * */ #include "derivative.h" #include "exceptions.h" #include "startcf.h" /***********************************************************************/ /* * Set NO_PRINTF to 0 in order the exceptions.c interrupt handler * to output messages to the standard io. * */ #define NO_PRINTF 1 #if NO_PRINTF #define VECTORDISPLAY(MESSAGE) asm { nop; }; #define VECTORDISPLAY2(MESSAGE,MESSAGE2) asm { nop; }; #define VECTORDISPLAY3(MESSAGE,MESSAGE2,MESSAGE3) asm { nop; }; #else #include #define VECTORDISPLAY(MESSAGE1) printf(MESSAGE1); #define VECTORDISPLAY2(MESSAGE1,MESSAGE2) printf(MESSAGE1,MESSAGE2); #define VECTORDISPLAY3(MESSAGE1,MESSAGE2,MESSAGE3) printf(MESSAGE1,MESSAGE2,MESSAGE3); #endif #ifdef __cplusplus extern "C" { #endif extern unsigned long far _SP_INIT[]; /***********************************************************************/ /* * Handling of the TRK ColdFire libs (printf support in Debugger Terminal) * * To enable this support: * - Set CONSOLE_IO_SUPPORT 1 in this file; this will enable * TrapHandler_printf for the trap #14 exception. * * - Make sure the file console_io_cf.c is in your project. * * - In the debugger make sure that in the Connection "Setup" dialog, * "Debug Options" property page, the check box * "Enable Terminal printf support" is set. * * * */ #ifndef CONSOLE_IO_SUPPORT #define CONSOLE_IO_SUPPORT 0 #endif #if CONSOLE_IO_SUPPORT == 1 asm __declspec(register_abi) void TrapHandler_printf(void) { HALT RTE } #endif /***********************************************************************/ /* * This is the handler for all exceptions which are not common to all * ColdFire Chips. * * Called by mcf_exception_handler * */ void derivative_interrupt(unsigned long vector) { if (vector < 64 || vector > 192) { VECTORDISPLAY2("User Defined Vector #%d\n",vector); } } /*********************************************************************** * * This is the exception handler for all exceptions common to all * chips ColdFire. Most exceptions do nothing, but some of the more * important ones are handled to some extent. * * Called by asm_exception_handler * * The ColdFire family of processors has a simplified exception stack * frame that looks like the following: * * 3322222222221111 111111 * 1098765432109876 5432109876543210 * 8 +----------------+----------------+ * | Program Counter | * 4 +----------------+----------------+ * |FS/Fmt/Vector/FS| SR | * SP --> 0 +----------------+----------------+ * * The stack self-aligns to a 4-byte boundary at an exception, with * the FS/Fmt/Vector/FS field indicating the size of the adjustment * (SP += 0,1,2,3 bytes). * 31 28 27 26 25 18 17 16 15 0 * 4 +---------------------------------------+------------------------------------+ * | Format | FS[3..2] | Vector | FS[1..0] | SR | * SP --> 0 +---------------------------------------+------------------------------------+ */ #define MCF5XXX_RD_SF_FORMAT(PTR) \ ((*((unsigned short *)(PTR)) >> 12) & 0x00FF) #define MCF5XXX_RD_SF_VECTOR(PTR) \ ((*((unsigned short *)(PTR)) >> 2) & 0x00FF) #define MCF5XXX_RD_SF_FS(PTR) \ ( ((*((unsigned short *)(PTR)) & 0x0C00) >> 8) | (*((unsigned short *)(PTR)) & 0x0003) ) #define MCF5XXX_SF_SR(PTR) *(((unsigned short *)(PTR))+1) #define MCF5XXX_SF_PC(PTR) *((unsigned long *)(PTR)+1) #define MCF5XXX_EXCEPTFMT "%s -- PC = %#08X\n" void mcf_exception_handler(void *framepointer) { volatile unsigned long exceptionStackFrame = (*(unsigned long *)(framepointer)); volatile unsigned short stackFrameSR = MCF5XXX_SF_SR(framepointer); volatile unsigned short stackFrameWord = (*(unsigned short *)(framepointer)); volatile unsigned long stackFrameFormat = (unsigned long)MCF5XXX_RD_SF_FORMAT(&stackFrameWord); volatile unsigned long stackFrameFS = (unsigned long)MCF5XXX_RD_SF_FS(&stackFrameWord); volatile unsigned long stackFrameVector = (unsigned long)MCF5XXX_RD_SF_VECTOR(&stackFrameWord); volatile unsigned long stackFramePC = MCF5XXX_SF_PC(framepointer); switch (stackFrameFormat) { case 4: case 5: case 6: case 7: break; default: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT,"Illegal stack type", stackFramePC); break; } switch (stackFrameVector) { case 2: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Access Error", stackFramePC); switch (stackFrameFS) { case 4: VECTORDISPLAY("Error on instruction fetch\n"); break; case 8: VECTORDISPLAY("Error on operand write\n"); break; case 9: VECTORDISPLAY("Attempted write to write-protected space\n"); break; case 12: VECTORDISPLAY("Error on operand read\n"); break; default: VECTORDISPLAY("Reserved Fault Status Encoding\n"); break; } break; case 3: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Address Error", stackFramePC); switch (stackFrameFS) { case 4: VECTORDISPLAY("Error on instruction fetch\n"); break; case 8: VECTORDISPLAY("Error on operand write\n"); break; case 9: VECTORDISPLAY("Attempted write to write-protected space\n"); break; case 12: VECTORDISPLAY("Error on operand read\n"); break; default: VECTORDISPLAY("Reserved Fault Status Encoding\n"); break; } break; case 4: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Illegal instruction", stackFramePC); break; case 8: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Privilege violation", stackFramePC); break; case 9: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Trace Exception", stackFramePC); break; case 10: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Unimplemented A-Line Instruction", stackFramePC); break; case 11: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Unimplemented F-Line Instruction", stackFramePC); break; case 12: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Debug Interrupt", stackFramePC); break; case 14: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Format Error", stackFramePC); break; case 15: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Unitialized Interrupt", stackFramePC); break; case 24: VECTORDISPLAY3(MCF5XXX_EXCEPTFMT, "Spurious Interrupt", stackFramePC); break; case 25: case 26: case 27: case 28: case 29: case 30: case 31: VECTORDISPLAY2("Autovector interrupt level %d\n", stackFrameVector - 24); break; case 32: case 33: case 34: case 35: case 36: case 37: case 38: case 39: case 40: case 41: case 42: case 43: case 44: case 45: case 46: case 47: VECTORDISPLAY2("TRAP #%d\n", stackFrameVector - 32); break; case 5: case 6: case 7: case 13: case 16: case 17: case 18: case 19: case 20: case 21: case 22: case 23: case 48: case 49: case 50: case 51: case 52: case 53: case 54: case 55: case 56: case 57: case 58: case 59: case 60: case 61: case 62: case 63: VECTORDISPLAY2("Reserved: #%d\n", stackFrameVector); break; default: derivative_interrupt(stackFrameVector); break; } } asm __declspec(register_abi) void asm_exception_handler(void) { link a6,#0 lea -20(sp), sp movem.l d0-d2/a0-a1, (sp) lea 24(sp),a0 /* A0 point to exception stack frame on the stack */ jsr mcf_exception_handler movem.l (sp), d0-d2/a0-a1 lea 20(sp), sp unlk a6 rte } typedef void (* vectorTableEntryType)(void); /* * MCF51JF32 vector table * CF V1 has 114 vector + SP_INIT in the vector table (115 entries) */ __declspec(weak) vectorTableEntryType vector_0 @(GetIntVectAddr(INITSP)) = (vectorTableEntryType)&_SP_INIT; __declspec(weak) vectorTableEntryType vector_1 @(GetIntVectAddr(INITPC)) = (vectorTableEntryType)&_startup; __declspec(weak) vectorTableEntryType vector_2 @(GetIntVectAddr(Vaccerr)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_3 @(GetIntVectAddr(Vadderr)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_4 @(GetIntVectAddr(Viinstr)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_5 @(GetIntVectAddr(Vdiv_by_zero)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_6 @(GetIntVectAddr(VReserved6)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_7 @(GetIntVectAddr(VReserved7)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_8 @(GetIntVectAddr(Vprviol)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_9 @(GetIntVectAddr(Vtrace)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_10 @(GetIntVectAddr(Vunilaop)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_11 @(GetIntVectAddr(Vunilfop)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_12 @(GetIntVectAddr(Vdbgi)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_13 @(GetIntVectAddr(VReserved13)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_14 @(GetIntVectAddr(Vferror)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_15 @(GetIntVectAddr(VReserved15)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_16 @(GetIntVectAddr(VReserved16)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_17 @(GetIntVectAddr(VReserved17)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_18 @(GetIntVectAddr(VReserved18)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_19 @(GetIntVectAddr(VReserved19)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_20 @(GetIntVectAddr(VReserved20)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_21 @(GetIntVectAddr(VReserved21)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_22 @(GetIntVectAddr(VReserved22)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_23 @(GetIntVectAddr(VReserved23)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_24 @(GetIntVectAddr(Vspuri)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_25 @(GetIntVectAddr(VReserved25)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_26 @(GetIntVectAddr(VReserved26)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_27 @(GetIntVectAddr(VReserved27)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_28 @(GetIntVectAddr(VReserved28)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_29 @(GetIntVectAddr(VReserved29)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_30 @(GetIntVectAddr(VReserved30)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_31 @(GetIntVectAddr(VReserved31)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_32 @(GetIntVectAddr(Vtrap0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_33 @(GetIntVectAddr(Vtrap1)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_34 @(GetIntVectAddr(Vtrap2)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_35 @(GetIntVectAddr(Vtrap3)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_36 @(GetIntVectAddr(Vtrap4)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_37 @(GetIntVectAddr(Vtrap5)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_38 @(GetIntVectAddr(Vtrap6)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_39 @(GetIntVectAddr(Vtrap7)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_40 @(GetIntVectAddr(Vtrap8)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_41 @(GetIntVectAddr(Vtrap9)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_42 @(GetIntVectAddr(Vtrap10)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_43 @(GetIntVectAddr(Vtrap11)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_44 @(GetIntVectAddr(Vtrap12)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_45 @(GetIntVectAddr(Vtrap13)) = asm_exception_handler; #if CONSOLE_IO_SUPPORT == 1 __declspec(weak) vectorTableEntryType vector_46 @(GetIntVectAddr(Vtrap14)) = TrapHandler_printf; #else __declspec(weak) vectorTableEntryType vector_46 @(GetIntVectAddr(Vtrap14)) = asm_exception_handler; #endif __declspec(weak) vectorTableEntryType vector_47 @(GetIntVectAddr(Vtrap15)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_48 @(GetIntVectAddr(VReserved48)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_49 @(GetIntVectAddr(VReserved49)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_50 @(GetIntVectAddr(VReserved50)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_51 @(GetIntVectAddr(VReserved51)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_52 @(GetIntVectAddr(VReserved52)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_53 @(GetIntVectAddr(VReserved53)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_54 @(GetIntVectAddr(VReserved54)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_55 @(GetIntVectAddr(VReserved55)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_56 @(GetIntVectAddr(VReserved56)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_57 @(GetIntVectAddr(VReserved57)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_58 @(GetIntVectAddr(VReserved58)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_59 @(GetIntVectAddr(VReserved59)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_60 @(GetIntVectAddr(VReserved60)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_61 @(GetIntVectAddr(Vunsinstr)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_62 @(GetIntVectAddr(VReserved62)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_63 @(GetIntVectAddr(VReserved63)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_64 @(GetIntVectAddr(Virq)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_65 @(GetIntVectAddr(Vlvd)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_66 @(GetIntVectAddr(Vllwu)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_67 @(GetIntVectAddr(Vlol)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_68 @(GetIntVectAddr(Vflash)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_69 @(GetIntVectAddr(Vdmach0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_70 @(GetIntVectAddr(Vdmach1)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_71 @(GetIntVectAddr(Vdmach2)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_72 @(GetIntVectAddr(Vdmach3)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_73 @(GetIntVectAddr(Vusb0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_74 @(GetIntVectAddr(Vrngb)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_75 @(GetIntVectAddr(Vftm1fault_ovf)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_76 @(GetIntVectAddr(Vftm1ch0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_77 @(GetIntVectAddr(Vftm1ch1)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_78 @(GetIntVectAddr(Vftm1ch2)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_79 @(GetIntVectAddr(Vftm1ch3)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_80 @(GetIntVectAddr(Vftm1ch4)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_81 @(GetIntVectAddr(Vftm1ch5)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_82 @(GetIntVectAddr(Vcmp0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_83 @(GetIntVectAddr(Vftm0fault_ovf)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_84 @(GetIntVectAddr(Vftm0ch0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_85 @(GetIntVectAddr(Vftm0ch1)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_86 @(GetIntVectAddr(Vspi0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_87 @(GetIntVectAddr(Vsci0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_88 @(GetIntVectAddr(Vsai_rx)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_89 @(GetIntVectAddr(Vsai_tx)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_90 @(GetIntVectAddr(Viic0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_91 @(GetIntVectAddr(Viic2)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_92 @(GetIntVectAddr(Vspi1)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_93 @(GetIntVectAddr(Vsci1)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_94 @(GetIntVectAddr(Viic1)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_95 @(GetIntVectAddr(Viic3)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_96 @(GetIntVectAddr(Vadc0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_97 @(GetIntVectAddr(Vtsi0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_98 @(GetIntVectAddr(Vdac0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_99 @(GetIntVectAddr(Vcmt)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_100 @(GetIntVectAddr(Vpdb0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_101 @(GetIntVectAddr(Vlptmr0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_102 @(GetIntVectAddr(Vlptmr1)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_103 @(GetIntVectAddr(VL7swi)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_104 @(GetIntVectAddr(VL6swi)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_105 @(GetIntVectAddr(VL5swi)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_106 @(GetIntVectAddr(VL4swi)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_107 @(GetIntVectAddr(VL3swi)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_108 @(GetIntVectAddr(VL2swi)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_109 @(GetIntVectAddr(VL1swi)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_110 @(GetIntVectAddr(Vmtim0)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_111 @(GetIntVectAddr(Vusbdcd)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_112 @(GetIntVectAddr(Vportab)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_113 @(GetIntVectAddr(Vportdc)) = asm_exception_handler; __declspec(weak) vectorTableEntryType vector_114 @(GetIntVectAddr(Vportfe)) = asm_exception_handler; #ifdef __cplusplus } #endif