Aerial-guided navigation of a ground robot among movable obstacles
iSAM: Incremental Smoothing and Mapping