WiimoteEmu: Fix gyroscope/quaternion conversion math.

2022-10-10 21:18:55 -05:00 · 2022-10-10 21:18:55 -05:00 · bf53e14abe
parent 6eb1f8beba
commit bf53e14abe
1 changed files with 3 additions and 1 deletions
--- a/Source/Core/Core/HW/WiimoteEmu/Dynamics.cpp
+++ b/Source/Core/Core/HW/WiimoteEmu/Dynamics.cpp
@ -398,7 +398,9 @@ Common::Quaternion GetRotationFromAcceleration(const Common::Vec3& accel)

 Common::Quaternion GetRotationFromGyroscope(const Common::Vec3& gyro)
 {
-  return Common::Quaternion{1, gyro.x / 2, gyro.y / 2, gyro.z / 2};
+  const auto length = gyro.Length();
+  return (length != 0) ? Common::Quaternion::Rotate(length, gyro / length) :
+                         Common::Quaternion::Identity();
 }

 Common::Matrix33 GetRotationalMatrix(const Common::Vec3& angle)