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

pince + main

Browse Source
This commit is contained in:
Antoine PerreaultE
2025-02-25 16:38:35 -05:00
parent a11f31a2a8
commit f60f129410
3 changed files with 47 additions and 24 deletions
Download Patch File Download Diff File Expand all files Collapse all files

28
src/main/java/frc/robot/commands/L2.java
View File

@ -28,25 +28,25 @@ public class L2 extends Command {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
if(elevateur.position()>=500 && elevateur.position()<=510){
if(elevateur.position()<=-1 && elevateur.position()>=-0.9){
elevateur.vitesse(0);
}
else if(elevateur.position()>=510){
elevateur.vitesse(0.3);
else if(elevateur.position()>=-1){
elevateur.vitesse(-0.2);
}
else{
elevateur.vitesse(.3);
}
if(pince.encodeurpivot()>=500 && pince.encodeurpivot()<=510){
pince.pivote(0);
elevateur.vitesse(.2);
// }
// if(pince.encodeurpivot()>=500 && pince.encodeurpivot()<=510){
// pince.pivote(0);
}
else if(pince.encodeurpivot()>=510){
pince.pivote(0.2);
}
else{
pince.pivote(-0.2);
}
// }
// else if(pince.encodeurpivot()>=510){
// pince.pivote(0.2);
// }
// else{
// pince.pivote(-0.2);
}
}