[Smac Planner] Enable goal orientation non-specificity

configuration/packages/smac/configuring-smac-hybrid.rst

@@ -389,6 +389,18 @@ Parameters
   Description
     Goal heading mode enum string to plan goal with multiple orientation. Options are "DEFAULT", "BIDIRECTIONAL" and "ALL_DIRECTION". With default mode, the planner will plan the goal with the orientation of the goal pose as was sent by the user. With the "BIDIRECTIONAL" mode, the planner will plan the goal with the orientation of the goal pose and with orientation 180 degree offset from the goal pose orientation. For "ALL_DIRECTION" mode, the planner will plan the goal with the orientation of the goal pose and all the possible orientation based on the angle quantization bins. For both the "BIDIRECTIONAL" and "ALL_DIRECTION" mode, the planner returns the path with the minimum cost.
 
+:``<name>``.coarse_search_resolution:
+
+  ============== ===========================
+  Type           Default                    
+  -------------- ---------------------------
+  string            "4"   
+  ============== ===========================
+
+  Description
+    Number of goal heading bins to skip during the coarse search phase of planning. When a goal is found, a fine search is performed to determine the exact path. This parameter is only used when the goal heading mode is set to "ALL_DIRECTION" and It helps to reduce search time.
+
+
 Example
 *******
 .. code-block:: yaml
@@ -425,6 +437,7 @@ Example
         use_quadratic_cost_penalty: False
         downsample_obstacle_heuristic: True
         allow_primitive_interpolation: False
+        coarse_search_resolution: 4         # Number of bins to skip when doing a coarse search for the path. Only used for all_direction goal heading mode.
         goal_heading_mode: "DEFAULT"        # DEFAULT, BIDIRECTIONAL, ALL_DIRECTION
         smooth_path: True                   # If true, does a simple and quick smoothing post-processing to the path
 

configuration/packages/smac/configuring-smac-lattice.rst

@@ -339,7 +339,16 @@ Parameters
   Description
     Goal heading mode enum string to plan goal with multiple orientation. Options are "DEFAULT", "BIDIRECTIONAL" and "ALL_DIRECTION". With default mode, the planner will plan the goal with the orientation of the goal pose as was sent by the user. With the "BIDIRECTIONAL" mode, the planner will plan the goal with the orientation of the goal pose and with orientation 180 degree offset from the goal pose orientation. For "ALL_DIRECTION" mode, the planner will plan the goal with the orientation of the goal pose and all the possible orientation based on the angle quantization bins. For both the "BIDIRECTIONAL" and "ALL_DIRECTION" mode, the planner returns the path with the minimum cost.
 
+:``<name>``.coarse_search_resolution:
 
+  ============== ===========================
+  Type           Default                    
+  -------------- ---------------------------
+  string            "4"   
+  ============== ===========================
+
+  Description
+    Number of goal heading bins to skip during the coarse search phase of planning. When a goal is found, a fine search is performed to determine the exact path. This parameter is only used when the goal heading mode is set to "ALL_DIRECTION" and It helps to reduce search time.
 
 Example
 *******
@@ -371,6 +380,7 @@ Example
         lookup_table_size: 20.0             # Size of the dubin/reeds-sheep distance window to cache, in meters.
         cache_obstacle_heuristic: false     # Cache the obstacle map dynamic programming distance expansion heuristic between subsequent replannings of the same goal location. Dramatically speeds up replanning performance (40x) if costmap is largely static.
         allow_reverse_expansion: false      # If true, allows the robot to use the primitives to expand in the mirrored opposite direction of the current robot's orientation (to reverse).
+        coarse_search_resolution: 4         # Number of bins to skip when doing a coarse search for the path. Only used for all_direction goal heading mode.
         goal_heading_mode: "DEFAULT"        # DEFAULT, BIDIRECTIONAL, ALL_DIRECTION
         smooth_path: True                   # If true, does a simple and quick smoothing post-processing to the path
         smoother:

migration/Iron.rst

@@ -311,8 +311,9 @@ Smac and Theta* planners have a new parameter ``terminal_checking_interval`` whi
 
 Enable goal orientation non-specificity
 *******************************************
-`PR #4148 <https://github.com/ros-planning/navigation2/pull/4127>`_  introduces a new parameter(goal_heading_mode) in the smac planner, specifically the smac planner hybrid and smac planner lattice that allows for the
+`PR #4148 <https://github.com/ros-planning/navigation2/pull/4127>`_  introduces two new parameters(goal_heading_mode, coarse_search_resolution) in the smac planner, specifically the smac planner hybrid and smac planner lattice that allows for the
 planner to plan to a goal with multiple orientations and return the best path in just one planning call. This is useful for robots that can approach a goal from multiple orientations and the user does not want to plan to each orientation separately.
+In addition to this, the coarse_search_resolution parameter is added to the smac planner lattice to allow for a faster search for the best path.
 
 Here is an Example of the smacHybrid planner with the default goal_heading_mode to see the difference in the planned path.