perf(obstacle_stop_planner): prevent unnecessary duplicate points

[maxime-clem]

Signed-off-by: Maxime CLEMENT maxime.clement@tier4.jp

Description

This PR improve performance of function searchPointcloudNearTrajectory() used to filter a pointcloud and keep only points close enough to a trajectory.

In the current implementation, a point from the pointcloud will be added for all trajectory point that are within range.
This PR ensures that a point can only be added once.

Pre-review checklist for the PR author

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

• I've confirmed the contribution guidelines.
• The PR follows the pull request guidelines.

In-review checklist for the PR reviewers

The PR reviewers must check the checkboxes below before approval.

• The PR follows the pull request guidelines.

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.

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

[codecov]

Codecov Report

Merging #1486 (7b94ead) into main (38a3c60) will increase coverage by 0.43%.
The diff coverage is n/a.

❗ Current head 7b94ead differs from pull request most recent head bce2598. Consider uploading reports for the commit bce2598 to get more accurate results

@@            Coverage Diff             @@
##             main    #1486      +/-   ##
==========================================
+ Coverage   10.28%   10.72%   +0.43%     
==========================================
  Files        1205     1103     -102     
  Lines       86829    78410    -8419     
  Branches    20079    18649    -1430     
==========================================
- Hits         8931     8409     -522     
+ Misses      68602    61087    -7515     
+ Partials     9296     8914     -382     

Flag	Coverage Δ
total	10.70% <0.00%> (+0.43%)	⬆️

Impacted Files	Coverage Δ
...ail/dds_fastrtps/response_status__type_support.cpp	0.00% <0.00%> (-16.08%)	⬇️
..._msgs/msg/detail/response_status__type_support.cpp	0.00% <0.00%> (-15.39%)	⬇️
...city_planner/include/utilization/arc_lane_util.hpp	32.75% <0.00%> (-15.13%)	⬇️
planning/behavior_path_planner/src/utilities.cpp	1.04% <0.00%> (-2.32%)	⬇️
...planning_evaluator/src/planning_evaluator_node.cpp	37.11% <0.00%> (-1.04%)	⬇️
...ils/include/motion_utils/trajectory/trajectory.hpp	77.86% <0.00%> (-0.89%)	⬇️
...ner/src/scene_module/avoidance/avoidance_utils.cpp	2.91% <0.00%> (-0.22%)	⬇️
.../motion_velocity_smoother/src/trajectory_utils.cpp	3.24% <0.00%> (-0.13%)	⬇️
system/default_ad_api/src/interface.cpp	71.42% <0.00%> (ø)
planning/obstacle_cruise_planner/src/node.cpp	0.00% <0.00%> (ø)
... and 190 more

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

[taikitanaka3]

LGTM
with CI testing
https://evaluation.tier4.jp/evaluation/reports/52233d8b-efc3-525d-b001-c0515cb61a11?project_id=prd_jt