Merge DeferredBlockMulti

src/main/java/frc4388/robot/Robot.java

@@ -20,7 +20,6 @@ import edu.wpi.first.wpilibj2.command.CommandScheduler;
 import frc4388.robot.constants.BuildConstants;
 import frc4388.robot.constants.Constants.SimConstants;
 import frc4388.utility.DeferredBlock;
-import frc4388.utility.DeferredBlockMulti;
 import frc4388.utility.Trim;
 import frc4388.utility.compute.RobotTime;
 import frc4388.utility.status.FaultReporter;
@@ -95,7 +94,6 @@ public class Robot extends LoggedRobot {
   @Override
   public void disabledExit() {
     DeferredBlock.execute();
-    DeferredBlockMulti.execute();
   }
 
   /**

src/main/java/frc4388/robot/RobotContainer.java

@@ -60,7 +60,6 @@ import frc4388.robot.subsystems.SwerveDrive;
 
 // Utilites
 import frc4388.utility.DeferredBlock;
-import frc4388.utility.DeferredBlockMulti;
 import frc4388.utility.compute.TimesNegativeOne;
 import frc4388.utility.compute.ReefPositionHelper.Side;
 
@@ -590,12 +589,14 @@ public class RobotContainer {
 
         configureButtonBindings();        
         configureVirtualButtonBindings();
-        new DeferredBlock(() -> { // Called on first robot enable
+        
+        DeferredBlock.addBlock(() -> { // Called on first robot enable
             m_robotSwerveDrive.resetGyro();
-        });
-        new DeferredBlockMulti(() -> { // Called on every robot enable
+        }, false);
+        DeferredBlock.addBlock(() -> { // Called on every robot enable
             TimesNegativeOne.update();
-        });
+        }, true);
+
         DriverStation.silenceJoystickConnectionWarning(true);
         // CameraServer.startAutomaticCapture();
 

src/main/java/frc4388/robot/subsystems/DiffDrive.java

@@ -34,7 +34,7 @@ public class DiffDrive extends SubsystemBase implements Queryable {
   private TalonFX m_leftBackMotor;
   private TalonFX m_rightBackMotor;
   private DifferentialDrive m_driveTrain;
-  private Pigeon2 m_gyro;
+  // private Pigeon2 m_gyro;
 
   /**
    * Add your docs here.
@@ -51,7 +51,7 @@ public class DiffDrive extends SubsystemBase implements Queryable {
     m_leftBackMotor .setControl(new Follower(m_leftFrontMotor.getDeviceID(), false));
     m_rightBackMotor.setControl(new Follower(m_rightBackMotor.getDeviceID(), false));
     m_driveTrain = driveTrain;
-    m_gyro = gyro;
+    // m_gyro = gyro;
   }
 
   @Override