Track target working

2026-06-09 00:38:05 -06:00 · 2022-03-16 10:32:15 -06:00
parent b346fcbec5
commit ca4d87977a
7 changed files with 25 additions and 12 deletions
@@ -59,6 +59,8 @@ public class VisionOdometry extends SubsystemBase {
  public ArrayList<Point> getTargetPoints() throws VisionObscuredException {
    PhotonPipelineResult result = m_camera.getLatestResult();
    latency = result.getLatencyMillis();
+
+    System.out.println("Result: " + result.hasTargets() + ", latency: " + latency);
  
    if(!result.hasTargets())
      throw new VisionObscuredException();