diff --git a/photon-lib/src/main/native/include/photon/simulation/VisionSystemSim.h b/photon-lib/src/main/native/include/photon/simulation/VisionSystemSim.h index aca9e3d91b..158a3962af 100644 --- a/photon-lib/src/main/native/include/photon/simulation/VisionSystemSim.h +++ b/photon-lib/src/main/native/include/photon/simulation/VisionSystemSim.h @@ -251,6 +251,10 @@ class VisionSystemSim { cameraPoses2d.push_back(lateCameraPose.ToPose2d()); auto camResult = camSim->Process(latency, lateCameraPose, allTargets); + fmt::println("Submitting frame with {} tags", + camResult.GetTargets().size()); + if (camResult.GetTargets().size()) + fmt::println("(with the sim target @ {})", camResult.GetBestTarget().GetYaw()); camSim->SubmitProcessedFrame(camResult, timestampNt); for (const auto& target : camResult.GetTargets()) { auto trf = target.GetBestCameraToTarget();