fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-22 15:07:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

hardfault_log:Add Fault Status registers

Browse Source
This commit is contained in:
David Sidrane
2020-09-02 13:33:50 -07:00
committed by Beat Küng
parent bf41574b1d
commit 7f91e41f67
3 changed files with 61 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/systemcmds/hardfault_log/hardfault_log.c
+34
View File
@@ -392,6 +392,31 @@ static int write_registers(uint32_t regs[], char *buffer, int max, int fd)
return OK;
}
/****************************************************************************
* write_registers
****************************************************************************/
static int write_fault_registers(fault_regs_s *fault_regs, char *buffer, int max, int fd)
{
#if defined(CONFIG_ARCH_CORTEXM7)
const char fmt[] = " cfsr:0x%08x hfsr:0x%08x dfsr:0x%08x mmfsr:0x%08x bfsr:0x%08x afsr:0x%08x abfsr:0x%08x \n";
#else
const char fmt[] = " cfsr:0x%08x hfsr:0x%08x dfsr:0x%08x mmfsr:0x%08x bfsr:0x%08x afsr:0x%08x\n";
#endif
int n = snprintf(buffer, max, fmt,
fault_regs->cfsr, fault_regs->hfsr, fault_regs->dfsr,
#if defined(CONFIG_ARCH_CORTEXM7)
fault_regs->mmfsr, fault_regs->bfsr, fault_regs->afsr, fault_regs->abfsr);
#else
fault_regs->mmfsr, fault_regs->bfsr, fault_regs->afsr);
#endif
if (n != write(fd, buffer, n)) {
return -EIO;
}
return OK;
}
/****************************************************************************
* write_registers_info
****************************************************************************/
@@ -408,6 +433,15 @@ static int write_registers_info(int fdout, info_s *pi, char *buffer, int sz)
}
}
if (pi->flags & eFaultRegPresent) {
ret = -EIO;
int n = snprintf(buffer, sz, " Fault status registers: from NVIC\n");
if (n == write(fdout, buffer, n)) {
ret = write_fault_registers(&pi->fault_regs, buffer, sz, fdout);
}
}
return ret;
}