[examples] Fix ProfiledPIDFeedForward after merge

This commit is contained in:
Peter Johnson
2025-11-01 10:01:42 -07:00
parent cc043df07f
commit 3f88c287d6

View File

@@ -37,9 +37,7 @@ public class Robot extends TimedRobot {
public void goToPosition(double goalPosition) {
double pidVal = m_controller.calculate(m_encoder.getDistance(), goalPosition);
m_motor.setVoltage(
pidVal
+ m_feedforward.calculateWithVelocities(
m_lastSpeed, m_controller.getSetpoint().velocity));
pidVal + m_feedforward.calculate(m_lastSpeed, m_controller.getSetpoint().velocity));
m_lastSpeed = m_controller.getSetpoint().velocity;
}