X-Git-Url: http://challenge-bot.com/repos/?a=blobdiff_plain;f=src%2Forg%2Fusfirst%2Ffrc%2Fteam3501%2Frobot%2Fcommands%2Fauton%2FPassRampart.java;h=ec467836653fa8977f97c9cc953e1bce7079fdef;hb=0f3df681ca44dc9f5c77f61326e1d7b0143ca2b9;hp=e0dfb49032205d26d5403fc903e09522fa7a043d;hpb=aa616af6a9dc8eebb4e347998f64125f75ce05d2;p=3501%2Fstronghold-2016 diff --git a/src/org/usfirst/frc/team3501/robot/commands/auton/PassRampart.java b/src/org/usfirst/frc/team3501/robot/commands/auton/PassRampart.java index e0dfb490..ec467836 100755 --- a/src/org/usfirst/frc/team3501/robot/commands/auton/PassRampart.java +++ b/src/org/usfirst/frc/team3501/robot/commands/auton/PassRampart.java @@ -1,5 +1,9 @@ package org.usfirst.frc.team3501.robot.commands.auton; +import org.usfirst.frc.team3501.robot.Constants; +import org.usfirst.frc.team3501.robot.commands.driving.DriveDistance; +import org.usfirst.frc.team3501.robot.commands.driving.DriveForTime; + import edu.wpi.first.wpilibj.command.CommandGroup; /*** @@ -22,16 +26,15 @@ public class PassRampart extends CommandGroup { public PassRampart() { - final double BEG_TIME = 0; - final double BEG_SPEED = 0; - final double MID_TIME = 0; - final double MID_SPEED = 0; - final double END_TIME = 0; - final double END_SPEED = 0; - - addSequential(new DriveForTime(BEG_TIME, BEG_SPEED)); - addSequential(new DriveForTime(MID_TIME, MID_SPEED)); - addSequential(new DriveForTime(END_TIME, END_SPEED)); + if (Constants.Auton.IS_USING_TIME) { + addSequential(new DriveForTime(Constants.Auton.PASS_RAMPART_TIME, + Constants.Auton.PASS_RAMPART_SPEED)); + } + else { + addSequential(new DriveDistance( + Constants.Auton.PASS_RAMPART_DIST, + Constants.DriveTrain.PASS_DEFENSE_TIMEOUT)); + } }