Constants.DriveTrain.PID_ERROR);
double gyroD = SmartDashboard.getNumber(Constants.DriveTrain.GYRO_D_Val,
Constants.DriveTrain.PID_ERROR);
+ SmartDashboard.putNumber(Constants.DriveTrain.DRIVE_MOTOR_VAL, 0.5);
- double Setpoint = SmartDashboard.getNumber(
- Constants.DriveTrain.DRIVE_TARGET_DIST, Constants.DriveTrain.PID_ERROR);
- double Speed = SmartDashboard.getNumber(
- Constants.DriveTrain.DRIVE_MOTOR_VAL, Constants.DriveTrain.PID_ERROR);
-
- driveTrain.getDriveController().setName("Drive");
- driveTrain.getGyroController().setName("Gyro");
-
- driveTrain.getDriveController().setConstants(driveP, driveI, driveD);
}
@Override