diff --git a/src/main/java/frc4388/robot/Constants.java b/src/main/java/frc4388/robot/Constants.java index 549a128..37137a4 100644 --- a/src/main/java/frc4388/robot/Constants.java +++ b/src/main/java/frc4388/robot/Constants.java @@ -151,7 +151,7 @@ public final class Constants { } public static final class ExtenderConstants { - public static final double EXTENDER_FORWARD_LIMIT = 250.0; + public static final double EXTENDER_FORWARD_LIMIT = 235.0;//250.0; public static final double EXTENDER_REVERSE_LIMIT = 0.0; } diff --git a/src/main/java/frc4388/robot/RobotContainer.java b/src/main/java/frc4388/robot/RobotContainer.java index af796f7..ed4d006 100644 --- a/src/main/java/frc4388/robot/RobotContainer.java +++ b/src/main/java/frc4388/robot/RobotContainer.java @@ -357,7 +357,8 @@ public class RobotContainer { .whenReleased(new InstantCommand(() -> m_robotTurret.m_boomBoomRotateEncoder.setPosition(0), m_robotTurret)) .whenReleased(new InstantCommand(() -> m_robotHood.m_angleEncoder.setPosition(0), m_robotHood)) - .whenReleased(new InstantCommand(() -> m_robotExtender.setEncoder(0), m_robotExtender)); + .whenReleased(new InstantCommand(() -> m_robotExtender.setEncoder(0), m_robotExtender)) + .whenReleased(new InstantCommand(() -> ExtenderIntakeGroup.setDirectionToOut(), m_robotIntake, m_robotExtender)); // new JoystickButton(getButtonBox(), ButtonBox.Button.kLeftSwitch.value) // .whileHeld(new RunCommand(() -> RunMiddleSwitch.setManual(true))) diff --git a/src/main/java/frc4388/robot/commands/ExtenderIntakeCommands/ExtenderIntakeGroup.java b/src/main/java/frc4388/robot/commands/ExtenderIntakeCommands/ExtenderIntakeGroup.java index 02ce30a..21fb95d 100644 --- a/src/main/java/frc4388/robot/commands/ExtenderIntakeCommands/ExtenderIntakeGroup.java +++ b/src/main/java/frc4388/robot/commands/ExtenderIntakeCommands/ExtenderIntakeGroup.java @@ -24,6 +24,10 @@ public class ExtenderIntakeGroup extends ParallelRaceGroup { addCommands(new RunIntakeConditionally(intake), new RunExtender(extender)); } + public static void setDirectionToOut() { + ExtenderIntakeGroup.direction = 1; + } + public static void changeDirection() { // Never implemented? ExtenderIntakeGroup.direction *= -1; }