MTi-G-700/710 sensor fusion algorithm