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;