GJK code fixes, seems to actually WORK and makes sense too