diff --git a/src/modules/ekf2_replay/ekf2_replay_main.cpp b/src/modules/ekf2_replay/ekf2_replay_main.cpp index 74f1159152..8b2937abb3 100644 --- a/src/modules/ekf2_replay/ekf2_replay_main.cpp +++ b/src/modules/ekf2_replay/ekf2_replay_main.cpp @@ -645,6 +645,9 @@ void Ekf2Replay::logIfUpdated() log_message.body.innov.s[i] = innov.vel_pos_innov[i]; log_message.body.innov.s[i + 6] = innov.vel_pos_innov_var[i]; } + for (unsigned i = 0; i < 3; i++) { + log_message.body.innov.s[i + 12] = innov.output_tracking_error[i]; + } writeMessage(_write_fd, (void *)&log_message.head1, _formats[LOG_EST4_MSG].length);