Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Tools: implement EK3GPSDisable in replay

This commit is contained in:
Andrew Tridgell 2022-08-04 10:56:30 +10:00
parent f46d0750cc
commit 346712fe5d
1 changed files with 9 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
Tools/Replay/LR_MsgHandler.cpp
View File

@ -73,6 +73,9 @@ void LR_MsgHandler_REV2::process_message(uint8_t *msgbytes)
break; break;
case AP_DAL::Event::setSourceSet0 ... AP_DAL::Event::setSourceSet2: case AP_DAL::Event::setSourceSet0 ... AP_DAL::Event::setSourceSet2:
break; break;
case AP_DAL::Event::EK3GPSDisable:
case AP_DAL::Event::EK3GPSEnable:
break;
} }
if (replay_force_ekf3) { if (replay_force_ekf3) {
LR_MsgHandler_REV3 h{f, ekf2, ekf3}; LR_MsgHandler_REV3 h{f, ekf2, ekf3};
@ -133,6 +136,12 @@ void LR_MsgHandler_REV3::process_message(uint8_t *msgbytes)
case AP_DAL::Event::setSourceSet0 ... AP_DAL::Event::setSourceSet2: case AP_DAL::Event::setSourceSet0 ... AP_DAL::Event::setSourceSet2:
ekf3.setPosVelYawSourceSet(uint8_t(msg.event)-uint8_t(AP_DAL::Event::setSourceSet0)); ekf3.setPosVelYawSourceSet(uint8_t(msg.event)-uint8_t(AP_DAL::Event::setSourceSet0));
break; break;
case AP_DAL::Event::EK3GPSDisable:
ekf3.force_gps_disable(true);
break;
case AP_DAL::Event::EK3GPSEnable:
ekf3.force_gps_disable(false);
break;
} }
if (replay_force_ekf2) { if (replay_force_ekf2) {