Fix the heading hold mag problem YE