Distributed real-time cooperative localization and mapping using an uncertainty-aware expectation maximization approach
iSAM2: Incremental smoothing and mapping using the Bayes tree