Merge branch 'main' of https://github.com/Team334/R2024

Team334 · Mar 28, 2024 · 81b3dc0 · 81b3dc0
2 parents e6f1557 + 7e6637b
commit 81b3dc0
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/src/main/java/frc/robot/commands/auto/NoteAlign.java b/src/main/java/frc/robot/commands/auto/NoteAlign.java
@@ -53,6 +53,12 @@ public void execute() {
       noteX = noteAngles.get()[0];
     }
 
+    if (!_headingController.atSetpoint()) {
+
+    } else {
+
+    }
+
     double rotationVelocity = MathUtil.clamp(
       _headingController.calculate(noteX, 0),
       -Speeds.SWERVE_DRIVE_MAX_ANGULAR_SPEED,