Distributed Optimization with Consensus Constraint for Multi-Robot Semantic Octree Mapping