Gravity Matching Aided Inertial Navigation Technique Based on Marginal Robust Unscented Kalman Filter