SwervePIDVAFollower(drive: SwerveDrive, translationalCoeffs: PIDCoefficients, headingCoeffs: PIDCoefficients, kV: Double, kA: Double, kStatic: Double, clock: NanoClock = NanoClock.system())
Traditional PID controller with feedforward velocity and acceleration components to follow a trajectory. More specifically, the feedback is applied to the components of the robot's pose (x position, y position, and heading) to determine the velocity correction. The feedforward components are instead applied at the wheel level.
drive - mecanum drive instance
translationalCoeffs - PID coefficients for the robot axial and lateral (x and y, respectively) controllers
headingCoeffs - PID coefficients for the robot heading controller
kV - feedforward velocity gain
kA - feedforward acceleration gain
kStatic - signed, additive feedforward constant (used to overcome static friction)