diff --git a/src/main/java/frc/robot/subsystems/vision/VisionSubsystem.java b/src/main/java/frc/robot/subsystems/vision/VisionSubsystem.java index 78d2ad5b..0800cb76 100644 --- 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) {