ekf2_replay: Add missing log messages

This commit is contained in:
Paul Riseborough 2016-11-14 19:16:00 +11:00 committed by Lorenz Meier
parent 2799c0fae2
commit 06aca33085

View File

@ -643,6 +643,10 @@ void Ekf2Replay::logIfUpdated()
est_status.covariances) : sizeof(log_message.body.est2.cov);
memset(&(log_message.body.est2.cov), 0, sizeof(log_message.body.est2.cov));
memcpy(&(log_message.body.est2.cov), est_status.covariances, maxcopy2);
log_message.body.est2.gps_check_fail_flags = est_status.gps_check_fail_flags;
log_message.body.est2.control_mode_flags = est_status.control_mode_flags;
log_message.body.est2.health_flags = est_status.health_flags;
log_message.body.est2.innov_test_flags = est_status.innovation_check_flags;
writeMessage(_write_fd, (void *)&log_message.head1, _formats[LOG_EST2_MSG].length);
log_message.type = LOG_EST3_MSG;