C++ Implementation of VClip convex polyhedron collision detection algorithm