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

valeurs encodeurs, sequance, touche, quelque test amperage

Browse Source
This commit is contained in:
Antoine PerreaultE
2025-03-03 20:32:11 -05:00
parent 263caa4d85
commit 9f4142d7aa
15 changed files with 168 additions and 113 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
src/main/java/frc/robot/commands/Elevateur/L2.java
View File

@ -26,12 +26,11 @@ public class L2 extends Command {
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
if(pince.encodeurpivot()>=16 && pince.encodeurpivot()<=17){
if(pince.encodeurpivot()>=14 && pince.encodeurpivot()<=15){
pince.pivote(0);
}
else if(pince.encodeurpivot()>=17){
pince.pivote(-0.1);
else if(pince.encodeurpivot()>=14){
pince.pivote(-0.2);
}
else{
pince.pivote(0.1);

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

@ -28,26 +28,26 @@ public class L3 extends Command {
// Called every time the scheduler runs while the command is scheduled.
@Override
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.7);
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{
elevateur.vitesse(0.25);
pince.pivote(0.15);
}
}
else if(elevateur.position()>=elevateur.encodeurelevateurL3bas()){
elevateur.vitesse(-0.7);
}
else{
elevateur.vitesse(0.25);
}
}
// Called once the command ends or is interrupted.
@Override

6
src/main/java/frc/robot/commands/Elevateur/L4.java
View File

@ -29,11 +29,11 @@ public class L4 extends Command {
public void execute() {
if(elevateur.position()<=elevateur.encodeurelevateurL4bas() && elevateur.position()>=elevateur.encodeurelevateurL4haut()){
elevateur.vitesse(0);
pince.pivote(-0.1);
if(pince.encodeurpivot()>=22 && pince.encodeurpivot()<=23){
pince.pivote(-0.15);
if(pince.encodeurpivot()>=20 && pince.encodeurpivot()<=21){
pince.pivote(0);
}
else if(pince.encodeurpivot()>=22){
else if(pince.encodeurpivot()>=20){
pince.pivote(-0.15);
}
else{

28
src/main/java/frc/robot/commands/Elevateur/StationPince.java
View File

@ -22,7 +22,7 @@ public class StationPince extends Command {
this.elevateur = elevateur;
this.pince = pince;
this.bougie = bougie;
addRequirements(pince,elevateur, bougie);
addRequirements(pince, elevateur, bougie);
// Use addRequirements() here to declare subsystem dependencies.
}
@ -35,9 +35,18 @@ public class StationPince extends Command {
@Override
public void execute() {
if(pince.emperagecoral() >= 12){
if(pince.emperagecoral() >= 18){
pince.x = true;
}
if(elevateur.position()<=-0.1 && elevateur.position()>= -0.2){
elevateur.vitesse(0);
}
else if(elevateur.position()>=-0.1){
elevateur.vitesse(-0.7);
}
else{
elevateur.vitesse(0.25);
}
if(pince.x){
pince.aspirecoral(0);
bougie.Bleu();
@ -47,19 +56,21 @@ public class StationPince extends Command {
}
}
else{
pince.aspirecoral(0.1);
pince.aspirecoral(0.25);
}
if (!pince.x){
if(pince.encodeurpivot()>=10.5 && pince.encodeurpivot()<=11.5){
pince.pivote(-0.15);
if(pince.encodeurpivot()>=10 && pince.encodeurpivot()<=11){
pince.pivote(0);
}
else if(pince.encodeurpivot()>=11){
pince.pivote(-0.1);
else if(pince.encodeurpivot()>=10.5){
pince.pivote(-0.15);
}
else{
pince.pivote(0.1);
pince.pivote(0.15);
}
}
}
}
// Called once the command ends or is interrupted.
@ -67,6 +78,7 @@ public class StationPince extends Command {
public void end(boolean interrupted) {
pince.pivote(0);
pince.aspirecoral(0);
elevateur.vitesse(0);
pince.x =false;
}