Esempio n. 1
0
#   if True:
#       hand.Grab()
#       bank.WaitDone()
#       time.sleep(5)
#       logging.info("Release now.")
#       hand.Release()
#       bank.WaitDone()
#   while True:
#       logging.info("Wait here forever.")
#       time.sleep(10)
hand.Calibrate()
#bank.WaitDone()
bank.base_motor.SetDisableAfterMoving(False)
arm.Rotate(-math.pi / 2)
bank.WaitDone()
arm.Calibrate()
bank.WaitDone()
#arm.RaiseFully()
#bank.WaitDone()
arm.GoToPositionHeight()
bank.WaitDone()
arm.Rotate(0.0)
bank.WaitDone()
hand.Release()
bank.WaitDone()
time.sleep(5.0)
#arm.Rotate(math.pi / 30)
bank.WaitDone()
arm.LowerOntoBottle()
bank.WaitDone()
#   #   #arm.Lower()