diff --git a/src/main/java/frc/robot/queuer/QueuerState.java b/src/main/java/frc/robot/queuer/QueuerState.java new file mode 100644 index 0000000..ee1d5e3 --- /dev/null +++ b/src/main/java/frc/robot/queuer/QueuerState.java @@ -0,0 +1,9 @@ +package frc.robot.queuer; +public enum QueuerState{ + IDLE_WITH_GP, + IDLE_NO_GP, + SHOOTING, + INTAKING, + OUTTAKING; + +} diff --git a/src/main/java/frc/robot/queuer/QueuerSubsystem.java b/src/main/java/frc/robot/queuer/QueuerSubsystem.java new file mode 100644 index 0000000..5703528 --- /dev/null +++ b/src/main/java/frc/robot/queuer/QueuerSubsystem.java @@ -0,0 +1,18 @@ +package frc.robot.queuer; + +import com.ctre.phoenix6.hardware.TalonFX; + +import edu.wpi.first.wpilibj.DigitalInput; +import frc.robot.util.scheduling.SubsystemPriority; +import frc.robot.util.state_machines.StateMachine; + +public class QueuerSubsystem extends StateMachine { + private final TalonFX motor; + private final DigitalInput sensor; + + public QueuerSubsystem(TalonFX motor, DigitalInput sensor) { + super(SubsystemPriority.QUEUER, QueuerState.IDLE_NO_GP); + + this.sensor = sensor; + this.motor = motor; + }}