sbpl_recovery

sbpl_recovery

A recovery behavior that uses the SBPL lattice planner and the pose follower to try to plan in full 3D to get the robot out of really tricky situations.