|
|
|
@ -1547,12 +1547,12 @@ void DataFlash_Class::Log_Write_AttitudeView(AP_AHRS_View &ahrs, const Vector3f
@@ -1547,12 +1547,12 @@ void DataFlash_Class::Log_Write_AttitudeView(AP_AHRS_View &ahrs, const Vector3f
|
|
|
|
|
WriteBlock(&pkt, sizeof(pkt)); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
void DataFlash_Class::Log_Write_Current_instance(const AP_BattMonitor &battery, |
|
|
|
|
const uint64_t time_us, |
|
|
|
|
void DataFlash_Class::Log_Write_Current_instance(const uint64_t time_us, |
|
|
|
|
const uint8_t battery_instance, |
|
|
|
|
const enum LogMessages type, |
|
|
|
|
const enum LogMessages celltype) |
|
|
|
|
{ |
|
|
|
|
AP_BattMonitor &battery = AP::battery(); |
|
|
|
|
float temp; |
|
|
|
|
bool has_temp = battery.get_temperature(temp, battery_instance); |
|
|
|
|
struct log_Current pkt = { |
|
|
|
@ -1587,20 +1587,19 @@ void DataFlash_Class::Log_Write_Current_instance(const AP_BattMonitor &battery,
@@ -1587,20 +1587,19 @@ void DataFlash_Class::Log_Write_Current_instance(const AP_BattMonitor &battery,
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Write an Current data packet
|
|
|
|
|
void DataFlash_Class::Log_Write_Current(const AP_BattMonitor &battery) |
|
|
|
|
void DataFlash_Class::Log_Write_Current() |
|
|
|
|
{ |
|
|
|
|
const uint64_t time_us = AP_HAL::micros64(); |
|
|
|
|
if (battery.num_instances() >= 1) { |
|
|
|
|
Log_Write_Current_instance(battery, |
|
|
|
|
time_us, |
|
|
|
|
const uint8_t num_instances = AP::battery().num_instances(); |
|
|
|
|
if (num_instances >= 1) { |
|
|
|
|
Log_Write_Current_instance(time_us, |
|
|
|
|
0, |
|
|
|
|
LOG_CURRENT_MSG, |
|
|
|
|
LOG_CURRENT_CELLS_MSG); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (battery.num_instances() >= 2) { |
|
|
|
|
Log_Write_Current_instance(battery, |
|
|
|
|
time_us, |
|
|
|
|
if (num_instances >= 2) { |
|
|
|
|
Log_Write_Current_instance(time_us, |
|
|
|
|
1, |
|
|
|
|
LOG_CURRENT2_MSG, |
|
|
|
|
LOG_CURRENT_CELLS2_MSG); |
|
|
|
|