NonRigidPointSet: make LS-solve more stable