fix errors

[3501/2017steamworks] / src / org / usfirst / frc / team3501 / robot / commandgroups / AutonHopperShoot.java

diff --git a/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java b/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java
index 2083548128fed923cdb270307c12d71c53bc8ff3..18b590548b6b7eb94b2121f3a234fc47435f2f65 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java
+++ b/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java
@@ -14,17 +14,18 @@ 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, 0.75));
     // Robot turns towards hopper
     addSequential(new TurnForAngle(45.0, Constants.Direction.RIGHT, 1.0));
     // Robot drives near hopper
     addSequential(new DriveDistance(DISTANCE_TO_HOPPER, 1));
-    // Robot turns left towards hopper
+    // Robot turns right towards hopper
     addSequential(new TurnForAngle(45.0, Constants.Direction.RIGHT, 1.0));
-    // Robot drives in front of hopper
+    // Robot drives into hopper switch
     addSequential(new DriveDistance(2.0, 1.0));
     // Robot backs up from switch
     addSequential(new DriveDistance(2.0, -1.0));
@@ -35,7 +36,7 @@ public class AutonHopperShoot extends CommandGroup {
     // Robot turns parallel to boiler
     addSequential(new TurnForAngle(45.0, Constants.Direction.LEFT, 1.0));
     // Shoot
-    addSequential(new RunFlyWheelContinuous(1.0));
+    addSequential(new RunFlyWheelContinuous());
 
   }
 }