Add DISTANCE_TO_TURNING_POINT to AutonHopperShoot
[3501/2017steamworks] / src / org / usfirst / frc / team3501 / robot / commandgroups / AutonHopperShoot.java
index 2083548128fed923cdb270307c12d71c53bc8ff3..b5e7b95d2860b6600cd6064b8d7e83a3e40a3fcf 100644 (file)
@@ -14,10 +14,11 @@ import edu.wpi.first.wpilibj.command.CommandGroup;
 public class AutonHopperShoot extends CommandGroup {
 
   private static final double DISTANCE_TO_HOPPER = 224.569677;
+  private static final double DISTANCE_TO_TURNING_POSITION = 5.0;
 
   public AutonHopperShoot() {
     // Robot drives from center to front of airship
-    addSequential(new DriveDistance(5.0, 1));
+    addSequential(new DriveDistance(DISTANCE_TO_TURNING_POSITION, 1));
     // Robot turns towards hopper
     addSequential(new TurnForAngle(45.0, Constants.Direction.RIGHT, 1.0));
     // Robot drives near hopper