fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-25 12:23:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

imxrt:Add critmon

Browse Source
This commit is contained in:
David Sidrane
2020-01-29 13:54:20 -05:00
committed by Daniel Agar
parent 78c7f98ef1
commit 2f1bc6676e
1 changed files with 21 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files
platforms/nuttx/src/px4/nxp/imxrt/board_critmon/board_critmon.c
+21 -8
View File
@@ -37,6 +37,15 @@
************************************************************************************/ ************************************************************************************/
#include <nuttx/config.h> #include <nuttx/config.h>
#include <time.h>
#include <fixedmath.h>
#include "dwt.h"
#include "up_arch.h"
#include <nuttx/clock.h>
#include <arch/board/board.h> #include <arch/board/board.h>
#if defined(CONFIG_SCHED_CRITMONITOR) || defined(CONFIG_SCHED_IRQMONITOR) #if defined(CONFIG_SCHED_CRITMONITOR) || defined(CONFIG_SCHED_IRQMONITOR)
@@ -45,22 +54,26 @@
* Public Functions * Public Functions
************************************************************************************/ ************************************************************************************/
#error "missing implementation for up_critmon_gettime() and up_critmon_convert()"
/************************************************************************************ /************************************************************************************
* Name: up_critmon_gettime * Name: up_critmon_gettime
************************************************************************************/ ************************************************************************************/
// uint32_t up_critmon_gettime(void) uint32_t up_critmon_gettime(void)
// { {
// } return getreg32(DWT_CYCCNT);
}
/************************************************************************************ /************************************************************************************
* Name: up_critmon_convert * Name: up_critmon_convert
************************************************************************************/ ************************************************************************************/
// void up_critmon_convert(uint32_t elapsed, FAR struct timespec *ts) void up_critmon_convert(uint32_t elapsed, FAR struct timespec *ts)
// { {
// } b32_t b32elapsed;
b32elapsed = itob32(elapsed) / BOARD_CPU_FREQUENCY;
ts->tv_sec = b32toi(b32elapsed);
ts->tv_nsec = NSEC_PER_SEC * b32frac(b32elapsed) / b32ONE;
}
#endif /* CONFIG_SCHED_CRITMONITOR */ #endif /* CONFIG_SCHED_CRITMONITOR */