ros-navigation / navigation2

ROS 2 Navigation Framework and System
https://nav2.org/
Other
2.47k stars 1.25k forks source link

smac_planner tuning with dynamic obstacles #2520

Closed saadehmd closed 3 years ago

saadehmd commented 3 years ago

Not sure if this is a bug, so removing the bug report tag.

DESCRIPTION

Unlike the navfn planner smac planner only reacts to the costs that are >= INSCRIBED cost value. A visual representation of this is shown in the GIFs attached. The GIF shows an infinite loop of replanning, where obstacles are registered from the Social navigation Layer. So the costs are laid out in a velocity-skewed gaussian-fashion around the moving obstacles. A lobe at the center is forcefully turned to be equal to INSCRIBED cost for ease of visualization ( although in reality they change smoothly starting from the center).

Expected behavior

Actual Behavior

The planner stays away from INSCRIBED and OCCUPIED cells but doesn't react at all to any other cost values unlike the NavFn planner

Additional information

Navfn_planner GIF navfn

Smac_planner GIF smac