Tools/Replay: Add handlers for external lat lng position set

This commit is contained in:
Paul Riseborough 2023-05-14 09:55:43 +10:00 committed by Andrew Tridgell
parent 3677cb025d
commit e3d05094a0
3 changed files with 14 additions and 0 deletions

View File

@ -289,6 +289,12 @@ void LR_MsgHandler_REPH::process_message(uint8_t *msgbytes)
AP::dal().handle_message(msg, ekf2, ekf3); AP::dal().handle_message(msg, ekf2, ekf3);
} }
void LR_MsgHandler_RSLL::process_message(uint8_t *msgbytes)
{
MSG_CREATE(RSLL, msgbytes);
AP::dal().handle_message(msg, ekf2, ekf3);
}
void LR_MsgHandler_REVH::process_message(uint8_t *msgbytes) void LR_MsgHandler_REVH::process_message(uint8_t *msgbytes)
{ {
MSG_CREATE(REVH, msgbytes); MSG_CREATE(REVH, msgbytes);

View File

@ -57,6 +57,12 @@ class LR_MsgHandler_REPH : public LR_MsgHandler_EKF
void process_message(uint8_t *msg) override; void process_message(uint8_t *msg) override;
}; };
class LR_MsgHandler_RSLL : public LR_MsgHandler_EKF
{
using LR_MsgHandler_EKF::LR_MsgHandler_EKF;
void process_message(uint8_t *msg) override;
};
class LR_MsgHandler_REVH : public LR_MsgHandler_EKF class LR_MsgHandler_REVH : public LR_MsgHandler_EKF
{ {
using LR_MsgHandler_EKF::LR_MsgHandler_EKF; using LR_MsgHandler_EKF::LR_MsgHandler_EKF;

View File

@ -118,6 +118,8 @@ bool LogReader::handle_log_format_msg(const struct log_Format &f)
msgparser[f.type] = new LR_MsgHandler_ROFH(formats[f.type], ekf2, ekf3); msgparser[f.type] = new LR_MsgHandler_ROFH(formats[f.type], ekf2, ekf3);
} else if (streq(name, "REPH")) { } else if (streq(name, "REPH")) {
msgparser[f.type] = new LR_MsgHandler_REPH(formats[f.type], ekf2, ekf3); msgparser[f.type] = new LR_MsgHandler_REPH(formats[f.type], ekf2, ekf3);
} else if (streq(name, "RSLL")) {
msgparser[f.type] = new LR_MsgHandler_RSLL(formats[f.type], ekf2, ekf3);
} else if (streq(name, "REVH")) { } else if (streq(name, "REVH")) {
msgparser[f.type] = new LR_MsgHandler_REVH(formats[f.type], ekf2, ekf3); msgparser[f.type] = new LR_MsgHandler_REVH(formats[f.type], ekf2, ekf3);
} else if (streq(name, "RWOH")) { } else if (streq(name, "RWOH")) {