update code
[3501/2017steamworks] / src / org / usfirst / frc / team3501 / robot / Robot.java
index ec1699e468eb544c285da59699ce157eeda94a60..7a1f8a631925d979e623da7f2d8ee4179c625473 100644 (file)
@@ -56,11 +56,18 @@ public class Robot extends IterativeRobot {
   public void autonomousPeriodic() {
     Scheduler.getInstance().run();
 
-    double DriveP = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_D_Val,
+    double P = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_D_Val,
         Constants.DriveTrain.PID_ERROR);
-    double DriveI = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_I_Val,
+    double I = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_I_Val,
         Constants.DriveTrain.PID_ERROR);
-    double DriveD = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_D_Val,
+    double D = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_D_Val,
+        Constants.DriveTrain.PID_ERROR);
+    double P = SmartDashboard.getNumber(Constants.DriveTrain.GYRO_P_Val,
+        Constants.DriveTrain.PID_ERROR);
+    double I = SmartDashboard.getNumber(Constants.DriveTrain.GYRO_I_Val,
+        Constants.DriveTrain.PID_ERROR);
+    double D = SmartDashboard.getNumber(Constants.DriveTrain.GYRO_D_Val,
+
         Constants.DriveTrain.PID_ERROR);
 
     DriveTrain.getDriveTrain().getDriveController().setConstants(DriveP, DriveI,