public void autonomousPeriodic() {
Scheduler.getInstance().run();
- double DriveP = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_D_Val,
+ double P = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_D_Val,
Constants.DriveTrain.PID_ERROR);
- double DriveI = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_I_Val,
+ double I = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_I_Val,
Constants.DriveTrain.PID_ERROR);
- double DriveD = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_D_Val,
+ double D = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_D_Val,
+ Constants.DriveTrain.PID_ERROR);
+ double P = SmartDashboard.getNumber(Constants.DriveTrain.GYRO_P_Val,
+ Constants.DriveTrain.PID_ERROR);
+ double I = SmartDashboard.getNumber(Constants.DriveTrain.GYRO_I_Val,
+ Constants.DriveTrain.PID_ERROR);
+ double D = SmartDashboard.getNumber(Constants.DriveTrain.GYRO_D_Val,
+
Constants.DriveTrain.PID_ERROR);
DriveTrain.getDriveTrain().getDriveController().setConstants(DriveP, DriveI,