fix a crashing bug of Lemke's method
fix a crashing bug of Lemke's method

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