Move all constants in DeadReckoning to Auton class because it makes more sense
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / commands / auton / AlignToScore.java
index f2c577ced14c79e9bd1888f9b32b173d26de1169..6d0b9ede6cc1b0688cf466af57967bdd717cebe3 100644 (file)
@@ -39,7 +39,7 @@ public class AlignToScore extends CommandGroup {
   public double horizontalDistToGoal;
 
   public AlignToScore(int position) {
-    if (Constants.DeadReckoning.isUsingTimeToPassDefense) {
+    if (Constants.Auton.isUsingTimeToPassDefense) {
       if (position == 1) {
         addSequential(new DriveForTime(Constants.Auton.POS1_DIST1_TIME,
             Constants.Auton.POS1_DRIVE_MAXSPEED));
@@ -146,7 +146,7 @@ public class AlignToScore extends CommandGroup {
    * double horizontalDistToGoal) {
    * double leftDist = Robot.driveTrain.getLeftLidarDistance();
    * double rightDist = Robot.driveTrain.getRightLidarDistance();
-   *
+   * 
    * double errorAngle = Math.atan(Math.abs(leftDist - rightDist) / 2);
    * double distToTower;
    * // TODO: figure out if we do want to shoot into the side goal if we are
@@ -156,7 +156,7 @@ public class AlignToScore extends CommandGroup {
    * .cos(CENTER_OF_MASS_TO_ROBOT_FRONT + (leftDist - rightDist) / 2)
    * - DIST_CASTLE_WALL_TO_SIDE_GOAL;
    * }
-   *
+   * 
    * // TODO: figure out if we do want to shoot into the font goal if we are
    * // in position 3, 4, 5, or if we want to change that
    * else {
@@ -164,9 +164,9 @@ public class AlignToScore extends CommandGroup {
    * .cos(CENTER_OF_MASS_TO_ROBOT_FRONT + (leftDist - rightDist) / 2)
    * - DIST_CASTLE_WALL_TO_SIDE_GOAL;
    * }
-   *
+   * 
    * double angleToTurn = Math.atan(distToTower / horizontalDistToGoal);
-   *
+   * 
    * return angleToTurn;
    * }
    */