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

refactor(ndt_scan_matcher): refactor callbackSensorPoints #1757

Conversation

kminoda
Copy link
Contributor

@kminoda kminoda commented Sep 1, 2022

Signed-off-by: kminoda koji.m.minoda@gmail.com

Description

  • refactored callbackSensorPoints
  • refactored alignUsingMonteCarlo
  • modified the function name from lowerCamerCase to snake_case
  • changed the definition of exe_time in callbackSensorPoints

Related links

Tests performed

Ran Autoware tutorial rosbag with logging_simulator and confirmed that the performance does not change before and after this modification.

(Performance must not change)

Notes for reviewers

Pre-review checklist for the PR author

The PR author must check the checkboxes below when creating the PR.

In-review checklist for the PR reviewers

The PR reviewers must check the checkboxes below before approval.

  • The PR follows the pull request guidelines.
  • The PR has been properly tested.
  • The PR has been reviewed by the code owners.

Post-review checklist for the PR author

The PR author must check the checkboxes below before merging.

  • There are no open discussions or they are tracked via tickets.
  • The PR is ready for merge.

After all checkboxes are checked, anyone who has write access can merge the PR.

Signed-off-by: kminoda <koji.m.minoda@gmail.com>
@kminoda kminoda self-assigned this Sep 1, 2022
@kminoda kminoda added the component:localization Vehicle's position determination in its environment. (auto-assigned) label Sep 1, 2022
pre-commit-ci bot and others added 6 commits September 1, 2022 06:31
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
…ub.com:kminoda/autoware.universe into refactor/ndt_scan_matcher_callbackSensorPoints
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
…ub.com:kminoda/autoware.universe into refactor/ndt_scan_matcher_callbackSensorPoints
@kminoda kminoda marked this pull request as ready for review September 1, 2022 06:53
@kminoda kminoda requested a review from YamatoAndo September 1, 2022 06:54
@codecov
Copy link

codecov bot commented Sep 1, 2022

Codecov Report

Base: 10.32% // Head: 10.27% // Decreases project coverage by -0.05% ⚠️

Coverage data is based on head (24b77a2) compared to base (c57206c).
Patch coverage: 0.00% of modified lines in pull request are covered.

Additional details and impacted files
@@            Coverage Diff             @@
##             main    #1757      +/-   ##
==========================================
- Coverage   10.32%   10.27%   -0.06%     
==========================================
  Files        1147     1208      +61     
  Lines       81613    87401    +5788     
  Branches    19048    20076    +1028     
==========================================
+ Hits         8429     8982     +553     
- Misses      64188    69117    +4929     
- Partials     8996     9302     +306     
Flag Coverage Δ *Carryforward flag
differential 0.00% <0.00%> (?)
total 10.29% <0.00%> (-0.02%) ⬇️ Carriedforward from 0a2bcef

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

Impacted Files Coverage Δ
...include/ndt_scan_matcher/ndt_scan_matcher_core.hpp 0.00% <0.00%> (ø)
...can_matcher/include/ndt_scan_matcher/util_func.hpp 0.00% <ø> (ø)
localization/ndt_scan_matcher/src/debug.cpp 0.00% <0.00%> (ø)
...ion/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp 0.00% <0.00%> (ø)
...n/ndt_scan_matcher/src/pose_array_interpolator.cpp 0.00% <0.00%> (ø)
localization/ndt_scan_matcher/src/util_func.cpp 0.00% <0.00%> (ø)
...polation/include/interpolation/zero_order_hold.hpp 47.05% <0.00%> (-34.76%) ⬇️
...ocity_planner/src/utilization/path_utilization.cpp 18.91% <0.00%> (-2.30%) ⬇️
...tion/include/interpolation/interpolation_utils.hpp 54.83% <0.00%> (-1.83%) ⬇️
control/trajectory_follower/test/test_mpc.cpp 55.68% <0.00%> (-1.14%) ⬇️
... and 396 more

Help us with your feedback. Take ten seconds to tell us how you rate us. Have a feature suggestion? Share it here.

☔ View full report at Codecov.
📢 Do you have feedback about the report comment? Let us know in this issue.

