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 continue
object_angles = tf.transformations.euler_from_quaternion([rot[3] , rot[0], rot[1], rot[2]], axes='sxyz') 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) xangle = object_angles[0] + radians(159.431)# + radians(77.878)
xangle1 = object_angles[1]# - radians(90) xangle1 = object_angles[1] + radians(90)
xangle2 = object_angles[2]# - radians(22.231) xangle2 = object_angles[2] + radians(-200.569)
object_angles = (xangle, xangle1, xangle2) object_angles = (xangle, xangle1, xangle2)
print("Angles:") print("Angles:")
print(xangle) print(xangle)
@ -58,9 +58,9 @@ if __name__ == "__main__":
# Yaw(2): -180 deg. # Yaw(2): -180 deg.
# #
# INITIAL STANDING VALUES # INITIAL STANDING VALUES
# 0.211 12.112 + 77.878 # 0.211 -20.569 + 159.431
# 1.57 90.000 - 90.000 # 1.57 -90.000 + 90.000
# -2.75 -157.769 - 22.231 # -2.75 20.569 - 200.569
# #
# #
# #