Update src/dlc2kinematics/utils/auxiliaryfunctions.py

AdaptiveMotorControlLab · Dec 13, 2023 · e8b3169 · e8b3169
1 parent 1b98e64
commit e8b3169
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/src/dlc2kinematics/utils/auxiliaryfunctions.py b/src/dlc2kinematics/utils/auxiliaryfunctions.py
@@ -236,7 +236,7 @@ def doubleangle_calc(pos):
     y = rel[1]
     z = rel[2]
     # yaw, pitch relative to the vertical plane (x-z plane)
-    yaw = np.arctan(x / z) * 180 / np.pi
+    yaw = np.rad2deg(np.arctan2(x, z))
     padj = np.sqrt((x ** 2) + (z ** 2))
     pitch = np.arctan(padj / y) * 180.0 / np.pi