flywheel shot distance updates from 8230 & 1418

Author: sophiep29

src/main/java/frc/robot/config/FlywheelConfig.java

@@ -33,7 +33,7 @@ public class FlywheelConfig {
   public static final double FLYWHEEL_OUTTAKE_SPEED = 0;
   public static final double FLYWHEEL_HUB_SHOT_SPEED = 40;
   public static final double FLYWHEEL_TOWER_SHOT_SPEED = 0;
-  public static final double FLYWHEEL_TRENCH_SHOT_SPEED = 40; // to be set later w/ testing
+  public static final double FLYWHEEL_TRENCH_SHOT_SPEED = 65;
   public static final double FLYWHEEL_DEFAULT_SHOT_SPEED = 40;
   public static final double FLYWHEEL_TOLERANCE = 5;
 }

src/main/java/frc/robot/helpers/ShotCalculator.java

@@ -130,9 +130,12 @@ public static boolean shouldRunShooter(double graceSeconds) {
 
   // Set map inputs
   static {
-    DISTANCE_TO_FLYWHEEL.put(Units.inchesToMeters(171), 87.0);
+    DISTANCE_TO_FLYWHEEL.put(Units.inchesToMeters(174), 87.0);
     DISTANCE_TO_FLYWHEEL.put(Units.inchesToMeters(141), 70.0);
     DISTANCE_TO_FLYWHEEL.put(Units.inchesToMeters(90), 60.0);
     DISTANCE_TO_FLYWHEEL.put(Units.inchesToMeters(61), 50.0);
+    DISTANCE_TO_FLYWHEEL.put(Units.inchesToMeters(43), 40.0);
+    DISTANCE_TO_FLYWHEEL.put(Units.inchesToMeters(74), 50.0);
+    DISTANCE_TO_FLYWHEEL.put(Units.inchesToMeters(134), 65.0);
   }
 }