diff --git a/wpilibj/src/main/java/edu/wpi/first/wpilibj/PIDController.java b/wpilibj/src/main/java/edu/wpi/first/wpilibj/PIDController.java index 27d7536e1c..4806bf01e3 100644 --- a/wpilibj/src/main/java/edu/wpi/first/wpilibj/PIDController.java +++ b/wpilibj/src/main/java/edu/wpi/first/wpilibj/PIDController.java @@ -271,10 +271,10 @@ public class PIDController implements PIDInterface, LiveWindowSendable, Controll } else { m_totalError = m_maximumOutput / m_P; } - - m_result = m_P * m_totalError + m_D * m_error - + calculateFeedForward(); } + + m_result = m_P * m_totalError + m_D * m_error + + calculateFeedForward(); } else { if (m_I != 0) { double potentialIGain = (m_totalError + m_error) * m_I;