Search in sources :

Example 31 with ChassisSpeeds

use of edu.wpi.first.math.kinematics.ChassisSpeeds in project Pathfinder2 by Wobblyyyy.

the class TestCompareChassisSpeedsWithTranslation method compare.

private static void compare(double vx, double vy, double vz, Angle angle) {
    ValidationUtils.validate(vx, "vx");
    ValidationUtils.validate(vy, "vy");
    ValidationUtils.validate(vz, "vz");
    ValidationUtils.validate(angle, "angle");
    ChassisSpeeds speeds = new ChassisSpeeds(vx, vy, vz);
    Translation translation = new Translation(vx, vy, vz);
    compare(speeds, translation, angle);
}
Also used : Translation(me.wobblyyyy.pathfinder2.geometry.Translation) ChassisSpeeds(edu.wpi.first.math.kinematics.ChassisSpeeds)

Aggregations

ChassisSpeeds (edu.wpi.first.math.kinematics.ChassisSpeeds)31 Pose2d (edu.wpi.first.math.geometry.Pose2d)6 Rotation2d (edu.wpi.first.math.geometry.Rotation2d)4 DifferentialDriveWheelSpeeds (edu.wpi.first.math.kinematics.DifferentialDriveWheelSpeeds)3 PathPlannerState (com.pathplanner.lib.PathPlannerTrajectory.PathPlannerState)2 RamseteController (edu.wpi.first.math.controller.RamseteController)2 Transform2d (edu.wpi.first.math.geometry.Transform2d)2 Translation2d (edu.wpi.first.math.geometry.Translation2d)2 Trajectory (edu.wpi.first.math.trajectory.Trajectory)2 Field2d (edu.wpi.first.wpilibj.smartdashboard.Field2d)2 ArrayList (java.util.ArrayList)2 AHRS (com.kauailabs.navx.frc.AHRS)1 MatBuilder (edu.wpi.first.math.MatBuilder)1 SlewRateLimiter (edu.wpi.first.math.filter.SlewRateLimiter)1 DifferentialDriveKinematics (edu.wpi.first.math.kinematics.DifferentialDriveKinematics)1 MecanumDriveMotorVoltages (edu.wpi.first.math.kinematics.MecanumDriveMotorVoltages)1 SwerveDriveKinematics (edu.wpi.first.math.kinematics.SwerveDriveKinematics)1 SwerveModuleState (edu.wpi.first.math.kinematics.SwerveModuleState)1 N1 (edu.wpi.first.math.numbers.N1)1 N3 (edu.wpi.first.math.numbers.N3)1