fix: null vision poses no longer causing issues

mimizh2418 · mimizh2418 · commit 6e3b8cb50569 · 2024-01-29T18:27:55.000-08:00
diff --git a/src/main/java/org/team1540/robot2024/subsystems/vision/AprilTagVision.java b/src/main/java/org/team1540/robot2024/subsystems/vision/AprilTagVision.java
@@ -53,7 +53,7 @@ public void periodic() {
         }
 
         TimestampedVisionPose latestPose = getEstimatedPose();
-        Logger.recordOutput("Vision/EstimatedPose", latestPose.poseMeters());
+        Logger.recordOutput("Vision/EstimatedPose", latestPose == null ? new Pose2d() : latestPose.poseMeters());
         visionPoseConsumer.accept(latestPose);
     }
 

Original file line number	Diff line number	Diff line change
`@@ -53,7 +53,7 @@ public void periodic() {`
`53`	`53`	`}`
`54`	`54`
`55`	`55`	`TimestampedVisionPose latestPose = getEstimatedPose();`
`56`		`- Logger.recordOutput("Vision/EstimatedPose", latestPose.poseMeters());`
	`56`	`+ Logger.recordOutput("Vision/EstimatedPose", latestPose == null ? new Pose2d() : latestPose.poseMeters());`
`57`	`57`	`visionPoseConsumer.accept(latestPose);`
`58`	`58`	`}`
`59`	`59`