def __init__(self):
super().__init__('CenterToLeft')
# Go to bussing lane
self.addSequential(SetDistance(137.05))
self.addParallel(ClimbForTime(3))
self.addParallel(SuckForTime(12))
# Turn left
self.addSequential(WaitCommand(timeout=0.1))
self.addSequential(SetGyroAngle(-90))
# Set up for going to switch
self.addSequential(WaitCommand(timeout=0.1))
self.addSequential(SetDistance(309.34))
# Turn right
self.addSequential(WaitCommand(timeout=0.1))
self.addSequential(SetGyroAngle(90))
# Drive up to switch
self.addSequential(WaitCommand(timeout=0.1))
self.addSequential(SetDistance(262.35))
# Face the switch
self.addSequential(WaitCommand(timeout=0.1))
self.addSequential(SetGyroAngle(90))
# Drive right up to the switch
self.addSequential(WaitCommand(timeout=0.1))
self.addSequential(SetDistance(8.39))
# Drop off cube
self.addSequential(RetractCubeForTime(3))
def __init__(self):
super().__init__('Auto Test')
self.addSequential(SetDistance(413))
self.addSequential(WaitCommand(timeout=1))
self.addSequential(SetGyroAngle(90))
self.addSequential(WaitCommand(timeout=1))
self.addSequential(SetDistance(717))
def __init__(self):
super().__init__('RightToRight')
# Go to switch
self.addSequential(SetDistance(399.4))
self.addParallel(ClimbForTime(3))
self.addParallel(SuckForTime(12))
# Turn left
self.addSequential(WaitCommand(timeout=0.1))
self.addSequential(SetGyroAngle(-90))
# Drive right up to the switch
self.addSequential(WaitCommand(timeout=0.1))
self.addSequential(SetDistance(8.39))
# Drop off the cube
self.addSequential(RetractCubeForTime(3))
def __init__(self):
super().__init__('Cross Line Auto')
print('[AUTO] CrossLineAuto running')
self.addSequential(SetDistance(350))