added climber reset (#44)

* added climber reset * removed unused comment. fixed formatting
SaintsRobotics · Apr 5, 2024 · b9c849e · b9c849e
1 parent c0396b0
commit b9c849e
Show file tree

Hide file tree

Showing 3 changed files with 9 additions and 4 deletions.
diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java
@@ -262,6 +262,7 @@ public void resetAllSubsystems() {
     m_intakeSubsystem.reset();
     m_shooterSubsystem.reset();
     m_robotDrive.reset();
+    m_climberSubsystem.reset();
   }
 
   public void compressorInit() {

diff --git a/src/main/java/frc/robot/commands/DefaultLEDCommand.java b/src/main/java/frc/robot/commands/DefaultLEDCommand.java
@@ -64,19 +64,19 @@ public void initialize() {
     }
 
     //check for pneumatics state and override b4 value
-    if (m_climberSubsystem.getState() == Value.kForward){
+    if (m_climberSubsystem.getState() == Value.kForward) {
       rgb[0] = 257;
       rgb[1] = 257;
       rgb[2] = 257;
     }
 
-    if (m_intakeSubsystem.getArmPosition() == IntakeConstants.kIntakeAmpScoringAngle){
-      if (m_intakeSubsystem.ampReady()){
+    if (m_intakeSubsystem.getArmPosition() == IntakeConstants.kIntakeAmpScoringAngle) {
+      if (m_intakeSubsystem.ampReady()) {
         rgb[0] = 0;
         rgb[1] = 255;
         rgb[2] = 0;   
       }
-      else{
+      else {
         rgb[0] = 0;
         rgb[1] = 255;
         rgb[2] = 0;

diff --git a/src/main/java/frc/robot/subsystems/ClimberSubsystem.java b/src/main/java/frc/robot/subsystems/ClimberSubsystem.java
@@ -41,6 +41,10 @@ public void periodic() {
     SmartDashboard.putBoolean("Compressor Running", m_pHub.getCompressor());
   }
 
+  public void reset() {
+    m_state = kOff;
+  }
+
   /**
    * Sets the state of the solenoid to off
    */