From 0eecf7ef207c371086dc58fe8c704a1eb0673743 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?=E4=B8=80=E5=96=B5?= <yimiao9036@outlook.com>
Date: Wed, 24 Jun 2026 14:37:59 +0800
Subject: [PATCH] =?UTF-8?q?2026.6.24=E5=AE=9E=E7=8E=B0=20QGC=5FWAYPOINTS?=
 =?UTF-8?q?=20=E2=86=92=20=E7=B3=BB=E7=BB=9F=E5=86=85=E9=83=A8=E8=88=AA?=
 =?UTF-8?q?=E7=82=B9=E6=A0=BC=E5=BC=8F=20=E7=9A=84=E8=BD=AC=E6=8D=A2?=
 =?UTF-8?q?=E9=93=BE=E8=B7=AF?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 run_mission.py | 13 +++++++------
 1 file changed, 7 insertions(+), 6 deletions(-)

diff --git a/run_mission.py b/run_mission.py
index fc4dc9c..efe849d 100644
--- a/run_mission.py
+++ b/run_mission.py
@@ -172,6 +172,7 @@ class MissionOrchestrator:
                 hold_time = wp.get("param1", 8.0)   # 悬停时间（如有）
 
                 x, y, z = latlon_to_ned(lat, lon, alt, ref_lat, ref_lon, ref_alt)
+                print(f"航点信息；{x}{y}{z}")
 
                 # 根据 MAV_CMD 类型构建内部航点
                 if cmd == 22:  # TAKEOFF
@@ -507,13 +508,13 @@ def main():
     # 允许命令行指定配置文件路径
     config_file = sys.argv[1] if len(sys.argv) > 1 else "./config.json"
 
-    waypoints = [
-            {'x': 1.0, 'y': 0.0, 'z': -1.5, 'yaw': 0},
-            {'x': 1.0, 'y': 1.0, 'z': -1.5, 'yaw': 90},
-            {'x': 0.0, 'y': 0.0, 'z': -1.2, 'yaw': 0},
-        ]
+    # waypoints = [
+    #         {'x': 1.0, 'y': 0.0, 'z': -1.5, 'yaw': 0},
+    #         {'x': 1.0, 'y': 1.0, 'z': -1.5, 'yaw': 90},
+    #         {'x': 0.0, 'y': 0.0, 'z': -1.2, 'yaw': 0},
+    #     ]
 
-    orchestrator = MissionOrchestrator(config_path=config_file,waypoints=waypoints)
+    orchestrator = MissionOrchestrator(config_path=config_file,waypoints=None)
     orchestrator.start()
     orchestrator.run()