Nonlinear Multiplicative Smoothing Applied to Trajectory Recovery for GPS/INS-Aided Navigation