Initial commit for 3D continuous collision detection