update code

diff --git a/src/org/usfirst/frc/team3501/robot/Robot.java b/src/org/usfirst/frc/team3501/robot/Robot.java
index b1e2a8cd1e6a5bdeef572fd88e9147e839a21769..44c513d5085fe4fda891a4ab086a838106454f50 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/Robot.java
+++ b/src/org/usfirst/frc/team3501/robot/Robot.java
@@ -84,6 +84,12 @@ public class Robot extends IterativeRobot {
 
     Scheduler.getInstance().add(new DriveDistance(Setpoint, Speed));
 
+    SmartDashboard.putNumber(Constants.DriveTrain.P_Val, 0);
+    SmartDashboard.putNumber(Constants.DriveTrain.I_Val, 0);
+    SmartDashboard.putNumber(Constants.DriveTrain.D_Val, 0);
+    SmartDashboard.putNumber(Constants.DriveTrain.TARGET_DIST, 50);
+    SmartDashboard.putNumber(Constants.DriveTrain.MOTOR_VAL, 0.5);
+
   }
 
   @Override

diff --git a/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java b/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java
index b113acc2d9841d9088b26ee6c1e0c765d4dd06db..aae3d8fe7d7e9f9a2fb332d5bb500c5a896541fd 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java
+++ b/src/org/usfirst/frc/team3501/robot/subsystems/DriveTrain.java
@@ -60,6 +60,7 @@ public class DriveTrain extends Subsystem {
   public boolean shouldBeClimbing = false;
 
   private PIDController driveController;
+  private PIDController gyroController;
 
   private DriveTrain() {