From 453f17849bc4427ef45df0679f5a86225c23d3e1 Mon Sep 17 00:00:00 2001 From: Martin Schuck Date: Wed, 18 Nov 2026 18:44:56 +0100 Subject: [PATCH] Suppress as_euler gimbal-lock warnings in controllers --- crazyflow/control/mellinger/control.py | 8 +++++--- 1 file changed, 5 insertions(+), 3 deletions(-) diff --git a/crazyflow/control/mellinger/control.py b/crazyflow/control/mellinger/control.py index 07ff08bd..d0fb1759 100644 --- a/crazyflow/control/mellinger/control.py +++ b/crazyflow/control/mellinger/control.py @@ -100,7 +100,7 @@ def state2attitude( ) # l. 178 Rate-controlled YAW is moving YAW angle setpoint # => only one case here, since the setpoint is always in absolute mode - desired_yaw = R.from_quat(setpoint_quat).as_euler("xyz")[..., 2] + desired_yaw = R.from_quat(setpoint_quat).as_euler("xyz", suppress_warnings=True)[..., 2] # l. 189 Z-Axis [zB] rot = R.from_quat(quat).as_matrix() z_axis = rot[..., -1] # 3rd column or roation matrix is z axis @@ -132,7 +132,9 @@ def state2attitude( # # safety: assume_valid is okay here because we just constructed the rotation matrix from # orthonormal vectors - command_RPY = R.from_matrix(matrix, assume_valid=True).as_euler("xyz", degrees=False) + command_RPY = R.from_matrix(matrix, assume_valid=True).as_euler( + "xyz", degrees=False, suppress_warnings=True + ) # l. 283 [control_thrust] # The firmware returns thrust in PWM, but we want to stay in SI units. The conversion from # thrust to PWM uses a mass_thrust parameter, which is a constant converting thrust values to @@ -290,7 +292,7 @@ def body_rate2force_torque( xp = array_namespace(quat) # l. 215 ff Without a position or attitude setpoint, the firmware levels the drone at the # current yaw - yaw = R.from_quat(quat).as_euler("xyz", degrees=False)[..., 2] + yaw = R.from_quat(quat).as_euler("xyz", degrees=False, suppress_warnings=True)[..., 2] rpy_des = xp.stack((xp.zeros_like(yaw), xp.zeros_like(yaw), yaw), axis=-1) ang_vel_des = cmd[..., :3] prev_ang_vel_des = ang_vel_des if prev_cmd is None else prev_cmd[..., :3]