diff --git a/src/main/java/frc/team5115/RobotContainer.java b/src/main/java/frc/team5115/RobotContainer.java index 4b543a2..bba3d22 100644 --- a/src/main/java/frc/team5115/RobotContainer.java +++ b/src/main/java/frc/team5115/RobotContainer.java @@ -2,7 +2,6 @@ import com.pathplanner.lib.auto.AutoBuilder; import com.pathplanner.lib.auto.NamedCommands; - import edu.wpi.first.math.geometry.Pose2d; import edu.wpi.first.math.geometry.Rotation2d; import edu.wpi.first.wpilibj2.command.Command; @@ -58,6 +57,7 @@ public class RobotContainer { // Controller private final CommandXboxController joyDrive = new CommandXboxController(0); + private final CommandXboxController joyManip = new CommandXboxController(1); // Dashboard inputs private final LoggedDashboardChooser autoChooser; @@ -80,7 +80,8 @@ public RobotContainer() { new ModuleIOSparkMax(1), new ModuleIOSparkMax(2), new ModuleIOSparkMax(3)); - vision = new PhotonVision(drivetrain); + // vision = new PhotonVision(drivetrain); + vision = null; break; case SIM: @@ -159,20 +160,20 @@ private void configureButtonBindings() { // joyDrive.x().onTrue(Commands.runOnce(drivetrain::stopWithX, drivetrain)); joyDrive.start().onTrue(resetFieldOrientation()); - joyDrive + joyManip .back() .onTrue(DriveCommands.vomit(intake, feeder, shooter)) .onFalse(DriveCommands.forceStop(intake, feeder, shooter)); - joyDrive.a().onTrue(DriveCommands.intakeUntilNote(arm, intake, feeder)); + joyManip.a().onTrue(DriveCommands.intakeUntilNote(arm, intake, feeder)); - joyDrive + joyManip .y() .onTrue( Commands.parallel(arm.stow(), shooter.stop(), feeder.stop(), intake.stop()) .withInterruptBehavior(InterruptionBehavior.kCancelSelf)); - joyDrive + joyManip .b() .onTrue(DriveCommands.prepareShoot(arm, intake, feeder, shooter, 15, 5000)) .onFalse( @@ -180,7 +181,7 @@ private void configureButtonBindings() { .andThen(shooter.stop()) .withInterruptBehavior(InterruptionBehavior.kCancelIncoming)); - joyDrive + joyManip .x() .onTrue(DriveCommands.prepareAmp(arm, amper, intake, feeder)) .onFalse(DriveCommands.triggerAmp(arm, amper, intake, feeder));