challenge-bot.com Git - 3501/stronghold-2016/blob - src/org/usfirst/frc/team3501/robot/commands/auton/PassRockWall.java

   1 package org.usfirst.frc.team3501.robot.commands.auton;
   2
   3 import org.usfirst.frc.team3501.robot.Constants;
   4 import org.usfirst.frc.team3501.robot.commands.driving.DriveDistance;
   5 import org.usfirst.frc.team3501.robot.commands.driving.DriveForTime;
   6
   7 import edu.wpi.first.wpilibj.command.CommandGroup;
   8
   9 /***
  10  * This command will drive the robot through the rock wall.
  11  *
  12  * dependency on subsystems: drivetrain
  13  *
  14  * dependency on other commands: DriveForTime
  15  *
  16  * pre-condition: robot is flush against the ramp of the outerworks in front of
  17  * the rock wall
  18  *
  19  * post-condition: the robot has passed the rock wall and is in the next zone
  20  *
  21  * @author Meryem and Avi
  22  *
  23  */
  24
  25 public class PassRockWall extends CommandGroup {
  26
  27   public PassRockWall() {
  28     if (Constants.Auton.isUsingTime) {
  29       addSequential(new DriveForTime(Constants.Auton.passRockWallTime,
  30           Constants.Auton.passRockWallSpeed));
  31     }
  32     else {
  33       addSequential(new DriveDistance(
  34           Constants.Auton.passRockWallDistance,
  35           Constants.DriveTrain.PASS_DEFENSE_TIMEOUT));
  36     }
  37
  38   }
  39 }