Camera Position Calibrator Fix (#33)

* I haven't looked at this in weeks 😁

* time is fleeting it's running out time to be the man of the house

* I'll be here buying you time

* Updated all vendors except Advantage Kit

* I haven't looked at this in weeks 😁

* time is fleeting it's running out time to be the man of the house

* I'll be here buying you time

* Update AdvantageKit.json

* Added needed check

* Fix logic

---------

Co-authored-by: Strflightmight09 <[email protected]>

Author: levyishai

src/main/java/org/trigon/commands/CameraPositionCalculationCommand.java

@@ -35,6 +35,11 @@ public void initialize() {
     @Override
     public void execute() {
         rotateRobot.accept(ROTATION_SPEED.get());
+        
+        final Pose2d currentPose = cameraPoseSupplier.get();
+        if (currentPose != null)
+            endPose = currentPose;
+
         endPose = cameraPoseSupplier.get();
         logRobotToCamera();
     }