feat(tier4_autoware_utils): add calcSignedArcLength from pose to pose

[taikitanaka3]

Related Issue(required)

#265

Description(required)

add pose to pose arc length(no behavior change)

Review Procedure(required)

see build pass
below is different from arclength from pose to point

Related PR(optional)

Pre-Review Checklist for the PR Author

PR Author should check the checkboxes below when creating the PR.

• Read commit-guidelines
• Assign PR to reviewer

If you are adding new package following items are required:

• Documentation with description of the package is available
• A sample launch file and parameter file are available if the package contains executable nodes

Checklist for the PR Reviewer

Reviewers should check the checkboxes below before approval.

• Commits are properly organized and messages are according to the guideline
• PR title describes the changes

Post-Review Checklist for the PR Author

PR Author should check the checkboxes below before merging.

• All open points are addressed and tracked via issues or tickets

CI Checks

• Build and test for PR / build-and-test-pr: Required to pass before the merge.
• Build and test for PR / clang-tidy-pr: NOT required to pass before the merge. It is up to the reviewer(s). Found false positives? See the [guidelines][clang-tidy-guidelines].
• Check spelling: NOT required to pass before the merge. It is up to the reviewer(s). See here if you want to add some words to the spell check dictionary.

[codecov]

Codecov Report

Merging #421 (e00ffdb) into tier4/proposal (0af7a42) will decrease coverage by 0.52%.
The diff coverage is n/a.

@@                Coverage Diff                @@
##           tier4/proposal    #421      +/-   ##
=================================================
- Coverage           10.10%   9.57%   -0.53%     
=================================================
  Files                 705     460     -245     
  Lines               49295   36400   -12895     
  Branches             6265    4829    -1436     
=================================================
- Hits                 4980    3487    -1493     
+ Misses              40248   29837   -10411     
+ Partials             4067    3076     -991     

Impacted Files	Coverage Δ
...ude/tier4_autoware_utils/trajectory/trajectory.hpp	92.30% <ø> (ø)
...vehicle_model/sim_model_delay_steer_acc_geared.cpp	0.00% <0.00%> (ø)
...vehicle_model/sim_model_ideal_steer_acc_geared.cpp	0.00% <0.00%> (ø)
...selector/external_velocity_limit_selector_node.hpp
control/shift_decider/src/shift_decider.cpp
...er4_state_rviz_plugin/src/autoware_state_panel.cpp
...ose_button_panel/src/initial_pose_button_panel.cpp
common/tier4_api_utils/test/test.cpp
...mon/autoware_point_types/test/test_point_types.cpp
...r_apollo_instance_segmentation/src/feature_map.cpp
... and 238 more

---

Continue to review full report at Codecov.

Legend - Click here to learn more
Δ = absolute <relative> (impact), ø = not affected, ? = missing data
Powered by Codecov. Last update 0af7a42...e00ffdb. Read the comment docs.

[takayuki5168]

LGTM
If you still wanna merge this PR, please get :saitokantoku:'s approval.

[stale]

This pull request has been automatically marked as stale because it has not had recent activity.

[kenji-miyake]

@taikitanaka3 Please resubmit this to main if you still need this PR. 🙏