1: $ } \quad \Comment{Check convergence using distance threshold $