Efficient Algorithms And Systems For Multi-Agent Mapping And World-Scale Real-Time Localization