To develop GPS and inertial sensor data fusion algorithm, which takes in account nonlinearity of MEMS (microelectromechanical) sensor model and improves performance metrics of navigation during GPS signal outages. This algorithm estimates velocity, position of vehicle, bias and scale factor of accelerometer. The developed algorithm was applied for kinematics data processing with simulated period of GPS signal outage. The implementation of algorithm was done using MATLAB's programming language.