Added support for RMHC_SLAM. To Do: Odometry.