Esempio n. 1
0
#   #   #   #hand.Hold()
time.sleep(5.0)
arm.RaiseFully()
bank.WaitDone()
hand.Dispense()
bank.WaitDone()
arm.SetWristToGrabPosition()
#   #   #   time.sleep(1.0)
#   #   bank.WaitDone()

#   #   arm.SetupLowerStop()
#   #   bank.Rezero()
arm.Lower()
bank.WaitDone()
#arm.Rotate(-math.pi / 25)
#arm.Rotate(math.pi / 30)
#bank.WaitDone()
hand.Release()
bank.WaitDone()
#arm.GoToReleasePositionHeight()
#bank.WaitDone()
#hand.Rotate(math.pi / 6)
arm.RaiseOverDroppedBottle()
bank.WaitDone()
logging.info("Raise fully")
arm.RaiseFully()
bank.WaitDone()
bank.Rezero()
time.sleep(5.0)
#   #   #   #hand.Hold()