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

Replay: support set source events

This commit is contained in:
Andrew Tridgell 2022-05-27 21:28:34 +10:00
parent a91894ff2d
commit d823ed6358
1 changed files with 5 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
Tools/Replay/LR_MsgHandler.cpp
View File

@ -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) {