smol changes

Author: Eddie-Edward

src/main/java/frc/robot/vision/VisionConfig.java

@@ -123,7 +123,7 @@ public static class AlignmentConfig {
 
     }
 
-    private static final double acutalX = 6.175;
+    private static final double acutalX = 5.675;
     private static final double x = 0.5 * acutalX;
     private static final double y = (Math.sqrt(3)/2) * acutalX;
 

src/main/java/frc/robot/vision/commands/AutoAlign.java

@@ -43,10 +43,10 @@ public class AutoAlign extends Command {
 
   private final double branchOffsetRightWrist = Units.inchesToMeters(6.469);
   private final Transform2d leftBranchTransformRightWrist = new Transform2d(0.0, -branchOffsetRightWrist - Units.inchesToMeters(0.75), Rotation2d.kZero);
-  private final Transform2d rightBranchTransformRightWrist = new Transform2d(0.0, branchOffsetRightWrist - Units.inchesToMeters(1.25), Rotation2d.kZero);
+  private final Transform2d rightBranchTransformRightWrist = new Transform2d(0.0, branchOffsetRightWrist - Units.inchesToMeters(0.75), Rotation2d.kZero);
 
   private final double branchOffsetLeftWrist = Units.inchesToMeters(6.469);
-  private final Transform2d leftBranchTransformLeftWrist = new Transform2d(0.0, -branchOffsetLeftWrist + Units.inchesToMeters(0.75) , Rotation2d.kZero);
+  private final Transform2d leftBranchTransformLeftWrist = new Transform2d(0.0, -branchOffsetLeftWrist + Units.inchesToMeters(1.25) , Rotation2d.kZero);
   private final Transform2d rightBranchTransformLeftWrist = new Transform2d(0.0, branchOffsetLeftWrist + Units.inchesToMeters(0.5), Rotation2d.kZero);
 
   public final Transform2d robotOffset = new Transform2d(0.3018, 0, Rotation2d.kZero);