PLS5618/Reefscape-2025
6
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

touche, amperage, distance

Browse Source
This commit is contained in:
Antoine PerreaultE
2025-03-03 09:22:48 -05:00
parent 37452f0b05
commit 264bbd003f
17 changed files with 227 additions and 102 deletions
Download Patch File Download Diff File Expand all files Collapse all files

25
src/main/java/frc/robot/commands/Elevateur/L3.java
View File

@@ -30,22 +30,23 @@ public class L3 extends Command {
public void execute() {
if(elevateur.position()<=elevateur.encodeurelevateurL3bas() && elevateur.position()>=elevateur.encodeurelevateurL3haut()){
elevateur.vitesse(0);
}
pince.pivote(-0.15);
if(pince.encodeurpivot()>=20 && pince.encodeurpivot()<=21){
pince.pivote(0);
}
else if(pince.encodeurpivot()>=20){
pince.pivote(-0.15);
}
else{
pince.pivote(0.15);
}
}
else if(elevateur.position()>=elevateur.encodeurelevateurL3bas()){
elevateur.vitesse(-0.5);
elevateur.vitesse(-0.7);
}
else{
elevateur.vitesse(0.5);
elevateur.vitesse(0.25);
}
if(pince.encodeurpivot()>=15.6 && pince.encodeurpivot()<=16){
pince.pivote(0);
}
else if(pince.encodeurpivot()>=16){
pince.pivote(-0.1);
}
else{
pince.pivote(0.1);
}
}
// Called once the command ends or is interrupted.