Expose both pose solutions (#521)

* Half-add second pose

* add c++

* run wpiformat

* Fix c++

photon-lib/src/main/java/org/photonvision/SimPhotonCamera.java

@@ -144,7 +144,7 @@ public class SimPhotonCamera extends PhotonCamera {
             targetAreaEntry.setDouble(bestTarget.getArea());
             targetSkewEntry.setDouble(bestTarget.getSkew());
 
-            var transform = bestTarget.getCameraToTarget();
+            var transform = bestTarget.getBestCameraToTarget();
             double[] poseData = {
                 transform.getX(), transform.getY(), transform.getRotation().toRotation2d().getDegrees()
             };

photon-lib/src/main/java/org/photonvision/SimVisionSystem.java

@@ -171,6 +171,7 @@ public class SimVisionSystem {
                                         0.0,
                                         -1, // TODO fiducial ID
                                         new Transform3d(),
+                                        new Transform3d(),
                                         0.25,
                                         List.of(
                                                 new TargetCorner(0, 0), new TargetCorner(0, 0),