kminoda and others added 18 commits September 1, 2022 17:47
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
…ub.com:kminoda/autoware.universe into refactor/ndt_scan_matcher_callbackSensorPoints
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
…ub.com:kminoda/autoware.universe into refactor/ndt_scan_matcher_callbackSensorPoints
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
…ub.com:kminoda/autoware.universe into refactor/ndt_scan_matcher_callbackSensorPoints
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
…ub.com:kminoda/autoware.universe into refactor/ndt_scan_matcher_callbackSensorPoints
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
kminoda and others added 4 commits September 21, 2022 22:37
Signed-off-by: kminoda <koji.minoda@tier4.jp>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>
@IshitaTakeshi
Copy link
Contributor

For a large change like this I think we definitely need tests but for this time I can approve

Copy link
Contributor

@YamatoAndo YamatoAndo left a comment

Choose a reason for hiding this comment

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

There are a lot of changes, but I approve this pr because the localization worked as before.

@kminoda kminoda merged commit 87f2322 into autowarefoundation:main Sep 29, 2022
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
* now works

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* refactored alignUsingMonteCarlo

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* output from screen to log

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* lowerCamelCase to snake_case

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* remove iteration_num_max from NdtResult

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* minor fix

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* remove publish_scalars

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* move publish_tf out from publish_pose

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* simplified the function transform_sensor_points

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* WIP pose_array_interpolator

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* added pose_array_interpolator class

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* remove unnecessary code

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* removed std::pow(*, 2)

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* reflected comments

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* minor fix in publish_point_cloud (seperated pcd transform and publish)

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* removed unnecessary commentout

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* changed Eigen::Vector3f to Eigen::Vector3d

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* reverted No pose warning for initial pose

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* from_HOGE_to_FUGA to HOGE_to_FUGA

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* validate_* functions should not change member variables implicitely

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* removed member function that implicitely changes the member variables

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* remote 'ros' and 'eigen' prefix from utiility function name

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* debugged

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* added a name for each validation booleans

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

Signed-off-by: kminoda <koji.m.minoda@gmail.com>
Signed-off-by: kminoda <koji.minoda@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
boyali referenced this pull request in boyali/autoware.universe Oct 3, 2022
* now works

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* refactored alignUsingMonteCarlo

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* output from screen to log

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* lowerCamelCase to snake_case

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* remove iteration_num_max from NdtResult

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* minor fix

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* remove publish_scalars

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* move publish_tf out from publish_pose

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* simplified the function transform_sensor_points

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* WIP pose_array_interpolator

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* added pose_array_interpolator class

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* remove unnecessary code

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* removed std::pow(*, 2)

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* reflected comments

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* minor fix in publish_point_cloud (seperated pcd transform and publish)

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* removed unnecessary commentout

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* changed Eigen::Vector3f to Eigen::Vector3d

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* reverted No pose warning for initial pose

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* from_HOGE_to_FUGA to HOGE_to_FUGA

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* validate_* functions should not change member variables implicitely

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* removed member function that implicitely changes the member variables

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* remote 'ros' and 'eigen' prefix from utiility function name

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* debugged

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* added a name for each validation booleans

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

Signed-off-by: kminoda <koji.m.minoda@gmail.com>
Signed-off-by: kminoda <koji.minoda@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
boyali referenced this pull request in boyali/autoware.universe Oct 19, 2022
* now works

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* refactored alignUsingMonteCarlo

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* output from screen to log

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* lowerCamelCase to snake_case

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* remove iteration_num_max from NdtResult

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* minor fix

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* remove publish_scalars

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* move publish_tf out from publish_pose

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* simplified the function transform_sensor_points

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* WIP pose_array_interpolator

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* added pose_array_interpolator class

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* remove unnecessary code

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* removed std::pow(*, 2)

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* reflected comments

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* minor fix in publish_point_cloud (seperated pcd transform and publish)

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* removed unnecessary commentout

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* changed Eigen::Vector3f to Eigen::Vector3d

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* reverted No pose warning for initial pose

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* from_HOGE_to_FUGA to HOGE_to_FUGA

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* validate_* functions should not change member variables implicitely

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* removed member function that implicitely changes the member variables

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* remote 'ros' and 'eigen' prefix from utiility function name

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* debugged

Signed-off-by: kminoda <koji.minoda@tier4.jp>

* ci(pre-commit): autofix

* added a name for each validation booleans

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

Signed-off-by: kminoda <koji.m.minoda@gmail.com>
Signed-off-by: kminoda <koji.minoda@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
@kminoda kminoda deleted the refactor/ndt_scan_matcher_callbackSensorPoints branch August 10, 2023 08:51
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)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

3 participants