Added voxel filtering for stereo camera data.

Added conditional compilation
for kalman filtering because opencv headers clash with
pcl statistical filtering header.