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 rock wall.
10 * dependency on subsystems: 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 rock wall and is in the next zone
19 * @author Meryem and Avi
23 public class PassRockWall
extends CommandGroup
{
25 private final double BEG_TIME
= 0;
26 private final double MID_TIME
= 0;
27 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 PassRockWall() {
34 addSequential(new DriveForTime(BEG_TIME
, BEG_SPEED
));
35 addSequential(new DriveForTime(MID_TIME
, MID_SPEED
));
36 addSequential(new DriveForTime(END_TIME
, END_SPEED
));