diff --git a/src/main/deploy/pathplanner/autos/Preload1Center.auto b/src/main/deploy/pathplanner/autos/Preload1Center.auto index 5ef36e5..82fb827 100644 --- a/src/main/deploy/pathplanner/autos/Preload1Center.auto +++ b/src/main/deploy/pathplanner/autos/Preload1Center.auto @@ -14,7 +14,7 @@ { "type": "named", "data": { - "name": "Shoot" + "name": "ShootSubwoofer" } } ] diff --git a/src/main/deploy/pathplanner/autos/Preload1Left.auto b/src/main/deploy/pathplanner/autos/Preload1Left.auto index 0ca87a7..c542188 100644 --- a/src/main/deploy/pathplanner/autos/Preload1Left.auto +++ b/src/main/deploy/pathplanner/autos/Preload1Left.auto @@ -14,7 +14,7 @@ { "type": "named", "data": { - "name": "Shoot" + "name": "ShootSubwoofer" } } ] diff --git a/src/main/deploy/pathplanner/autos/Preload1Right.auto b/src/main/deploy/pathplanner/autos/Preload1Right.auto index 9e46106..6d02967 100644 --- a/src/main/deploy/pathplanner/autos/Preload1Right.auto +++ b/src/main/deploy/pathplanner/autos/Preload1Right.auto @@ -14,7 +14,7 @@ { "type": "named", "data": { - "name": "Shoot" + "name": "ShootSubwoofer" } } ] diff --git a/src/main/java/org/carlmontrobotics/RobotContainer.java b/src/main/java/org/carlmontrobotics/RobotContainer.java index 9983108..84026de 100644 --- a/src/main/java/org/carlmontrobotics/RobotContainer.java +++ b/src/main/java/org/carlmontrobotics/RobotContainer.java @@ -376,9 +376,10 @@ private void registerAutoCommands() { new PassToOuttake(intakeShooter), new ArmToPos(arm, GROUND_INTAKE_POS))))); NamedCommands.registerCommand("ShootSubwoofer", - new SequentialCommandGroup( - new ArmToPos(arm, Armc.SUBWOOFER_ANGLE_RAD), - new RampRPMAuton(intakeShooter), + new SequentialCommandGroup(new ParallelCommandGroup( + new ArmToPos(arm, + Armc.SUBWOOFER_ANGLE_RAD), + new RampRPMAuton(intakeShooter)), new PassToOuttake(intakeShooter), new ArmToPos(arm, GROUND_INTAKE_POS))); NamedCommands.registerCommand("Limelight Intake CCW", diff --git a/src/main/java/org/carlmontrobotics/commands/PassToOuttake.java b/src/main/java/org/carlmontrobotics/commands/PassToOuttake.java index 1e3e656..1586a19 100644 --- a/src/main/java/org/carlmontrobotics/commands/PassToOuttake.java +++ b/src/main/java/org/carlmontrobotics/commands/PassToOuttake.java @@ -42,6 +42,7 @@ public void end(boolean interrupted) { @Override public boolean isFinished() { return (!intakeShooter.intakeDetectsNote() - && !intakeShooter.outtakeDetectsNote()) || LimelightHelpers.getTV(SHOOTER_LL_NAME); + && !intakeShooter.outtakeDetectsNote()); + // || !LimelightHelpers.getTV(SHOOTER_LL_NAME); } }