Implement receding horizon version with anchor waypoints

Instead of having the strided waypoint be selected based on the current progress, this changed implement should select a number of 'anchor' waypoints at the beginning of the mission and these will not change.