-
Notifications
You must be signed in to change notification settings - Fork 682
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
fix(ndt_scan_matcher): fix timestamp in service_ndt_align func #8599
fix(ndt_scan_matcher): fix timestamp in service_ndt_align func #8599
Conversation
Signed-off-by: Yamato Ando <yamato.ando@tier4.jp>
Thank you for contributing to the Autoware project! 🚧 If your pull request is in progress, switch it to draft mode. Please ensure:
|
@@ -961,7 +961,8 @@ void NDTScanMatcher::service_ndt_align_main( | |||
diagnostics_ndt_align_->add_key_value("is_succeed_transform_initial_pose", true); | |||
|
|||
// transform pose_frame to map_frame | |||
const auto initial_pose_msg_in_map_frame = transform(req->pose_with_covariance, transform_s2t); | |||
auto initial_pose_msg_in_map_frame = transform(req->pose_with_covariance, transform_s2t); | |||
initial_pose_msg_in_map_frame.header.stamp = req->pose_with_covariance.header.stamp; |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
[Note]
transform :
autoware.universe/localization/localization_util/include/localization_util/util_func.hpp
Lines 70 to 76 in 18b5ee1
template <class T> | |
T transform(const T & input, const geometry_msgs::msg::TransformStamped & transform) | |
{ | |
T output; | |
tf2::doTransform<T>(input, output, transform); | |
return output; | |
} |
tf2::doTransform
The header
is copied from transform
.
Codecov ReportAll modified and coverable lines are covered by tests ✅
Additional details and impacted files@@ Coverage Diff @@
## main #8599 +/- ##
=======================================
Coverage 23.99% 24.00%
=======================================
Files 1385 1385
Lines 102485 102496 +11
Branches 38994 38996 +2
=======================================
+ Hits 24592 24602 +10
Misses 75410 75410
- Partials 2483 2484 +1
*This pull request uses carry forward flags. Click here to find out more. ☔ View full report in Codecov by Sentry. |
…arefoundation#8599) fix timestamp Signed-off-by: Yamato Ando <yamato.ando@tier4.jp>
…arefoundation#8599) fix timestamp Signed-off-by: Yamato Ando <yamato.ando@tier4.jp>
…arefoundation#8599) fix timestamp Signed-off-by: Yamato Ando <yamato.ando@tier4.jp>
Description
The timestamp of
/initialpose3d
was always set to 0, so I investigated the cause and made the necessary fixes.Related links
Parent Issue:
How was this PR tested?
Lsim works.
and check the timestamp of
/initialpose3d
.Notes for reviewers
None.
Interface changes
None.
Effects on system behavior
None.