Sharing Heterogeneous Spatial Knowledge: Map Fusion Between Asynchronous Monocular Vision and Lidar or Other Prior Inputs
iSAM2: Incremental smoothing and mapping using the Bayes tree