diff --git a/src/main/java/org/team1540/robot2024/subsystems/vision/AprilTagVision.java b/src/main/java/org/team1540/robot2024/subsystems/vision/AprilTagVision.java index 0146a01c..d64a7737 100644 --- a/src/main/java/org/team1540/robot2024/subsystems/vision/AprilTagVision.java +++ b/src/main/java/org/team1540/robot2024/subsystems/vision/AprilTagVision.java @@ -18,8 +18,10 @@ public class AprilTagVision extends SubsystemBase { private final Consumer visionPoseConsumer; - private TimestampedVisionPose frontPose; - private TimestampedVisionPose rearPose; + private TimestampedVisionPose frontPose = + new TimestampedVisionPose(-1, new Pose2d(), new int[0], new Pose2d[0]); + private TimestampedVisionPose rearPose = + new TimestampedVisionPose(-1, new Pose2d(), new int[0], new Pose2d[0]); public AprilTagVision( AprilTagVisionIO frontCameraIO,