GJK: use support direction cache and augment the convergence threshold.

This improves a lot convergence for quadratic shapes.
Fix dynamic borrow cheking error occuring on tests.