Drivetrain/auton changes

[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / subsystems / DriveTrain.java

diff --git a/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java b/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java
index 73dcde7087954b041c3e102516b973dfa4de42d1..0f52e115d8eda7dca2cfbf7b04cc8a49fb08084b 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java
+++ b/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java
@@ -199,22 +199,25 @@ public class DriveTrain extends PIDSubsystem {
     // Handle flipping of the "front" of the robot
     double k = (isFlipped() ? -1 : 1);
 
-    if (type == Constants.DriveTrain.TANK) {
-      // TODO Test this for negation and for voltage vs. [-1,1] outputs
-      double leftSpeed = (-frontLeft.get() + -rearLeft.get()) / 2;
-      double rightSpeed = (-frontRight.get() + -rearRight.get()) / 2;
-      left = ((Constants.DriveTrain.kADJUST - 1) * leftSpeed + left)
-          / Constants.DriveTrain.kADJUST;
-      right = ((Constants.DriveTrain.kADJUST - 1) * rightSpeed + right)
-          / Constants.DriveTrain.kADJUST;
-      robotDrive.tankDrive(-left * k, -right * k);
-    } else if (type == Constants.DriveTrain.ARCADE) {
-      double speed = (-frontLeft.get() + -rearLeft.get() + -frontRight.get() + -rearRight
-          .get()) / 2;
-      left = ((Constants.DriveTrain.kADJUST - 1) * speed + left)
-          / Constants.DriveTrain.kADJUST;
-      robotDrive.arcadeDrive(left * k, right);
-    }
+    robotDrive.tankDrive(-left, -right);
+
+    // if (type == Constants.DriveTrain.TANK) {
+    // // TODO Test this for negation and for voltage vs. [-1,1] outputs
+    // double leftSpeed = (-frontLeft.get() + -rearLeft.get()) / 2;
+    // double rightSpeed = (-frontRight.get() + -rearRight.get()) / 2;
+    // left = ((Constants.DriveTrain.kADJUST - 1) * leftSpeed + left)
+    // / Constants.DriveTrain.kADJUST;
+    // right = ((Constants.DriveTrain.kADJUST - 1) * rightSpeed + right)
+    // / Constants.DriveTrain.kADJUST;
+    // robotDrive.tankDrive(-left * k, -right * k);
+    // } else if (type == Constants.DriveTrain.ARCADE) {
+    // double speed = (-frontLeft.get() + -rearLeft.get() + -frontRight.get() +
+    // -rearRight
+    // .get()) / 2;
+    // left = ((Constants.DriveTrain.kADJUST - 1) * speed + left)
+    // / Constants.DriveTrain.kADJUST;
+    // robotDrive.arcadeDrive(left * k, right);
+    // }
   }
 
   public void setMotorSpeeds(double left, double right) {