Browse Source

Replay: support wheel odomotry

c415-sdk
Andrew Tridgell 4 years ago
parent
commit
afb11cf29b
  1. 5
      Tools/Replay/LR_MsgHandler.cpp
  2. 6
      Tools/Replay/LR_MsgHandler.h
  3. 2
      Tools/Replay/LogReader.cpp

5
Tools/Replay/LR_MsgHandler.cpp

@ -242,6 +242,11 @@ void LR_MsgHandler_ROFH::process_message(uint8_t *msg)
AP::dal().handle_message(MSG_CAST(ROFH,msg), ekf2, ekf3); AP::dal().handle_message(MSG_CAST(ROFH,msg), ekf2, ekf3);
} }
void LR_MsgHandler_RWOH::process_message(uint8_t *msg)
{
AP::dal().handle_message(MSG_CAST(RWOH,msg), ekf2, ekf3);
}
void LR_MsgHandler_REPH::process_message(uint8_t *msg) void LR_MsgHandler_REPH::process_message(uint8_t *msg)
{ {
AP::dal().handle_message(MSG_CAST(REPH,msg), ekf2, ekf3); AP::dal().handle_message(MSG_CAST(REPH,msg), ekf2, ekf3);

6
Tools/Replay/LR_MsgHandler.h

@ -100,6 +100,12 @@ class LR_MsgHandler_REVH : public LR_MsgHandler_EKF
void process_message(uint8_t *msg) override; void process_message(uint8_t *msg) override;
}; };
class LR_MsgHandler_RWOH : public LR_MsgHandler_EKF
{
using LR_MsgHandler_EKF::LR_MsgHandler_EKF;
void process_message(uint8_t *msg) override;
};
class LR_MsgHandler_RFRN : public LR_MsgHandler class LR_MsgHandler_RFRN : public LR_MsgHandler
{ {
public: public:

2
Tools/Replay/LogReader.cpp

@ -226,6 +226,8 @@ bool LogReader::handle_log_format_msg(const struct log_Format &f)
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, "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")) {
msgparser[f.type] = new LR_MsgHandler_RWOH(formats[f.type], ekf2, ekf3);
} else { } else {
// debug(" No parser for (%s)\n", name); // debug(" No parser for (%s)\n", name);
} }

Loading…
Cancel
Save