KinectFusion-like program