Add DISTANCE_TO_TURNING_POINT to AutonHopperShoot
authorMichael Wang <michaelwang9000@gmail.com>
Thu, 19 Jan 2017 05:09:48 +0000 (21:09 -0800)
committerMichael Wang <michaelwang9000@gmail.com>
Tue, 21 Feb 2017 20:40:26 +0000 (12:40 -0800)
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