This commit is contained in:
Max Hunt 2020-02-13 12:01:10 +00:00
parent e17f92b9f6
commit 9d7437859b

View File

@ -19,9 +19,9 @@ def tf_lookup(object_name):
continue
object_angles = tf.transformations.euler_from_quaternion([rot[3] , rot[0], rot[1], rot[2]], axes='sxyz')
xangle = object_angles[0] + radians(180)
xangle = object_angles[0]# + radians(180)
xangle1 = object_angles[1]# + radians(90)
xangle2 = object_angles[2] + radians(-270)
xangle2 = object_angles[2]# + radians(-270)
object_angles = (xangle, xangle1, xangle2)
print("Angles:")
print(xangle)
@ -58,9 +58,9 @@ if __name__ == "__main__":
# Yaw(2): -180 deg.
#
# INITIAL STANDING VALUES
# 0.211 -20.569 + 159.431
# 1.57 -90.000 + 90.000
# -2.75 20.569 - 200.569
#
#
#
#
#
#