def deliverCase():
    global aCase
    global arm
    arm.gotoPosition(aCase.type.dropPosition)
    while not arm.isAtGoalPosition():
        time.sleep(0.1)
    time.sleep(0.2)
    arm.openGripper()
    time.sleep(1.5)
    arm.gotoPosition("one")
示例#2
0
def position4_callback(channel):
    global learnMode
    if learnMode is True:
        print("+ learning position 4")
        arm.recordPosition("four")
        arm.holdCurrentPosition()
        arm.resumeTorque()
        learnMode = False
    else:
        print("- moving to position 4")
        arm.gotoPosition("four")