diff --git a/src/main/java/frc/robot/commands/auton/AutonBuilder.java b/src/main/java/frc/robot/commands/auton/AutonBuilder.java index 32040619..1a227cbf 100644 --- a/src/main/java/frc/robot/commands/auton/AutonBuilder.java +++ b/src/main/java/frc/robot/commands/auton/AutonBuilder.java @@ -125,7 +125,7 @@ public Command goIntake(ChoreoTrajectory intakeTrajectory) { new IntakeRollerIntakeCommand(intakeRollerSubsystem, lightBarSubsystem) ).withTimeout(1), new IntakeRollerIntakeCommand(intakeRollerSubsystem, lightBarSubsystem).until( - () -> intakeRollerSubsystem.getBackSensorReached()).withTimeout(2) + () -> intakeRollerSubsystem.getRockwellSensorValue()).withTimeout(2) // new IntakeRollerIntakeCommand(intakeRollerSubsystem, lightBarSubsystem) // .alongWith(new DriveForwardCommand(swerveSubsystem).until( // intakeRollerSubsystem::getFrontSensorValue).until( diff --git a/src/main/java/frc/robot/commands/swerve/AutonNoteAlignCommand.java b/src/main/java/frc/robot/commands/swerve/AutonNoteAlignCommand.java index d515534d..b00e5be2 100644 --- a/src/main/java/frc/robot/commands/swerve/AutonNoteAlignCommand.java +++ b/src/main/java/frc/robot/commands/swerve/AutonNoteAlignCommand.java @@ -61,7 +61,7 @@ public void initialize() { @Override //stops when there is a note in the intake public boolean isFinished() { - return intakeRollerSubsystem.getFrontSensorReached(); + return intakeRollerSubsystem.getAmpSensor(); } @Override @@ -87,6 +87,11 @@ after. If it remains out of frame, this issue should be rather evident (the robo @Override public void end(boolean interrupted) { + swerveSubsystem.setRobotRelativeDrivePowers( + 0, + 0, + 0 + ); System.out.println("Ended NoteAlignCommand"); } } diff --git a/src/main/java/frc/robot/subsystems/intake/IntakeRollerSubsystem.java b/src/main/java/frc/robot/subsystems/intake/IntakeRollerSubsystem.java index d324e6b2..5d986312 100644 --- a/src/main/java/frc/robot/subsystems/intake/IntakeRollerSubsystem.java +++ b/src/main/java/frc/robot/subsystems/intake/IntakeRollerSubsystem.java @@ -139,5 +139,7 @@ public void periodic() { if (getFrontSensorValue()) { lightBarSubsystem.setLightBarStatus(LightBarStatus.HOLDING_NOTE, 2); } + + System.out.println(getAmpSensor()); } }