Implemented follow waypoints.