DataFlash : Update names in EKF optical flow logging

This commit is contained in:
priseborough 2014-09-10 19:37:33 +10:00 committed by Andrew Tridgell
parent a20729f60f
commit a07e402ebf
2 changed files with 12 additions and 12 deletions

View File

@ -350,10 +350,10 @@ struct PACKED log_EKF4 {
struct PACKED log_EKF5 { struct PACKED log_EKF5 {
LOG_PACKET_HEADER; LOG_PACKET_HEADER;
uint32_t time_ms; uint32_t time_ms;
float obsX; float flowX;
float obsY; float flowY;
float innovX; float omegaX;
float innovY; float omegaY;
float gndPos; float gndPos;
uint8_t scaler; uint8_t scaler;
uint8_t quality; uint8_t quality;
@ -528,7 +528,7 @@ struct PACKED log_Esc {
{ LOG_ESC8_MSG, sizeof(log_Esc), \ { LOG_ESC8_MSG, sizeof(log_Esc), \
"ESC8", "Icccc", "TimeMS,RPM,Volt,Curr,Temp" }, \ "ESC8", "Icccc", "TimeMS,RPM,Volt,Curr,Temp" }, \
{ LOG_EKF5_MSG, sizeof(log_EKF5), \ { LOG_EKF5_MSG, sizeof(log_EKF5), \
"EKF5","IfffffBB","TimeMS,FX,FY,IFX,IFY,GP,SF,Q" } "EKF5","IfffffBB","TimeMS,flowX,flowY,omegaX,omegaY,gndPos,fScaler,flowQual" }
#if HAL_CPU_CLASS >= HAL_CPU_CLASS_75 #if HAL_CPU_CLASS >= HAL_CPU_CLASS_75
#define LOG_COMMON_STRUCTURES LOG_BASE_STRUCTURES, LOG_EXTRA_STRUCTURES #define LOG_COMMON_STRUCTURES LOG_BASE_STRUCTURES, LOG_EXTRA_STRUCTURES

View File

@ -996,17 +996,17 @@ void DataFlash_Class::Log_Write_EKF(AP_AHRS_NavEKF &ahrs)
// Write fifth EKF packet // Write fifth EKF packet
float fscale; float fscale;
float gndPos; float gndPos;
float obsX, obsY; float flowX, flowY;
float innovX, innovY; float omegaX, omegaY;
uint8_t flowQual; uint8_t flowQual;
ahrs.get_NavEKF().getFlowDebug(fscale, obsX, obsY, innovX, innovY, gndPos, flowQual); ahrs.get_NavEKF().getFlowDebug(fscale, gndPos, flowX, flowY, omegaX, omegaY, flowQual);
struct log_EKF5 pkt5 = { struct log_EKF5 pkt5 = {
LOG_PACKET_HEADER_INIT(LOG_EKF5_MSG), LOG_PACKET_HEADER_INIT(LOG_EKF5_MSG),
time_ms : hal.scheduler->millis(), time_ms : hal.scheduler->millis(),
obsX : (float)(obsX), flowX : (float)(flowX),
obsY : (float)(obsY), flowY : (float)(flowY),
innovX : (float)(innovX), omegaX : (float)(omegaX),
innovY : (float)(innovY), omegaY : (float)(omegaY),
gndPos : (float)(gndPos), gndPos : (float)(gndPos),
scaler: (uint8_t)(100*fscale), scaler: (uint8_t)(100*fscale),
quality : (uint8_t)(flowQual) quality : (uint8_t)(flowQual)