auto heading, works but strange bug in roll/pitch