implement code for PassRoughTerrain command group

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

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

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

/***
 * This command will drive the robot through the rough terrain.
 *
 * pre-condition: robot is flush against the ramp of the outerworks in front of
 * the rough terrain
 *
 * post-condition: the robot has passed the rough terrain and is in the next
 * zone
 *
 * @author Meryem and Avi
 *
 */
public class PassRoughTerrain extends CommandGroup {

  // TODO: test for the time
  private final double BEG_TIME = 0;
  private final double MID_TIME = 0;
  private final double END_TIME = 0;

  private final double BEG_SPEED = 0;
  private final double MID_SPEED = 0;
  private final double END_SPEED = 0;

  public PassRoughTerrain() {

    addSequential(new DriveForTime(BEG_TIME, BEG_SPEED));
    addSequential(new DriveForTime(MID_TIME, MID_SPEED));
    addSequential(new DriveForTime(END_TIME, BEG_SPEED));

  }
}