fix: 🐛 Fix Fisheye transformation implementation

LemLib · Jan 29, 2025 · 8828d33 · 8828d33
1 parent 371182d
commit 8828d33
Showing 1 changed file with 3 additions and 3 deletions.
diff --git a/src/gamepad/joystick_transformation.cpp b/src/gamepad/joystick_transformation.cpp
@@ -34,9 +34,9 @@ std::pair<float, float> Fisheye::get_value(std::pair<float, float> value) {
     float y_abs = abs(y);
     float j = std::sqrt(m_radius * m_radius - 1.0 * 1.0);
     if (x_abs >= j && y_abs >= j) {
-        float theta = std::atan2(y_abs, x_abs);
-        x_abs *= m_radius / std::cos(abs(std::remainder(theta, 90)));
-        y_abs *= m_radius / std::cos(abs(std::remainder(theta, 90)));
+        float scale = std::hypot(std::min(x_abs / y_abs, y_abs / x_abs), 1.0) / m_radius;
+        x_abs *= scale;
+        y_abs *= scale;
     }
     x = std::copysign(std::min(1.0f, x_abs), x);
     y = std::copysign(std::min(1.0f, y_abs), y);