def testFrisbeeGrabber():
print "test frisbeeGrabber"
link.set_servo_position(c.frisbeeGrabber, c.frisbeeGrabberClose)
link.enable_servo(c.frisbeeGrabber)
frisbeeGrabberOpen()
t.sleep(.5)
frisbeeGrabberClose(10)
link.disable_servo(c.frisbeeGrabber)
def testGrabberArm():
print "testing grabberArm"
link.set_servo_position(c.grabberArm, c.grabberArmClear)
link.enable_servo(c.grabberArm)
grabberArmStraightUp()
grabberArmClear()
link.disable_servo(c.grabberArm)
link.disable_servo(c.cubeHolderArm)
def testGrabber():
print "testing grabber"
link.set_servo_position(c.grabber, c.grabberClearClosed)
link.enable_servo(c.grabber)
t.sleep(.5)
grabberOpenInit()
t.sleep(1) #was.4
grabberClearClosed()
t.sleep(.5)
link.disable_servo(c.grabber)
def testCubeHolderArm():
print "testing cubeHolderArm"
link.set_servo_position(c.cubeHolderArm, c.cubeHolderArmCompleteDown)
link.enable_servo(c.cubeHolderArm)
cubeHolderArmSlightBack()
t.sleep(.5)
testETScanner
cubeHolderArmCompleteDown()
t.sleep(.5)
link.disable_servo(c.cubeHolderArm)
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)