diff --git a/Robot2019/src/main/java/frc/robot/subsystems/HatchPanel.java b/Robot2019/src/main/java/frc/robot/subsystems/HatchPanel.java index 6333111..6ebe575 100644 --- a/Robot2019/src/main/java/frc/robot/subsystems/HatchPanel.java +++ b/Robot2019/src/main/java/frc/robot/subsystems/HatchPanel.java @@ -9,10 +9,12 @@ import edu.wpi.first.wpilibj.DoubleSolenoid; import edu.wpi.first.wpilibj.command.Subsystem; +import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard; public class HatchPanel extends Subsystem { private DoubleSolenoid pistons; + private String pistonState; /** * Subsystem for controlling the hatch panel mechanism @@ -21,6 +23,9 @@ public class HatchPanel extends Subsystem { */ public HatchPanel(DoubleSolenoid pistons) { this.pistons = pistons; + pistonState = "IN"; + pistons.set(DoubleSolenoid.Value.kReverse); + SmartDashboard.putString("Hatch Piston State", pistonState); } /** @@ -31,9 +36,13 @@ public HatchPanel(DoubleSolenoid pistons) { public boolean toggle() { if (pistons.get() == DoubleSolenoid.Value.kForward) { pistons.set(DoubleSolenoid.Value.kReverse); + pistonState = "IN"; + SmartDashboard.putString("Hatch Piston State", pistonState); return false; } else { pistons.set(DoubleSolenoid.Value.kForward); + pistonState = "OUT"; + SmartDashboard.putString("Hatch Piston State", pistonState); return true; } }