wip fix GJK & test