src/main/java/frc/robot/Autonomous.java
public void fullAuto(double distance) {
		new SequentialCommandGroup(
				new InstantCommand(() -> deployIntake()),
				new InstantCommand(() -> Robot.shootCommands.shootFull()),
				new WaitCommand(4),
				new InstantCommand(() -> Robot.intake.set(0.5)),
				new WaitUntilCommand(() -> commands.driveFeet(distance, 0.2, true)),
				new WaitCommand(1),
				new WaitUntilCommand(() -> commands.driveFeet(distance - 0.75, -0.35, true)),
				new InstantCommand(() -> Robot.intake.stop()),
				new InstantCommand(() -> Robot.shootCommands.shootFull())).schedule();
	}
// Standard two ball auto program with input for the distance to the cargo
Standard two ball auto program with input for the distance to the cargo
Standard two ball auto program with input for the distance to the cargo
public void fullAuto(double distance) {
		new SequentialCommandGroup(
				new InstantCommand(() -> deployIntake()),
				new InstantCommand(() -> Robot.shootCommands.shootFull()),
				new WaitCommand(4),
				new InstantCommand(() -> Robot.intake.set(0.5)),
				new WaitUntilCommand(() -> commands.driveFeet(distance, 0.2, true)),
				new WaitCommand(1),
				new WaitUntilCommand(() -> commands.driveFeet(distance - 0.75, -0.35, true)),
				new InstantCommand(() -> Robot.intake.stop()),
				new InstantCommand(() -> Robot.shootCommands.shootFull())).schedule();
	}
public void fullAuto ( double distance ) { new SequentialCommandGroup ( new InstantCommand ( ( ) -> deployIntake ( ) ) , new InstantCommand ( ( ) -> Robot . shootCommands . shootFull ( ) ) , new WaitCommand ( 4 ) , new InstantCommand ( ( ) -> Robot . intake . set ( 0.5 ) ) , new WaitUntilCommand ( ( ) -> commands . driveFeet ( distance , 0.2 , true ) ) , new WaitCommand ( 1 ) , new WaitUntilCommand ( ( ) -> commands . driveFeet ( distance - 0.75 , - 0.35 , true ) ) , new InstantCommand ( ( ) -> Robot . intake . stop ( ) ) , new InstantCommand ( ( ) -> Robot . shootCommands . shootFull ( ) ) ) . schedule ( ) ; }
Standard two ball auto program with input for the distance to the cargo
Standard two ball auto program with input for the distance to the cargo