https://severisuominen.github.io//posts/gjk-with-epa-part-1/