A Real-time Approach to Nonlinear Modeling of Inertial Errors with Application to Three Dimension Vehicle Navigation