diff --git a/photon-core/src/main/java/org/photonvision/vision/target/TrackedTarget.java b/photon-core/src/main/java/org/photonvision/vision/target/TrackedTarget.java index 9f2079976..ffb3dbdfe 100644 --- a/photon-core/src/main/java/org/photonvision/vision/target/TrackedTarget.java +++ b/photon-core/src/main/java/org/photonvision/vision/target/TrackedTarget.java @@ -19,6 +19,7 @@ package org.photonvision.vision.target; import edu.wpi.first.apriltag.AprilTagDetection; import edu.wpi.first.apriltag.AprilTagPoseEstimate; import edu.wpi.first.math.geometry.Transform3d; +import edu.wpi.first.wpilibj.DriverStation; import java.util.ArrayList; import java.util.HashMap; import java.util.List; @@ -364,6 +365,9 @@ public class TrackedTarget implements Releasable { } public Transform3d getBestCameraToTarget3d() { + if (m_bestCameraToTarget3d.equals(new Transform3d())) { + DriverStation.reportWarning("3d mode is not enabled.", false); + } return m_bestCameraToTarget3d; } diff --git a/photon-targeting/src/main/native/include/photon/targeting/PhotonTrackedTarget.h b/photon-targeting/src/main/native/include/photon/targeting/PhotonTrackedTarget.h index bbd6721bf..e5641e7a3 100644 --- a/photon-targeting/src/main/native/include/photon/targeting/PhotonTrackedTarget.h +++ b/photon-targeting/src/main/native/include/photon/targeting/PhotonTrackedTarget.h @@ -22,6 +22,7 @@ #include #include +#include #include #include @@ -138,7 +139,12 @@ class PhotonTrackedTarget { * reprojection error is the ambiguity, which is between 0 and 1. * @return The pose of the target relative to the robot. */ - frc::Transform3d GetBestCameraToTarget() const { return bestCameraToTarget; } + frc::Transform3d GetBestCameraToTarget() const { + if (bestCameraToTarget == frc::Transform3d()) { + FRC_ReportError(frc::warn::Warning, "3d mode is not enabled"); + } + return bestCameraToTarget; + } /** * Get the transform that maps camera space (X = forward, Y = left, Z = up) to