From a3c89d16a1389c326b212dcf1c7c0a3469f0433e Mon Sep 17 00:00:00 2001 From: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Date: Wed, 15 Feb 2023 07:41:32 +0900 Subject: [PATCH] fix(avoidance): fix bug in calculation of rss longitudinal margin (#2872) Signed-off-by: satoshi-ota --- .../src/scene_module/avoidance/avoidance_module.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp b/planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp index a364fff2ca269..5fa0924d2b4a9 100644 --- a/planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp +++ b/planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp @@ -2458,7 +2458,7 @@ double AvoidanceModule::getRSSLongitudinalDistance( * ======================================= */ if (!is_front_object && !opposite_lane_vehicle) { - return v_obj * idling_time + 0.5 * accel_for_rss * std::pow(v_obj, 2.0) + + return v_obj * idling_time + 0.5 * accel_for_rss * std::pow(idling_time, 2.0) + std::pow(v_obj + accel_for_rss * idling_time, 2.0) / (2.0 * accel_for_rss) - std::pow(v_ego, 2.0) / (2.0 * accel_for_rss); }