diff --git a/src/tststreamer.py b/src/tststreamer.py index 4892f287b2cb86ecf4daa0db431753be3513c49a..cdbbd57c895d28c47c7189f6677c1f668a8e2f78 100755 --- a/src/tststreamer.py +++ b/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: