Filter modified in pointcloud_mapper_for_slam