Fixed the bug in self-collision for Lemke