An Effective Sage-Husa Kalman Filter for SINS/Doppler/Odometer Integrated Navigation System