Software/Code: CommandGroups

CommandGroups: list of commands that are performed in order. They are added using the “addSequential(...)” method and are called sequentially. 

AutoCollectWhileDriving.java: Intake the ball, wait for powercell (elevator).





AutoScoreandCollect.java: Drives, launches, makes a u-turn and collects to get more balls under the shield generator.






AutoSmartLaunch.java: Spins up the launcher in velocity mode ends when on target, waits a small amount of time, 25000 drives the elevator in velocity mode, 3 waits long enough to empty the elevator, stops the elevator in vBus Mode, stops the launcher in Vbus mode.


AutonomousDriveAndShoot.java: Drives, stop, and shoot.



SmartCollect.java: Spins the intake, ends when the proximity sensor detects a power cell, intake stop, advance the elevator a set amount. 



SmartCollectLastBall.java: Spins the intake, ends when the proximity sensor detects a power cell,Stops the intake. Note- Does not advance the elevator as the robot holds one power cell in the intake ramp so the power cell does not jam the elevator.


SmartCollectWithLED.java:


SmartLaunch.java: Spins up the launcher in velocity mode ends when on target, waits a small amount of time, 25000 drives the elevator in velocity mode, 3 waits long enough to empty the elevator, stops the elevator in stops in vbus so that it coasts slowly down instead of stopping immediately.


SmartLaunchWithLED.java: 


 StopLaunch.java: