Middlewares/MCoreDump/addr2line.c

@@ -1,579 +0,0 @@
-#include "addr2line.h"
-
-// 错误类型打印
-#define DUMP_CPU_ARM_CORTEX_M0          0
-#define DUMP_CPU_ARM_CORTEX_M3          1
-#define DUMP_CPU_ARM_CORTEX_M4          2
-#define DUMP_CPU_ARM_CORTEX_M7          3
-
-#define DUMP_CPU_PLATFORM_TYPE      DUMP_CPU_ARM_CORTEX_M4
-
-/* system handler control and state register */
-#ifndef DUMP_SYSHND_CTRL
-    #define DUMP_SYSHND_CTRL                (*(volatile unsigned int*)  (0xE000ED24u))
-#endif
-
-/* memory management fault status register */
-#ifndef DUMP_NVIC_MFSR
-    #define DUMP_NVIC_MFSR                  (*(volatile unsigned char*) (0xE000ED28u))
-#endif
-
-/* bus fault status register */
-#ifndef DUMP_NVIC_BFSR
-    #define DUMP_NVIC_BFSR                  (*(volatile unsigned char*) (0xE000ED29u))
-#endif
-
-/* usage fault status register */
-#ifndef DUMP_NVIC_UFSR
-    #define DUMP_NVIC_UFSR                  (*(volatile unsigned short*)(0xE000ED2Au))
-#endif
-
-/* hard fault status register */
-#ifndef DUMP_NVIC_HFSR
-    #define DUMP_NVIC_HFSR                  (*(volatile unsigned int*)  (0xE000ED2Cu))
-#endif
-
-/* debug fault status register */
-#ifndef DUMP_NVIC_DFSR
-    #define DUMP_NVIC_DFSR                  (*(volatile unsigned short*)(0xE000ED30u))
-#endif
-
-/* memory management fault address register */
-#ifndef DUMP_NVIC_MMAR
-    #define DUMP_NVIC_MMAR                  (*(volatile unsigned int*)  (0xE000ED34u))
-#endif
-
-/* bus fault manage address register */
-#ifndef DUMP_NVIC_BFAR
-    #define DUMP_NVIC_BFAR                  (*(volatile unsigned int*)  (0xE000ED38u))
-#endif
-
-/* auxiliary fault status register */
-#ifndef DUMP_NVIC_AFSR
-    #define DUMP_NVIC_AFSR                  (*(volatile unsigned short*)(0xE000ED3Cu))
-#endif
-
-/**
- * Cortex-M fault registers
- */
-struct dump_hard_fault_regs
-{
-    struct
-    {
-        unsigned int r0;                 // Register R0
-        unsigned int r1;                 // Register R1
-        unsigned int r2;                 // Register R2
-        unsigned int r3;                 // Register R3
-        unsigned int r12;                // Register R12
-        unsigned int lr;                 // Link register
-        unsigned int pc;                 // Program counter
-        union
-        {
-            unsigned int value;
-            struct
-            {
-                unsigned int IPSR : 8;   // Interrupt Program Status register (IPSR)
-                unsigned int EPSR : 19;  // Execution Program Status register (EPSR)
-                unsigned int APSR : 5;   // Application Program Status register (APSR)
-            } bits;
-        } psr;                           // Program status register.
-    } saved;
-
-    union
-    {
-        unsigned int value;
-        struct
-        {
-            unsigned int MEMFAULTACT    : 1; // Read as 1 if memory management fault is active
-            unsigned int BUSFAULTACT    : 1; // Read as 1 if bus fault exception is active
-            unsigned int UnusedBits1    : 1;
-            unsigned int USGFAULTACT    : 1; // Read as 1 if usage fault exception is active
-            unsigned int UnusedBits2    : 3;
-            unsigned int SVCALLACT      : 1; // Read as 1 if SVC exception is active
-            unsigned int MONITORACT     : 1; // Read as 1 if debug monitor exception is active
-            unsigned int UnusedBits3    : 1;
-            unsigned int PENDSVACT      : 1; // Read as 1 if PendSV exception is active
-            unsigned int SYSTICKACT     : 1; // Read as 1 if SYSTICK exception is active
-            unsigned int USGFAULTPENDED : 1; // Usage fault pended; usage fault started but was replaced by a higher-priority exception
-            unsigned int MEMFAULTPENDED : 1; // Memory management fault pended; memory management fault started but was replaced by a higher-priority exception
-            unsigned int BUSFAULTPENDED : 1; // Bus fault pended; bus fault handler was started but was replaced by a higher-priority exception
-            unsigned int SVCALLPENDED   : 1; // SVC pended; SVC was started but was replaced by a higher-priority exception
-            unsigned int MEMFAULTENA    : 1; // Memory management fault handler enable
-            unsigned int BUSFAULTENA    : 1; // Bus fault handler enable
-            unsigned int USGFAULTENA    : 1; // Usage fault handler enable
-        } bits;
-    } syshndctrl;                        // System Handler Control and State Register (0xE000ED24)
-
-    union
-    {
-        unsigned char value;
-        struct
-        {
-            unsigned char IACCVIOL    : 1; // Instruction access violation
-            unsigned char DACCVIOL    : 1; // Data access violation
-            unsigned char UnusedBits  : 1;
-            unsigned char MUNSTKERR   : 1; // Unstacking error
-            unsigned char MSTKERR     : 1; // Stacking error
-            unsigned char MLSPERR     : 1; // Floating-point lazy state preservation (M4/M7)
-            unsigned char UnusedBits2 : 1;
-            unsigned char MMARVALID   : 1; // Indicates the MMAR is valid
-        } bits;
-    } mfsr;                              // Memory Management Fault Status Register (0xE000ED28)
-    unsigned int mmar;                   // Memory Management Fault Address Register (0xE000ED34)
-
-    union
-    {
-        unsigned char value;
-        struct
-        {
-            unsigned char IBUSERR    : 1; // Instruction access violation
-            unsigned char PRECISERR  : 1; // Precise data access violation
-            unsigned char IMPREISERR : 1; // Imprecise data access violation
-            unsigned char UNSTKERR   : 1; // Unstacking error
-            unsigned char STKERR     : 1; // Stacking error
-            unsigned char LSPERR     : 1; // Floating-point lazy state preservation (M4/M7)
-            unsigned char UnusedBits : 1;
-            unsigned char BFARVALID  : 1; // Indicates BFAR is valid
-        } bits;
-    } bfsr;                              // Bus Fault Status Register (0xE000ED29)
-    unsigned int bfar;                   // Bus Fault Manage Address Register (0xE000ED38)
-
-    union
-    {
-        unsigned short value;
-        struct
-        {
-            unsigned short UNDEFINSTR : 1; // Attempts to execute an undefined instruction
-            unsigned short INVSTATE   : 1; // Attempts to switch to an invalid state (e.g., ARM)
-            unsigned short INVPC      : 1; // Attempts to do an exception with a bad value in the EXC_RETURN number
-            unsigned short NOCP       : 1; // Attempts to execute a coprocessor instruction
-            unsigned short UnusedBits : 4;
-            unsigned short UNALIGNED  : 1; // Indicates that an unaligned access fault has taken place
-            unsigned short DIVBYZERO0 : 1; // Indicates a divide by zero has taken place (can be set only if DIV_0_TRP is set)
-        } bits;
-    } ufsr;                              // Usage Fault Status Register (0xE000ED2A)
-
-    union
-    {
-        unsigned int value;
-        struct
-        {
-            unsigned int UnusedBits  : 1;
-            unsigned int VECTBL      : 1; // Indicates hard fault is caused by failed vector fetch
-            unsigned int UnusedBits2 : 28;
-            unsigned int FORCED      : 1; // Indicates hard fault is taken because of bus fault/memory management fault/usage fault
-            unsigned int DEBUGEVT    : 1; // Indicates hard fault is triggered by debug event
-        } bits;
-    } hfsr;                              // Hard Fault Status Register (0xE000ED2C)
-
-    union
-    {
-        unsigned int value;
-        struct
-        {
-            unsigned int HALTED   : 1;   // Halt requested in NVIC
-            unsigned int BKPT     : 1;   // BKPT instruction executed
-            unsigned int DWTTRAP  : 1;   // DWT match occurred
-            unsigned int VCATCH   : 1;   // Vector fetch occurred
-            unsigned int EXTERNAL : 1;   // EDBGRQ signal asserted
-        } bits;
-    } dfsr;                              // Debug Fault Status Register (0xE000ED30)
-
-    unsigned int afsr;                   // Auxiliary Fault Status Register (0xE000ED3C), Vendor controlled (optional)
-};
-
-enum
-{
-    PRINT_MAIN_STACK_CFG_ERROR,
-    PRINT_FIRMWARE_INFO,
-    PRINT_ASSERT_ON_THREAD,
-    PRINT_ASSERT_ON_HANDLER,
-    PRINT_THREAD_STACK_INFO,
-    PRINT_MAIN_STACK_INFO,
-    PRINT_THREAD_STACK_OVERFLOW,
-    PRINT_MAIN_STACK_OVERFLOW,
-    PRINT_CALL_STACK_INFO,
-    PRINT_CALL_STACK_ERR,
-    PRINT_FAULT_ON_THREAD,
-    PRINT_FAULT_ON_HANDLER,
-    PRINT_REGS_TITLE,
-    PRINT_HFSR_VECTBL,
-    PRINT_MFSR_IACCVIOL,
-    PRINT_MFSR_DACCVIOL,
-    PRINT_MFSR_MUNSTKERR,
-    PRINT_MFSR_MSTKERR,
-    PRINT_MFSR_MLSPERR,
-    PRINT_BFSR_IBUSERR,
-    PRINT_BFSR_PRECISERR,
-    PRINT_BFSR_IMPREISERR,
-    PRINT_BFSR_UNSTKERR,
-    PRINT_BFSR_STKERR,
-    PRINT_BFSR_LSPERR,
-    PRINT_UFSR_UNDEFINSTR,
-    PRINT_UFSR_INVSTATE,
-    PRINT_UFSR_INVPC,
-    PRINT_UFSR_NOCP,
-    PRINT_UFSR_UNALIGNED,
-    PRINT_UFSR_DIVBYZERO0,
-    PRINT_DFSR_HALTED,
-    PRINT_DFSR_BKPT,
-    PRINT_DFSR_DWTTRAP,
-    PRINT_DFSR_VCATCH,
-    PRINT_DFSR_EXTERNAL,
-    PRINT_MMAR,
-    PRINT_BFAR,
-};
-
-static const char *const print_info[] = {
-    [PRINT_MAIN_STACK_CFG_ERROR]  = "ERROR: Unable to get the main stack information, please check the configuration of the main stack\n",
-    [PRINT_FIRMWARE_INFO]         = "Firmware name: %s, hardware version: %s, software version: %s\n",
-    [PRINT_ASSERT_ON_THREAD]      = "Assert on thread %s\n",
-    [PRINT_ASSERT_ON_HANDLER]     = "Assert on interrupt or bare metal(no OS) environment\n",
-    [PRINT_THREAD_STACK_INFO]     = "===== Thread stack information =====\n",
-    [PRINT_MAIN_STACK_INFO]       = "====== Main stack information ======\n",
-    [PRINT_THREAD_STACK_OVERFLOW] = "Error: Thread stack(%08x) was overflow\n",
-    [PRINT_MAIN_STACK_OVERFLOW]   = "Error: Main stack(%08x) was overflow\n",
-    [PRINT_CALL_STACK_INFO]       = "Show more call stack info by run: addr2line -e %s%s -a -f %.*s\n",
-    [PRINT_CALL_STACK_ERR]        = "Dump call stack has an error\n",
-    [PRINT_FAULT_ON_THREAD]       = "Fault on thread %s\n",
-    [PRINT_FAULT_ON_HANDLER]      = "Fault on interrupt or bare metal(no OS) environment\n",
-    [PRINT_REGS_TITLE]            = "=================== Registers information ====================\n",
-    [PRINT_HFSR_VECTBL]           = "Hard fault is caused by failed vector fetch\n",
-    [PRINT_MFSR_IACCVIOL]         = "Memory management fault is caused by instruction access violation\n",
-    [PRINT_MFSR_DACCVIOL]         = "Memory management fault is caused by data access violation\n",
-    [PRINT_MFSR_MUNSTKERR]        = "Memory management fault is caused by unstacking error\n",
-    [PRINT_MFSR_MSTKERR]          = "Memory management fault is caused by stacking error\n",
-    [PRINT_MFSR_MLSPERR]          = "Memory management fault is caused by floating-point lazy state preservation\n",
-    [PRINT_BFSR_IBUSERR]          = "Bus fault is caused by instruction access violation\n",
-    [PRINT_BFSR_PRECISERR]        = "Bus fault is caused by precise data access violation\n",
-    [PRINT_BFSR_IMPREISERR]       = "Bus fault is caused by imprecise data access violation\n",
-    [PRINT_BFSR_UNSTKERR]         = "Bus fault is caused by unstacking error\n",
-    [PRINT_BFSR_STKERR]           = "Bus fault is caused by stacking error\n",
-    [PRINT_BFSR_LSPERR]           = "Bus fault is caused by floating-point lazy state preservation\n",
-    [PRINT_UFSR_UNDEFINSTR]       = "Usage fault is caused by attempts to execute an undefined instruction\n",
-    [PRINT_UFSR_INVSTATE]         = "Usage fault is caused by attempts to switch to an invalid state (e.g., ARM)\n",
-    [PRINT_UFSR_INVPC]            = "Usage fault is caused by attempts to do an exception with a bad value in the EXC_RETURN number\n",
-    [PRINT_UFSR_NOCP]             = "Usage fault is caused by attempts to execute a coprocessor instruction\n",
-    [PRINT_UFSR_UNALIGNED]        = "Usage fault is caused by indicates that an unaligned access fault has taken place\n",
-    [PRINT_UFSR_DIVBYZERO0]       = "Usage fault is caused by Indicates a divide by zero has taken place (can be set only if DIV_0_TRP is set)\n",
-    [PRINT_DFSR_HALTED]           = "Debug fault is caused by halt requested in NVIC\n",
-    [PRINT_DFSR_BKPT]             = "Debug fault is caused by BKPT instruction executed\n",
-    [PRINT_DFSR_DWTTRAP]          = "Debug fault is caused by DWT match occurred\n",
-    [PRINT_DFSR_VCATCH]           = "Debug fault is caused by Vector fetch occurred\n",
-    [PRINT_DFSR_EXTERNAL]         = "Debug fault is caused by EDBGRQ signal asserted\n",
-    [PRINT_MMAR]                  = "The memory management fault occurred address is %08x\n",
-    [PRINT_BFAR]                  = "The bus fault occurred address is %08x\n",
-};
-
-static struct dump_hard_fault_regs regs;
-
-#if (DUMP_CPU_PLATFORM_TYPE != DUMP_CPU_ARM_CORTEX_M0)
-/**
- * fault diagnosis then print cause of fault
- */
-static void fault_diagnosis(void)
-{
-    if (regs.hfsr.bits.VECTBL)
-    {
-        addr2line_print(print_info[PRINT_HFSR_VECTBL]);
-    }
-    if (regs.hfsr.bits.FORCED)
-    {
-        /* Memory Management Fault */
-        if (regs.mfsr.value)
-        {
-            if (regs.mfsr.bits.IACCVIOL)
-            {
-                addr2line_print(print_info[PRINT_MFSR_IACCVIOL]);
-            }
-            if (regs.mfsr.bits.DACCVIOL)
-            {
-                addr2line_print(print_info[PRINT_MFSR_DACCVIOL]);
-            }
-            if (regs.mfsr.bits.MUNSTKERR)
-            {
-                addr2line_print(print_info[PRINT_MFSR_MUNSTKERR]);
-            }
-            if (regs.mfsr.bits.MSTKERR)
-            {
-                addr2line_print(print_info[PRINT_MFSR_MSTKERR]);
-            }
-
-#if (DUMP_CPU_PLATFORM_TYPE == DUMP_CPU_ARM_CORTEX_M4) || (DUMP_CPU_PLATFORM_TYPE == DUMP_CPU_ARM_CORTEX_M7)
-            if (regs.mfsr.bits.MLSPERR)
-            {
-                addr2line_print(print_info[PRINT_MFSR_MLSPERR]);
-            }
-#endif
-
-            if (regs.mfsr.bits.MMARVALID)
-            {
-                if (regs.mfsr.bits.IACCVIOL || regs.mfsr.bits.DACCVIOL)
-                {
-                    addr2line_print(print_info[PRINT_MMAR], regs.mmar);
-                }
-            }
-        }
-        /* Bus Fault */
-        if (regs.bfsr.value)
-        {
-            if (regs.bfsr.bits.IBUSERR)
-            {
-                addr2line_print(print_info[PRINT_BFSR_IBUSERR]);
-            }
-            if (regs.bfsr.bits.PRECISERR)
-            {
-                addr2line_print(print_info[PRINT_BFSR_PRECISERR]);
-            }
-            if (regs.bfsr.bits.IMPREISERR)
-            {
-                addr2line_print(print_info[PRINT_BFSR_IMPREISERR]);
-            }
-            if (regs.bfsr.bits.UNSTKERR)
-            {
-                addr2line_print(print_info[PRINT_BFSR_UNSTKERR]);
-            }
-            if (regs.bfsr.bits.STKERR)
-            {
-                addr2line_print(print_info[PRINT_BFSR_STKERR]);
-            }
-
-#if (DUMP_CPU_PLATFORM_TYPE == DUMP_CPU_ARM_CORTEX_M4) || (DUMP_CPU_PLATFORM_TYPE == DUMP_CPU_ARM_CORTEX_M7)
-            if (regs.bfsr.bits.LSPERR)
-            {
-                addr2line_print(print_info[PRINT_BFSR_LSPERR]);
-            }
-#endif
-
-            if (regs.bfsr.bits.BFARVALID)
-            {
-                if (regs.bfsr.bits.PRECISERR)
-                {
-                    addr2line_print(print_info[PRINT_BFAR], regs.bfar);
-                }
-            }
-
-        }
-        /* Usage Fault */
-        if (regs.ufsr.value)
-        {
-            if (regs.ufsr.bits.UNDEFINSTR)
-            {
-                addr2line_print(print_info[PRINT_UFSR_UNDEFINSTR]);
-            }
-            if (regs.ufsr.bits.INVSTATE)
-            {
-                addr2line_print(print_info[PRINT_UFSR_INVSTATE]);
-            }
-            if (regs.ufsr.bits.INVPC)
-            {
-                addr2line_print(print_info[PRINT_UFSR_INVPC]);
-            }
-            if (regs.ufsr.bits.NOCP)
-            {
-                addr2line_print(print_info[PRINT_UFSR_NOCP]);
-            }
-            if (regs.ufsr.bits.UNALIGNED)
-            {
-                addr2line_print(print_info[PRINT_UFSR_UNALIGNED]);
-            }
-            if (regs.ufsr.bits.DIVBYZERO0)
-            {
-                addr2line_print(print_info[PRINT_UFSR_DIVBYZERO0]);
-            }
-        }
-    }
-    /* Debug Fault */
-    if (regs.hfsr.bits.DEBUGEVT)
-    {
-        if (regs.dfsr.value)
-        {
-            if (regs.dfsr.bits.HALTED)
-            {
-                addr2line_print(print_info[PRINT_DFSR_HALTED]);
-            }
-            if (regs.dfsr.bits.BKPT)
-            {
-                addr2line_print(print_info[PRINT_DFSR_BKPT]);
-            }
-            if (regs.dfsr.bits.DWTTRAP)
-            {
-                addr2line_print(print_info[PRINT_DFSR_DWTTRAP]);
-            }
-            if (regs.dfsr.bits.VCATCH)
-            {
-                addr2line_print(print_info[PRINT_DFSR_VCATCH]);
-            }
-            if (regs.dfsr.bits.EXTERNAL)
-            {
-                addr2line_print(print_info[PRINT_DFSR_EXTERNAL]);
-            }
-        }
-    }
-}
-#endif
-
-int coredump_fault_diagnosis(void)
-{
-    /* the Cortex-M0 is not support fault diagnosis */
-#if (DUMP_CPU_PLATFORM_TYPE != DUMP_CPU_ARM_CORTEX_M0)
-    regs.syshndctrl.value = DUMP_SYSHND_CTRL;  // System Handler Control and State Register
-    regs.mfsr.value       = DUMP_NVIC_MFSR;    // Memory Fault Status Register
-    regs.mmar             = DUMP_NVIC_MMAR;    // Memory Management Fault Address Register
-    regs.bfsr.value       = DUMP_NVIC_BFSR;    // Bus Fault Status Register
-    regs.bfar             = DUMP_NVIC_BFAR;    // Bus Fault Manage Address Register
-    regs.ufsr.value       = DUMP_NVIC_UFSR;    // Usage Fault Status Register
-    regs.hfsr.value       = DUMP_NVIC_HFSR;    // Hard Fault Status Register
-    regs.dfsr.value       = DUMP_NVIC_DFSR;    // Debug Fault Status Register
-    regs.afsr             = DUMP_NVIC_AFSR;    // Auxiliary Fault Status Register
-
-    fault_diagnosis();
-    return 0;
-#endif
-
-    return -1;
-}
-
-int addr2line_print_stack_before(uint32_t lr)
-{
-    int on_thread_before_fault = lr & (1UL << 2);
-    /* check which stack was used before (MSP or PSP) */
-    if (on_thread_before_fault)
-        addr2line_print(print_info[PRINT_FAULT_ON_THREAD], rt_thread_self()->name != NULL ? rt_thread_self()->name : "NO_NAME");
-    else
-        addr2line_print(print_info[PRINT_FAULT_ON_HANDLER]);
-
-    coredump_fault_diagnosis();
-    return 0;
-}
-
-void addr2line_trigger_exception(void)
-{
-    volatile int *SCB_CCR = (volatile int *)0xE000ED14; // SCB->CCR
-    int x, y, z;
-
-    *SCB_CCR |= (1 << 4);     /* bit4: DIV_0_TRP. */
-    x = 10;
-    y = strlen("");
-    z = x / y;
-    addr2line_print("z:%d\n", z);
-}
-
-
-// addr to line
-#include <stdbool.h>
-
-#pragma section = ".text"
-
-static bool is_in_text(uint32_t addr)
-{
-#if 0
-    uint32_t code_start_addr = (uint32_t)&CODE_SECTION_START(CMB_CODE_SECTION_NAME);
-    uint32_t code_size = (uint32_t)&CODE_SECTION_END(CMB_CODE_SECTION_NAME) - code_start_addr;
-#else
-    uint32_t code_start_addr = (uint32_t)__section_begin(".text");
-    uint32_t code_size = (uint32_t)__section_end(".text") - code_start_addr;
-#endif
-
-    if (code_start_addr < addr && addr <= code_start_addr + code_size)
-    {
-        return true;
-    }
-
-    return false;
-}
-
-static bool disassembly_ins_is_bl_blx(uint32_t addr)
-{
-#define BL_INS_MASK         0xF800
-#define BL_INS_HIGH         0xF800
-#define BL_INS_LOW          0xF000
-#define BLX_INX_MASK        0xFF00
-#define BLX_INX             0x4700
-
-    uint16_t ins1 = *((uint16_t *)addr);
-    uint16_t ins2 = *((uint16_t *)(addr + 2));
-
-    if ((ins2 & BL_INS_MASK) == BL_INS_HIGH && (ins1 & BL_INS_MASK) == BL_INS_LOW)
-    {
-        return true;
-    }
-    else if ((ins2 & BLX_INX_MASK) == BLX_INX)
-    {
-        return true;
-    }
-    else
-    {
-        return false;
-    }
-}
-
-void addr2line_print(uint32_t *addr, int size)
-{
-    addr2line_print("\naddr2line -e " PROJECT_NAME " -a -f ");
-    size /= sizeof(uint32_t);
-
-    for (int i = 1; i < size; i++)
-    {
-        const uint32_t lr = addr[i];
-
-        if (false == is_in_text(lr))
-            continue;
-
-        uint32_t pc = lr - sizeof(size_t); // 假设当前是lr寄存器的值，向下增长4就是pc寄存器的值
-
-        if (pc % 2 == 0) // thumb 指令pc寄存器值一定是偶数
-            continue;
-
-        pc = lr - 1; // lr寄存器值保存的是pc+1
-
-        if (true == disassembly_ins_is_bl_blx(pc - sizeof(size_t))) // pc 的上一条指令是跳转指令
-            addr2line_print("%08x ", pc);
-    }
-
-    addr2line_print("\n");
-}
-
-#if 0
-static void test_addr2line(void)
-{
-    uint32_t sg_test_stack[] =
-    {
-        0x00000001, 0x000514d5, 0x000000f0, 0x00000001,
-        0x000c3fcc, 0x00000000, 0x000538b4, 0x00549822,
-        0xdeadbeef, 0x00000000, 0x00000000, 0x00000000,
-        0x00000000, 0x00000000, 0x00000000, 0x00000000,
-        0x00000000, 0x00000000, 0x00000000, 0x00000000,
-        0x00000000, 0x00000000, 0x00000000, 0x00000000,
-        0x00000000, 0x0000000a, 0x00000210, 0x00000000,
-        0x00000000, 0x00000006, 0x000514eb, 0x000516f8,
-        0x49000000, 0x00000004, 0x0000007d, 0x00000000,
-        0x00000000, 0x00000000, 0x00000000, 0x00000000,
-        0x00000000, 0x00000000, 0x00000000, 0x00000000,
-        0x00000000, 0x00000000, 0x00000000, 0x00000000,
-        0x00000000, 0x00000010, 0x00000000, 0x00000200,
-        0x00000000, 0x000008f4, 0x000537bb, 0x000000f0,
-        0x00000000, 0x00000001, 0x00000002, 0x20033378,
-        0x000468e3, 0x00000000, 0x20036c3c, 0x20036c78,
-        0x000b8789, 0x00000000, 0x20016dd8, 0x20008198,
-        0x000b819f, 0x00000000, 0x2003727c, 0x20016dd8,
-        0x0006047f, 0x00000050, 0x00000000, 0x20016dd8,
-        0x00000001, 0x00000001, 0x000604dd, 0x00000000,
-        0x2003092c, 0x20030b1c, 0x200334f4, 0x200334b4,
-        0x00060215, 0x2003764c, 0x20036e98, 0x00000008,
-        0x200081f4, 0x200334b4, 0x00000000, 0x0068007a,
-        0x00000000, 0x20030b1c, 0x00063dd3, 0x007a0068,
-        0x00000000, 0x00000000, 0x00000000, 0x00000000,
-        0xffffffff, 0x20033520, 0x2003060c, 0x2002cc84,
-        0x2002cbf4, 0x20033378, 0x0005ce35, 0x20030e20,
-        0x000d17c8, 0x20030214, 0x00000014, 0xdeadbeef,
-        0xdeadbeef, 0xdeadbeef, 0x00057c99, 0x00000000,
-        0xdeadbeef, 0xdeadbeef, 0xdeadbeef, 0xdeadbeef,
-        0x000302e7
-    };
-
-    uint32_t *addr = sg_test_stack;
-    int size = sizeof(sg_test_stack);
-    _addr2line_print(addr, size);
-}
-#endif

