This is a copy of the old tabletop_collision_map_processing without arm_navigation dependencies.