仿真跑起来了，但是起点转向不太对。

yincheng.zhong

2025-11-24 346cc7d685283df529aadbcf9c156de040ce44f9

 STM32H743/FML/motion_control.h

@@ -50,6 +50,7 @@
    E_MCStage stage;                 /* 当前控制阶段 */
    float pos_enu[3];                /* 当前 ENU 位置 (E/N/U) */
    float heading_deg;               /* 当前航向 (deg) */
    float target_heading_deg;        /* 目标航向 (deg) */
    float pitch_deg;                 /* 当前俯仰 (deg) */
    float roll_deg;                  /* 当前横滚 (deg) */
    HIDO_BOOL target_valid;          /* 目标点是否有效 */