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);
}
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