Removing point constraints from AutoConstraintCalculator, as this is not needed for V1 delivery of Trailblazer.\nThis will help clean up the AutoConstraintCalculator + tests for initial implimentation.

Author: saikiranra

src/main/java/frc/robot/autos/trailblazer/Trailblazer.java

@@ -100,12 +100,9 @@ private ChassisSpeeds getSwerveSetpoint(
 
     var originalTargetPose = pathTracker.getTargetPose();
     DogLog.log("Trailblazer/Tracker/RawOutput", originalTargetPose);
-    var constrainedTargetPose =
-        AutoConstraintCalculator.constrainTargetPose(originalTargetPose, usedConstraints);
-    DogLog.log("Trailblazer/Tracker/UsedOutput", constrainedTargetPose);
 
     var originalVelocityGoal =
-        pathFollower.calculateSpeeds(localization.getPose(), constrainedTargetPose);
+        pathFollower.calculateSpeeds(localization.getPose(), originalTargetPose);
     DogLog.log("Trailblazer/Follower/RawOutput", originalVelocityGoal);
     var constrainedVelocityGoal =
         AutoConstraintCalculator.constrainVelocityGoal(originalVelocityGoal, usedConstraints);

src/main/java/frc/robot/autos/trailblazer/constraints/AutoConstraintCalculator.java

@@ -4,13 +4,6 @@
 import edu.wpi.first.math.kinematics.ChassisSpeeds;
 
 public class AutoConstraintCalculator {
-  public static Pose2d constrainTargetPose(Pose2d inputPose, AutoConstraintOptions options) {
-    if (options.collisionAvoidance()) {
-      // TODO: Implement collision avoidance
-    }
-
-    return inputPose;
-  }
 
   public static ChassisSpeeds constrainVelocityGoal(
       ChassisSpeeds inputSpeeds, AutoConstraintOptions options) {