bougie rainbw

This commit is contained in:
Antoine PerreaultE 2025-03-01 09:36:50 -05:00
parent 17875a3d15
commit 0e349c53bb

View File

@ -7,17 +7,20 @@ package frc.robot.commands.grimpeur;
import java.util.function.DoubleSupplier;
import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Bougie;
import frc.robot.subsystems.Grimpeur;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class GrimpeurManuel extends Command {
private Grimpeur grimpeur;
private DoubleSupplier x;
private Bougie bougie;
/** Creates a new GrimpeurManuel. */
public GrimpeurManuel(Grimpeur grimpeur,DoubleSupplier x) {
public GrimpeurManuel(Grimpeur grimpeur,DoubleSupplier x, Bougie bougie) {
this.grimpeur = grimpeur;
this.x = x;
addRequirements(grimpeur);
this.bougie = bougie;
addRequirements(grimpeur, bougie);
// Use addRequirements() here to declare subsystem dependencies.
}
@ -29,9 +32,11 @@ public class GrimpeurManuel extends Command {
@Override
public void execute() {
if(grimpeur.stop()){
bougie.RainBow();
grimpeur.grimpe(0);
}
else{
bougie.RainBowStop();
grimpeur.grimpe(x.getAsDouble());
}
@ -41,6 +46,10 @@ public class GrimpeurManuel extends Command {
@Override
public void end(boolean interrupted) {
grimpeur.grimpe(0);
if(grimpeur.stop()){
bougie.RainBow();
}
else{bougie.RainBowStop();}
}
// Returns true when the command should end.