mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-01 02:55:07 +08:00
ekf2_replay: Add missing log messages
This commit is contained in:
committed by
Lorenz Meier
parent
2799c0fae2
commit
06aca33085
@@ -643,6 +643,10 @@ void Ekf2Replay::logIfUpdated()
|
|||||||
est_status.covariances) : sizeof(log_message.body.est2.cov);
|
est_status.covariances) : sizeof(log_message.body.est2.cov);
|
||||||
memset(&(log_message.body.est2.cov), 0, 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);
|
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);
|
writeMessage(_write_fd, (void *)&log_message.head1, _formats[LOG_EST2_MSG].length);
|
||||||
|
|
||||||
log_message.type = LOG_EST3_MSG;
|
log_message.type = LOG_EST3_MSG;
|
||||||
|
|||||||
Reference in New Issue
Block a user