fix(ndt_scan_matcher): check first old_pose_msg for initialization

Signed-off-by: melike tanrikulu <melike@leodrive.ai>
autowarefoundation · Jan 17, 2023 · d8558e4 · d8558e4
1 parent 11c0c8d
commit d8558e4
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/localization/ndt_scan_matcher/src/util_func.cpp b/localization/ndt_scan_matcher/src/util_func.cpp
@@ -129,7 +129,7 @@ void get_nearest_timestamp_pose(
     const rclcpp::Time pose_time_stamp = output_new_pose_cov_msg_ptr->header.stamp;
     if (pose_time_stamp > time_stamp) {
       // TODO(Tier IV): refactor
-      if (pose_time_stamp.seconds() == 0.0) {
+      if (output_old_pose_cov_msg_ptr->header.stamp.sec == 0.0) {
         output_old_pose_cov_msg_ptr = output_new_pose_cov_msg_ptr;
       }
       break;