public class TankVelocityConstraint implements TrajectoryVelocityConstraint
Tank-specific drive constraints that also limit maximum wheel velocities.
public TankVelocityConstraint(double maxWheelVel, double trackWidth)
maxWheelVel
trackWidth
public double get(double s, @NotNull Pose2d pose, @NotNull Pose2d deriv, @NotNull Pose2d baseRobotVel)
Returns the maximum profile velocity.
s
pose
deriv
baseRobotVel