battery: publish measured values also when battery not connected

This commit is contained in:
Matthias Grob
2021-07-01 14:24:38 +02:00
parent a99ddd0845
commit b824f33ae9
5 changed files with 33 additions and 43 deletions
@@ -565,10 +565,8 @@ void FixedwingAttitudeControl::Run()
if (_battery_status_sub.updated()) {
battery_status_s battery_status{};
if (_battery_status_sub.copy(&battery_status)) {
if (battery_status.scale > 0.0f) {
_battery_scale = battery_status.scale;
}
if (_battery_status_sub.copy(&battery_status) && battery_status.connected && battery_status.scale > 0.f) {
_battery_scale = battery_status.scale;
}
}