add TODO comment for testing WaitCommand

[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / auton / DefaultAutonStrategy.java

diff --git a/src/org/usfirst/frc/team3501/robot/commands/auton/DefaultAutonStrategy.java b/src/org/usfirst/frc/team3501/robot/commands/auton/DefaultAutonStrategy.java
index 5b6453ddaa9382a4e30e6d76c3f4f56830c1196a..6ccef7c587e889d1d32ac32d778a9661b7afbc94 100755 (executable)
--- a/src/org/usfirst/frc/team3501/robot/commands/auton/DefaultAutonStrategy.java
+++ b/src/org/usfirst/frc/team3501/robot/commands/auton/DefaultAutonStrategy.java
@@ -5,6 +5,7 @@ import org.usfirst.frc.team3501.robot.Constants.Defense;
 import org.usfirst.frc.team3501.robot.commands.shooter.Shoot;
 
 import edu.wpi.first.wpilibj.command.CommandGroup;
+import edu.wpi.first.wpilibj.command.WaitCommand;
 
 /**
  * The default autonomous strategy involves passing the defense that is in front
@@ -42,7 +43,9 @@ public class DefaultAutonStrategy extends CommandGroup {
     else if (defense == Constants.Defense.RAMPART)
       addSequential(new PassRampart());
 
-    addSequential(new AimAndAlign());
+    addSequential(new AlignToScore(position));
+    // TODO: test for how long robot should wait
+    addSequential(new WaitCommand(5.0));
     addSequential(new Shoot());
 
   }