robotToWheelVelocities
public final static List<Double> robotToWheelVelocities(Pose2d robotVel, Double trackWidth, Double wheelBase, Double lateralMultiplier)
public final static List<Double> robotToWheelVelocities(Pose2d robotVel, Double trackWidth, Double wheelBase)
Computes the wheel velocities corresponding to robotVel given the provided trackWidth and wheelBase.
Parameters
robotVel
velocity of the robot in its reference frame
trackWidth
lateral distance between pairs of wheels on different sides of the robot
wheelBase
distance between pairs of wheels on the same side of the robot
lateralMultiplier
multiplicative gain to adjust for systematic, proportional lateral error (gain greater than 1.0 corresponds to overcompensation).