limelighter coriger

2026-03-31 19:20:34 -04:00
parent 9d09af20b0
commit 4d1b353e25
1 changed files with 3 additions and 0 deletions
--- a/src/main/java/frc/robot/commands/Limelighter.java
+++ b/src/main/java/frc/robot/commands/Limelighter.java
@@ -65,6 +65,9 @@ public class Limelighter extends Command {
        x = 11.915394;
       BotPose = limelight3g.getBotPoseRed();
      }
+      botx = BotPose[0];
+      boty = BotPose[1];
+      calcul = limelight3g.Calcule(botx, x, boty, 4, angle);
      if(calcul > -5 && calcul < 5){
         drivetrain.setControl(
           drive.withRotationalRate(0));