Improved group display in rviz