Add the full GJK algorithm with simple tests.