gearToRobotVelocities
public final static Pose2d gearToRobotVelocities(List<Angle> gearRotations, List<Double> gearVelocities, Double trackWidth)
Computes the robot velocities corresponding to gearRotations, gearVelocities, and trackWidth.
Parameters
gearRotations
the total rotations of each gear
gearVelocities
the current velocities of each gear, in linear distance units
trackWidth
lateral distance between pairs of wheels on different sides of the robot