From 68d11dceaa0cf09f70495f9e13daa7e7512c5e95 Mon Sep 17 00:00:00 2001 From: joelzoto <118407587+joelzoto@users.noreply.github.com> Date: Sat, 29 Mar 2025 18:10:47 -0400 Subject: [PATCH] fixed stupid alliance selection --- .../java/frc/robot/vision/commands/AutoAlign.java | 14 +++----------- 1 file changed, 3 insertions(+), 11 deletions(-) diff --git a/src/main/java/frc/robot/vision/commands/AutoAlign.java b/src/main/java/frc/robot/vision/commands/AutoAlign.java index 002d8f2..e6ce44f 100644 --- a/src/main/java/frc/robot/vision/commands/AutoAlign.java +++ b/src/main/java/frc/robot/vision/commands/AutoAlign.java @@ -97,20 +97,12 @@ public void execute() { double YOutput = 0.15 * kLineupSpeed.in(MetersPerSecond) * 0.95 * xDistanceController.calculate(y, targetPose.getY()); double thetaOutput = 0.15 * RotationsPerSecond.of(0.75).in(RadiansPerSecond) * thetaController.calculate(currentPose.getRotation().getRadians(), targetPose.getRotation().getRadians()); - if (DriverStation.getAlliance().get() == Alliance.Blue){ - CommandSwerveDrivetrain.getInstance().applyRequest(() -> - RobotContainer.drive.withVelocityX(-XOutput) - .withVelocityY(-YOutput) + CommandSwerveDrivetrain.getInstance().applyRequest(() -> + RobotContainer.drive.withVelocityX(XOutput) + .withVelocityY(YOutput) .withRotationalRate(thetaOutput) ).execute(); - } else { - CommandSwerveDrivetrain.getInstance().applyRequest(() -> - RobotContainer.drive.withVelocityX(XOutput) - .withVelocityY(YOutput) - .withRotationalRate(-thetaOutput) - ).execute(); - } commandRan = true; SmartDashboard.putBoolean("command ran", commandRan);