driveTrain.getDriveController().setName("Drive");
driveTrain.getGyroController().setName("Gyro");
-
driveTrain.getDriveController().setConstants(driveP, driveI, driveD);
driveTrain.getGyroController().setConstants(gyroP, gyroI, gyroD);
Scheduler.getInstance().add(new DriveDistance(Setpoint, Speed));
-
- 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.MOTOR_VAL, 0.5);
-
}
@Override