Use attached object colors as is in Rviz plugin (#3274)

Fixes #3273

Co-authored-by: Sebastian Castro <[email protected]>

moveit_ros/visualization/rviz_plugin_render_tools/src/robot_state_visualization.cpp

@@ -132,11 +132,9 @@ void RobotStateVisualization::updateHelper(const moveit::core::RobotStateConstPt
     {
       std::map<std::string, std_msgs::msg::ColorRGBA>::const_iterator it = color_map->find(attached_body->getName());
       if (it != color_map->end())
-      {  // render attached bodies with a color that is a bit different
-        color.r = std::max(1.0f, it->second.r * 1.05f);
-        color.g = std::max(1.0f, it->second.g * 1.05f);
-        color.b = std::max(1.0f, it->second.b * 1.05f);
-        alpha = color.a = it->second.a;
+      {
+        color = it->second;
+        alpha = color.a;
       }
     }
     rviz_default_plugins::robot::RobotLink* link = robot_.getLink(attached_body->getAttachedLinkName());