Toggle waypoints implemented