fix

Author: levyishai

src/main/java/frc/trigon/robot/commands/commandfactories/CoralPlacingCommands.java

@@ -43,7 +43,7 @@ private static Command getAutonomouslyScoreCommand(boolean shouldScoreRight) {
     private static Command getScoreCommand(boolean shouldScoreRight) {
         return new SequentialCommandGroup(
                 CoralCollectionCommands.getLoadCoralCommand(),
-                getPrepareArmElevatorIfWontHitReef(shouldScoreRight).until(OperatorConstants.CONTINUE_TRIGGER),
+                GeneralCommands.getFlippableOverridableArmCommand(REEF_CHOOSER::getArmElevatorState, true, CoralPlacingCommands::shouldReverseScore).until(OperatorConstants.CONTINUE_TRIGGER),
                 new ParallelCommandGroup(
                         GeneralCommands.getFlippableOverridableArmCommand(REEF_CHOOSER::getArmElevatorState, false, CoralPlacingCommands::shouldReverseScore),
                         EndEffectorCommands.getSetTargetStateCommand(EndEffectorConstants.EndEffectorState.SCORE_CORAL)

src/main/java/frc/trigon/robot/constants/FieldConstants.java

@@ -32,7 +32,7 @@ public class FieldConstants {
             REEF_CENTER_TO_TARGET_SCORING_POSITION_Y_TRANSFORM_METERS = 0.17,
             REEF_CENTER_TO_TARGET_ALGAE_COLLECTION_POSITION_X_TRANSFORM_METERS = 1.6,
             REEF_CENTER_TO_TARGET_NO_HIT_REEF_POSITION_X_TRANSFORM_METERS = REEF_CENTER_TO_TARGET_SCORING_POSITION_X_TRANSFORM_METERS + 0.2;
-    public static final double SAFE_DISTANCE_FROM_SCORING_POSE_METERS = 0.25;
+    public static final double SAFE_DISTANCE_FROM_SCORING_POSE_METERS = 0.17;
 
     private static final boolean SHOULD_USE_HOME_TAG_LAYOUT = false;
     public static final AprilTagFieldLayout APRIL_TAG_FIELD_LAYOUT = createAprilTagFieldLayout();