diff --git a/object_tf_client.py b/object_tf_client.py index 5c51a6e..96f8233 100755 --- a/object_tf_client.py +++ b/object_tf_client.py @@ -19,11 +19,11 @@ def tf_lookup(object_name): continue object_angles = tf.transformations.euler_from_quaternion([rot[0] , rot[1] , rot[2], rot[3]]) - xangle = object_angles[0]# + radians(-90) + xangle = object_angles[0] + radians(-90) xangle1 = object_angles[1]# + radians(-90) xangle2 = object_angles[2]# + radians(-180) object_angles = (xangle, xangle1, xangle2) - target_quat = tf.transformations.quaternion_from_euler(object_angles[0], object_angles[1], object_angles[2]) + target_quat = tf.transformations.quaternion_from_euler(xangle, xangle1, xangle2) target_pose = Pose() target_pose.position.x = trans[0] target_pose.position.y = trans[1]