fix some bug in gjk; add continuous collision, still need more test