diff --git a/src/pycram/external_interfaces/knowrob.py b/src/pycram/external_interfaces/knowrob.py index ee82a2853..48b0c3e4a 100644 --- a/src/pycram/external_interfaces/knowrob.py +++ b/src/pycram/external_interfaces/knowrob.py @@ -150,11 +150,12 @@ def get_table_pose(table_name): Get table pose from knowledge :param table_name: predefined name for each table """ - + print("waiting for server") rospy.wait_for_service('pose_server') try: - service = rospy.ServiceProxy('pose_server', String) - table_pose = service(table_name) + service = rospy.ServiceProxy('pose_server', ObjectPose) + table_pose = service(table_name)# + print(f"table_pose_knowrob: {table_pose}") return table_pose except rospy.ServiceException: print("Service call failed")