elevateurise mieux

src/main/java/frc/robot/command/L2.java

@@ -24,12 +24,16 @@ public class L2 extends Command {
   // Called every time the scheduler runs while the command is scheduled.
   @Override
   public void execute() {
-    if(elevateur.position()>=500){
+    if(elevateur.position()>=500 && elevateur.position()<=510){
       elevateur.vitesse(0);
     }
+    else if(elevateur.position()>=510){
+      elevateur.vitesse(-0.3);
+    }
     else{
       elevateur.vitesse(.3);
     }
+
   }
 
   // Called once the command ends or is interrupted.
@@ -41,6 +45,6 @@ public class L2 extends Command {
   // Returns true when the command should end.
   @Override
   public boolean isFinished() {
-    return elevateur.position()>=500;
+    return false;
   }
 }

src/main/java/frc/robot/command/L3.java

@@ -24,9 +24,12 @@ public class L3 extends Command {
   // Called every time the scheduler runs while the command is scheduled.
   @Override
   public void execute() {
-    if(elevateur.position()>=700){
+    if(elevateur.position()>=700 && elevateur.position()<=710){
       elevateur.vitesse(0);
     }
+    else if(elevateur.position()>=510){
+      elevateur.vitesse(-0.5);
+    }
     else{
       elevateur.vitesse(.5);
     }
@@ -41,6 +44,6 @@ public class L3 extends Command {
   // Returns true when the command should end.
   @Override
   public boolean isFinished() {
-    return elevateur.position()>=700;
+    return false;
   }
 }

src/main/java/frc/robot/command/L4.java

@@ -24,9 +24,12 @@ public class L4 extends Command {
   // Called every time the scheduler runs while the command is scheduled.
   @Override
   public void execute() {
-    if(elevateur.position()>=800){
+    if(elevateur.position()>=800 && elevateur.position()<=810){
       elevateur.vitesse(0);
     }
+    else if(elevateur.position()>=810){
+      elevateur.vitesse(-0.5);
+    }
     else{
       elevateur.vitesse(.5);
     }