This commit is contained in:
samuel desharnais
2026-04-01 18:20:55 -04:00
parent e5f7b05063
commit 8202b012cb
2 changed files with 36 additions and 29 deletions

View File

@@ -19,6 +19,7 @@ import com.ctre.phoenix6.signals.RGBWColor;
* Subsystem that controls an addressable LED strip using a CANdle.
*/
public class LEDSubsystem extends SubsystemBase {
Timer _timer;
ShuffleboardTab teb = Shuffleboard.getTab("teb");
private GenericEntry equipe =
teb.add("equipe commence (bleu = ouvert, rouge = fermé)", true).withWidget(BuiltInWidgets.kToggleSwitch).getEntry();
@@ -28,17 +29,18 @@ public class LEDSubsystem extends SubsystemBase {
m_candle.setControl(new SolidColor(0, 80).withColor(new RGBWColor(255, 0, 0, 0)));
}
public void Rouge(){
new SolidColor(0, 80).withColor(new RGBWColor(0, 0, 255, 0));
m_candle.setControl(new SolidColor(0, 80).withColor(new RGBWColor(0, 0, 255, 0)));
}
public void Vert(){
new SolidColor(0, 80).withColor(new RGBWColor(0, 255, 0, 0));
m_candle.setControl(new SolidColor(0, 80).withColor(new RGBWColor(0, 255, 0, 0)));
}
public void Noir(){
new SolidColor(0, 80).withColor(new RGBWColor(0, 0, 0, 0));
m_candle.setControl(new SolidColor(0, 80).withColor(new RGBWColor(0, 0, 0, 0)));
}
public void Flach(boolean couleur){
Timer timer = new Timer();
timer.reset();
timer.start();
if(timer.get() <0.5){
if(couleur){
@@ -55,6 +57,9 @@ public class LEDSubsystem extends SubsystemBase {
}
public LEDSubsystem() {
setDefaultCommand(updateLEDs());
_timer = new Timer();
_timer.reset();
_timer.start();
}
public boolean Equipe(){
return equipe.getBoolean(false);
@@ -65,69 +70,69 @@ public class LEDSubsystem extends SubsystemBase {
* @return Command to run
*/
public Command updateLEDs() {
double temps = DriverStation.getMatchTime();
return run(() -> {
if(Equipe()){
if(temps < 30){
if(_timer.get() < 30){
Vert();
}
else if(temps < 52){
else if(_timer.get() < 52){
Bleu();
}
else if(temps < 55){
else if(_timer.get() < 55){
Flach(true);
}
else if(temps < 77){
else if(_timer.get() < 77){
Rouge();
}
else if(temps < 80){
else if(_timer.get() < 80){
Flach(false);
}
else if(temps < 102){
else if(_timer.get() < 102){
Bleu();
}
else if(temps < 105){
else if(_timer.get() < 105){
Flach(true);
}
else if(temps <127){
else if(_timer.get() <127){
Rouge();
}
else if(temps < 130){
else if(_timer.get() < 130){
Flach(false);
}
else if(temps < 140){
else if(_timer.get() < 140){
Vert();
}
}
else{
if(temps < 30){
if(_timer.get() < 30){
Vert();
}
else if(temps < 52){
else if(_timer.get() < 52){
Rouge();
}
else if(temps < 55){
else if(_timer.get() < 55){
Flach(false);
}
else if(temps < 77){
else if(_timer.get() < 77){
Bleu();
}
else if(temps < 80){
else if(_timer.get() < 80){
Flach(true);
}
else if(temps < 102){
else if(_timer.get() < 102){
Rouge();
}
else if(temps < 105){
else if(_timer.get() < 105){
Flach(false);
}
else if(temps <127){
else if(_timer.get() <127){
Bleu();
}
else if(temps < 130){
else if(_timer.get() < 130){
Flach(true);
}
else if(temps < 140){
else if(_timer.get() < 140){
Vert();
}
}