MTi-G-700 sensor fusion algorithm