refactor RunIntake to be RunIntakeContinous (because its used only with joysticks

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

diff --git a/src/org/usfirst/frc/team3501/robot/commands/shooter/ShootAtHighGoal.java b/src/org/usfirst/frc/team3501/robot/commands/shooter/ShootAtHighGoal.java
index 6d15cde8362194c3ca7ef19763a6a3f49929a827..7fca1ff75e2533726300bd551296ac88883ae2db 100755 (executable)
--- a/src/org/usfirst/frc/team3501/robot/commands/shooter/ShootAtHighGoal.java
+++ b/src/org/usfirst/frc/team3501/robot/commands/shooter/ShootAtHighGoal.java
@@ -14,26 +14,33 @@ import edu.wpi.first.wpilibj.command.WaitCommand;
  * post-conditions: catapult is retracted, intake is extended
  */
 public class ShootAtHighGoal extends CommandGroup {
-  private static final double WAIT_SECONDS = 0.4;
+  private static final double WAIT_SECONDS = 1.0;
 
   public ShootAtHighGoal() {
-    // make sure catapult is down
-    addSequential(new ResetCatapult());
 
     // make sure intake is in up position
     addSequential(new MoveIntakeArm(IntakeArm.RETRACT));
 
+    addSequential(new WaitCommand(WAIT_SECONDS));
+
+    // get ball onto catapult
+
     // shoot catapult pistons
     addSequential(new FireCatapult());
 
+    addSequential(new WaitCommand(WAIT_SECONDS));
+
     // extend intake (ball actually shoots here)
     addSequential(new MoveIntakeArm(IntakeArm.EXTEND));
 
+    addSequential(new WaitCommand(WAIT_SECONDS));
+
     // wait a bit
     addSequential(new WaitCommand(WAIT_SECONDS));
 
     // retract catapult pistons
     addSequential(new ResetCatapult());
 
+    //
   }
 }