C++ code for triangulation for 3D point cloud