Implemented nonlinear least squares estimation for multilateration.