Added confidence filter and mean filter to depth image, removed radius and voxel filter code, since these are slow