From e8edd41d9474cbd2de2fe9eb5e585291aed822c6 Mon Sep 17 00:00:00 2001 From: Max Hunt Date: Thu, 13 Feb 2020 10:10:42 +0000 Subject: [PATCH] Update --- main.py | 5 ----- object_tf_client.py | 5 +++++ 2 files changed, 5 insertions(+), 5 deletions(-) diff --git a/main.py b/main.py index e490c70..a42a1f2 100755 --- a/main.py +++ b/main.py @@ -264,11 +264,6 @@ if __name__ == "__main__": left_pick = otc.tf_lookup('a3') - print() - print() - print(left_pick) - print() - print() # left_pick.position.z+=0.5 left_pnp.pick(left_pick) diff --git a/object_tf_client.py b/object_tf_client.py index 8173d68..53b41ca 100755 --- a/object_tf_client.py +++ b/object_tf_client.py @@ -23,6 +23,11 @@ def tf_lookup(object_name): xangle1 = object_angles[1]# + radians(-90) xangle2 = object_angles[2]# + radians(-180) object_angles = (xangle, xangle1, xangle2) + print("Angles:") + print(xangle) + print(xangle1) + print(xangle2) + print() target_quat = tf.transformations.quaternion_from_euler(xangle, xangle1, xangle2) target_pose = Pose() target_pose.position.x = trans[0]