def dumpPod():
print "dump pod"
move.grabberArmDown(20)
move.grabberOpen()
t.sleep (.50)
move.grabberArmRelease(15)
drive.withStop( -250, 250, 0.75 )
def botgalToFrisbee():
print("botgaltofrisbee")
link.enable_servo(c.grabberArm)
move.cubeHolderArmMesa()
drive.withStop(200, 200, 2.4)
move.grabberOpen()
t.sleep (1.000)
move.grabberArmStraightUp()
def grabBot():
print "grabBot"
move.grabberOpen()#opening grabber
#using grabberArm as a move
move.grabberArmUp( 10 )
t.sleep( .5 )
move.grabberClose()
t.sleep(0.500 )
# using grabberArm as a move
move.grabberArmDrop()
link.disable_servo( c.grabberArm)
t.sleep(1.00)
def grabCubes():
move.cubeHolderArmUp()
move.grabberArmDrop()
move.grabberOpen()
drive.withStop(100, 100, 4)
drive.withStop(-100, 100, 2.00)
drive.withStop(100, 100, 2.5)
move.grabberArmDown()
t.sleep(2)
link.set_servo_position( c.grabber, 400)
'''move.closeGrabber()'''
t.sleep(2)
move.grabberArmDrop()
drive.withStop(50, 50, 1.5)
def grabFrisbee():
link.enable_servo(c.grabber)
link.enable_servo(c.frisbeeGrabber)
move.grabberOpen()
move.frisbeeGrabberOpen()
#t.sleep(1.00)
move.grabberArmGrabFrisbee( 40 )
t.sleep(1.00)
move.grabberArmFinal(10)
t.sleep(1.00)
move.grabberMidClose()
#t.sleep(1.00)
move.frisbeeGrabberClose()
t.sleep(1.00)
move.grabberSlowOpen()
move.grabberArmBack(5)