implemented GJK collision detection in matlab