diff --git a/object_tf_client.py b/object_tf_client.py index cf83c67..241f12a 100755 --- a/object_tf_client.py +++ b/object_tf_client.py @@ -21,11 +21,10 @@ def tf_lookup(object_name): print('@@@@@@@@@@@@@@@@') print(rot) print('@@@@@@@@@@@@@@@@') - object_angles = tf.transformations.euler_from_quaternion([rot[0] , rot[1], rot[2], rot[3]]) + object_angles = tf.transformations.euler_from_quaternion([rot[2] , rot[0], rot[1], rot[2]], axes='sxyz') xangle = object_angles[0] + radians(360) xangle1 = object_angles[1]# + radians(90) xangle2 = object_angles[2]# + radians(-106) - object_angles = (xangle, xangle1, xangle2) print("Angles:") print(xangle) print(xangle1)