core / com.acmerobotics.roadrunner.kinematics / SwerveKinematics

SwerveKinematics

object SwerveKinematics

Swerve drive kinematic equations. All wheel positions and velocities are given starting with front left and proceeding counter-clockwise (i.e., front left, rear left, rear right, front right). Robot poses are specified in a coordinate system with positive x pointing forward, positive y pointing left, and positive heading measured counter-clockwise from the x-axis.

Functions

robotToModuleAccelerationVectors

fun robotToModuleAccelerationVectors(robotAccel: Pose2d, trackWidth: Double, wheelBase: Double = trackWidth): List<Vector2d>

Computes the acceleration vectors corresponding to robotAccel given the provided trackWidth and wheelBase.

robotToModuleAngularVelocities

fun robotToModuleAngularVelocities(robotVel: Pose2d, robotAccel: Pose2d, trackWidth: Double, wheelBase: Double = trackWidth): List<Double>

Computes the module angular velocities corresponding to robotAccel given the provided trackWidth and wheelBase.

robotToModuleOrientations

fun robotToModuleOrientations(robotVel: Pose2d, trackWidth: Double, wheelBase: Double = trackWidth): List<Double>

Computes the module orientations (in radians) corresponding to robotVel given the provided trackWidth and wheelBase.

robotToModuleVelocityVectors

fun robotToModuleVelocityVectors(robotVel: Pose2d, trackWidth: Double, wheelBase: Double = trackWidth): List<Vector2d>

Computes the wheel velocity vectors corresponding to robotVel given the provided trackWidth and wheelBase.

robotToWheelAccelerations

fun robotToWheelAccelerations(robotVel: Pose2d, robotAccel: Pose2d, trackWidth: Double, wheelBase: Double = trackWidth): List<Double>

Computes the wheel accelerations corresponding to robotAccel given the provided trackWidth and wheelBase.

robotToWheelVelocities

fun robotToWheelVelocities(robotVel: Pose2d, trackWidth: Double, wheelBase: Double = trackWidth): List<Double>

Computes the wheel velocities corresponding to robotVel given the provided trackWidth and wheelBase.

wheelToRobotVelocities

fun wheelToRobotVelocities(wheelVelocities: List<Double>, moduleOrientations: List<Double>, trackWidth: Double, wheelBase: Double = trackWidth): Pose2d

Computes the robot velocities corresponding to wheelVelocities, moduleOrientations, and the drive parameters.