This commit is contained in:
samuel desharnais
2023-02-22 18:29:18 -05:00
parent 6405e1b883
commit 2c79346ce9
8 changed files with 26 additions and 2 deletions

View File

@ -29,6 +29,7 @@ public class PivotBrasRentre extends CommandBase {
public void execute() {
if(brasTelescopique.distance()>1){
brasTelescopique.AvanceRecule(0.5);
brasTelescopique.fermer();
}
if (pivot.distance()>1){
pivot.monteDescendre(0.5);
@ -36,9 +37,10 @@ public class PivotBrasRentre extends CommandBase {
else if(brasTelescopique.photocell()){
brasTelescopique.Reset();
brasTelescopique.AvanceRecule(0);
brasTelescopique.ouvrir();
}
else{
brasTelescopique.AvanceRecule(.5);
brasTelescopique.AvanceRecule(0.5);
}
if(pivot.limitpivot()){
pivot.Reset();

View File

@ -29,12 +29,14 @@ public class PivotChercheBas extends CommandBase {
public void execute() {
if(brasTelescopique.distance()<10){
brasTelescopique.AvanceRecule(0.5);
brasTelescopique.fermer();
}
else if(brasTelescopique.distance()>11) {
brasTelescopique.AvanceRecule(-0.5);
}
else {
brasTelescopique.AvanceRecule(0);
brasTelescopique.ouvrir();
}
if (pivot.distance()<10){
pivot.monteDescendre(0.5);

View File

@ -29,12 +29,14 @@ public class PivotChercheHaut extends CommandBase {
public void execute() {
if(brasTelescopique.distance()<10){
brasTelescopique.AvanceRecule(0.5);
brasTelescopique.fermer();
}
else if(brasTelescopique.distance()>11) {
brasTelescopique.AvanceRecule(-0.5);
}
else {
brasTelescopique.AvanceRecule(0);
brasTelescopique.ouvrir();
}
if (pivot.distance()<10){
pivot.monteDescendre(0.5);

View File

@ -31,12 +31,14 @@ public class PivoteBrasBas extends CommandBase {
public void execute() {
if(brasTelescopique.distance()<10){
brasTelescopique.AvanceRecule(0.5);
brasTelescopique.fermer();
}
else if(brasTelescopique.distance()>11) {
brasTelescopique.AvanceRecule(-0.5);
}
else {
brasTelescopique.AvanceRecule(0);
brasTelescopique.ouvrir();
}
if (pivot.distance()<10){
pivot.monteDescendre(0.5);

View File

@ -29,12 +29,14 @@ public class PivoteBrasHaut extends CommandBase {
public void execute() {
if(brasTelescopique.distance()<10){
brasTelescopique.AvanceRecule(0.5);
brasTelescopique.fermer();
}
else if(brasTelescopique.distance()>11) {
brasTelescopique.AvanceRecule(-0.5);
}
else {
brasTelescopique.AvanceRecule(0);
brasTelescopique.ouvrir();
}
if (pivot.distance()<10){
pivot.monteDescendre(0.5);

View File

@ -29,12 +29,14 @@ public class PivoteBrasMilieux extends CommandBase {
public void execute() {
if(brasTelescopique.distance()<10){
brasTelescopique.AvanceRecule(0.5);
brasTelescopique.fermer();
}
else if(brasTelescopique.distance()>11) {
brasTelescopique.AvanceRecule(-0.5);
}
else {
brasTelescopique.AvanceRecule(0);
brasTelescopique.ouvrir();
}
if (pivot.distance()<10){
pivot.monteDescendre(0.5);