undo previous commit
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / auton / PassRoughTerrain.java
diff --git a/src/org/usfirst/frc/team3501/robot/commands/auton/PassRoughTerrain.java b/src/org/usfirst/frc/team3501/robot/commands/auton/PassRoughTerrain.java
new file mode 100644 (file)
index 0000000..8851edf
--- /dev/null
@@ -0,0 +1,41 @@
+package org.usfirst.frc.team3501.robot.commands.auton;
+
+import org.usfirst.frc.team3501.robot.commands.driving.DriveForTime;
+
+import edu.wpi.first.wpilibj.command.CommandGroup;
+
+/***
+ * This command will drive the robot through the rough terrain.
+ *
+ * dependency on subsytems: drivetrain
+ *
+ * dependency on other commands: DriveForTime
+ *
+ * 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));
+
+  }
+}