Skip to content
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

Conversation

YamatoAndo
Copy link
Contributor

Description

The timestamp of /initialpose3d was always set to 0, so I investigated the cause and made the necessary fixes.

Related links

Parent Issue:

  • Link

How was this PR tested?

Lsim works.

and check the timestamp of /initialpose3d.

ros2 topic echo /initialpose3d --field header

Notes for reviewers

None.

Interface changes

None.

Effects on system behavior

None.

Signed-off-by: Yamato Ando <yamato.ando@tier4.jp>
@github-actions github-actions bot added the component:localization Vehicle's position determination in its environment. (auto-assigned) label Aug 23, 2024
Copy link

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;
Copy link
Contributor

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

[Note]

transform :

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

https://github.com/ros2/geometry2/blob/ae8a167e10ee65b4a44a9d7b71cd23d2579215f8/tf2_geometry_msgs/include/tf2_geometry_msgs/tf2_geometry_msgs.hpp#L789-L814

The header is copied from transform.

@YamatoAndo YamatoAndo added the run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) label Aug 23, 2024
Copy link

codecov bot commented Aug 23, 2024

Codecov Report

All modified and coverable lines are covered by tests ✅

Project coverage is 24.00%. Comparing base (23e13fd) to head (b6881ed).
Report is 13 commits behind head on main.

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     
Flag Coverage Δ *Carryforward flag
differential 28.31% <100.00%> (?)
total 23.99% <ø> (-0.01%) ⬇️ Carriedforward from 23e13fd

*This pull request uses carry forward flags. Click here to find out more.

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

@YamatoAndo YamatoAndo merged commit f64c4ed into autowarefoundation:main Aug 26, 2024
41 checks passed
kyoichi-sugahara pushed a commit to kyoichi-sugahara/autoware.universe that referenced this pull request Aug 27, 2024
…arefoundation#8599)

fix timestamp

Signed-off-by: Yamato Ando <yamato.ando@tier4.jp>
a-maumau pushed a commit to a-maumau/autoware.universe that referenced this pull request Sep 2, 2024
…arefoundation#8599)

fix timestamp

Signed-off-by: Yamato Ando <yamato.ando@tier4.jp>
ktro2828 pushed a commit to ktro2828/autoware.universe that referenced this pull request Sep 18, 2024
…arefoundation#8599)

fix timestamp

Signed-off-by: Yamato Ando <yamato.ando@tier4.jp>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:localization Vehicle's position determination in its environment. (auto-assigned) run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants