This MR has the purpose to catch up the feature of ROS1 on master for ROS2
Interface of rviz2 for slam: