This commit is contained in:
Antoine PerreaultE 2023-11-06 19:40:13 -05:00
parent 79691234b4
commit ac2d2cf323
2 changed files with 9 additions and 5 deletions

View File

@ -31,7 +31,12 @@ public class Force1 extends CommandBase {
double vitesse = SmartDashboard.getNumber("Force Lanceur", 100);
lanceur.lancer(200);
if (lanceur.vitesse() > vitesse ){
accumulateur.tourneavant();
if(accumulateur.tourneavant() < 1024){
accumulateur.Deaccumuler();
}
if(accumulateur.tournearriere()<-256){
accumulateur.reaccumuler();
}
accumulateur.tournearriere();
} else {
accumulateur.stop();

View File

@ -13,7 +13,6 @@ import frc.robot.Constants;
public class Accumulateur extends SubsystemBase {
private WPI_TalonSRX moteuracc = new WPI_TalonSRX(Constants.accumulateur);
private DigitalInput limitacc = new DigitalInput(Constants.ballon);
/** Creates a new Accumulateur. */
public Accumulateur() {
@ -21,14 +20,14 @@ public class Accumulateur extends SubsystemBase {
public void Deaccumuler(){
moteuracc.set(0.5);
}
public void reaccumuler(){
moteuracc.set(-0.5);
}
public double tourneavant(){
moteuracc.set(0.5);
return(moteuracc.getSelectedSensorPosition());
}
public double tournearriere(){
moteuracc.set(-0.5);
return(moteuracc.getSelectedSensorPosition());
}