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 15:26:37 +00:00
parent 57f7872a7f
commit e4d02a8cb2
1 changed files with 22 additions and 22 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

44
main.py
View File

@ -247,12 +247,12 @@ if __name__ == "__main__":
right_pose.orientation.z = -0.000 right_pose.orientation.z = -0.000
right_pose.orientation.w = 0.004 right_pose.orientation.w = 0.004
# left_pnp = PickAndPlace('left', hover_distance) left_pnp = PickAndPlace('left', hover_distance)
# right_pnp = PickAndPlace('right', hover_distance) right_pnp = PickAndPlace('right', hover_distance)
# # Go to initial position # Go to initial position
# left_pnp.move_to_start(left_pnp.ik_request(left_pose)) left_pnp.move_to_start(left_pnp.ik_request(left_pose))
# right_pnp.move_to_start(right_pnp.ik_request(right_pose)) right_pnp.move_to_start(right_pnp.ik_request(right_pose))
load_objects() load_objects()
@ -260,26 +260,26 @@ if __name__ == "__main__":
tf_service(init=True) tf_service(init=True)
###################################HACKING BEGIN ###################################HACKING BEGIN
for i in range(0, 5): # for i in range(0, 5):
print() # print()
otc.tf_lookup('a3') # otc.tf_lookup('a3')
print() # print()
print() # print()
print("!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!") # print("!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!")
for i in range(0, 5): # for i in range(0, 5):
print() # print()
otc.tf_lookup('f2') # otc.tf_lookup('f2')
print() # print()
print() # print()
# left_pick = otc.tf_lookup('a1') left_pick = otc.tf_lookup('a1')
# left_pick.position.z+=0.05 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_place.position.z+=0.05 left_place.position.z+=0.05
# left_pnp.place(left_place) left_pnp.place(left_place)