def dumpPod(): print "dump pod" move.grabberArmDown(20) move.grabberOpen() t.sleep (.50) move.grabberArmRelease(15) drive.withStop( -250, 250, 0.75 )
def turnToMesa(): print "turnToMesa" if c.isPrime: drive.withStop( -250, 250, 0.73 ) #was -250, 250, 0.7550 #correct code else: drive.withStop( -250, 250, 0.755 ) #was 0.750 move.grabberArmDown() '''
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 frisbeeToBotgal(): drive.withStop(200, 100, 4.00) move.grabberArmDown() move.frisbeeGrabberOpen() link.create_disconnect()
def deliverFrisbeeToNorthEndZone(): drive.withStop(200, 200, 2.00) drive.withStop( 250, -250, 0.755 ) drive.withStop(200, 200, 1.8) move.grabberArmDown() move.frisbeeGrabberOpen()