refactor isUsingTimeToPassDefense to isUsingTime
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / auton / PassRoughTerrain.java
CommitLineData
6bb7f8ac 1package org.usfirst.frc.team3501.robot.commands.auton;
d607dcbb 2
9d518a5c
CZ
3import org.usfirst.frc.team3501.robot.Constants;
4import org.usfirst.frc.team3501.robot.commands.driving.DriveDistance;
dfcc1b21
CZ
5import org.usfirst.frc.team3501.robot.commands.driving.DriveForTime;
6
42d6d87c 7import edu.wpi.first.wpilibj.command.CommandGroup;
d607dcbb
ME
8
9/***
10 * This command will drive the robot through the rough terrain.
11 *
a7c4ef67
ME
12 * dependency on subsytems: drivetrain
13 *
14 * dependency on other commands: DriveForTime
15 *
d607dcbb
ME
16 * pre-condition: robot is flush against the ramp of the outerworks in front of
17 * the rough terrain
18 *
19 * post-condition: the robot has passed the rough terrain and is in the next
20 * zone
21 *
22 * @author Meryem and Avi
23 *
24 */
dba0b9ad 25public class PassRoughTerrain extends CommandGroup {
d607dcbb 26
dba0b9ad 27 public PassRoughTerrain() {
d607dcbb 28
ca325a58 29 if (Constants.Auton.isUsingTime) {
600a1a1c
KZ
30 addSequential(new DriveForTime(Constants.Auton.passRockWallTime,
31 Constants.Auton.passRockWallSpeed));
9d518a5c
CZ
32 }
33 else {
34 addSequential(new DriveDistance(
600a1a1c 35 Constants.Auton.passRoughTerrainDistance,
9d518a5c
CZ
36 Constants.DriveTrain.PASS_DEFENSE_TIMEOUT));
37 }
d607dcbb 38
d607dcbb
ME
39 }
40}