Update readme

Add some rviz and some launch fieles.
and update README.