added coloring for TSDF implementation