fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-04 00:51:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

sdlog2: add missing GPS status data to ekf2 replay

Browse Source
This commit is contained in:
Paul Riseborough
2016-03-13 17:47:56 +01:00
committed by Lorenz Meier
parent c0404e8460
commit 016bfad507
2 changed files with 5 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/sdlog2/sdlog2.c
+2
View File
@@ -1476,8 +1476,10 @@ int sdlog2_thread_main(int argc, char *argv[])
log_msg.body.log_RPL2.lon = buf.replay.lon; log_msg.body.log_RPL2.lon = buf.replay.lon;
log_msg.body.log_RPL2.alt = buf.replay.alt; log_msg.body.log_RPL2.alt = buf.replay.alt;
log_msg.body.log_RPL2.fix_type = buf.replay.fix_type; log_msg.body.log_RPL2.fix_type = buf.replay.fix_type;
log_msg.body.log_RPL2.nsats = buf.replay.nsats;
log_msg.body.log_RPL2.eph = buf.replay.eph; log_msg.body.log_RPL2.eph = buf.replay.eph;
log_msg.body.log_RPL2.epv = buf.replay.epv; log_msg.body.log_RPL2.epv = buf.replay.epv;
log_msg.body.log_RPL2.sacc = buf.replay.sacc;
log_msg.body.log_RPL2.vel_m_s = buf.replay.vel_m_s; log_msg.body.log_RPL2.vel_m_s = buf.replay.vel_m_s;
log_msg.body.log_RPL2.vel_n_m_s = buf.replay.vel_n_m_s; log_msg.body.log_RPL2.vel_n_m_s = buf.replay.vel_n_m_s;
log_msg.body.log_RPL2.vel_e_m_s = buf.replay.vel_e_m_s; log_msg.body.log_RPL2.vel_e_m_s = buf.replay.vel_e_m_s;
src/modules/sdlog2/sdlog2_messages.h
+3 -1
View File
@@ -545,8 +545,10 @@ struct log_RPL2_s {
int32_t lon; int32_t lon;
int32_t alt; int32_t alt;
uint8_t fix_type; uint8_t fix_type;
uint8_t nsats;
float eph; float eph;
float epv; float epv;
float sacc;
float vel_m_s; float vel_m_s;
float vel_n_m_s; float vel_n_m_s;
float vel_e_m_s; float vel_e_m_s;
@@ -661,7 +663,7 @@ static const struct log_format_s log_formats[] = {
LOG_FORMAT(MACS, "fff", "RRint,PRint,YRint"), LOG_FORMAT(MACS, "fff", "RRint,PRint,YRint"),
LOG_FORMAT(CAMT, "QI", "timestamp,seq"), LOG_FORMAT(CAMT, "QI", "timestamp,seq"),
LOG_FORMAT(RPL1, "QQQQQffffffffff", "t,gIdt,aIdt,Tm,Tb,gIx,gIy,gIz,aIx,aIy,aIz,magX,magY,magZ,b_alt"), LOG_FORMAT(RPL1, "QQQQQffffffffff", "t,gIdt,aIdt,Tm,Tb,gIx,gIy,gIz,aIx,aIy,aIz,magX,magY,magZ,b_alt"),
LOG_FORMAT(RPL2, "QQLLLMffffffM", "Tpos,Tvel,lat,lon,alt,fix_type,eph,epv,v,vN,vE,vD,v_val"), LOG_FORMAT(RPL2, "QQLLLMMfffffffM", "Tpos,Tvel,lat,lon,alt,fix,nsats,eph,epv,sacc,v,vN,vE,vD,v_val"),
LOG_FORMAT(RPL3, "QffffIB", "Tflow,fx,fy,gx,gy,delT,qual"), LOG_FORMAT(RPL3, "QffffIB", "Tflow,fx,fy,gx,gy,delT,qual"),
LOG_FORMAT(RPL4, "Qf", "Trng,rng"), LOG_FORMAT(RPL4, "Qf", "Trng,rng"),
/* system-level messages, ID >= 0x80 */ /* system-level messages, ID >= 0x80 */