Middlewares/MCoreDump/addr2line.h

@@ -1,11 +0,0 @@
-#ifndef ADDR2LINE_H
-#define ADDR2LINE_H
-
-// 触发一个异常
-void addr2line_trigger_exception(void);
-// 打印地址供CMD命令行运行
-void addr2line_print(uint32_t *addr, int size);
-// 打印异常错误类型
-int addr2line_print_stack_before(uint32_t exc_return);
-
-#endif

Middlewares/MCoreDump/arch/armv7m/armv7m.c

@@ -285,8 +285,9 @@ void print_registers_armv7m(core_regset_type *reg, fp_regset_type *fp_reg, char
  * @param fp_regset Pointer to structure for storing FPU registers
  */
 // 通过sp指针得到寄存器信息
-void collect_registers_armv7m(uint32_t *stack_top, core_regset_type *core_regset, fp_regset_type *fp_regset)
+uint32_t collect_registers_armv7m(uint32_t *stack_top, core_regset_type *core_regset, fp_regset_type *fp_regset)
 {
+    uint32_t fpu_flag = 0;
     /*
      * This function uses the same stack frame parsing approach as collect_registers_armv7ms
      * for consistency. Both PendSV_Handler and HardFault_Handler now use identical
@@ -303,7 +304,7 @@ void collect_registers_armv7m(uint32_t *stack_top, core_regset_type *core_regset
 
 #if MCD_FPU_SUPPORT
     /* Read FPU flag first - indicates if FPU context was saved */
-    uint32_t fpu_flag = *current_ptr++;
+    fpu_flag = *current_ptr++;
 #endif
 
     /* Extract core registers r4-r11 (software saved by RT-Thread) */
@@ -358,6 +359,7 @@ void collect_registers_armv7m(uint32_t *stack_top, core_regset_type *core_regset
 
     /* SP should point to the current stack pointer position after all saved data */
     core_regset->sp = (uintptr_t)current_ptr;
+    return fpu_flag;
 }
 
 /**

Middlewares/MCoreDump/arch/mcd_arch_interface.h

@@ -33,7 +33,7 @@ int armv7m_hard_fault_exception_hook(void *context);
  * @param core_regset Pointer to store ARM core registers
  * @param fp_regset Pointer to store FPU registers
  */
-void collect_registers_armv7m(uint32_t *stack_top, core_regset_type *core_regset, fp_regset_type *fp_regset);
+uint32_t collect_registers_armv7m(uint32_t *stack_top, core_regset_type *core_regset, fp_regset_type *fp_regset);
 
 // 打印寄存器
 void print_registers_armv7m(core_regset_type *reg, fp_regset_type *fp_reg, char *thread);

Middlewares/MCoreDump/coredump.c

@@ -199,6 +199,9 @@ void mcd_init(mcd_writeout_func_t func)
 
 static void fill_one_threads_regset(core_regset_type *core_regset, fp_regset_type *fp_regset)
 {
+    if (NULL == m_ctx.writeout_func)
+        return;
+
     fill_note_prstatus(&m_ctx.tmp.prstatus, core_regset);
     m_ctx.writeout_func((uint8_t *)&m_ctx.tmp.prstatus, sizeof(elf_note_prstatus_t));
 
@@ -218,6 +221,10 @@ static void addr_align(uint32_t *addr, uint32_t *memlen)
 // 生成.elf格式
 void mcd_gen_coredump(struct thread_info_ops *ops)
 {
+    if (NULL == ops || NULL == ops->get_memarea_count || NULL == ops->get_memarea
+        || NULL == ops->get_thread_regset || NULL == m_ctx.writeout_func)
+        return;
+
     int note_size;
     uint32_t addr, memlen;
 
@@ -265,6 +272,9 @@ void mcd_gen_coredump(struct thread_info_ops *ops)
 
 int32_t mcd_corefile_size(struct thread_info_ops *ops)
 {
+    if (NULL == ops || NULL == ops->get_memarea_count || NULL == ops->get_memarea)
+        return 0;
+
     int elf_size = 0;
     int segment_count;
     uint32_t addr, memlen;
@@ -337,6 +347,7 @@ static int32_t minidump_memarea(struct thread_info_ops *ops, int32_t idx,
 
 void mcd_mini_dump_ops(struct thread_info_ops *ops)
 {
+    memset(ops, 0, sizeof(struct thread_info_ops));
     ops->get_threads_count = minidump_thr_cnts;
     ops->get_current_thread_idx = minidump_cur_idx;
     ops->get_thread_regset = minidump_thr_rset;

Middlewares/MCoreDump/mcd_cfg.h

@@ -40,7 +40,7 @@
 /* RT-Thread print functions */
 #ifndef RT_USING_ULOG
 /* Use rt_kprintf directly */
-#define mcd_println(...)               rt_kprintf(__VA_ARGS__);rt_kprintf("\r\n")
+#define mcd_println(...)               do{rt_kprintf(__VA_ARGS__);rt_kprintf("\r\n");}while(0)
 #define mcd_print(...)                 rt_kprintf(__VA_ARGS__)
 #else /* RT_USING_ULOG */
 /* Use ulog for unified logging */

Middlewares/MCoreDump/rtthread_port.c

@@ -13,10 +13,18 @@
 #include "arch/mcd_arch_interface.h"
 #include "addr2line/addr2line.h"
 
-#define PRINT_COREDUMP_INFO_STRING 1 // 打印字符串格式的coredump信息
+#define PRINT_COREDUMP_ELF 1 // 直接打印elf格式
+#define PRINT_COREDUMP_INFO_STRING 0 // 打印字符串格式的coredump信息
 #define STACK_CORE_REG_SIZE (17 * 4) // 16个自动+手动压栈寄存器 + exe_return
-#define STACK_FPU_REG_SIZE (17 * 4) // 17个自动压栈的浮点寄存器
+#define STACK_FPU_REG_SIZE (16 * 4) // 16个自动压栈的浮点寄存器
 
+static rt_int32_t is_thread_object(rt_thread_t thread)
+{
+    /* Check if the object is a thread (both static and dynamic) */
+    return ((thread->type & ~RT_Object_Class_Static) == RT_Object_Class_Thread);
+}
+
+#if PRINT_COREDUMP_ELF
 /*
  * RT-Thread OS abstraction layer implementation for MCoreDump
  */
@@ -26,12 +34,6 @@ typedef struct
     rt_int32_t cur_idx;
 } rtthread_ti_priv_t;
 
-static rt_int32_t is_thread_object(rt_thread_t thread)
-{
-    /* Check if the object is a thread (both static and dynamic) */
-    return ((thread->type & ~RT_Object_Class_Static) == RT_Object_Class_Thread);
-}
-
 static int32_t rtthread_thread_cnts(struct thread_info_ops *ops)
 {
     rtthread_ti_priv_t *priv = (rtthread_ti_priv_t *)ops->priv;
@@ -167,7 +169,7 @@ static int32_t rtthread_get_memarea(struct thread_info_ops *ops, int32_t idx,
                     *memlen += STACK_CORE_REG_SIZE * 2; // 前后括大两倍：实际可能更多局部变量在死机前还没来得及向下增长sp
 #if MCD_FPU_SUPPORT
                     /* Read FPU flag first - indicates if FPU context was saved */
-                    uint32_t fpu_flag = *(uint32_t *)thread->sp;
+                    uint32_t fpu_flag = 0 != get_cur_fp_regset_address()->fpscr; // 异常标志位肯定被置位
                     *addr -= 1;
                     *memlen += 1;
 
@@ -196,11 +198,12 @@ static int32_t rtthread_get_memarea(struct thread_info_ops *ops, int32_t idx,
     }
     return 0;
 }
+#endif
 
 #if PRINT_COREDUMP_INFO_STRING
 static int mcd_print_coredump_info_string(struct thread_info_ops *ops)
 {
-    rt_int32_t current_idx = rtthread_cur_index(ops);
+    rt_thread_t current_thread = rt_thread_self();
     rt_int32_t idx_l = 0;
     struct rt_object_information *information;
     struct rt_object *object;
@@ -220,7 +223,7 @@ static int mcd_print_coredump_info_string(struct thread_info_ops *ops)
         if (is_thread_object(thread))
         {
             /* If this is the current thread, use current stack pointer */
-            if (idx_l == current_idx)
+            if (thread == current_thread)
             {
                 uint32_t fpu_flag = 0;
                 addr = (rt_uint32_t)get_cur_core_regset_address()->sp;      // 异常中填充
@@ -229,7 +232,7 @@ static int mcd_print_coredump_info_string(struct thread_info_ops *ops)
                 memlen += STACK_CORE_REG_SIZE * 2; // 前后括大两倍：实际可能更多局部变量在死机前还没来得及向下增长sp
 #if MCD_FPU_SUPPORT
                 /* Read FPU flag first - indicates if FPU context was saved */
-                fpu_flag = *(uint32_t *)thread->sp;
+                fpu_flag = 0 != get_cur_fp_regset_address()->fpscr; // 异常标志位肯定被置位
                 addr -= 1;
                 memlen += 1;
 
@@ -251,12 +254,12 @@ static int mcd_print_coredump_info_string(struct thread_info_ops *ops)
             }
             else
             {
-                mcd_print("Thread index:%d\n", idx_l + 1);
                 addr = (rt_uint32_t)thread->sp;
-                memlen = (rt_uint32_t)thread->stack_addr + thread->stack_size - (rt_uint32_t)thread->sp;
-                core_regset_type core_regset;
-                fp_regset_type fp_regset;
-                collect_registers((uint32_t *)thread->sp, &core_regset, &fp_regset); // rtos栈寄存器格式转换成core_regset类型的
+                memlen = (rt_uint32_t)thread->stack_addr + thread->stack_size - addr;
+                core_regset_type core_regset = {0};
+                fp_regset_type fp_regset = {0};
+                uint32_t use_fpu = collect_registers((uint32_t *)addr, &core_regset, &fp_regset); // rtos栈寄存器格式转换成core_regset类型的
+                mcd_print("Thread index:%d (fpu:%d)\n", idx_l + 1, use_fpu);
                 print_registers(&core_regset, &fp_regset, thread->name);
                 addr2line_cmd_with_pc_print((rt_uint32_t *)core_regset.pc, (uint32_t *)addr, memlen);
             }
@@ -273,24 +276,29 @@ static int mcd_print_coredump_info_string(struct thread_info_ops *ops)
 
 void mcd_rtos_thread_ops(struct thread_info_ops *ops)
 {
+    memset(ops, 0, sizeof(struct thread_info_ops));
+#if PRINT_COREDUMP_ELF
     static rtthread_ti_priv_t priv;
     ops->get_threads_count = rtthread_thread_cnts;
     ops->get_current_thread_idx = rtthread_cur_index;
     ops->get_thread_regset = rtthread_thread_register;
     ops->get_memarea_count = rtthread_get_mem_cnts;
     ops->get_memarea = rtthread_get_memarea;
-#if PRINT_COREDUMP_INFO_STRING
-    ops->print_info_string = mcd_print_coredump_info_string;
-#endif
     ops->priv = &priv;
     priv.cur_idx = -1;
     priv.thr_cnts = -1;
+#endif
+#if PRINT_COREDUMP_INFO_STRING
+    ops->print_info_string = mcd_print_coredump_info_string;
+#endif
+
 }
 
 MCD_WEAK rt_err_t rtt_hard_fault_exception_hook(void *context)
 {
     arch_hard_fault_exception_hook(context);
     addr2line_print_stack_before((uint32_t)context);
+    //error_user_info_print();
     return -RT_ERROR;
 }
 
@@ -304,11 +312,24 @@ MCD_WEAK void rtt_assert_hook(const char *ex, const char *func, rt_size_t line)
 
     mcd_faultdump(MCD_OUTPUT_SERIAL);
 
+    error_user_info_print();
     rt_interrupt_leave();
 
     while (_continue == 1);
 }
 
+void coredump_trigger_exception(void)
+{
+    volatile int *SCB_CCR = (volatile int *)0xE000ED14; // SCB->CCR
+    int x, y, z;
+
+    *SCB_CCR |= (1 << 4);     /* bit4: DIV_0_TRP. */
+    x = 10;
+    y = strlen("");
+    z = x / y;
+    rt_kprintf("z:%d\n", z);
+}
+
 static int mcd_coredump_init(void)
 {
     //mcd_print_memoryinfo();

Middlewares/rtthread/libcpu/arm/cortex-m3/context_iar.S

@@ -202,4 +202,52 @@ _update_done
     
 #endif
 
+#if 0 // 带浮点寄存器的
+    IMPORT rt_hw_hard_fault_exception
+    EXPORT HardFault_Handler
+HardFault_Handler:
+
+    ; get current context
+    MRS     r0, msp                 ; get fault context from handler.
+    TST     lr, #0x04               ; if(!EXC_RETURN[2])
+    BEQ     _get_sp_done1
+    MRS     r0, psp                 ; get fault context from thread.
+_get_sp_done1
+
+#if defined ( __ARMVFP__ )
+    TST     lr, #0x10               ; if(!EXC_RETURN[4])
+    BNE     skip_push_fpu1
+    VSTMDB  r0!, {d8 - d15}         ; push FPU register s16~s31
+skip_push_fpu1
+#endif
+
+    STMFD   r0!, {r4 - r11}         ; push r4 - r11 register
+
+#if defined ( __ARMVFP__ )
+    MOV     r4, #0x00               ; flag = 0
+    TST     lr, #0x10               ; if(!EXC_RETURN[4])
+    BNE     push_flag1
+    MOV     r4, #0x01               ; flag = 1
+push_flag1
+    STMFD   r0!, {r4}              ; push flag
+#endif
+
+    STMFD   r0!, {lr}              ; push flag
+
+    TST     lr, #0x04               ; if(!EXC_RETURN[2])
+    BEQ     _update_msp1
+    MSR     psp, r0                 ; update stack pointer to PSP.
+    B       _update_done1
+_update_msp1
+    MSR     msp, r0                 ; update stack pointer to MSP.
+_update_done1
+
+    PUSH    {lr}
+    BL      rt_hw_hard_fault_exception
+    POP     {lr}
+
+    ORR     lr, lr, #0x04
+    BX      lr
+#endif
+
     END