A Partial-Step Algorithm for the Nonlinear Estimation Problem