Robust Incremental Smoothing and Mapping (riSAM) published in ICRA 2023 - View it on GitHub