diff --git a/src/main/java/org/team1540/robot2024/commands/drivetrain/DriveWithTargetingCommand.java b/src/main/java/org/team1540/robot2024/commands/drivetrain/DriveWithTargetingCommand.java index 04317c5..b84ba94 100644 --- a/src/main/java/org/team1540/robot2024/commands/drivetrain/DriveWithTargetingCommand.java +++ b/src/main/java/org/team1540/robot2024/commands/drivetrain/DriveWithTargetingCommand.java @@ -50,6 +50,10 @@ public void initialize() { @Override public void execute() { + if (Constants.isTuningMode()) { + rotController.setPID(kP.get(), kI.get(), kD.get()); + } + Rotation2d targetRot = drivetrain.getPose() .minus(target.get()).getTranslation().getAngle()