From f58873db8e8af91ced0f5a47555e181f42e9fde9 Mon Sep 17 00:00:00 2001 From: superpenguin612 <74030080+superpenguin612@users.noreply.github.com> Date: Sat, 3 Dec 2022 12:46:34 -0500 Subject: [PATCH] [wpimath] Remove extra terms in matrix for pose estimator docs (#4756) --- .../wpi/first/math/estimator/MecanumDrivePoseEstimator.java | 3 +-- .../include/frc/estimator/DifferentialDrivePoseEstimator.h | 2 +- 2 files changed, 2 insertions(+), 3 deletions(-) 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 6702142ac2..46b55aa2c5 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 @@ -36,8 +36,7 @@ import java.util.Objects; *

The state-space system used internally has the following states (x) and outputs (y): * *

x = [x, y, theta]ᵀ in the field coordinate system containing x position, y - * position, and heading, followed by the distance driven by the front left, front right, rear left, - * and rear right wheels. + * position, and heading. * *

y = [x, y, theta]ᵀ from vision containing x position, y position, and * heading. diff --git a/wpimath/src/main/native/include/frc/estimator/DifferentialDrivePoseEstimator.h b/wpimath/src/main/native/include/frc/estimator/DifferentialDrivePoseEstimator.h index b74d2bb841..31ba550855 100644 --- a/wpimath/src/main/native/include/frc/estimator/DifferentialDrivePoseEstimator.h +++ b/wpimath/src/main/native/include/frc/estimator/DifferentialDrivePoseEstimator.h @@ -79,7 +79,7 @@ class WPILIB_DLLEXPORT DifferentialDrivePoseEstimator { * Increase these numbers to trust your * model's state estimates less. This matrix * is in the form - * [x, y, theta, dist_l, dist_r]ᵀ, + * [x, y, theta]ᵀ, * with units in meters and radians. * @param visionMeasurementStdDevs Standard deviations of the vision * measurements. Increase these numbers to