From: Michael Wang <michaelwang9000@gmail.com>
Date: Sun, 19 Feb 2017 19:37:29 +0000 (-0800)
Subject: change code so it fits new measurements
X-Git-Url: http://challenge-bot.com/repos/?p=3501%2F2017steamworks;a=commitdiff_plain;h=fc01853816fd54b165e7bffcd8afe3daa492029b

change code so it fits new measurements
---

diff --git a/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java b/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java
index 18b5905..02f8e7e 100644
--- a/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java
+++ b/src/org/usfirst/frc/team3501/robot/commandgroups/AutonHopperShoot.java
@@ -13,28 +13,21 @@ 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(DISTANCE_TO_TURNING_POSITION, 0.75));
+    addSequential(new DriveDistance(94.75, 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 right towards hopper
-    addSequential(new TurnForAngle(45.0, Constants.Direction.RIGHT, 1.0));
+    addSequential(new TurnForAngle(90.0, Constants.Direction.RIGHT, 1.0));
     // Robot drives into hopper switch
-    addSequential(new DriveDistance(2.0, 1.0));
+    addSequential(new DriveDistance(44.0, 1));
     // Robot backs up from switch
-    addSequential(new DriveDistance(2.0, -1.0));
+    addSequential(new DriveDistance(5.0, -1.0));
     // Robot turns towards the boiler
     addSequential(new TurnForAngle(90.0, Constants.Direction.RIGHT, 1.0));
     // Robot drives to boiler
-    addSequential(new DriveDistance(123.3, 1.0));
+    addSequential(new DriveDistance(75.7, 0.75));
     // Robot turns parallel to boiler
-    addSequential(new TurnForAngle(45.0, Constants.Direction.LEFT, 1.0));
+    addSequential(new TurnForAngle(46.6, Constants.Direction.LEFT, 1.0));
     // Shoot
     addSequential(new RunFlyWheelContinuous());