max/robotics
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Update

Browse Source
This commit is contained in:
Max Hunt 2020-02-13 15:05:55 +00:00
parent b53d2b0a58
commit 07fd2a0ce5
1 changed files with 1 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
object_tf_client.py
View File

@ -21,11 +21,10 @@ def tf_lookup(object_name):
print('@@@@@@@@@@@@@@@@')
print(rot)
print('@@@@@@@@@@@@@@@@')
object_angles = tf.transformations.euler_from_quaternion([rot[0] , rot[1], rot[2], rot[3]])
object_angles = tf.transformations.euler_from_quaternion([rot[2] , rot[0], rot[1], rot[2]], axes='sxyz')
xangle = object_angles[0] + radians(360)
xangle1 = object_angles[1]# + radians(90)
xangle2 = object_angles[2]# + radians(-106)
object_angles = (xangle, xangle1, xangle2)
print("Angles:")
print(xangle)
print(xangle1)