GJK Update

GJK works now, an example is included in the game manager. A lot of bugs
fixed mostly related to the math library.