addSequential(new DriveForDistance(POS1_DIST1, DEFAULT_SPEED));
addSequential(new TurnForAngle(POS1_TURN1));
addSequential(new DriveForDistance(POS1_DIST2, DEFAULT_SPEED));
horizontalDistToGoal = 0;
addSequential(new DriveForDistance(POS1_DIST1, DEFAULT_SPEED));
addSequential(new TurnForAngle(POS1_TURN1));
addSequential(new DriveForDistance(POS1_DIST2, DEFAULT_SPEED));
horizontalDistToGoal = 0;