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

[wpimath] Add Rotation3d rotation vector getter (#7564)

Browse Source 
The code churn in Java is just making the function order consistent
between languages.
This commit is contained in:
Tyler Veness
2024-12-22 13:34:51 -08:00
committed by GitHub
parent 0c99073b94
commit 02a0adc653
5 changed files with 40 additions and 25 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
wpimath/src/main/native/include/frc/kinematics/Odometry3d.h
View File

@@ -120,8 +120,7 @@ class WPILIB_DLLEXPORT Odometry3d {
const Pose3d& Update(const Rotation3d& gyroAngle,
const WheelPositions& wheelPositions) {
auto angle = gyroAngle + m_gyroOffset;
auto angle_difference =
(angle - m_previousAngle).GetQuaternion().ToRotationVector();
auto angle_difference = (angle - m_previousAngle).ToVector();
auto twist2d =
m_kinematics.ToTwist2d(m_previousWheelPositions, wheelPositions);