moduleToRobotVelocities
public final static Pose2d moduleToRobotVelocities(List<Double> wheelVelocities, List<Angle> moduleOrientations, Double trackWidth, Double wheelBase)
public final static Pose2d moduleToRobotVelocities(List<Double> wheelVelocities, List<Angle> moduleOrientations, Double trackWidth)
Computes the robot velocities corresponding to wheelVelocities, moduleOrientations, and the drive parameters.
Parameters
wheelVelocities
wheel velocities (or wheel position deltas)
moduleOrientations
module orientations
trackWidth
lateral distance between pairs of modules on different sides of the robot
wheelBase
distance between pairs of modules on the same side of the robot
public final static Pose2d moduleToRobotVelocities(List<Double> wheelVelocities, List<Angle> moduleOrientations, List<Vector2d> modulePositions)
Computes the robot velocities corresponding to wheelVelocities, moduleOrientations, and the drive parameters.
Parameters
wheelVelocities
wheel velocities (or wheel position deltas)
moduleOrientations
module orientations
modulePositions
the positions of all the modules relative to the center of rotation of the robot