This commit is contained in:
Max Hunt 2020-02-10 22:34:48 +00:00
parent d0a27ed3bc
commit 1ec26b4ef6

View File

@ -19,9 +19,7 @@ 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]])
print(object_angles) object_angles = (object_angles[0] += radians(90), object_angles[1], object_angles[2])
return
object_angles[0] += radians(90)
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]