diff --git a/wpimath/src/main/java/edu/wpi/first/math/estimator/DifferentialDrivePoseEstimator.java b/wpimath/src/main/java/edu/wpi/first/math/estimator/DifferentialDrivePoseEstimator.java index 074362e359..b199d4d63b 100644 --- a/wpimath/src/main/java/edu/wpi/first/math/estimator/DifferentialDrivePoseEstimator.java +++ b/wpimath/src/main/java/edu/wpi/first/math/estimator/DifferentialDrivePoseEstimator.java @@ -40,8 +40,8 @@ import java.util.function.BiConsumer; *

x = [x, y, theta, dist_l, dist_r]ᵀ in the field coordinate system * containing x position, y position, heading, left encoder distance, and right encoder distance. * - *

u = [v_l, v_r, dtheta]ᵀ containing left wheel velocity, right wheel - * velocity, and change in gyro heading. + *

u = [v_x, v_y, omega]ᵀ containing x velocity, y velocity, and angular rate + * in the field coordinate system. * *

NB: Using velocities make things considerably easier, because it means that teams don't have * to worry about getting an accurate model. Basically, we suspect that it's easier for teams to get diff --git a/wpimath/src/main/java/edu/wpi/first/math/estimator/MecanumDrivePoseEstimator.java b/wpimath/src/main/java/edu/wpi/first/math/estimator/MecanumDrivePoseEstimator.java index 42a6adb002..d6f10755f2 100644 --- a/wpimath/src/main/java/edu/wpi/first/math/estimator/MecanumDrivePoseEstimator.java +++ b/wpimath/src/main/java/edu/wpi/first/math/estimator/MecanumDrivePoseEstimator.java @@ -38,8 +38,8 @@ import java.util.function.BiConsumer; *

x = [x, y, theta]ᵀ in the field coordinate system containing x position, y * position, and heading. * - *

u = [v_l, v_r, dtheta]ᵀ containing left wheel velocity, right wheel - * velocity, and change in gyro heading. + *

u = [v_x, v_y, omega]ᵀ containing x velocity, y velocity, and angular rate + * in the field coordinate system. * *

y = [x, y, theta]ᵀ from vision containing x position, y position, and * heading; or y = [theta]ᵀ containing gyro heading. diff --git a/wpimath/src/main/java/edu/wpi/first/math/estimator/SwerveDrivePoseEstimator.java b/wpimath/src/main/java/edu/wpi/first/math/estimator/SwerveDrivePoseEstimator.java index 9e48728909..8782b7bdc2 100644 --- a/wpimath/src/main/java/edu/wpi/first/math/estimator/SwerveDrivePoseEstimator.java +++ b/wpimath/src/main/java/edu/wpi/first/math/estimator/SwerveDrivePoseEstimator.java @@ -38,8 +38,8 @@ import java.util.function.BiConsumer; *

x = [x, y, theta]ᵀ in the field coordinate system containing x position, y * position, and heading. * - *

u = [v_l, v_r, dtheta]ᵀ containing left wheel velocity, right wheel - * velocity, and change in gyro heading. + *

u = [v_x, v_y, omega]ᵀ containing x velocity, y velocity, and angular rate + * in the field coordinate system. * *

y = [x, y, theta]ᵀ from vision containing x position, y position, and * heading; or y = [theta]ᵀ containing gyro heading. diff --git a/wpimath/src/main/native/include/frc/estimator/DifferentialDrivePoseEstimator.h b/wpimath/src/main/native/include/frc/estimator/DifferentialDrivePoseEstimator.h index b957c1ec79..12810faabd 100644 --- a/wpimath/src/main/native/include/frc/estimator/DifferentialDrivePoseEstimator.h +++ b/wpimath/src/main/native/include/frc/estimator/DifferentialDrivePoseEstimator.h @@ -38,8 +38,8 @@ namespace frc { * system containing x position, y position, heading, left encoder distance, * and right encoder distance. * - * u = [v_l, v_r, dtheta]ᵀ containing left wheel velocity, - * right wheel velocity, and change in gyro heading. + * u = [v_x, v_y, omega]ᵀ containing x velocity, y velocity, + * and angular velocity in the field coordinate system. * * NB: Using velocities make things considerably easier, because it means that * teams don't have to worry about getting an accurate model. Basically, we diff --git a/wpimath/src/main/native/include/frc/estimator/MecanumDrivePoseEstimator.h b/wpimath/src/main/native/include/frc/estimator/MecanumDrivePoseEstimator.h index 93c9f1e42b..e9817efb81 100644 --- a/wpimath/src/main/native/include/frc/estimator/MecanumDrivePoseEstimator.h +++ b/wpimath/src/main/native/include/frc/estimator/MecanumDrivePoseEstimator.h @@ -38,8 +38,8 @@ namespace frc { * x = [x, y, theta]ᵀ in the field coordinate system * containing x position, y position, and heading. * - * u = [v_l, v_r, dtheta]ᵀ containing left wheel velocity, - * right wheel velocity, and change in gyro heading. + * u = [v_x, v_y, omega]ᵀ containing x velocity, y velocity, + * and angular velocity in the field coordinate system. * * y = [x, y, theta]ᵀ from vision containing x position, y * position, and heading; or y = [theta]ᵀ containing gyro diff --git a/wpimath/src/main/native/include/frc/estimator/SwerveDrivePoseEstimator.h b/wpimath/src/main/native/include/frc/estimator/SwerveDrivePoseEstimator.h index 91e0e50dbe..7422a3c911 100644 --- a/wpimath/src/main/native/include/frc/estimator/SwerveDrivePoseEstimator.h +++ b/wpimath/src/main/native/include/frc/estimator/SwerveDrivePoseEstimator.h @@ -40,8 +40,8 @@ namespace frc { * x = [x, y, theta]ᵀ in the field coordinate system * containing x position, y position, and heading. * - * u = [v_l, v_r, dtheta]ᵀ containing left wheel velocity, - * right wheel velocity, and change in gyro heading. + * u = [v_x, v_y, omega]ᵀ containing x velocity, y velocity, + * and angular velocity in the field coordinate system. * * y = [x, y, theta]ᵀ from vision containing x position, y * position, and heading; or y = [theta]ᵀ containing gyro