pivot balayeuse et grimpeur fait

2026-03-10 18:58:34 -04:00
parent fb0ca84885
commit a45e81349a
5 changed files with 14 additions and 6 deletions
--- a/src/main/java/frc/robot/commands/MonterGrimpeur.java
+++ b/src/main/java/frc/robot/commands/MonterGrimpeur.java
@@ -23,8 +23,13 @@ public class MonterGrimpeur extends Command {
  // Called every time the scheduler runs while the command is scheduled.
  @Override
  public void execute() {
-    if(grimpeur.Position() < grimpeur.PositionFinal()){
-      grimpeur.Grimper(0.5);
+    
+    if(Math.abs(grimpeur.Position()) < grimpeur.PositionFinal()){
+      grimpeur.Grimper(0.2);
+      System.out.println("monte");
+    }
+    else {
+      grimpeur.Grimper(0);
    }
  }