Update gyro using vision

DevilBotz2876 · Mar 28, 2024 · c16aa84 · c16aa84
1 parent 3f4aa2a
commit c16aa84
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/src/main/java/frc/robot/subsystems/vision/VisionSubsystem.java b/src/main/java/frc/robot/subsystems/vision/VisionSubsystem.java
@@ -175,7 +175,7 @@ public void periodic() {
           RobotConfig.drive.addVisionMeasurement(
               currentEstimatedRobotPose.get().estimatedPose.toPose2d(),
               currentEstimatedRobotPose.get().timestampSeconds,
-              VecBuilder.fill(distance / 2, distance / 2, 100));
+              VecBuilder.fill(distance / 2, distance / 2, distance/2));
         }
 
         if (camera == primaryCamera) {