Fix Lemke bug: add early stopping
Fix Lemke bug: add early stopping

dartsim/dart,axeisghost/DART6motionBlur,dartsim/dart,axeisghost/DART6motionBlur,axeisghost/DART6motionBlur,dartsim/dart,dartsim/dart,dartsim/dart