set up AlignToScore command group

[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / auton / PassLowBar.java

package org.usfirst.frc.team3501.robot.commands.auton;

import edu.wpi.first.wpilibj.command.CommandGroup;

/***
 * This command will drive the robot through the low bar.
 *
 * pre-condition: robot is flush against the ramp of the outerworks in front of
 * the low bar
 *
 * post-condition: the robot has passed the low bar and is in the next zone
 *
 * @author Meryem and Avi
 *
 */

public class PassLowBar extends CommandGroup {

  private final double DISTANCE = 4.0;
  private final double DEFAULT_SPEED = 0.5;

  public PassLowBar() {
    // TODO: need to add sequential for retracting the arms and shooting hood once those commands are made
    addSequential(new DriveForDistance(DISTANCE, DEFAULT_SPEED));
  }

  public PassLowBar(double speed) {
    addSequential(new DriveForDistance(DISTANCE, speed));
  }
}