Clean up model visualization tools

Adjust launch.xml
Add new rviz config