The C++ version of the ratslam algorithm