aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_BattMonitor: fix Rotoye Temperature Monitoring

Browse Source
This commit is contained in:
Joshua Henderson 2022-08-30 01:09:53 -04:00 committed by Peter Barker
parent 5aae259fd5
commit b26e37d652
1 changed files with 16 additions and 11 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

27
libraries/AP_BattMonitor/AP_BattMonitor_SMBus_Rotoye.cpp
View File

@ -3,20 +3,25 @@
#include <AP_HAL/AP_HAL.h>
// Specific to Rotoye Batmon
#define BATTMONITOR_SMBUS_TEMP_EXT 0x07
#define BATTMONITOR_SMBUS_TEMP_EXT 0x48
// return the maximum of the internal and external temperature sensors
void AP_BattMonitor_SMBus_Rotoye::read_temp(void) {
uint16_t t_int, t_ext;
/* Both internal and external values will always be sent by Batmon.
uint16_t t_int = 0;
uint16_t t_ext = 0;
/* Both internal and external values will always be sent by Batmon.
If no external thermistor is used, a zero-value is sent. */
if (read_word(BATTMONITOR_SMBUS_TEMP, t_int) &&
read_word(BATTMONITOR_SMBUS_TEMP_EXT, t_ext)) {
uint16_t t;
_state.temperature_time = AP_HAL::millis();
t = ((t_ext > t_int) ? t_ext : t_int);
_state.temperature = KELVIN_TO_C(0.1f * (float)t);
const bool have_temp_internal = read_word(BATTMONITOR_SMBUS_TEMP, t_int);
const bool have_temp_external = read_word(BATTMONITOR_SMBUS_TEMP_EXT, t_ext);
if (!have_temp_internal && !have_temp_external) {
_has_temperature = (AP_HAL::millis() - _state.temperature_time) <= AP_BATT_MONITOR_TIMEOUT;
return;
}
_has_temperature = true;
_state.temperature_time = AP_HAL::millis();
_state.temperature = KELVIN_TO_C(0.1f * float(MAX(t_int, t_ext)));
}