This commit is contained in:
Max Hunt 2020-02-13 00:04:41 +00:00
parent 0b3df22575
commit 2781835feb

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