comments finished
[3501/2017steamworks] / src / org / usfirst / frc / team3501 / robot / commandgroups / AutonGearThenBaselinePegCloseToBoiler.java
index bdb97804e3c17ca142b32d7d7d0ffecfbe043a40..5466e92eb3f12bcb76f7cb148e3fa5bc26707876 100644 (file)
@@ -11,20 +11,22 @@ import edu.wpi.first.wpilibj.command.CommandGroup;
  *
  */
 public class AutonGearThenBaselinePegCloseToBoiler extends CommandGroup {
-    private static final int MOTOR_VALUE_TURN = 60;
-    private static final int MOTOR_VALUE_FORWARD = 60;
-    private static final double DISTANCE_FROM_BOILER_WALL = 111.5676;
 
-    public AutonGearThenBaselinePegCloseToBoiler() {
-  
-      
-      requires(Robot.getDriveTrain());
-      addSequential(new DriveDistance(DISTANCE_FROM_BOILER_WALL/Math.sqrt(3)+52.4614,MOTOR_VALUE_FORWARD));
-      addSequential(new TurnForAngle(60, Direction.LEFT , MOTOR_VALUE_TURN));
-      addSequential(new DriveDistance(143.3272-2*DISTANCE_FROM_BOILER_WALL/Math.sqrt(3)-10.5,MOTOR_VALUE_FORWARD));
-      //does not include drift distance
-      
-    }
+  private static final int MOTOR_VALUE_TURN = 60;
+  private static final int MOTOR_VALUE_FORWARD = 60;
+  private static final double DISTANCE_FROM_BOILER_WALL = 111.5676;
+
+  public AutonGearThenBaselinePegCloseToBoiler() {
+
+    requires(Robot.getDriveTrain());
+    addSequential(
+        new DriveDistance(DISTANCE_FROM_BOILER_WALL / Math.sqrt(3) + 52.4614,
+            MOTOR_VALUE_FORWARD));
+    addSequential(new TurnForAngle(60, Direction.LEFT, MOTOR_VALUE_TURN));
+    addSequential(new DriveDistance(
+        143.3272 - 2 * DISTANCE_FROM_BOILER_WALL / Math.sqrt(3) - 10.5,
+        MOTOR_VALUE_FORWARD));
+    // does not include drift distance
+
+  }
 }