1 package org
.usfirst
.frc
.team3501
.robot
.commands
.auton
;
3 import org
.usfirst
.frc
.team3501
.robot
.Constants
;
4 import org
.usfirst
.frc
.team3501
.robot
.commands
.driving
.DriveDistance
;
5 import org
.usfirst
.frc
.team3501
.robot
.commands
.driving
.DriveForTime
;
7 import edu
.wpi
.first
.wpilibj
.command
.CommandGroup
;
10 * This command will drive the robot through the rampart.
12 * dependency on subsystems: drivetrain
14 * dependency on other commands: DriveForTime
16 * pre-condition: robot is flush against the ramp of the outerworks in front of
19 * post-condition: the robot has passed the rampart and is in the next zone
21 * @author Meryem and Avi
25 public class PassRampart
extends CommandGroup
{
27 public PassRampart() {
29 if (Constants
.DeadReckoning
.isDeadReckoning
) {
30 addSequential(new DriveForTime(Constants
.DeadReckoning
.passRockWallTime
,
31 Constants
.DeadReckoning
.passRockWallSpeed
));
34 addSequential(new DriveDistance(
35 Constants
.DeadReckoning
.passRampartDistance
,
36 Constants
.DriveTrain
.PASS_DEFENSE_TIMEOUT
));