SmartDashboard.putNumber(driveTrain.DRIVE_I_Val, 0);
SmartDashboard.putNumber(driveTrain.DRIVE_D_Val, 0);
SmartDashboard.putNumber(driveTrain.DRIVE_TARGET_DIST, 50);
- SmartDashboard.putNumber(driveTrain.DRIVE_MOTOR_VAL, 0.5);
+ SmartDashboard.putNumber(driveTrain.MAX_TIME_OUT, 10);
SmartDashboard.putNumber(driveTrain.GYRO_P_Val, 0);
SmartDashboard.putNumber(driveTrain.GYRO_I_Val, 0);
double gyroD = SmartDashboard.getNumber(driveTrain.GYRO_D_Val,
driveTrain.PID_ERROR);
- double Setpoint = SmartDashboard.getNumber(driveTrain.DRIVE_TARGET_DIST,
+ double setpoint = SmartDashboard.getNumber(driveTrain.DRIVE_TARGET_DIST,
driveTrain.PID_ERROR);
- double Speed = SmartDashboard.getNumber(driveTrain.DRIVE_MOTOR_VAL,
+ double maxTimeOut = SmartDashboard.getNumber(driveTrain.MAX_TIME_OUT,
driveTrain.PID_ERROR);
driveTrain.getDriveController().setName("Drive");
driveTrain.getGyroController().setConstants(gyroP, gyroI, gyroD);
- Scheduler.getInstance().add(new DriveDistance(Setpoint, Speed));
+ Scheduler.getInstance().add(new DriveDistance(setpoint, maxTimeOut));
}
@Override
public static final String DRIVE_I_Val = "DriveI";
public static final String DRIVE_D_Val = "DriveD";
public static final String DRIVE_TARGET_DIST = "SET_DIST";
- public static final String DRIVE_MOTOR_VAL = "SPEED";
+ public static final String MAX_TIME_OUT = "MaxTimeOut";
public static final String GYRO_P_Val = "GyroP";
public static final String GYRO_I_Val = "GyroI";
public static final String GYRO_D_Val = "GyroD";