fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-24 01:53:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixed reporting of battery voltages in uORB

Browse Source
This commit is contained in:
Timothy Scott
2020-03-31 09:14:50 +02:00
committed by Julian Oes
parent d609639367
commit 14a61a6695
2 changed files with 13 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/battery/battery.cpp
+12
View File
@@ -150,6 +150,18 @@ Battery::updateBatteryStatus(hrt_abstime timestamp, float voltage_v, float curre
_battery_status.connected = connected;
_battery_status.system_source = selected_source;
_battery_status.priority = priority;
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;
}
}
_battery_status.timestamp = timestamp;