Merge pull request autowarefoundation#619 from tier4/feat/beta/v0.43.…

…0/update-start-goal-planner Feat/beta/v0.43.0/update start goal planner
soblin · Sep 4, 2023 · 7f75175 · 7f75175
2 parents 7c4169f + 4dc92ec
commit 7f75175
Show file tree

Hide file tree

Showing 2 changed files with 40 additions and 3 deletions.
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
@@ -11,7 +11,7 @@
       goal_search:
         search_priority: "efficient_path" # "efficient_path" or "close_goal"
         parking_policy: "left_side" # "left_side" or "right_side"
-        forward_goal_search_length: 20.0
+        forward_goal_search_length: 30.0
         backward_goal_search_length: 20.0
         goal_search_interval: 2.0
         longitudinal_margin: 3.0
@@ -31,7 +31,8 @@
       # object recognition
       object_recognition:
         use_object_recognition: true
-        object_recognition_collision_check_margin: 1.0
+        object_recognition_collision_check_margin: 0.6 # this should be larger than `surround_check_distance` of surround_obstacle_checker
+        object_recognition_collision_check_max_extra_stopping_margin: 1.0
 
       # pull over
       pull_over:

diff --git a/...ne_driving/behavior_planning/behavior_path_planner/start_planner/start_planner.param.yaml b/...ne_driving/behavior_planning/behavior_path_planner/start_planner/start_planner.param.yaml
@@ -28,11 +28,47 @@
       # search start pose backward
       enable_back: true
       search_priority: "efficient_path"  # "efficient_path" or "short_back_distance"
-      max_back_distance: 30.0
+      max_back_distance: 20.0
       backward_search_resolution: 2.0
       backward_path_update_duration: 3.0
       ignore_distance_from_lane_end: 15.0
       # turns signal
       th_turn_signal_on_lateral_offset: 1.0
       intersection_search_length: 30.0
       length_ratio_for_turn_signal_deactivation_near_intersection: 0.5
+      # freespace planner
+      freespace_planner:
+        enable_freespace_planner: false
+        end_pose_search_start_distance: 20.0
+        end_pose_search_end_distance: 30.0
+        end_pose_search_interval: 2.0
+        freespace_planner_algorithm: "astar"  # options: astar, rrtstar
+        velocity: 1.0
+        vehicle_shape_margin: 1.0
+        time_limit: 3000.0
+        minimum_turning_radius: 5.0
+        maximum_turning_radius: 5.0
+        turning_radius_size: 1
+        # search configs
+        search_configs:
+          theta_size: 144
+          angle_goal_range: 6.0
+          curve_weight: 1.2
+          reverse_weight: 1.0
+          lateral_goal_range: 0.5
+          longitudinal_goal_range: 2.0
+        # costmap configs
+        costmap_configs:
+          obstacle_threshold: 30
+        # -- A* search Configurations --
+        astar:
+          only_behind_solutions: false
+          use_back: false
+          distance_heuristic_weight: 1.0
+        # -- RRT* search Configurations --
+        rrtstar:
+          enable_update: true
+          use_informed_sampling: true
+          max_planning_time: 150.0
+          neighbor_radius: 8.0
+          margin: 1.0