KinectFusion implementation by windwish.