Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-28 10:46:33 +08:00
Code Issues Actions 31 Packages Projects Releases Wiki Activity

battery compensation is now performed on the cell voltage rather than the total voltage

Browse Source
This commit is contained in:
nanthony21
2018-02-10 11:38:27 -06:00
committed by Lorenz Meier
parent e04d30c9cf
commit 9c7de38b75
1 changed files with 7 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/systemlib/battery.cpp
+7 -5
View File
@@ -170,18 +170,20 @@ Battery::sumDischarged(hrt_abstime timestamp, float current_a)
void void
Battery::estimateRemaining(float voltage_v, float current_a, float throttle_normalized, bool armed) Battery::estimateRemaining(float voltage_v, float current_a, float throttle_normalized, bool armed)
{ {
// remaining battery capacity based on voltage
const float cell_voltage = voltage_v / _n_cells.get();
// correct battery voltage locally for load drop to avoid estimation fluctuations // correct battery voltage locally for load drop to avoid estimation fluctuations
if (_r_internal.get() >= 0.f) { if (_r_internal.get() >= 0.f) {
voltage_v += _r_internal.get() * current_a; cell_voltage += _r_internal.get() * current_a;
} else { } else {
// assume quadratic relation between throttle and current // assume quadratic relation between throttle and current
// good assumption if throttle represents RPM // good assumption if throttle represents RPM
voltage_v += throttle_normalized * throttle_normalized * _v_load_drop.get(); cell_voltage += throttle_normalized * throttle_normalized * _v_load_drop.get();
} }
// remaining battery capacity based on voltage
const float cell_voltage = voltage_v / _n_cells.get();
_remaining_voltage = math::gradual(cell_voltage, _v_empty.get(), _v_charged.get(), 0.f, 1.f); _remaining_voltage = math::gradual(cell_voltage, _v_empty.get(), _v_charged.get(), 0.f, 1.f);
// choose which quantity we're using for final reporting // choose which quantity we're using for final reporting