Added GJK collision routine from MollyRocket