Ryan Blue
7b828ce84f
[wpimath] Add nearest to Pose2d and Translation2d ( #4882 )
...
Co-authored-by: David Vo <auscompgeek@users.noreply.github.com >
2023-02-03 15:27:16 -08:00
Tyler Veness
8bf67b1b33
[wpimath] PIDController::Calculate(double, double): update setpoint flag ( #5021 )
...
Fixes #5020 .
2023-01-29 07:18:48 -08:00
Tyler Veness
d48a83dee2
[wpimath] Update Wikipedia links for quaternion to Euler angle conversion (NFC) ( #4995 )
2023-01-21 15:16:35 -08:00
Jordan McMichael
42c997a3c4
[wpimath] Fix Pose3d exponential and clean up Pose3d logarithm ( #4970 )
...
Implementation based on this paper: https://ethaneade.org/lie.pdf
2023-01-18 20:38:03 -08:00
Oliver W
a8c465f3fb
[wpimath] HolonomicDriveController: Add getters for the controllers ( #4948 )
2023-01-16 08:33:15 -08:00
sciencewhiz
1e05b21ab5
[wpimath] Fix PID atSetpoint to not return true prematurely ( #4906 )
...
Wait until setpoint and measurement have been set.
2023-01-13 22:26:30 -08:00
ohowe
e5a6197633
[wpimath] Fix SwerveDriveKinematics not initializing a new array each time ( #4942 )
...
This is problematic if you call it twice before utilizing the result.
2023-01-13 20:16:50 -08:00
Matt
f7f19207e0
[wpimath] Allow multiple vision measurements from same timestamp ( #4917 )
...
Co-authored-by: Jordan McMichael <jlmcmchl@gmail.com >
Co-authored-by: Tyler Veness <calcmogul@gmail.com >
2023-01-11 23:04:30 -08:00
ohowe
330ba45f9c
[wpimath] Fix swerve kinematics util classes equals function ( #4907 )
...
Co-authored-by: Tyler Veness <calcmogul@gmail.com >
2023-01-08 16:29:35 -08:00
Tyler Veness
2121bd5fb8
[wpimath] Remove RKF45 ( #4870 )
...
RKDP is strictly better in terms of accuracy per unit of work. We used
RKF45 for sim physics in the 2021 season, but we transitioned to RKDP
before the 2022 season.
2022-12-27 19:29:59 -06:00
Sriman Achanta
26bdbf3d41
Java optimization and formatting fixes ( #4857 )
2022-12-26 11:37:53 -08:00
Sriman Achanta
92149efa11
Spelling and grammar cleanups ( #4849 )
2022-12-26 11:32:13 -08:00
Ashray._.g
2744991771
[wpimath] Fix docs in SwerveModulePosition ( #4825 )
...
Changed m/s and speeds to m and distance.
2022-12-16 05:48:20 -08:00
shueja-personal
7ba8a9ee1f
[wpimath] ProfiledPIDController: Add to SendableRegistry ( #4656 )
...
Co-authored-by: Ryan Blue <ryanzblue@gmail.com >
2022-12-13 22:31:06 -08:00
Tyler Veness
3270d4fc86
[wpimath] Rewrite pose estimator docs ( #4807 )
2022-12-12 20:30:52 -08:00
Tyler Veness
7e84ea891f
[wpimath] Fix ComputerVisionUtil transform example in parameter docs (NFC) ( #4800 )
2022-12-11 22:44:08 -08:00
Charlie
da3ec1be10
[wpimath] Change terminology for ArmFeedforward gravity gain (NFC) ( #4791 )
2022-12-11 22:43:44 -08:00
ohowe
4a0ad6b48c
[wpimath] Rotation2d: Add reference to angleModulus in docs (NFC) ( #4786 )
2022-12-09 23:35:15 -08:00
sciencewhiz
989c9fb29a
[wpimath] Revert Rotation2D change that limits angles ( #4781 )
...
Reverts "[wpimath] Constrain Rotation2d range to -pi to pi (#4611 )"
This reverts commit d1d458db2b .
This broke multiple teams code in beta. It is also easier to limit the angle externally, then reconstruct a larger angle that got limited. This additionally adds comments to clarify the behavior and retains tests that were added in the reverted commit, and fixes a javadoc comment angle reference.
2022-12-08 18:10:44 -08:00
Tyler Veness
f18fd41ac3
[wpimath] Remove broken and obsoleted ComputerVisionUtil functions ( #4775 )
...
The ComputerVisionUtil class was added before AprilTag support was
announced. Now that it has, the functions for estimating a pose from
range and yaw are no longer needed; it's just better to get the pose
directly from the AprilTag.
The coordinate system on some function arguments was confusing or didn't
match the NWU convention the rest of the library uses. It's easier to
remove the functions now and add them back after they're fixed since the
fixes aren't trivial.
The range function was removed because it uses pitch and yaw in the
camera's spherical coordinate system, which is obsoleted by AprilTags.
AprilTags give you a 6DOF pose directly, so range can be obtained via
Pose2d.getTranslation().getDistance().
Fixes #4757 .
2022-12-06 21:11:27 -08:00
Jaci Brunning
ff88756864
[wpimath] Add new DCMotor functions for alternative calculations and reduction calculation ( #4749 )
2022-12-03 09:47:16 -08:00
superpenguin612
f58873db8e
[wpimath] Remove extra terms in matrix for pose estimator docs ( #4756 )
2022-12-03 09:46:34 -08:00
superpenguin612
37e969b41a
[wpimath] Add constructors to pose estimators with default standard deviations ( #4754 )
2022-12-03 09:46:10 -08:00
Jordan McMichael
e22d8cc343
[wpimath] Use Odometry for internal state in Pose Estimation ( #4668 )
...
This effectively replaces the Unscented Kalman Filter used for Pose Estimation with the Odometry model, and uses a recalculable Kalman gain matrix to update pose estimations whenever a vision measurement is added.
Notably, this change removes the need for the confusing generics used in Java, and the C++ implementation got quite a bit less complex as well.
Co-authored-by: Tyler Veness <calcmogul@gmail.com >
2022-12-02 08:36:10 -08:00
Tyler Veness
eae68fc165
[wpimath] Add tolerance for Rotation3d rotation matrix special orthogonality ( #4744 )
2022-11-30 19:51:31 -08:00
Starlight220
d5200db6cd
[wpimath] Rename HolonomicDriveController.calculate params ( #4683 )
2022-11-23 23:13:50 -08:00
Tyler Veness
2ee3d86de4
[wpimath] Clarify Rotation3d roll-pitch-yaw direction ( #4699 )
2022-11-23 23:12:59 -08:00
Jordan McMichael
902e8686d3
[wpimath] Rework odometry APIs to improve feature parity ( #4645 )
...
Co-authored-by: Ryan Blue <ryanzblue@gmail.com >
2022-11-18 20:42:00 -08:00
amquake
88f7a3ccb9
[wpimath] Fix Pose relativeTo documentation ( #4661 )
2022-11-18 14:07:50 -08:00
Drew Williams
2e88a496c2
[wpimath] Add support for swerve joystick normalization ( #4516 )
2022-11-17 10:53:49 -08:00
Jordan McMichael
ce4c45df13
[wpimath] Rework function signatures for Pose Estimation / Odometry ( #4642 )
...
Forcing the use of SwerveModulePostition[] and wpi::array<SwerveModulePosition, len> in place of variadic function signatures.
2022-11-17 10:36:33 -08:00
Jordan McMichael
2e5f9e45bb
[wpimath] Remove encoder reset comments on Swerve, Mecanum Odometry and Pose Estimation ( #4643 )
...
In both of these cases, encoder resets are not required for normal use.
2022-11-16 15:20:05 -08:00
Tyler Veness
14d8506b72
[wpimath] Fix units docs for LinearSystemId::IdentifyDrivetrainSystem() ( #4600 )
2022-11-14 14:26:16 -08:00
ohowe
d1d458db2b
[wpimath] Constrain Rotation2d range to -pi to pi ( #4611 )
...
Co-authored-by: Ryan Blue <ryanzblue@gmail.com >
2022-11-14 14:25:15 -08:00
CarloWoolsey
dbcc1de37f
[wpimath] Add DifferentialDriveFeedforward classes which wrap LinearPlantInversionFeedforward ( #4598 )
...
Co-authored-by: Tyler Veness <calcmogul@gmail.com >
2022-11-10 16:54:51 -08:00
Griffin Della Grotte
b1b4c1e9e7
[wpimath] Fix Pose3d transformBy rotation type ( #4545 )
...
Co-authored-by: Ryan Blue <ryanzblue@gmail.com >
2022-11-07 09:57:33 -08:00
Alex Ryker
64a7136e08
[wpimath] SwerveDrivePoseEstimator: Restore comment about encoder reset ( #4569 )
2022-11-04 15:03:49 -07:00
Brennen Puth
b2b473b24a
[wpilib] Add AprilTag and AprilTagFieldLayout ( #4421 )
...
This is an API for looking up a Pose3d from a tag id, and includes functionality to load that map from a JSON file.
This also adds JSON support to Pose3d, Rotation3d. Translation3d, and Quaternion.
Co-authored-by: Tyler Veness <calcmogul@gmail.com >
Co-authored-by: AMereBagatelle <themerebagatelle@gmail.com >
2022-11-04 09:56:22 -07:00
Tyler Veness
2416827c25
[wpimath] Fix docs for pose estimator local measurement models ( #4558 )
2022-11-02 22:53:21 -07:00
Tyler Veness
8bc3b04f5b
[wpimath] Make ComputerVisionUtil use 3D geometry classes ( #4528 )
...
Closes #4189 .
2022-10-26 22:20:08 -07:00
Justin
2a98d6b5d7
[wpimath] PIDController: Add getters for position & velocity tolerances ( #4458 )
2022-10-25 16:10:19 -07:00
Jordan McMichael
901fc555f4
[wpimath] Position Delta Odometry for Mecanum ( #4514 )
2022-10-25 12:28:59 -07:00
Jordan McMichael
4170ec6107
[wpimath] Position Delta Odometry for Swerve ( #4493 )
2022-10-25 12:28:36 -07:00
Tyler Veness
c195b4fc46
[wpimath] Clean up PoseEstimator nominal dt docs ( #4496 )
2022-10-21 19:53:58 -07:00
shueja-personal
3e5bfff1b5
[wpimath] FromFieldRelativeSpeeds: Add ChassisSpeeds overload ( #4494 )
2022-10-21 18:58:23 -07:00
Tyler Veness
16cdc741cf
[wpimath] Add Pose3d(Pose2d) constructor ( #4485 )
2022-10-20 17:23:00 -07:00
Tyler Veness
ca43fe2798
[wpimath] Use Units conversions in ComputerVisionUtil docs (NFC) ( #4464 )
2022-10-12 13:54:15 -07:00
Ryan Blue
27b173374e
[wpimath] Add minLinearAccel parameter to DifferentialDriveAccelerationLimiter ( #4422 )
2022-10-10 08:57:37 -07:00
Ryan Blue
2a13dba8ac
[wpilib] TrajectoryUtil: Fix ambiguous documentation (NFC) ( #4461 )
2022-10-10 08:56:40 -07:00
Starlight220
b2276e47de
[wpimath] Enable continuous angle input for HolonomicDriveController ( #4453 )
2022-10-06 17:46:22 -05:00