From 88c2110bbb029414666285d82a378ffab13e5631 Mon Sep 17 00:00:00 2001 From: Andrew Tridgell Date: Thu, 4 Aug 2022 10:56:30 +1000 Subject: [PATCH] Tools: implement EK3GPSDisable in replay --- Tools/Replay/LR_MsgHandler.cpp | 9 +++++++++ 1 file changed, 9 insertions(+) diff --git a/Tools/Replay/LR_MsgHandler.cpp b/Tools/Replay/LR_MsgHandler.cpp index cbdca233afaf68..8b33aa0d0b46b5 100644 --- a/Tools/Replay/LR_MsgHandler.cpp +++ b/Tools/Replay/LR_MsgHandler.cpp @@ -73,6 +73,9 @@ void LR_MsgHandler_REV2::process_message(uint8_t *msgbytes) break; case AP_DAL::Event::setSourceSet0 ... AP_DAL::Event::setSourceSet2: break; + case AP_DAL::Event::EK3GPSDisable: + case AP_DAL::Event::EK3GPSEnable: + break; } if (replay_force_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: ekf3.setPosVelYawSourceSet(uint8_t(msg.event)-uint8_t(AP_DAL::Event::setSourceSet0)); 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) {