Modifications to Color KinectFusion Demo code

Modified original project to write out bmp image files of color data