diff --git a/src/main/java/frc4388/robot/commands/alignment/AutoAlign.java b/src/main/java/frc4388/robot/commands/alignment/AutoAlign.java index 1f85d2b..82121d7 100644 --- a/src/main/java/frc4388/robot/commands/alignment/AutoAlign.java +++ b/src/main/java/frc4388/robot/commands/alignment/AutoAlign.java @@ -50,7 +50,7 @@ public class AutoAlign extends Command { if (!isLidar){ desiredHeading = new Rotation2d(Math.atan2(dy, dx)+ Math.PI); }else{ - desiredHeading = new Rotation2d(Math.atan2(dy, dx)); + desiredHeading = new Rotation2d(Math.atan2(dx, dy)); }