Add GJK distance algorithm.
Merge remote-tracking branch 'origin/dev' into dev