USe shared module for waypoints (remove first turn staying)