DataFlash: Log new CUR2 entry for battery2 data

This commit is contained in:
Tom Pittenger 2016-06-02 14:00:57 -07:00
parent a596aa5907
commit 3ed2fafefa
2 changed files with 27 additions and 18 deletions

View File

@ -1640,20 +1640,29 @@ void DataFlash_Class::Log_Write_Attitude(AP_AHRS &ahrs, const Vector3f &targets)
// Write an Current data packet
void DataFlash_Class::Log_Write_Current(const AP_BattMonitor &battery)
{
float voltage2 = battery.voltage2();
if (battery.num_instances() >= 1) {
struct log_Current pkt = {
LOG_PACKET_HEADER_INIT(LOG_CURRENT_MSG),
time_us : AP_HAL::micros64(),
throttle : throttle,
battery_voltage : (int16_t) (battery.voltage() * 100.0f),
current_amps : (int16_t) (battery.current_amps() * 100.0f),
board_voltage : (uint16_t)(hal.analogin->board_voltage()*1000),
current_total : battery.current_total_mah(),
battery2_voltage : (int16_t)(voltage2 * 100.0f)
battery_voltage : battery.voltage(0),
current_amps : battery.current_amps(0),
current_total : battery.current_total_mah(0),
};
WriteBlock(&pkt, sizeof(pkt));
}
if (battery.num_instances() >= 2) {
struct log_Current pkt = {
LOG_PACKET_HEADER_INIT(LOG_CURRENT2_MSG),
time_us : AP_HAL::micros64(),
battery_voltage : battery.voltage(1),
current_amps : battery.current_amps(1),
current_total : battery.current_total_mah(1),
};
WriteBlock(&pkt, sizeof(pkt));
}
}
// Write a Compass packet
void DataFlash_Class::Log_Write_Compass(const Compass &compass, uint64_t time_us)
{

View File

@ -421,12 +421,9 @@ struct PACKED log_PID {
struct PACKED log_Current {
LOG_PACKET_HEADER;
uint64_t time_us;
int16_t throttle;
int16_t battery_voltage;
int16_t current_amps;
uint16_t board_voltage;
float battery_voltage;
float current_amps;
float current_total;
int16_t battery2_voltage;
};
struct PACKED log_Compass {
@ -751,7 +748,9 @@ Format characters in the format string for binary log messages
{ LOG_ARSP_MSG, sizeof(log_AIRSPEED), \
"ARSP", "QffcffB", "TimeUS,Airspeed,DiffPress,Temp,RawPress,Offset,U" }, \
{ LOG_CURRENT_MSG, sizeof(log_Current), \
"CURR", "QhhhHfh","TimeUS,Throttle,Volt,Curr,Vcc,CurrTot,Volt2" },\
"CURR", "Qfff","TimeUS,Volt,Curr,CurrTot" },\
{ LOG_CURRENT2_MSG, sizeof(log_Current), \
"CUR2", "Qfff","TimeUS,Volt,Curr,CurrTot" }, \
{ LOG_ATTITUDE_MSG, sizeof(log_Attitude),\
"ATT", "QccccCCCC", "TimeUS,DesRoll,Roll,DesPitch,Pitch,DesYaw,Yaw,ErrRP,ErrYaw" }, \
{ LOG_COMPASS_MSG, sizeof(log_Compass), \
@ -945,6 +944,7 @@ enum LogMessages {
LOG_ARSP_MSG,
LOG_ATTITUDE_MSG,
LOG_CURRENT_MSG,
LOG_CURRENT2_MSG,
LOG_COMPASS_MSG,
LOG_COMPASS2_MSG,
LOG_COMPASS3_MSG,