fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-22 12:27:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

battery: cell voltage fill refactor

Browse Source
This commit is contained in:
Matthias Grob
2020-03-26 15:14:27 +01:00
committed by Julian Oes
parent 14a61a6695
commit 49d22edc33
1 changed files with 3 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/battery/battery.cpp
+3 -7
View File
@@ -153,14 +153,10 @@ Battery::updateBatteryStatus(hrt_abstime timestamp, float voltage_v, float curre
static constexpr int uorb_max_cells = sizeof(_battery_status.voltage_cell_v) / sizeof(
_battery_status.voltage_cell_v[0]);
int i;
for (i = 0; i < _params.n_cells && i < uorb_max_cells; i++) {
_battery_status.voltage_cell_v[i] = _voltage_filtered_v / _params.n_cells;
}
for (; i < uorb_max_cells; i++) {
_battery_status.voltage_cell_v[i] = 0.0f;
// Fill cell voltages with average values to work around BATTERY_STATUS message not allowing to report just total voltage
for (int i = 0; (i < _battery_status.cell_count) && (i < uorb_max_cells); i++) {
_battery_status.voltage_cell_v[i] = _battery_status.voltage_filtered_v / _battery_status.cell_count;
}
}