diff --git a/src/modules/commander/HealthAndArmingChecks/checks/escCheck.cpp b/src/modules/commander/HealthAndArmingChecks/checks/escCheck.cpp index 9554c57a4f..9b35c80992 100644 --- a/src/modules/commander/HealthAndArmingChecks/checks/escCheck.cpp +++ b/src/modules/commander/HealthAndArmingChecks/checks/escCheck.cpp @@ -77,7 +77,7 @@ void EscChecks::checkAndReport(const Context &context, Report &reporter) esc_status_s esc_status; - if (_esc_status_sub.copy(&esc_status) && now - esc_status.timestamp < esc_telemetry_timeout) { + if (_esc_status_sub.copy(&esc_status) && (now < esc_status.timestamp + esc_telemetry_timeout)) { checkEscStatus(context, reporter, esc_status); reporter.setIsPresent(health_component_t::motors_escs);