@Override
public void autonomousPeriodic() {
Scheduler.getInstance().run();
- DriveTrain.getDriveTrain().getDriveController();
+
+ DriveTrain.getDriveTrain().getDriveController().setConstants(p, i, d);
double driveP = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_D_Val,
Constants.DriveTrain.PID_ERROR);