This commit is contained in:
Max Hunt 2020-02-13 01:28:06 +00:00
parent 0d80c0fe48
commit 4f7fbfa3f3

View File

@ -19,9 +19,9 @@ 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(-180)
xangle = object_angles[0] + radians(180)
xangle1 = object_angles[1] + radians(-90)
xangle2 = object_angles[2] + radians(0)
xangle2 = object_angles[2] + radians(90)
object_angles = (xangle, xangle1, xangle2)
target_quat = tf.transformations.quaternion_from_euler(object_angles[0], object_angles[1], object_angles[2])
target_pose = Pose()