Class SwerveDriveKinematicsConstraint

java.lang.Object

org.wpilib.math.trajectory.constraint.SwerveDriveKinematicsConstraint

All Implemented Interfaces:

TrajectoryConstraint

public class SwerveDriveKinematicsConstraint
extends Object
implements TrajectoryConstraint

A class that enforces constraints on the swerve drive kinematics. This can be used to ensure that the trajectory is constructed so that the commanded velocities for all 4 wheels of the drivetrain stay below a certain limit.

Nested Class Summary

Nested classes/interfaces inherited from interface TrajectoryConstraint

TrajectoryConstraint.MinMax

Constructor Summary

Constructors

Constructor	Description
SwerveDriveKinematicsConstraint(SwerveDriveKinematics kinematics, double maxVelocity)	Constructs a swerve drive kinematics constraint.

Method Summary

Modifier and Type	Method	Description
double	getMaxVelocity(Pose2d pose, double curvature, double velocity)	Returns the max velocity given the current pose and curvature.
TrajectoryConstraint.MinMax	getMinMaxAcceleration(Pose2d pose, double curvature, double velocity)	Returns the minimum and maximum allowable acceleration for the trajectory given pose, curvature, and velocity.

Methods inherited from class Object

clone, equals, finalize, getClass, hashCode, notify, notifyAll, toString, wait, wait, wait

Constructor Details

SwerveDriveKinematicsConstraint

public SwerveDriveKinematicsConstraint(SwerveDriveKinematics kinematics,
 double maxVelocity)

Constructs a swerve drive kinematics constraint.

Parameters:

kinematics - Swerve drive kinematics.

maxVelocity - The max velocity that a side of the robot can travel at in m/s.

Method Details

getMaxVelocity

public double getMaxVelocity(Pose2d pose,
 double curvature,
 double velocity)

Returns the max velocity given the current pose and curvature.

Specified by:

getMaxVelocity in interface TrajectoryConstraint

Parameters:

pose - The pose at the current point in the trajectory.

curvature - The curvature at the current point in the trajectory in rad/m.

velocity - The velocity at the current point in the trajectory before constraints are applied in m/s.

Returns:

The absolute maximum velocity.

getMinMaxAcceleration

public TrajectoryConstraint.MinMax getMinMaxAcceleration(Pose2d pose,
 double curvature,
 double velocity)

Returns the minimum and maximum allowable acceleration for the trajectory given pose, curvature, and velocity.

Specified by:

getMinMaxAcceleration in interface TrajectoryConstraint

Parameters:

pose - The pose at the current point in the trajectory.

curvature - The curvature at the current point in the trajectory in rad/m.

velocity - The velocity at the current point in the trajectory in m/s.

Returns:

The min and max acceleration bounds.