Filter pointcloud fix