Added rviz_cfg config