Working on debugging mag heading correction.