feat(motion_utils): add new calcSignedArcLength

[takayuki5168]

Signed-off-by: Takayuki Murooka takayuki5168@gmail.com

Description

Implemented calcSignedArcLength which assumes to calculate segment index outside the function.
Therefore, the input of calcSignedArcLength in this PR is position and segment index or point index.

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.

[purewater0901]

LGTM

[codecov]

Codecov Report

Merging #1701 (bfb1ecb) into main (fcf1302) will increase coverage by 0.39%.
The diff coverage is 36.20%.

@@            Coverage Diff             @@
##             main    #1701      +/-   ##
==========================================
+ Coverage   10.72%   11.11%   +0.39%     
==========================================
  Files        1103     1103              
  Lines       78416    80232    +1816     
  Branches    18648    20099    +1451     
==========================================
+ Hits         8409     8919     +510     
- Misses      61093    61963     +870     
- Partials     8914     9350     +436     

Flag	Coverage Δ		*Carryforward flag
differential	10.82% <30.18%> (?)
total	10.70% <100.00%> (ø)		Carriedforward from fcf1302

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

Impacted Files	Coverage Δ
...tion_utils/test/src/trajectory/test_trajectory.cpp	25.62% <13.95%> (-0.27%)	⬇️
...ils/include/motion_utils/trajectory/trajectory.hpp	78.89% <100.00%> (+1.03%)	⬆️
planning/behavior_path_planner/src/utilities.cpp	0.85% <0.00%> (-0.20%)	⬇️
planning/surround_obstacle_checker/src/node.cpp	0.00% <0.00%> (ø)
...nning/behavior_path_planner/src/path_utilities.cpp	0.00% <0.00%> (ø)
...ing/surround_obstacle_checker/src/debug_marker.cpp	0.00% <0.00%> (ø)
...city_planner/src/scene_module/blind_spot/scene.cpp	0.00% <0.00%> (ø)
..._planner/src/scene_module/intersection/manager.cpp	0.00% <0.00%> (ø)
...er/src/scene_module/avoidance/avoidance_module.cpp	0.00% <0.00%> (ø)
...or_path_planner/src/behavior_path_planner_node.cpp	0.33% <0.00%> (+0.10%)	⬆️
... and 3 more

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