grimpe en rouge aussi

2026-03-31 19:59:15 -04:00
parent 42e35fca8a
commit 7b535a845f
1 changed files with 15 additions and 15 deletions
--- a/src/main/java/frc/robot/commands/ModeAuto/GrimperReservoir.java
+++ b/src/main/java/frc/robot/commands/ModeAuto/GrimperReservoir.java
@@ -63,8 +63,6 @@ public class GrimperReservoir extends Command {
      BotPose = limeLight3G.getBotPoseBlue();
      botx = BotPose[0];
      boty = BotPose[1];
-      pigeonAngle = drivetrain.getPigeon2().getYaw().getValueAsDouble()+180;
-      System.out.println(pigeonAngle);
      if(angle < 0){
        angle = angle + 360;
      }
@@ -85,6 +83,8 @@ public class GrimperReservoir extends Command {
      }
      }
      else{
+        pigeonAngle = drivetrain.getPigeon2().getYaw().getValueAsDouble()+180;
+        System.out.println(pigeonAngle);
        y = 2.6;
        x = 1.11;
        angle = 0;