Contents:
Plans a path from start to goal.
start (pyrobosim.utils.pose.Pose) – Start pose.
pyrobosim.utils.pose.Pose
goal (pyrobosim.utils.pose.Pose) – Goal pose.