1 package org
.usfirst
.frc
.team3501
.robot
.commands
.auton
;
3 import edu
.wpi
.first
.wpilibj
.command
.CommandGroup
;
6 * This command will drive the robot through the rough terrain.
8 * dependency on subsytems: drivetrain
10 * dependency on other commands: DriveForTime
12 * pre-condition: robot is flush against the ramp of the outerworks in front of
15 * post-condition: the robot has passed the rough terrain and is in the next
18 * @author Meryem and Avi
21 public class PassRoughTerrain
extends CommandGroup
{
23 // TODO: test for the time
24 private final double BEG_TIME
= 0;
25 private final double MID_TIME
= 0;
26 private final double END_TIME
= 0;
28 private final double BEG_SPEED
= 0;
29 private final double MID_SPEED
= 0;
30 private final double END_SPEED
= 0;
32 public PassRoughTerrain() {
34 addSequential(new DriveForTime(BEG_TIME
, BEG_SPEED
));
35 addSequential(new DriveForTime(MID_TIME
, MID_SPEED
));
36 addSequential(new DriveForTime(END_TIME
, BEG_SPEED
));