Fix reporting of connected battery

This commit is contained in:
Don Gagne 2025-05-04 12:25:52 -07:00 committed by Daniel Agar
parent 67cf8d3229
commit eedd770cbd

View File

@ -63,14 +63,14 @@ bool check_battery_disconnected(orb_advert_t *mavlink_log_pub)
const bool recent_battery_measurement = hrt_absolute_time() < (battery_status_sub.get().timestamp + 1_s);
if (!recent_battery_measurement) {
if (recent_battery_measurement) {
// We have to send this message for now because "battery unavailable" gets ignored by QGC
calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, "Disconnect battery and try again");
return false;
}
// Make sure battery is reported to be disconnected
if (recent_battery_measurement && !battery_status_sub.get().connected) {
if (!recent_battery_measurement && !battery_status_sub.get().connected) {
return true;
}