Revert "added logging"

This reverts commit 79aba662e2a09dd3155fa56fef6702d9b5a7c596.

diff --git a/src/main/java/frc/robot/subsystems/drivetrain/Drivetrain.java b/src/main/java/frc/robot/subsystems/drivetrain/Drivetrain.java
index 62e5e4424688cf28bac00c5387ca0af1cac25d61..5c51fdde2292b110410eb91cbf6e450d95f57e23 100644 (file)
--- a/src/main/java/frc/robot/subsystems/drivetrain/Drivetrain.java
+++ b/src/main/java/frc/robot/subsystems/drivetrain/Drivetrain.java
@@ -310,16 +310,12 @@ public class Drivetrain extends SubsystemBase {
             if (vision != null && visionEnabled && visionEnableTimer.hasElapsed(5)) {
                 vision.updateOdometry(poseEstimator, time -> getPoseAt(time).getRotation().getRadians(), slipped);
 
-                double currentGyroYaw = gyroInputs.yawPosition.getRadians();
-                Logger.recordOutput("GyroBias/CurrentGyroYaw", currentGyroYaw);
-                Logger.recordOutput("GyroBias/SampleCount", gyroBiasEstimator.getSampleCount());
-                Logger.recordOutput("GyroBias/CanSeeTag", vision.canSeeTag());
-
-
                 if (vision.canSeeTag()) {
                     slipped = false;
                     modulePoses.reset();
 
+                    double currentGyroYaw = gyroInputs.yawPosition.getRadians();
+
                     // to compare bias
                     ArrayList<EstimatedRobotPose> visionPoses = vision.getEstimatedPoses(getPose());
 
@@ -332,10 +328,6 @@ public class Drivetrain extends SubsystemBase {
 
                             if (!Double.isNaN(gyroYawAtTimestamp)) {
 
-                                // Log gyro and vision yaw data for debugging
-                                Logger.recordOutput("GyroBias GyroYaw", gyroYawAtTimestamp);
-                                Logger.recordOutput("GyroBias VisionYaw", visionYaw);
-
                                 // use weighted observation
                                 gyroBiasEstimator.addObservation(visionYaw, gyroYawAtTimestamp, 1.0);
                             }
@@ -346,9 +338,6 @@ public class Drivetrain extends SubsystemBase {
                     if (gyroBiasEstimator.getSampleCount() >= GyroBiasConstants.MIN_SAMPLES) {
                         double fullBias = gyroBiasEstimator.getAndResetBias();
                         double bias = gyroBiasEstimator.applyPartialCorrection(fullBias);
-                        
-                        Logger.recordOutput("GyroBias CalculatedBias", bias);
-                        
                         if (Math.abs(bias) > GyroBiasConstants.MIN_CORRECTION_RAD) {
                             gyroIO.setYaw(new Rotation2d(currentGyroYaw + bias));
                             resetOdometry(