add load_mon support for Qurt platform (#22883)

- Added check in commander to see if CPU load monitoring has been disabled before signalling overload
This commit is contained in:
Eric Katzfey
2024-03-13 21:33:58 -04:00
committed by GitHub
parent ad50afda10
commit ae947513d7
5 changed files with 11 additions and 4 deletions
+8 -1
View File
@@ -2419,7 +2419,14 @@ void Commander::control_status_leds(bool changed, const uint8_t battery_warning)
if (_cpuload_sub.copy(&cpuload)) {
const float cpuload_percent = cpuload.load * 100.f;
bool overload = (cpuload_percent > _param_com_cpu_max.get()) || (cpuload.ram_usage > 0.99f);
bool overload = false;
// Only check CPU load if it hasn't been disabled
if (!(_param_com_cpu_max.get() < FLT_EPSILON)) {
overload = (cpuload_percent > _param_com_cpu_max.get());
}
overload = overload || (cpuload.ram_usage > 0.99f);
if (_overload_start == 0 && overload) {
_overload_start = time_now_us;
+3
View File
@@ -229,6 +229,9 @@ void LoadMon::cpuload()
struct mallinfo mem = mallinfo();
cpuload.ram_usage = (float)mem.uordblks / mem.arena;
cpuload.load = 1.f - interval_idletime / interval;
#elif defined(__PX4_QURT)
cpuload.ram_usage = 0.0f;
cpuload.load = px4muorb_get_cpu_load() / 100.0f;
#endif
cpuload.timestamp = hrt_absolute_time();