Improved rviz configuration