public void autonomousInit() {
driveTrain.setHighGear();
- 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.DRIVE_P_Val, 0);
+ SmartDashboard.putNumber(Constants.DriveTrain.DRIVE_I_Val, 0);
+ SmartDashboard.putNumber(Constants.DriveTrain.DRIVE_D_Val, 0);
+ SmartDashboard.putNumber(Constants.DriveTrain.DRIVE_TARGET_DIST, 50);
SmartDashboard.putNumber(Constants.DriveTrain.MOTOR_VAL, 0.5);
}
public void autonomousPeriodic() {
Scheduler.getInstance().run();
- double P = SmartDashboard.getNumber(Constants.DriveTrain.P_Val,
+ double P = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_P_Val,
Constants.DriveTrain.PID_ERROR);
- double I = SmartDashboard.getNumber(Constants.DriveTrain.I_Val,
+ double I = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_I_Val,
Constants.DriveTrain.PID_ERROR);
- double D = SmartDashboard.getNumber(Constants.DriveTrain.D_Val,
+ double D = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_D_Val,
Constants.DriveTrain.PID_ERROR);
double SPEED = SmartDashboard.getNumber(Constants.DriveTrain.MOTOR_VAL, 0);
- double SETPOINT = SmartDashboard.getNumber(Constants.DriveTrain.TARGET_DIST,
+ double SETPOINT = SmartDashboard.getNumber(Constants.DriveTrain.DRIVE_TARGET_DIST,
Constants.DriveTrain.TARGET_DISTANCE);
DriveTrain.getDriveTrain().getDriveController().setConstants(P, I, D);