robotToWheelAccelerations
public final static List<Double> robotToWheelAccelerations(Pose2d robotAccel, Double trackWidth, Double wheelBase, Double lateralMultiplier)
public final static List<Double> robotToWheelAccelerations(Pose2d robotAccel, Double trackWidth, Double wheelBase)
Computes the wheel accelerations corresponding to robotAccel given the provided trackWidth and wheelBase.
Parameters
robotAccel
acceleration 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).