diff --git a/src/main/java/frc/robot/subsystems/LEDSubsystem.java b/src/main/java/frc/robot/subsystems/LEDSubsystem.java index f22a276..c956db2 100644 --- a/src/main/java/frc/robot/subsystems/LEDSubsystem.java +++ b/src/main/java/frc/robot/subsystems/LEDSubsystem.java @@ -39,10 +39,7 @@ public class LEDSubsystem extends SubsystemBase { m_candle.setControl(new SolidColor(0, 80).withColor(new RGBWColor(0, 0, 0, 0))); } public void Flash(boolean couleur){ - Timer timer = new Timer(); - timer.reset(); - timer.start(); - if(timer.get() <0.5){ + if(_timer.get() <0.5){ if(couleur){ Bleu(); } @@ -52,7 +49,7 @@ public class LEDSubsystem extends SubsystemBase { } else{ Noir(); - timer.reset(); + _timer.reset(); } } public LEDSubsystem() { @@ -70,69 +67,71 @@ public class LEDSubsystem extends SubsystemBase { * @return Command to run */ public Command updateLEDs() { + double temps = DriverStation.getMatchTime(); return run(() -> { if(Equipe()){ - if(_timer.get() < 30){ + if(temps > 110){ Vert(); } - else if(_timer.get() < 52){ + else if(temps > 88){ Bleu(); } - else if(_timer.get() < 55){ + else if(temps > 85){ Flash(true); } - else if(_timer.get() < 77){ + else if(temps > 63){ Rouge(); } - else if(_timer.get() < 80){ + else if(temps > 60){ Flash(false); } - else if(_timer.get() < 102){ + else if(temps > 33){ Bleu(); } - else if(_timer.get() < 105){ + else if(temps > 30){ Flash(true); } - else if(_timer.get() <127){ + else if(temps > 13){ Rouge(); } - else if(_timer.get() < 130){ + else if(temps > 10){ Flash(false); } - else if(_timer.get() < 140){ + else if(temps < 10){ Vert(); } } else{ - if(_timer.get() < 30){ + if(temps > 110){ Vert(); } - else if(_timer.get() < 52){ + else if(temps > 88){ + Rouge(); } - else if(_timer.get() < 55){ + else if(temps > 85){ Flash(false); } - else if(_timer.get() < 77){ + else if(temps > 63){ Bleu(); } - else if(_timer.get() < 80){ + else if(temps > 60){ Flash(true); } - else if(_timer.get() < 102){ + else if(temps > 33){ Rouge(); } - else if(_timer.get() < 105){ + else if(temps > 30){ Flash(false); } - else if(_timer.get() <127){ + else if(temps > 13){ Bleu(); } - else if(_timer.get() < 130){ + else if(temps > 10){ Flash(true); } - else if(_timer.get() < 140){ + else if(temps < 10){ Vert(); } }