- addSequential(new DriveDistance(DISTANCE_TO_PEG, maxTimeOut));
- // addSequential(new WaitCommand(3));
- // addSequential(new DriveDistance(DISTANCE_TO_BACK_OUT, maxTimeOut));
- // addSequential(new TurnForAngle(ANGLE_TO_TURN, direction, maxTimeOut));
- // addSequential(new DriveDistance(THIRD_DISTANCE_TO_TRAVEL, maxTimeOut));
- // addSequential(
- // new TurnForAngle(ANGLE_TO_TURN, oppositeOf(direction), maxTimeOut));
- // addSequential(new DriveDistance(DISTANCE_TO_BASELINE, maxTimeOut));
+ // addSequential(new DriveDistance(DISTANCE_TO_PEG, maxTimeOut));
+
+ addSequential(new ShiftGearManipulatorPistonLow());
+ addSequential(new TimeDrive(2, 0.6));