From 275b03224aa6170d4dc8c661c1cd949dd88c1fcb Mon Sep 17 00:00:00 2001
From: yincheng.zhong <634916154@qq.com>
Date: 星期一, 24 十一月 2025 15:10:21 +0800
Subject: [PATCH] 转向问题解决，方向定义问题，开始走了
---
STM32H743/FML/motion_control.h | 2 ++
1 files changed, 2 insertions(+), 0 deletions(-)
diff --git a/STM32H743/FML/motion_control.h b/STM32H743/FML/motion_control.h
index b68899b..dfc0d3c 100644
--- a/STM32H743/FML/motion_control.h
+++ b/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; /* 鐩爣鐐规槸鍚︽湁鏁� */
@@ -77,6 +78,7 @@
HIDO_UINT32 nearest_index; /* 鏈�杩戣矾寰勭偣绱㈠紩锛堢紦瀛橈級 */
HIDO_UINT32 lookahead_index; /* 鍓嶈鐐圭储寮曪紙缂撳瓨锛� */
float last_heading_err; /* 涓婁竴鍛ㄦ湡鑸悜璇樊 (rad) */
+ float last_turn_sign; /* 涓婁竴鍛ㄦ湡閫夋嫨鐨勮浆鍚戞柟鍚戯紙-1/0/+1锛� */
float heading_err_d; /* 淇濈暀瀛楁锛氳埅鍚戣宸井鍒� */
float progress_m; /* 绱閲岀▼ (m锛屽彲鎵╁睍) */
} MC_State;
--
Gitblit v1.10.0