feat(goal_planner): sort goal candidates priority by weighted distance (

#591) Signed-off-by: kosuke55 <[email protected]>
tier4 · Sep 26, 2023 · 5b7e16c · 5b7e16c
1 parent 5017578
commit 5b7e16c
Showing 1 changed file with 4 additions and 1 deletion.
diff --git a/...lane_driving/behavior_planning/behavior_path_planner/goal_planner/goal_planner.param.yaml b/...lane_driving/behavior_planning/behavior_path_planner/goal_planner/goal_planner.param.yaml
@@ -9,7 +9,10 @@
 
       # goal search
       goal_search:
-        search_priority: "efficient_path" # "efficient_path" or "close_goal"
+        goal_priority: "minimum_weighted_distance" # "minimum_weighted_distance" or "minimum_longitudinal_distance"
+        minimum_weighted_distance:
+          lateral_weight: 40.0
+        path_priority: "efficient_path" # "efficient_path" or "close_goal"
         parking_policy: "left_side" # "left_side" or "right_side"
         forward_goal_search_length: 20.0
         backward_goal_search_length: 20.0