set up get numbers for smart dashboard

[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 0afd16687f95e3e8eb7de5a227ef7dd6b9ff05e8..e0f075b9c9c237882651e809ce8bd0980c7f457d 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/Robot.java
+++ b/src/org/usfirst/frc/team3501/robot/Robot.java
@@ -44,10 +44,8 @@ public class Robot extends IterativeRobot {
   public void autonomousInit() {
     driveTrain.setHighGear();
 
+    SmartDashboard.putNumber(Constants.DriveTrain.P_Val, -1);
     SmartDashboard.putNumber(Constants.DriveTrain.I_Val, -1);
-
-    SmartDashboard.putNumber("P", -1);
-
     SmartDashboard.putNumber(Constants.DriveTrain.D_Val, -1);
 
   }
@@ -56,8 +54,10 @@ public class Robot extends IterativeRobot {
   public void autonomousPeriodic() {
     Scheduler.getInstance().run();
 
-    DriveTrain.getDriveTrain().getDriveController().setConstants(p, i, d);
-
+    double P = SmartDashboard.getNumber(Constants.DriveTrain.P_Val, -1);
+    double I = SmartDashboard.getNumber(Constants.DriveTrain.I_Val, -1);
+    double D = SmartDashboard.getNumber(Constants.DriveTrain.D_Val, -1);
+    DriveTrain.getDriveTrain().getDriveController().setConstants(P, I, D);
   }
 
   @Override