A C++ Library for Simultaneous Localization and Mapping using Random Finite Sets