update code
[3501/2017steamworks] / src / org / usfirst / frc / team3501 / robot / Robot.java
index b1e2a8cd1e6a5bdeef572fd88e9147e839a21769..44c513d5085fe4fda891a4ab086a838106454f50 100644 (file)
@@ -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