fix: actually fix null vision poses

flamingchickens1540 · Jan 30, 2024 · 5dfb4ef · 5dfb4ef
1 parent 6e3b8cb
commit 5dfb4ef
Showing 1 changed file with 4 additions and 2 deletions.
diff --git 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<TimestampedVisionPose> 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,