Update
This commit is contained in:
parent
c6b70b9186
commit
adab7f93f8
4
main.py
4
main.py
@ -272,12 +272,12 @@ if __name__ == "__main__":
|
|||||||
# print()
|
# print()
|
||||||
|
|
||||||
left_pick = otc.tf_lookup('a3')
|
left_pick = otc.tf_lookup('a3')
|
||||||
left_pick.position.z+=0.5
|
# left_pick.position.z+=0.05
|
||||||
left_pnp.pick(left_pick)
|
left_pnp.pick(left_pick)
|
||||||
|
|
||||||
|
|
||||||
left_place = otc.tf_lookup('f2')
|
left_place = otc.tf_lookup('f2')
|
||||||
left_pick.position.z+=0.5
|
# left_pick.position.z+=0.05
|
||||||
left_pnp.place(left_place)
|
left_pnp.place(left_place)
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
@ -18,7 +18,7 @@ def tf_lookup(object_name):
|
|||||||
time.sleep(0.1)
|
time.sleep(0.1)
|
||||||
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[0] , rot[1], rot[2], rot[3]])
|
||||||
xangle = object_angles[0] + radians(90)# + radians(200.569)
|
xangle = object_angles[0] + radians(90)# + radians(200.569)
|
||||||
xangle1 = object_angles[1]# + radians(90)
|
xangle1 = object_angles[1]# + radians(90)
|
||||||
xangle2 = object_angles[2]# + radians(-200.569)
|
xangle2 = object_angles[2]# + radians(-200.569)
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user