fix(interpolation): case query key is same

[taikitanaka3]

Description

The way to solve this #1658

1. allow same query key
   this PR

2. Do not insert same query key to add "DOUBLE_EPSILON" (= 1e-6 for temporary)
   

   autoware.universe/planning/behavior_velocity_planner/src/utilization/path_utilization.cpp

   Line 111 in b0e4852

   if (s_in.at(j) < s_out.at(i) + DOUBLE_EPSILON && s_out.at(i) < s_in.at(j + 1)) {

3. purge resampling points when query is very small enough
   might affect other modules

[component_container_mt-52] terminate called after throwing an instance of 'std::invalid_argument'
[component_container_mt-52]   what():  Either base_keys or query_keys is not sorted.
[ERROR] [component_container_mt-52]: process has died [pid 21779, exit code -6, cmd '/opt/ros/galactic/lib/rclcpp_components/component_container_mt --ros-args -r __node:=behavior_planning_container -r __ns:=/planning/scenario_planning/lane_driving/behavior_planning --params-file /tmp/launch_params_b1m0l4fr'].

Related links

Tests performed

Notes for reviewers

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.
• 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.