update code

[3501/2017steamworks] / src / org / usfirst / frc / team3501 / robot / Robot.java

diff --git a/src/org/usfirst/frc/team3501/robot/Robot.java b/src/org/usfirst/frc/team3501/robot/Robot.java
index 0d736310e1dadd5cbd7fc42c45a59c99b2fae843..6388d0a171251eeebe101070816315715c7be208 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/Robot.java
+++ b/src/org/usfirst/frc/team3501/robot/Robot.java
@@ -25,6 +25,8 @@ public class Robot extends IterativeRobot {
     SmartDashboard.putNumber(driveTrain.DRIVE_P_Val, 0);
     SmartDashboard.putNumber(driveTrain.DRIVE_I_Val, 0);
     SmartDashboard.putNumber(driveTrain.DRIVE_D_Val, 0);
+    SmartDashboard.putNumber(driveTrain.DRIVE_GYRO_P_Val, 0);
+
     SmartDashboard.putNumber(driveTrain.DRIVE_TARGET_DIST, 50);
     SmartDashboard.putNumber(driveTrain.MAX_TIME_OUT, 10);
 
@@ -77,11 +79,12 @@ public class Robot extends IterativeRobot {
 
     driveTrain.getDriveController().setName("Drive");
     driveTrain.getGyroController().setName("Gyro");
-    driveTrain.getDriveController().setConstants(driveP, driveI, driveD);
 
+    driveTrain.getDriveController().setConstants(driveP, driveI, driveD);
     driveTrain.getGyroController().setConstants(gyroP, gyroI, gyroD);
 
-    Scheduler.getInstance().add(new DriveDistance(setpoint, maxTimeOut));
+    Scheduler.getInstance()
+        .add(new DriveDistance(setpoint, maxTimeOut));
   }
 
   @Override