Bugfixes for user heading tracking mode