Skip to content

Commit

Permalink
EKF2: use timestamp from argument of PublishEvPosBias() (#21822)
Browse files Browse the repository at this point in the history
* EKF2: use timestamp from argument of PublishEvPosBias()

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>

* Update src/modules/ekf2/EKF2.cpp

Co-authored-by: Mathieu Bresciani <brescianimathieu@gmail.com>

---------

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
Co-authored-by: Mathieu Bresciani <brescianimathieu@gmail.com>
  • Loading branch information
sfuhrer and bresch authored Jul 11, 2023
1 parent 02ab5e0 commit 81764c4
Showing 1 changed file with 1 addition and 1 deletion.
2 changes: 1 addition & 1 deletion src/modules/ekf2/EKF2.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -1057,7 +1057,7 @@ void EKF2::PublishEvPosBias(const hrt_abstime &timestamp)

if ((bias_vec - _last_ev_bias_published).longerThan(0.01f)) {
bias.timestamp_sample = _ekf.aid_src_ev_hgt().timestamp_sample;
bias.timestamp = hrt_absolute_time();
bias.timestamp = _replay_mode ? timestamp : hrt_absolute_time();
_estimator_ev_pos_bias_pub.publish(bias);

_last_ev_bias_published = Vector3f(bias.bias);
Expand Down

0 comments on commit 81764c4

Please sign in to comment.