|
| 1 | +package frc.robot.Manager; |
| 2 | + |
| 3 | +import static frc.robot.GlobalConstants.Controllers.*; |
| 4 | +import static frc.robot.Manager.ManagerConstants.*; |
| 5 | +import static frc.robot.Manager.ManagerStates.*; |
| 6 | + |
| 7 | +import frc.robot.Subsystems.Drive.Drive; |
| 8 | +import frc.robot.Subsystems.HoodedShooterSupersystem.HoodedShooterSupersystem; |
| 9 | +import frc.robot.Subsystems.Indexer.Indexer; |
| 10 | +import frc.robot.Subsystems.Intake.Intake; |
| 11 | +import frc.robot.Subsystems.Vision.Vision; |
| 12 | +import org.littletonrobotics.junction.Logger; |
| 13 | +import org.team7525.subsystem.Subsystem; |
| 14 | + |
| 15 | +public class Manager extends Subsystem<ManagerStates> { |
| 16 | + |
| 17 | + private static Manager instance; |
| 18 | + private Intake intake; |
| 19 | + public Drive drive; |
| 20 | + private Indexer indexer; |
| 21 | + private HoodedShooterSupersystem hoodedShooterSupersystem; |
| 22 | + private Vision vision; |
| 23 | + |
| 24 | + public static Manager getInstance() { |
| 25 | + if (instance == null) { |
| 26 | + instance = new Manager(); |
| 27 | + } |
| 28 | + return instance; |
| 29 | + } |
| 30 | + |
| 31 | + public Manager() { |
| 32 | + super(SUBSYSTEM_NAME, ManagerStates.IDLE); |
| 33 | + intake = Intake.getInstance(); |
| 34 | + hoodedShooterSupersystem = HoodedShooterSupersystem.getInstance(); |
| 35 | + drive = Drive.getInstance(); |
| 36 | + indexer = Indexer.getInstance(); |
| 37 | + vision = Vision.getInstance(); |
| 38 | + |
| 39 | + //add triggers |
| 40 | + addTrigger(IDLE, OUTTAKING, DRIVER_CONTROLLER::getXButtonPressed); |
| 41 | + addTrigger(INTAKE_PASSING, OUTTAKING, DRIVER_CONTROLLER::getXButtonPressed); |
| 42 | + addTrigger(INTAKING, OUTTAKING, DRIVER_CONTROLLER::getXButtonPressed); |
| 43 | + |
| 44 | + addTrigger(IDLE, INTAKING, DRIVER_CONTROLLER::getAButtonPressed); |
| 45 | + addTrigger(INTAKING, INTAKE_PASSING, DRIVER_CONTROLLER::getAButtonPressed); |
| 46 | + addTrigger(INTAKE_PASSING, FIXED_ALIGN, DRIVER_CONTROLLER::getAButtonPressed); |
| 47 | + addTrigger(FIXED_ALIGN, FIXED_SHOOT, DRIVER_CONTROLLER::getAButtonPressed); |
| 48 | + addTrigger(FIXED_ALIGN, FIXED_SHOOT, () -> hoodedShooterSupersystem.readyToShoot()); |
| 49 | + |
| 50 | + addTrigger(INTAKE_PASSING, DYNAMIC_ALIGN, DRIVER_CONTROLLER::getYButtonPressed); |
| 51 | + addTrigger(DYNAMIC_ALIGN, DYNAMIC_SHOOT, DRIVER_CONTROLLER::getYButtonPressed); |
| 52 | + addTrigger(DYNAMIC_ALIGN, DYNAMIC_SHOOT, () -> hoodedShooterSupersystem.readyToShoot()); |
| 53 | + } |
| 54 | + |
| 55 | + @Override |
| 56 | + public void runState() { |
| 57 | + if (DRIVER_CONTROLLER.getBButtonPressed()) { |
| 58 | + setState(IDLE); |
| 59 | + } |
| 60 | + |
| 61 | + logData(); |
| 62 | + |
| 63 | + intake.setState(getState().getIntakeStates()); |
| 64 | + hoodedShooterSupersystem.setState(getState().getHoodedShooterSupersystemStates()); |
| 65 | + indexer.setState(getState().getIndexerStates()); |
| 66 | + |
| 67 | + hoodedShooterSupersystem.periodic(); |
| 68 | + indexer.periodic(); |
| 69 | + intake.periodic(); |
| 70 | + drive.periodic(); |
| 71 | + vision.periodic(); |
| 72 | + } |
| 73 | + |
| 74 | + public boolean hasGamepiece() { |
| 75 | + return intake.hasGamepiece(); |
| 76 | + } |
| 77 | + |
| 78 | + public void logData() { |
| 79 | + Logger.recordOutput(SUBSYSTEM_NAME + "/State Time", getStateTime()); |
| 80 | + Logger.recordOutput(SUBSYSTEM_NAME + "/State String", getState().getStateString()); |
| 81 | + } |
| 82 | +} |
0 commit comments