Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-31 18:47:21 +08:00
Code Issues Actions 20 Packages Projects Releases Wiki Activity

battery: update average current also when no capacity is configured

Browse Source
This commit is contained in:
Matthias Grob
2022-03-31 19:38:08 +02:00
parent 13c3eae6d0
commit dd28c3e019
1 changed files with 17 additions and 17 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/battery/battery.cpp
+17 -17
View File
@@ -272,25 +272,25 @@ float Battery::computeRemainingTime(float current_a)
{ {
float time_remaining_s = NAN; float time_remaining_s = NAN;
if (_vehicle_status_sub.updated()) {
vehicle_status_s vehicle_status;
if (_vehicle_status_sub.copy(&vehicle_status)) {
_armed = (vehicle_status.arming_state == vehicle_status_s::ARMING_STATE_ARMED);
}
}
if (!PX4_ISFINITE(_current_average_filter_a.getState()) || _current_average_filter_a.getState() < FLT_EPSILON) {
_current_average_filter_a.reset(_params.bat_avrg_current);
}
if (_armed && PX4_ISFINITE(current_a)) {
// only update with positive numbers
_current_average_filter_a.update(fmaxf(current_a, 0.f));
}
// Remaining time estimation only possible with capacity // Remaining time estimation only possible with capacity
if (_params.capacity > 0.f) { if (_params.capacity > 0.f) {
if (_vehicle_status_sub.updated()) {
vehicle_status_s vehicle_status;
if (_vehicle_status_sub.copy(&vehicle_status)) {
_armed = (vehicle_status.arming_state == vehicle_status_s::ARMING_STATE_ARMED);
}
}
if (!PX4_ISFINITE(_current_average_filter_a.getState()) || _current_average_filter_a.getState() < FLT_EPSILON) {
_current_average_filter_a.reset(_params.bat_avrg_current);
}
if (_armed && PX4_ISFINITE(current_a)) {
// only update with positive numbers
_current_average_filter_a.update(fmaxf(current_a, 0.f));
}
const float remaining_capacity_mah = _state_of_charge * _params.capacity; const float remaining_capacity_mah = _state_of_charge * _params.capacity;
const float current_ma = fmaxf(_current_average_filter_a.getState() * 1e3f, FLT_EPSILON); const float current_ma = fmaxf(_current_average_filter_a.getState() * 1e3f, FLT_EPSILON);
time_remaining_s = remaining_capacity_mah / current_ma * 3600.f; time_remaining_s = remaining_capacity_mah / current_ma * 3600.f;