Add the publication of the robot pose.
Update rviz config file to have a better view.