Add tray return API call
This commit is contained in:
@@ -754,10 +754,10 @@ if __name__ == "__main__":
|
||||
rob = robot.robot # rob is robot.robot is the urx robot class, what we've been using previously
|
||||
|
||||
|
||||
#move_to_packup(robot)
|
||||
move_to_packup(robot)
|
||||
|
||||
# pick_up_holder(robot, 2)
|
||||
# drop_off_tray(robot, 0)
|
||||
#drop_off_tray(robot, 0)
|
||||
# drop_off_tray(robot, 1)
|
||||
# drop_off_tray(robot, 2)
|
||||
# drop_off_tray(robot, 3)
|
||||
@@ -769,15 +769,15 @@ if __name__ == "__main__":
|
||||
# drop_off_tray(robot, 3)
|
||||
|
||||
|
||||
for i in range(0,54):
|
||||
pick_up_holder(robot, None, i)
|
||||
# for i in range(0,54):
|
||||
# pick_up_holder(robot, None, i)
|
||||
|
||||
#print('Drop off', i+1)
|
||||
drop_off_tray(robot, 0)
|
||||
#input()
|
||||
# #print('Drop off', i+1)
|
||||
# drop_off_tray(robot, 0)
|
||||
# #input()
|
||||
|
||||
# holder_to_camera(robot, 0)
|
||||
# camera_to_holder(robot, 0)
|
||||
# # holder_to_camera(robot, 0)
|
||||
# # camera_to_holder(robot, 0)
|
||||
|
||||
print("Current tool pose is: ", rob.getl())
|
||||
curr_pos = rob.getl()
|
||||
|
||||
Reference in New Issue
Block a user