diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java index b12b2888..dad5cb68 100644 --- a/src/main/java/frc/robot/RobotContainer.java +++ b/src/main/java/frc/robot/RobotContainer.java @@ -263,9 +263,10 @@ protected void configureButtonBindings() { new Trigger(coPilot::getXButton) .whileTrue(new PointBlankShot(flywheel, pivot).deadlineWith(leds.enableState(LED_STATES.SHOOTING))); // new Trigger(coPilot::getYButton).whileTrue(new PivotUP(pivot)); - // new Trigger(coPilot::getYButton).whileTrue(new NotePass(flywheel, pivot)); - new Trigger(coPilot::getYButton).whileTrue(new Tune(flywheel, pivot) - .deadlineWith(leds.enableState(LED_STATES.SHOOTING))); + new Trigger(coPilot::getYButton).whileTrue(new NotePass(flywheel, pivot) + .deadlineWith(leds.enableState(LED_STATES.SHOOTING))); + // new Trigger(coPilot::getYButton).whileTrue(new Tune(flywheel, pivot) + // .deadlineWith(leds.enableState(LED_STATES.SHOOTING))); new Trigger(coPilot::getAButton).whileTrue(new AmpShot(flywheel, pivot) .deadlineWith(leds.enableState(LED_STATES.SHOOTING))); new Trigger(coPilot::getRightBumper) diff --git a/src/main/java/frc/robot/command/AutonSmartCollect.java b/src/main/java/frc/robot/command/AutonSmartCollect.java index 6816b283..17e4151b 100644 --- a/src/main/java/frc/robot/command/AutonSmartCollect.java +++ b/src/main/java/frc/robot/command/AutonSmartCollect.java @@ -41,10 +41,10 @@ public void initialize() { } @Override - public void execute() { // TODO this needs to be cleaned up + public void execute() { if (indexer.getPieceState() == PieceState.IN_COLLECT) { indexer.setPower(indexerPower.getAsDouble() / 2); - collector.setPower(collectorPower.getAsDouble() / 2); + // collector.setPower(collectorPower.getAsDouble() / 2); } else { collector.setPower(collectorPower.getAsDouble()); indexer.setPower(indexerPower.getAsDouble()); @@ -61,6 +61,6 @@ public void end(boolean interrupted) { @Override public boolean isFinished() { - return indexer.getPieceState() == PieceState.IN_PIVOT && !collector.getEntryBeamBreakState(); + return indexer.getPieceState() == PieceState.IN_PIVOT; } }