Recovered accurate positional information from noisy location data using non-linear pose-graph optimization