From b5eac5eace0bbe276e422a325d80c3e68b64764e Mon Sep 17 00:00:00 2001 From: maxwtan <100314265+MaxwellTTan20@users.noreply.github.com> Date: Mon, 6 Apr 2026 12:06:54 -0700 Subject: [PATCH] shuttling works --- src/main/java/frc/robot/util/PhaseManager.java | 10 +++++++--- 1 file changed, 7 insertions(+), 3 deletions(-) diff --git a/src/main/java/frc/robot/util/PhaseManager.java b/src/main/java/frc/robot/util/PhaseManager.java index 27a085e..6f98d64 100644 --- a/src/main/java/frc/robot/util/PhaseManager.java +++ b/src/main/java/frc/robot/util/PhaseManager.java @@ -1,5 +1,7 @@ package frc.robot.util; +import org.littletonrobotics.junction.Logger; + import edu.wpi.first.math.geometry.Pose2d; import edu.wpi.first.math.geometry.Translation2d; import frc.robot.constants.FieldConstants; @@ -76,6 +78,7 @@ public class PhaseManager { } public boolean isIdle() { + return wantedState == WantedState.IDLE; } @@ -94,10 +97,11 @@ public class PhaseManager { return FieldConstants.getHubTranslation().toTranslation2d(); } else { double targetY; + if (drivePose.getY() > 4.0) { - targetY = FieldConstants.FIELD_WIDTH * 1.5 - drivePose.getY(); - } { - targetY = FieldConstants.FIELD_WIDTH * 0.5 - drivePose.getY(); + targetY = (FieldConstants.FIELD_WIDTH * 1.5) - drivePose.getY(); + } else { + targetY = (FieldConstants.FIELD_WIDTH * 0.5) - drivePose.getY(); } return new Translation2d(FieldConstants.getAllianceSideTranslation(true).getX(), targetY); } -- 2.39.5