This commit is contained in:
@@ -24,15 +24,16 @@ public class GrimpeurDroit extends Command {
|
||||
@Override
|
||||
public void initialize() {
|
||||
grimpeur.resetencodeurd();
|
||||
grimpeur.resetencodeurg();
|
||||
grimpeur.pistonferme();
|
||||
}
|
||||
|
||||
// Called every time the scheduler runs while the command is scheduled.
|
||||
@Override
|
||||
public void execute() {
|
||||
|
||||
if(grimpeur.encoderd()>261 ){
|
||||
grimpeur.droit(doubleSupplier.getAsDouble());
|
||||
if(grimpeur.encoderd()>261){
|
||||
grimpeur.droit(0);
|
||||
|
||||
}
|
||||
else if(grimpeur.getpitch()<-15){
|
||||
grimpeur.droit(-doubleSupplier.getAsDouble());
|
||||
@@ -44,6 +45,11 @@ public class GrimpeurDroit extends Command {
|
||||
else{
|
||||
grimpeur.droit(0);
|
||||
}
|
||||
if(grimpeur.encoderd()>0){
|
||||
grimpeur.resetencodeurd();
|
||||
grimpeur.droit(0);
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
// Called once the command ends or is interrupted.
|
||||
|
||||
Reference in New Issue
Block a user