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 12:01:10 +00:00
parent e17f92b9f6
commit 9d7437859b
1 changed files with 5 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
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(180) xangle = object_angles[0]# + radians(180)
xangle1 = object_angles[1]# + radians(90) xangle1 = object_angles[1]# + radians(90)
xangle2 = object_angles[2] + radians(-270) xangle2 = object_angles[2]# + radians(-270)
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 -20.569 + 159.431 #
# 1.57 -90.000 + 90.000 #
# -2.75 20.569 - 200.569 #
# #
# #
# #