This commit is contained in:
Max Hunt 2020-02-10 22:35:43 +00:00
parent 1ec26b4ef6
commit 61d1e45a12

View File

@ -19,7 +19,8 @@ def tf_lookup(object_name):
continue continue
object_angles = tf.transformations.euler_from_quaternion([rot[0] , rot[1] , rot[2], rot[3]]) object_angles = tf.transformations.euler_from_quaternion([rot[0] , rot[1] , rot[2], rot[3]])
object_angles = (object_angles[0] += radians(90), object_angles[1], object_angles[2]) xangle = object_angles[0] += radians(90)
object_angles = (xangle, object_angles[1], object_angles[2])
target_quat = tf.transformations.quaternion_from_euler(object_angles[0], object_angles[1], object_angles[2]) target_quat = tf.transformations.quaternion_from_euler(object_angles[0], object_angles[1], object_angles[2])
target_pose = Pose() target_pose = Pose()
target_pose.position.x = trans[0] target_pose.position.x = trans[0]