Replay: support set source events

This commit is contained in:
Andrew Tridgell 2022-05-27 21:28:34 +10:00 committed by Peter Barker
parent 74c4f3c9a9
commit 8f2f770e93

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