Fix for display during delegation.

src/tststreamer.py

@@ -9,7 +9,7 @@ from cv_bridge import CvBridge, CvBridgeError
 from lrs_msgs_common.msg import DisplayRequest
 from lrs_msgs_tst.msg import TSTNodeStatus
 from lrs_srvs.srv import DisplayStart
-from tst.tst import get_tree_dot_string_from_uuid, status_exec_info, status_exec_status, get_id_from_uuid
+from tst.tst import get_tree_dot_string_from_uuid, get_tree_dot_string, status_exec_info, status_exec_status, get_id_from_uuid
 from sensor_msgs.msg import CompressedImage
 
 import rospy
@@ -80,22 +80,27 @@ def display_request_callback(data):
     display_type = data.type
     display_tag = data.tag
     display_unit = data.unit
-    rospy.logerr("DISPLAY_REQUEST_CALLBACK tag %s: %s unit %s: %s", tag, display_tag, unit, display_unit)    
+    rospy.logerr("DISPLAY_REQUEST_CALLBACK XXX %s tag %s: %s unit %s: %s", data.type, tag, display_tag, unit, display_unit)    
 
     if tag != display_tag:
+        rospy.logerr("return since tag != display_tag")
         return
     
     if (tag != ""):
         if unit != display_unit:
+            rospy.logerr("return since tag != "" and unit != display_unit")
             return
-        
+
     ns = rospy.get_namespace () + data.type
+    rospy.logerr("ns: %s", ns)
+    rospy.logerr("root_uuid: %s", data.root_uuid)
     resp = get_id_from_uuid(ns, data.root_uuid)
     id = resp.id
-    rospy.logerr("get dot file for id: %d", resp.id)
+    rospy.logerr("get dot file for id: %d - %s", resp.id, data.root_uuid)
     for i in range(3):
-        resp = get_tree_dot_string_from_uuid (ns, data.root_uuid)
-        # print(resp)
+        # resp = get_tree_dot_string_from_uuid (ns, data.root_uuid)
+        resp = get_tree_dot_string (ns, id)
+        print(resp)
         if resp.success:
             rospy.logerr("Got dotstring for id: %s %d", unit, id)
             handle_dot_string(resp.data)
@@ -139,9 +144,9 @@ def update_node(data):
 
 def nsc(data):
     global nsc_list
-    rospy.logerr("nsc: %d %d", data.root_id, data.unique_node_id)
+    # rospy.logerr("nsc: %d %d", data.root_id, data.unique_node_id)
     if not graph:
-        rospy.logerr("graph do not exist")
+        # rospy.logerr("graph do not exist")
         return
     new_nsc_list = []
     for el in nsc_list: