AP_Logger: only log Battery Status for active monitors

This commit is contained in:
Josh Henderson 2021-01-06 00:51:04 -05:00 committed by Andrew Tridgell
parent a564d58dda
commit 1c49a0b44d

View File

@ -655,10 +655,13 @@ void AP_Logger::Write_Current_instance(const uint64_t time_us,
// Write an Current data packet
void AP_Logger::Write_Current()
{
AP_BattMonitor &battery = AP::battery();
const uint64_t time_us = AP_HAL::micros64();
const uint8_t num_instances = AP::battery().num_instances();
for (uint8_t i = 0; i < num_instances; i++) {
Write_Current_instance(time_us, i);
if (battery.get_type(i) != AP_BattMonitor::Type::NONE) {
Write_Current_instance(time_us, i);
}
}
}