package org.usfirst.frc.team3501.robot;
+import org.usfirst.frc.team3501.robot.commandgroups.PrepareToShoot;
+import org.usfirst.frc.team3501.robot.commandgroups.Shoot;
import org.usfirst.frc.team3501.robot.subsystems.DriveTrain;
import org.usfirst.frc.team3501.robot.subsystems.Intake;
import org.usfirst.frc.team3501.robot.subsystems.Shooter;
import edu.wpi.first.wpilibj.command.CommandGroup;
import edu.wpi.first.wpilibj.command.Scheduler;
import edu.wpi.first.wpilibj.smartdashboard.SendableChooser;
+import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
public class Robot extends IterativeRobot {
intake = Intake.getIntake();
chooser = new SendableChooser();
+ SendableChooser autoChooser = new SendableChooser();
+ autoChooser.addDefault("Prepare to Shoot", new PrepareToShoot());
+ autoChooser.addObject("Shoot", new Shoot());
+ SmartDashboard.putData("Autonomous mode chooser", autoChooser);
+
}
public static DriveTrain getDriveTrain() {
--- /dev/null
+package org.usfirst.frc.team3501.robot.commandgroups;
+
+import edu.wpi.first.wpilibj.command.CommandGroup;
+
+public abstract class TestCommandGroup extends CommandGroup {
+
+ private TestCommandGroup() {
+ setup();
+ runCommandGroup();
+ teardown();
+
+ }
+
+ abstract void runCommandGroup();
+
+ abstract void setup();
+
+ abstract void teardown();
+
+}