fix yaw conversion from quat in cmd_full_state in crazyflie_sim/crazy…

…flie_server (#382)
IMRCLab · Dec 13, 2023 · 963df7b · 963df7b
1 parent 5bd08d8
commit 963df7b
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/crazyflie_sim/crazyflie_sim/crazyflie_server.py b/crazyflie_sim/crazyflie_sim/crazyflie_server.py
@@ -326,7 +326,7 @@ def _cmd_full_state_changed(self, msg, name):
  msg.pose.orientation.x,
  msg.pose.orientation.y,
  msg.pose.orientation.z]
- rpy = rowan.to_euler(q)
+ rpy = rowan.to_euler(q, convention='xyz')
 
  self.cfs[name].cmdFullState(
  [msg.pose.position.x, msg.pose.position.y, msg.pose.position.z],