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