[#526] Auto smart collect

frc-862 · Apr 8, 2024 · 49b1c26 · 49b1c26
1 parent b3f1805
commit 49b1c26
Show file tree

Hide file tree

Showing 2 changed files with 7 additions and 6 deletions.
diff --git 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
@@ -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;
     }
 }