Replaced voxel filtering of stereo camera data with statistical
filtering which gives better results