- fixed retrievePath bug
- using little-tsp (thanks!) for waypoint reordering
- re-enable cuda error checking
- cleanups

Smooth replanning actually works now!