Geometric parameter estimation by cost minimization door Liu Lu