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 11:30:22 +00:00
parent acd8d85c1b
commit 4e874067a5
1 changed files with 6 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
object_tf_client.py
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(90)# + radians(77.878)
xangle1 = object_angles[1]# - radians(90)
xangle2 = object_angles[2]# - radians(22.231)
xangle = object_angles[0] + radians(159.431)# + radians(77.878)
xangle1 = object_angles[1] + radians(90)
xangle2 = object_angles[2] + radians(-200.569)
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 12.112 + 77.878
# 1.57 90.000 - 90.000
# -2.75 -157.769 - 22.231
# 0.211 -20.569 + 159.431
# 1.57 -90.000 + 90.000
# -2.75 20.569 - 200.569
#
#
#