This is the code from sdmiller for using TSDF on a CPU