diff --git a/src/main/java/frc/robot/Constants.java b/src/main/java/frc/robot/Constants.java index fbbf8c1..71b8638 100644 --- a/src/main/java/frc/robot/Constants.java +++ b/src/main/java/frc/robot/Constants.java @@ -167,15 +167,24 @@ public static class Presets { // SHOOTER_DISTANCE_ANGLE.put(3.500, 28.27); // SHOOTER_DISTANCE_ANGLE.put(3.807, 33.56); + //Old points half trim + SHOOTER_DISTANCE_ANGLE.put(0.863, 64.55); + SHOOTER_DISTANCE_ANGLE.put(1.755, 43.78 + 5); + SHOOTER_DISTANCE_ANGLE.put(1.823, 43.44 + 5); + SHOOTER_DISTANCE_ANGLE.put(2.543, 38.15 + 5); + SHOOTER_DISTANCE_ANGLE.put(3.149, 35.13 + 5); + SHOOTER_DISTANCE_ANGLE.put(3.500, 28.27 + 5); + SHOOTER_DISTANCE_ANGLE.put(3.807, 33.56 + 5); + //NYC Regional - SHOOTER_DISTANCE_ANGLE.put(1.451101767427388, 53.738839285714285); - SHOOTER_DISTANCE_ANGLE.put(1.414185456363615, 54.87984793526786); - SHOOTER_DISTANCE_ANGLE.put(2.1285865676795237, 48.21742466517858); - SHOOTER_DISTANCE_ANGLE.put(2.487748521528895, 42.895333426339285); - SHOOTER_DISTANCE_ANGLE.put(3.0782159514727163, 40.37318638392857); - SHOOTER_DISTANCE_ANGLE.put(2.1774294348986682, 47.06856863839286); - SHOOTER_DISTANCE_ANGLE.put(3.2592748390692776, 37.72705078125); - SHOOTER_DISTANCE_ANGLE.put(0.8629958355261691, 64.55252511160714); + // SHOOTER_DISTANCE_ANGLE.put(1.451101767427388, 53.738839285714285); + // SHOOTER_DISTANCE_ANGLE.put(1.414185456363615, 54.87984793526786); + // SHOOTER_DISTANCE_ANGLE.put(2.1285865676795237, 48.21742466517858); + // SHOOTER_DISTANCE_ANGLE.put(2.487748521528895, 42.895333426339285); + // SHOOTER_DISTANCE_ANGLE.put(3.0782159514727163, 40.37318638392857); + // SHOOTER_DISTANCE_ANGLE.put(2.1774294348986682, 47.06856863839286); + // SHOOTER_DISTANCE_ANGLE.put(3.2592748390692776, 37.72705078125); + // SHOOTER_DISTANCE_ANGLE.put(0.8629958355261691, 64.55252511160714); }; public static final InterpolatingDoubleTreeMap ELEVATOR_DISTANCE_HEIGHT = new InterpolatingDoubleTreeMap(); @@ -190,15 +199,24 @@ public static class Presets { // ELEVATOR_DISTANCE_HEIGHT.put(3.500, 0.010); // ELEVATOR_DISTANCE_HEIGHT.put(3.807, 0.009); + //Old points moded + ELEVATOR_DISTANCE_HEIGHT.put(0.863, 0.095); + ELEVATOR_DISTANCE_HEIGHT.put(1.755, 0.061); + ELEVATOR_DISTANCE_HEIGHT.put(1.823, 0.031); + ELEVATOR_DISTANCE_HEIGHT.put(2.543, 0.024); + ELEVATOR_DISTANCE_HEIGHT.put(3.149, 0.029); + ELEVATOR_DISTANCE_HEIGHT.put(3.500, 0.010); + ELEVATOR_DISTANCE_HEIGHT.put(3.807, 0.009); + //NYC Regional - ELEVATOR_DISTANCE_HEIGHT.put(1.451101767427388, 0.05916796875); - ELEVATOR_DISTANCE_HEIGHT.put(1.414185456363615, 0.062373046875); - ELEVATOR_DISTANCE_HEIGHT.put(2.1285865676795237, 0.0343037109375); - ELEVATOR_DISTANCE_HEIGHT.put(2.487748521528895, 0.017803710937499998); - ELEVATOR_DISTANCE_HEIGHT.put(3.0782159514727163, 0.021448242187499997); - ELEVATOR_DISTANCE_HEIGHT.put(2.1774294348986682, 0.046933593749999995); - ELEVATOR_DISTANCE_HEIGHT.put(3.2592748390692776, 0.0175693359375); - ELEVATOR_DISTANCE_HEIGHT.put(0.8629958355261691, 0.09472265625); + // ELEVATOR_DISTANCE_HEIGHT.put(1.451101767427388, 0.05916796875); + // ELEVATOR_DISTANCE_HEIGHT.put(1.414185456363615, 0.062373046875); + // ELEVATOR_DISTANCE_HEIGHT.put(2.1285865676795237, 0.0343037109375); + // ELEVATOR_DISTANCE_HEIGHT.put(2.487748521528895, 0.017803710937499998); + // ELEVATOR_DISTANCE_HEIGHT.put(3.0782159514727163, 0.021448242187499997); + // ELEVATOR_DISTANCE_HEIGHT.put(2.1774294348986682, 0.046933593749999995); + // ELEVATOR_DISTANCE_HEIGHT.put(3.2592748390692776, 0.0175693359375); + // ELEVATOR_DISTANCE_HEIGHT.put(0.8629958355261691, 0.09472265625); } }