SnapPlanner checks the straight-line trajectory
Improved SnapPlanner docstrings.