fix(behavior_velocity): fix insertVelocity

[taikitanaka3]

Signed-off-by: tanaka3 ttatcoder@outlook.jp

Description

bug fix for insertVelcity util function in behavior velocity

• this happen only insert path point is close to original

before

after

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 #1768 (b5b0e92) into main (6075e60) will not change coverage.
The diff coverage is 0.00%.

@@           Coverage Diff           @@
##             main    #1768   +/-   ##
=======================================
  Coverage   10.38%   10.38%           
=======================================
  Files        1212     1212           
  Lines       87407    87407           
  Branches    20282    20283    +1     
=======================================
  Hits         9080     9080           
  Misses      68846    68846           
  Partials     9481     9481           

Flag	Coverage Δ		*Carryforward flag
differential	4.57% <0.00%> (?)
total	10.37% <0.00%> (ø)		Carriedforward from 6075e60

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

Impacted Files	Coverage Δ
...polation/include/interpolation/zero_order_hold.hpp	47.05% <ø> (ø)
...behavior_velocity_planner/src/utilization/util.cpp	12.45% <0.00%> (ø)

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

[kosuke55]

LGTM