- 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));
- }
-
- private Direction oppositeOf(Direction direction) {
- if (direction == Direction.LEFT)
- return Direction.RIGHT;
- return Direction.LEFT;
+ // 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));