Got rid of relative waypoint code, that now has its own branch