fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-07-16 17:10:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

esc_battery: report temperature

Browse Source 
Co-authored-by: Jacob Dahl <37091262+dakejahl@users.noreply.github.com>
This commit is contained in:
Alex Klimaj
2025-02-11 19:17:53 -07:00
committed by GitHub
parent b96b4fb68d
commit 98cba19f50
1 changed files with 8 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/esc_battery/EscBattery.cpp
+8
View File
@@ -91,17 +91,25 @@ EscBattery::Run()
const uint8_t online_esc_count = math::countSetBits(esc_status.esc_online_flags);
float average_voltage_v = 0.0f;
float total_current_a = 0.0f;
float average_temperature_c = 0.0f;
for (unsigned i = 0; i < esc_status.esc_count; ++i) {
if ((1 << i) & esc_status.esc_online_flags) {
average_voltage_v += esc_status.esc[i].esc_voltage;
total_current_a += esc_status.esc[i].esc_current;
if (PX4_ISFINITE(esc_status.esc[i].esc_temperature)) {
average_temperature_c += esc_status.esc[i].esc_temperature;
}
}
}
average_voltage_v /= online_esc_count;
total_current_a /= online_esc_count;
average_temperature_c /= online_esc_count;
_battery.setConnected(true);
_battery.updateTemperature(average_temperature_c);
_battery.updateVoltage(average_voltage_v);
_battery.updateCurrent(total_current_a);
_battery.updateAndPublishBatteryStatus(esc_status.timestamp);