A system, comprising a clock generating a timing signal, a magnetometer coupled to the clock and configured to receive the timing signal and to generate first heading data and a gyroscope coupled to the clock and configured to receive the timing signal and to generate second heading data. The system further includes a first adder coupled to the magnetometer and gyroscope and configured to determine a difference signal as a function of the first heading data and the second heading data and a constrain data system coupled to the first adder and configured to apply a limit to the difference signal. A combine delta system is coupled to the constrain data system and configured to combine two or more of the constrained data values to generate a combined delta signal, and a second adder coupled to the gyroscope and the combine delta system and configured to add the combined delta signal to the second heading data.