diff --git a/moveit_ros/visualization/motion_planning_rviz_plugin/src/interactive_marker_display.cpp b/moveit_ros/visualization/motion_planning_rviz_plugin/src/interactive_marker_display.cpp
index ad791e7053..5234407dd7 100644
--- a/moveit_ros/visualization/motion_planning_rviz_plugin/src/interactive_marker_display.cpp
+++ b/moveit_ros/visualization/motion_planning_rviz_plugin/src/interactive_marker_display.cpp
@@ -91,13 +91,13 @@ InteractiveMarkerDisplay::InteractiveMarkerDisplay()
 
 void InteractiveMarkerDisplay::onInitialize()
 {
-  //  auto ros_node_abstraction = context_->getRosNodeAbstraction().lock();
-  //  if (!ros_node_abstraction) {
-  //    return;
-  //  }
-  //
-  //  interactive_marker_namespace_property_->initialize(ros_node_abstraction);
-  //
+  auto ros_node_abstraction = context_->getRosNodeAbstraction().lock();
+  if (!ros_node_abstraction)
+  {
+    return;
+  }
+  interactive_marker_namespace_property_->initialize(ros_node_abstraction);
+
   rclcpp::NodeOptions options;
   options.arguments({ "--ros-args", "-r",
                       "__node:=" + std::string("interactive_marker_display_") +