Track target

src/main/java/frc4388/robot/subsystems/VisionOdometry.java

@@ -47,6 +47,9 @@ public class VisionOdometry extends SubsystemBase {
     m_camera = new PhotonCamera(VisionConstants.NAME);
     m_drive = drive;
     m_shooter = shooter;
+
+    setLEDs(false);
+    setDriverMode(true);
   }
 
   /** Gets the vision points from the limelight
@@ -93,6 +96,10 @@ public class VisionOdometry extends SubsystemBase {
     m_camera.setLED(on ? VisionLEDMode.kOn : VisionLEDMode.kOff);
   }
 
+  public void setDriverMode(boolean driverMode) {
+    m_camera.setDriverMode(driverMode);
+  }
+
   public Point getTargetOffset() throws VisionObscuredException {
     ArrayList<Point> screenPoints = getTargetPoints();