From d823ed6358328883735bd3c86401a3f7bd2a5769 Mon Sep 17 00:00:00 2001 From: Andrew Tridgell Date: Fri, 27 May 2022 21:28:34 +1000 Subject: [PATCH] Replay: support set source events --- Tools/Replay/LR_MsgHandler.cpp | 5 +++++ 1 file changed, 5 insertions(+) diff --git a/Tools/Replay/LR_MsgHandler.cpp b/Tools/Replay/LR_MsgHandler.cpp index 8af008248d..8b9d2bd431 100644 --- a/Tools/Replay/LR_MsgHandler.cpp +++ b/Tools/Replay/LR_MsgHandler.cpp @@ -71,6 +71,8 @@ void LR_MsgHandler_REV2::process_message(uint8_t *msgbytes) case AP_DAL::Event::checkLaneSwitch: ekf2.checkLaneSwitch(); break; + case AP_DAL::Event::setSourceSet0 ... AP_DAL::Event::setSourceSet2: + break; } if (replay_force_ekf3) { LR_MsgHandler_REV3 h{f, ekf2, ekf3}; @@ -128,6 +130,9 @@ void LR_MsgHandler_REV3::process_message(uint8_t *msgbytes) case AP_DAL::Event::checkLaneSwitch: ekf3.checkLaneSwitch(); break; + case AP_DAL::Event::setSourceSet0 ... AP_DAL::Event::setSourceSet2: + ekf3.setPosVelYawSourceSet(uint8_t(msg.event)-uint8_t(AP_DAL::Event::setSourceSet0)); + break; } if (replay_force_ekf2) {