Nonlinear Method for Parameter Identification Applied to a Trajectory Estimation Problem