diff --git a/src/main/java/frc/robot/commands/grimpeur/GrimpeurBas.java b/src/main/java/frc/robot/commands/grimpeur/GrimpeurBas.java index 4dfc3b0..7dbb65c 100644 --- a/src/main/java/frc/robot/commands/grimpeur/GrimpeurBas.java +++ b/src/main/java/frc/robot/commands/grimpeur/GrimpeurBas.java @@ -4,19 +4,11 @@ package frc.robot.commands.grimpeur; -import edu.wpi.first.networktables.DoubleSubscriber; -import edu.wpi.first.networktables.NetworkTable; -import edu.wpi.first.networktables.NetworkTableInstance; import edu.wpi.first.wpilibj2.command.Command; import frc.robot.subsystems.Grimpeur; - /* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */ public class GrimpeurBas extends Command { private Grimpeur grimpeur; - NetworkTableInstance networktable = NetworkTableInstance.getDefault(); - NetworkTable tabelevateur = networktable.getTable("tabelevateur"); - private DoubleSubscriber encodeur1 = tabelevateur.getDoubleTopic("encodeurgrimpeurbas").subscribe(-39.19); - private DoubleSubscriber encodeur2 = tabelevateur.getDoubleTopic("encodeurgrimpeurhaut ").subscribe(-38.5); /** Creates a new GrimpeurBas. */ public GrimpeurBas(Grimpeur grimpeur) { this.grimpeur = grimpeur; @@ -31,12 +23,10 @@ public class GrimpeurBas extends Command { // Called every time the scheduler runs while the command is scheduled. @Override public void execute() { - double encodeurbas = encodeur1.get(); - double encodeurhaut = encodeur2.get(); - if(grimpeur.encodeur()>=encodeurhaut && grimpeur.encodeur()<=encodeurbas){ + if(grimpeur.encodeur()>=-38.5 && grimpeur.encodeur()<=-39.19){ grimpeur.grimpe(0); } - else if(grimpeur.encodeur()>=encodeurhaut){ + else if(grimpeur.encodeur()>=-38.5){ grimpeur.grimpe(-0.5); } else{grimpeur.grimpe(0.5);