diff --git a/src/modules/esc_battery/EscBattery.cpp b/src/modules/esc_battery/EscBattery.cpp index e1a655ab0a..5c5c5f82de 100644 --- a/src/modules/esc_battery/EscBattery.cpp +++ b/src/modules/esc_battery/EscBattery.cpp @@ -86,7 +86,7 @@ EscBattery::Run() if (_esc_status_sub.update(&esc_status)) { - if (hrt_elapsed_time(&esc_status.timestamp) < 500_ms || + if (hrt_elapsed_time(&esc_status.timestamp) > 500_ms || esc_status.esc_count == 0 || esc_status.esc_count > 8) { return;