Team2890/allwpilib
4
0
Fork 0
mirror of https://github.com/wpilibsuite/allwpilib synced 2026-06-22 01:11:42 +00:00
Code Issues Packages Projects Releases Wiki Activity

[wpimath] Add constructors to pose estimators with default standard deviations (#4754)

Browse Source
This commit is contained in:
superpenguin612
2022-12-03 12:46:10 -05:00
committed by GitHub
parent 13cdc29382
commit 37e969b41a
8 changed files with 166 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
wpimath/src/main/native/cpp/estimator/MecanumDrivePoseEstimator.cpp
View File

@@ -51,6 +51,13 @@ frc::MecanumDrivePoseEstimator::InterpolationRecord::Interpolate(
}
}
frc::MecanumDrivePoseEstimator::MecanumDrivePoseEstimator(
MecanumDriveKinematics& kinematics, const Rotation2d& gyroAngle,
const MecanumDriveWheelPositions& wheelPositions, const Pose2d& initialPose)
: MecanumDrivePoseEstimator{kinematics, gyroAngle,
wheelPositions, initialPose,
{0.1, 0.1, 0.1}, {0.45, 0.45, 0.45}} {}
frc::MecanumDrivePoseEstimator::MecanumDrivePoseEstimator(
MecanumDriveKinematics& kinematics, const Rotation2d& gyroAngle,
const MecanumDriveWheelPositions& wheelPositions, const Pose2d& initialPose,