This commit is contained in:
Max Hunt 2020-02-13 15:25:18 +00:00
parent 5b92b95217
commit 57f7872a7f

View File

@ -26,7 +26,7 @@ def tf_lookup(object_name):
print('@@@@@@@@@@@@@@@@') print('@@@@@@@@@@@@@@@@')
print(object_angles) print(object_angles)
print('@@@@@@@@@@@@@@@@') print('@@@@@@@@@@@@@@@@')
Re = euler_matrix(radians(180), radians(0), radians(-270), 'rxyz') Re = tf.transformations.euler_matrix(radians(180), radians(0), radians(-270), 'rxyz')
updated_angles = matmul(Re, object_angles) updated_angles = matmul(Re, object_angles)
target_quat = tf.transformations.quaternion_from_matrix(updated_angles) target_quat = tf.transformations.quaternion_from_matrix(updated_angles)
target_pose = Pose() target_pose = Pose()