led

src/main/java/frc/robot/commands/ModeAuto/BougerGaucheAuto.java

@@ -46,23 +46,13 @@ public class BougerGaucheAuto extends Command {
   // Called every time the scheduler runs while the command is scheduled.
   @Override
   public void execute() {
-    if(alliance.get() == Alliance.Blue){
+      if(timer.get() < 1.25){
-      if(timer.get() < 0.75){
         drivetrain.setControl(drive.withVelocityY(1.5));
       }
       else{
         drivetrain.setControl(drive.withVelocityY(0));
       }
   }
-    else{
-      if(timer.get() < 0.75){
-        drivetrain.setControl(drive.withVelocityY(1.5));
-      }
-      else{
-        drivetrain.setControl(drive.withVelocityY(0));
-      }
-    }
-  }
 
   // Called once the command ends or is interrupted.
   @Override

src/main/java/frc/robot/commands/ModeAuto/GrimperReservoir.java

@@ -73,7 +73,7 @@ public class GrimperReservoir extends Command {
       x = 15.6;
       angle = 180;
       if(pigeonAngle< 190 && pigeonAngle> 170){
-        drivetrain.setControl(drive.withVelocityY(MathUtil.clamp((-(y-boty)*5.5), -2, 2)).withVelocityX(MathUtil.clamp((-(x-botx)*5.5),-2,2)));
+        drivetrain.setControl(drive.withVelocityY(MathUtil.clamp((-(y-boty)*6.5), -2, 2)).withVelocityX(MathUtil.clamp((-(x-botx)*6.5),-2,2)));
       }
       else{
         if(pigeonAngle>180){

src/main/java/frc/robot/subsystems/LEDSubsystem.java

@@ -68,6 +68,7 @@ public class LEDSubsystem extends SubsystemBase {
      */
     public Command updateLEDs() {
         double temps = DriverStation.getMatchTime();
+        System.out.println(temps);
         return run(() -> {
             if(Equipe()){
                 if(temps > 110){