changed getTargetX

Function treats cameraIndex as which camera the function returns a target for. Previously, function would return position of targetter Apriltag.

Author: lessfood

src/main/java/frc/robot/subsystems/vision/Vision.java

@@ -56,14 +56,22 @@ public Vision(VisionConsumer consumer, VisionIO... io) {
    * @param cameraIndex The index of the camera to use.
    */
   public Rotation2d getTargetX(int cameraIndex) {
-    for (int i : inputs[0].tagIds) {
+    DriverStation.reportWarning(Double.toString(inputs[cameraIndex].latestTargetObservation.tx().getDegrees()), false);
+    return inputs[cameraIndex].latestTargetObservation.tx();
+      
+    /**for (int i : inputs[0].tagIds) {
       DriverStation.reportWarning(Integer.toString(i), false);
       var tagPose = aprilTagLayout.getTagPose(i);
+      DriverStation.reportWarning(
+          Double.toString(
+            tagPose.get().getRotation().toRotation2d().plus(Rotation2d.kPi).getDegrees()),
+          false);
       if (i == cameraIndex) {
         return tagPose.get().getRotation().toRotation2d().plus(Rotation2d.kPi);
       }
     }
     return Rotation2d.kZero;
+    */
   }
 
   @Override