made note align run forever

Team334 · Mar 28, 2024 · 60b432d · 60b432d
1 parent b8210d2
commit 60b432d
Show file tree

Hide file tree

Showing 2 changed files with 8 additions and 1 deletion.
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,
@@ -76,6 +82,6 @@ public void end(boolean interrupted) {
   // Returns true when the command should end.
   @Override
   public boolean isFinished() {
-    return _headingController.atSetpoint();
+    return false;
   }
 }
diff --git a/src/main/java/frc/robot/commands/leds/DefaultLED.java b/src/main/java/frc/robot/commands/leds/DefaultLED.java
@@ -42,6 +42,7 @@ public void execute() {
     switch (UtilFuncs.GetLEDs()) {
       case DEFAULT:
         _leds.setColor(UtilFuncs.GetAlliance() == Alliance.Red ? LEDColors.RED : LEDColors.BLUE);
+        // 16 side | 19 back
         // leds.rainbow();
         break;