From 5f6203d055391e6ae28a536515cfe6a3a5d9dd2d Mon Sep 17 00:00:00 2001 From: apoorva <97716935+carokhan@users.noreply.github.com> Date: Thu, 24 Oct 2024 08:07:51 -0400 Subject: [PATCH] idiot --- src/main/java/frc/robot/subsystems/pivot2/Pivot.java | 8 +++----- 1 file changed, 3 insertions(+), 5 deletions(-) diff --git a/src/main/java/frc/robot/subsystems/pivot2/Pivot.java b/src/main/java/frc/robot/subsystems/pivot2/Pivot.java index 0923ed3..dff40cc 100644 --- a/src/main/java/frc/robot/subsystems/pivot2/Pivot.java +++ b/src/main/java/frc/robot/subsystems/pivot2/Pivot.java @@ -62,11 +62,9 @@ public Command setPivotTarget(DoubleSupplier radians) { return this.run( () -> { double volts = - pivotPID.calculate( - inputs.pivotPosition.getRadians(), - radians.getAsDouble() - + pivotFF.calculate( - pivotPID.getSetpoint().position, pivotPID.getSetpoint().velocity)); + pivotPID.calculate(inputs.pivotPosition.getRadians(), radians.getAsDouble()) + + pivotFF.calculate( + pivotPID.getSetpoint().position, pivotPID.getSetpoint().velocity); io.setPivotVoltage(volts); inputs.pivotAppliedVolts = volts;