Heavily Debugged GJK Algorithm, and greatly improved performance.