anglesnap takes joystick input directly

maybe fix maybe not - slightly different from prev. attempt
Iron-Panthers · Oct 18, 2023 · c6da381 · c6da381
1 parent 2bc96dd
commit c6da381
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/src/main/java/frc/robot/commands/RotateVectorDriveCommand.java b/src/main/java/frc/robot/commands/RotateVectorDriveCommand.java
@@ -71,11 +71,11 @@ public void execute() {
     double rotY = rotationYSupplier.getAsDouble();
     boolean isRobotRelative = isRobotRelativeSupplier.getAsBoolean();
 
-    double targetAngle = Util.angleSnap(Util.vectorToAngle(-rotX, -rotY), angles);
+    double targetAngle = Util.vectorToAngle(-rotX, -rotY);
 
     // if stick magnitude is greater then rotate angle mag
     if (Util.vectorMagnitude(rotX, rotY) > Drive.ROTATE_VECTOR_MAGNITUDE) {
-      angle = isRobotRelative ? Util.normalizeDegrees(targetAngle + initialAngle) : targetAngle;
+      angle = targetAngle;
     }
 
     drivebaseSubsystem.driveAngle(new Pair<>(x, y), angle);