hil : fix heading and altitude