调整档位参数及停止判断逻辑：档位重划分并新增LEVEL_5，中位停止仅判diff1~3，放宽高度限位校零条件

2026-09-04 11:28:05 +08:00
parent 26cccd60a0
commit 18ebcb7c10
3 changed files with 105 additions and 64 deletions
@@ -10,7 +10,7 @@
 #define		FOLLOW_VPT			10
 #define		SHIELD_VPT			8000
 #define		EME_STOP_VPT		4000
-#define		CENTRE_VPT			8000
+#define		CENTRE_VPT			4000
 #define		CENTRE_SHIELD_VPT			2000

 #define 	STOP_TIME_MS		500