|
|
|
@ -71,6 +71,8 @@ void LR_MsgHandler_REV2::process_message(uint8_t *msgbytes)
@@ -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)
@@ -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) { |
|
|
|
|