battery: publish measured values also when battery not connected

This commit is contained in:
Matthias Grob
2021-06-30 12:00:50 +02:00
parent a99ddd0845
commit b824f33ae9
5 changed files with 33 additions and 43 deletions
@@ -241,7 +241,7 @@ MulticopterRateControl::Run()
if (_battery_status_sub.updated()) {
battery_status_s battery_status;
if (_battery_status_sub.copy(&battery_status)) {
if (_battery_status_sub.copy(&battery_status) && battery_status.connected && battery_status.scale > 0.f) {
_battery_status_scale = battery_status.scale;
}
}