Update instruction generation to determine if a waypoint has been passed