Added rviz cfg.
Updated README.