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

Copter : Update logging for new PX4Flow sensor interface

Browse Source
This commit is contained in:
priseborough 2014-10-31 23:46:59 +11:00 committed by Andrew Tridgell
parent 20e715aa13
commit 23953b459e
1 changed files with 11 additions and 13 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

24
ArduCopter/Log.pde
View File

@ -241,11 +241,10 @@ struct PACKED log_Optflow {
LOG_PACKET_HEADER;
uint32_t time_ms;
uint8_t surface_quality;
int16_t raw_x;
int16_t raw_y;
float vel_x;
float vel_y;
float dist;
float flow_x;
float flow_y;
float body_x;
float body_y;
};
// Write an optical flow packet
@ -256,17 +255,16 @@ static void Log_Write_Optflow()
if (!optflow.enabled()) {
return;
}
const Vector2i &raw = optflow.raw();
const Vector2f &vel = optflow.velocity();
const Vector2f &flowRate = optflow.flowRate();
const Vector2f &bodyRate = optflow.bodyRate();
struct log_Optflow pkt = {
LOG_PACKET_HEADER_INIT(LOG_OPTFLOW_MSG),
time_ms : hal.scheduler->millis(),
surface_quality : optflow.quality(),
raw_x : raw.x,
raw_y : raw.y,
vel_x : vel.x,
vel_y : vel.y,
dist : optflow.ground_distance_m()
flow_x : flowRate.x,
flow_y : flowRate.y,
body_x : bodyRate.x,
body_y : bodyRate.y
};
DataFlash.WriteBlock(&pkt, sizeof(pkt));
#endif // OPTFLOW == ENABLED
@ -676,7 +674,7 @@ static const struct LogStructure log_structure[] PROGMEM = {
{ LOG_CURRENT_MSG, sizeof(log_Current),
"CURR", "IhIhhhf", "TimeMS,ThrOut,ThrInt,Volt,Curr,Vcc,CurrTot" },
{ LOG_OPTFLOW_MSG, sizeof(log_Optflow),
"OF", "IBhhfff", "TimeMS,Qual,RawX,RawY,VelX,VelY,Dist" },
"OF", "IBffff", "TimeMS,Qual,flowX,flowY,bodyX,bodyY" },
{ LOG_NAV_TUNING_MSG, sizeof(log_Nav_Tuning),
"NTUN", "Iffffffffff", "TimeMS,DPosX,DPosY,PosX,PosY,DVelX,DVelY,VelX,VelY,DAccX,DAccY" },
{ LOG_CONTROL_TUNING_MSG, sizeof(log_Control_Tuning),