climb reset

hammerhead226 · Aug 16, 2024 · 7e4a046 · 7e4a046
1 parent 0a0ebc9
commit 7e4a046
Show file tree

Hide file tree

Showing 2 changed files with 6 additions and 0 deletions.
diff --git a/src/main/java/frc/robot/Robot.java b/src/main/java/frc/robot/Robot.java
@@ -18,6 +18,7 @@
 import edu.wpi.first.wpilibj2.command.Command;
 import edu.wpi.first.wpilibj2.command.CommandScheduler;
 import frc.robot.Constants.LED_STATE;
+import frc.robot.statemachines.ClimbStateMachine.CLIMB_STATES;
 import frc.robot.util.LocalADStarAK;
 import org.littletonrobotics.junction.LogFileUtil;
 import org.littletonrobotics.junction.LoggedRobot;
@@ -115,6 +116,7 @@ public void robotPeriodic() {
   @Override
   public void disabledInit() {
     m_robotContainer.getLED().setState(LED_STATE.FIRE);
+    m_robotContainer.getClimbStateMachine().setClimbState(CLIMB_STATES.NONE);
   }
 
   /** This function is called periodically when disabled. */

diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java
@@ -999,4 +999,8 @@ public LED getLED() {
   public Drive getDrive() {
     return drive;
   }
+
+  public ClimbStateMachine getClimbStateMachine() {
+    return climbStateMachine;
+  }
 }