Merge pull request #345 from Defragster/patch-2

For review - Expose alt weak func(), label displayed dump

teensy4/startup.c

@@ -262,8 +262,128 @@ void reset_PFD()
 //  R2
 //  R1
 //  R0
-__attribute__((weak))
+// Code from :: https://community.nxp.com/thread/389002
+__attribute__((naked))
 void unused_interrupt_vector(void)
+{
+  __asm( ".syntax unified\n"
+         "MOVS R0, #4 \n"
+         "MOV R1, LR \n"
+         "TST R0, R1 \n"
+         "BEQ _MSP \n"
+         "MRS R0, PSP \n"
+         "B HardFault_HandlerC \n"
+         "_MSP: \n"
+         "MRS R0, MSP \n"
+         "B HardFault_HandlerC \n"
+         ".syntax divided\n") ;
+}
+
+__attribute__((weak))
+void HardFault_HandlerC(unsigned int *hardfault_args) {
+  volatile unsigned int stacked_r0 ;
+  volatile unsigned int stacked_r1 ;
+  volatile unsigned int stacked_r2 ;
+  volatile unsigned int stacked_r3 ;
+  volatile unsigned int stacked_r12 ;
+  volatile unsigned int stacked_lr ;
+  volatile unsigned int stacked_pc ;
+  volatile unsigned int stacked_psr ;
+  volatile unsigned int _CFSR ;
+  volatile unsigned int _HFSR ;
+  volatile unsigned int _DFSR ;
+  volatile unsigned int _AFSR ;
+  volatile unsigned int _BFAR ;
+  volatile unsigned int _MMAR ;
+  volatile unsigned int addr ;
+  volatile unsigned int nn ;
+
+  stacked_r0 = ((unsigned int)hardfault_args[0]) ;
+  stacked_r1 = ((unsigned int)hardfault_args[1]) ;
+  stacked_r2 = ((unsigned int)hardfault_args[2]) ;
+  stacked_r3 = ((unsigned int)hardfault_args[3]) ;
+  stacked_r12 = ((unsigned int)hardfault_args[4]) ;
+  stacked_lr = ((unsigned int)hardfault_args[5]) ;
+  stacked_pc = ((unsigned int)hardfault_args[6]) ;
+  stacked_psr = ((unsigned int)hardfault_args[7]) ;
+  // Configurable Fault Status Register
+  // Consists of MMSR, BFSR and UFSR
+  _CFSR = (*((volatile unsigned int *)(0xE000ED28))) ;
+  // Hard Fault Status Register
+  _HFSR = (*((volatile unsigned int *)(0xE000ED2C))) ;
+  // Debug Fault Status Register
+  _DFSR = (*((volatile unsigned int *)(0xE000ED30))) ;
+  // Auxiliary Fault Status Register
+  _AFSR = (*((volatile unsigned int *)(0xE000ED3C))) ;
+  // Read the Fault Address Registers. These may not contain valid values.
+  // Check BFARVALID/MMARVALID to see if they are valid values
+  // MemManage Fault Address Register
+  _MMAR = (*((volatile unsigned int *)(0xE000ED34))) ;
+  // Bus Fault Address Register
+  _BFAR = (*((volatile unsigned int *)(0xE000ED38))) ;
+  //__asm("BKPT #0\n") ; // Break into the debugger // NO Debugger here.
+
+  asm volatile("mrs %0, ipsr\n" : "=r" (addr)::);
+  printf_debug("\nFault irq %d\n", addr & 0x1FF);
+  printf_debug(" stacked_r0 ::  %x\n", stacked_r0);
+  printf_debug(" stacked_r1 ::  %x\n", stacked_r1);
+  printf_debug(" stacked_r2 ::  %x\n", stacked_r2);
+  printf_debug(" stacked_r3 ::  %x\n", stacked_r3);
+  printf_debug(" stacked_r12 ::  %x\n", stacked_r12);
+  printf_debug(" stacked_lr ::  %x\n", stacked_lr);
+  printf_debug(" stacked_pc ::  %x\n", stacked_pc);
+  printf_debug(" stacked_psr ::  %x\n", stacked_psr);
+  printf_debug(" _CFSR ::  %x\n", _CFSR);
+  printf_debug(" _HFSR ::  %x\n", _HFSR);
+  printf_debug(" _DFSR ::  %x\n", _DFSR);
+  printf_debug(" _AFSR ::  %x\n", _AFSR);
+  printf_debug(" _BFAR ::  %x\n", _BFAR);
+  printf_debug(" _MMAR ::  %x\n", _MMAR);
+
+  IOMUXC_SW_MUX_CTL_PAD_GPIO_B0_03 = 5; // pin 13
+  IOMUXC_SW_PAD_CTL_PAD_GPIO_B0_03 = IOMUXC_PAD_DSE(7);
+  GPIO2_GDIR |= (1 << 3);
+  GPIO2_DR_SET = (1 << 3);
+  GPIO2_DR_CLEAR = (1 << 3); //digitalWrite(13, LOW);
+
+  if ( F_CPU_ACTUAL >= 600000000 )
+    set_arm_clock(300000000);
+
+  while (1)
+  {
+    GPIO2_DR_SET = (1 << 3); //digitalWrite(13, HIGH);
+    // digitalWrite(13, HIGH);
+    for (nn = 0; nn < 2000000; nn++) ;
+    GPIO2_DR_CLEAR = (1 << 3); //digitalWrite(13, LOW);
+    // digitalWrite(13, LOW);
+    for (nn = 0; nn < 18000000; nn++) ;
+  }
+}
+
+__attribute__((weak))
+void userDebugDump(){
+	volatile unsigned int nn;
+	printf_debug("\nuserDebugDump() in startup.c ___ \n");
+
+  while (1)
+  {
+    GPIO2_DR_SET = (1 << 3); //digitalWrite(13, HIGH);
+    // digitalWrite(13, HIGH);
+    for (nn = 0; nn < 2000000; nn++) ;
+    GPIO2_DR_CLEAR = (1 << 3); //digitalWrite(13, LOW);
+	// digitalWrite(13, LOW);
+    for (nn = 0; nn < 18000000; nn++) ;
+    GPIO2_DR_SET = (1 << 3); //digitalWrite(13, HIGH);
+    // digitalWrite(13, HIGH);
+    for (nn = 0; nn < 20000000; nn++) ;
+    GPIO2_DR_CLEAR = (1 << 3); //digitalWrite(13, LOW);
+	// digitalWrite(13, LOW);
+    for (nn = 0; nn < 10000000; nn++) ;
+  }
+}
+
+__attribute__((weak))
+void PJRCunused_interrupt_vector(void)
 {
 	// TODO: polling Serial to complete buffered transmits
 #ifdef PRINT_DEBUG_STUFF
@@ -428,4 +548,3 @@ void abort(void)
 {
 	while (1) ;
 }
-