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 00:18:27 +00:00
parent d2ca778eec
commit 9bc21dea23
2 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
main.py
View File

@ -264,7 +264,7 @@ if __name__ == "__main__":
left_pick = otc.tf_lookup('a1')
left_pick.position.z+=0.5
left_pnp.pick(left_pick)

6
object_tf_client.py
View File

@ -19,9 +19,9 @@ def tf_lookup(object_name):
continue
object_angles = tf.transformations.euler_from_quaternion([rot[0] , rot[1] , rot[2], rot[3]])
xangle = 0#object_angles[0] + radians(90)
xangle1 = 0# object_angles[1] + radians(0)
xangle2 = 0# object_angles[2] + radians(90) #180
xangle = object_angles[0] + radians(90)
xangle1 = object_angles[1] + radians(0)
xangle2 = object_angles[2] + radians(180)
object_angles = (xangle, xangle1, xangle2)
target_quat = tf.transformations.quaternion_from_euler(object_angles[0], object_angles[1], object_angles[2])
target_pose = Pose()