Implementation of first successul heading controller