This commit is contained in:
Max Hunt 2020-02-13 01:28:52 +00:00
parent 4f7fbfa3f3
commit 4450a576ad

View File

@ -21,7 +21,7 @@ def tf_lookup(object_name):
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]])
xangle = object_angles[0] + radians(180) xangle = object_angles[0] + radians(180)
xangle1 = object_angles[1] + radians(-90) xangle1 = object_angles[1] + radians(-90)
xangle2 = object_angles[2] + radians(90) xangle2 = object_angles[2] + radians(-90)
object_angles = (xangle, xangle1, xangle2) 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(object_angles[0], object_angles[1], object_angles[2])
target_pose = Pose() target_pose = Pose()