smartFollow with waypoints