diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java index e324f5a..18234bc 100644 --- a/src/main/java/frc/robot/RobotContainer.java +++ b/src/main/java/frc/robot/RobotContainer.java @@ -6,6 +6,7 @@ package frc.robot; import com.ctre.phoenix.motorcontrol.can.WPI_TalonSRX; +import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard; import edu.wpi.first.wpilibj2.command.Command; import edu.wpi.first.wpilibj2.command.Commands; import edu.wpi.first.wpilibj2.command.button.CommandPS5Controller; @@ -15,18 +16,21 @@ import frc.robot.constants.IOConstants; import frc.robot.subsystems.Arm; import frc.robot.subsystems.DriveTrain; import frc.robot.subsystems.Grabber; +import frc.robot.subsystems.HighFive; public class RobotContainer { private CommandPS5Controller driver; private Arm arm; private DriveTrain driveTrain; private Grabber grabber; + private HighFive highFive; public RobotContainer() { arm = new Arm(); driveTrain = new DriveTrain(); grabber = new Grabber(); driver = new CommandPS5Controller(IOConstants.kDriverID0); + highFive = new HighFive(); configureBindings(); } @@ -49,7 +53,11 @@ public class RobotContainer { driver.povUp().whileTrue(arm.runArmMotor(1)); driver.povDown().whileTrue(arm.runArmMotor(-1)); + + Shuffleboard.getTab("HighFive") + .addBoolean("Switch Pressed", () -> highFive.SwitchDigitalInput()); } + public Command getAutonomousCommand() { return Commands.print("No autonomous command configured"); diff --git a/src/main/java/frc/robot/subsystems/HighFive.java b/src/main/java/frc/robot/subsystems/HighFive.java new file mode 100644 index 0000000..39b3bdc --- /dev/null +++ b/src/main/java/frc/robot/subsystems/HighFive.java @@ -0,0 +1,16 @@ +package frc.robot.subsystems; +import edu.wpi.first.wpilibj.DigitalInput; +import edu.wpi.first.wpilibj2.command.SubsystemBase; + +public class HighFive extends SubsystemBase { + private DigitalInput switchDigitalInput; + + public HighFive(){ + switchDigitalInput = new DigitalInput(0); + } + + public boolean SwitchDigitalInput() { + return switchDigitalInput.get(); + } + +}