Real-Time localization and Topological Mapping in Buried Pipe Networks