An adaptive U-D factorized Kalman filter for strap down inertial navigation system