chiyu1468
/
AirTrapMine
2
0
Fork 1
Code Issues Pull Requests Packages Projects Releases Wiki Activity
214 Commits
6 Branches
0 Tags
6.0 MiB
master
wenchun
chiyu
chiyuTemp
lunu
ken
Branches Tags
${ item.name }
Create tag ${ searchTerm }
Create branch ${ searchTerm }
from '6ef7d3a7a6'
${ noResults }
Commit Graph

32 Commits (6ef7d3a7a6d9282fa9813e5b1a961c68fc2f01c0)

Author SHA1 Message Date
wenchun 6ef7d3a7a6 feat(GUI): 交戰任務編排器 MissionOrchestrator（S0-S2 + 高度分層/前置攔截/速度比例限速） 
在既有 MissionExecutor 之上加一層「任務大腦」，串起 ABC 對抗流程：
A 組偵察 → 偵測敵機 → 手動確認重編隊 → A+B 四機前進追敵 → 足夠近展開包圍。
全部落在 src/GUI/。

新增 mission_orchestrator.py：
- MissionOrchestrator 階段狀態機 IDLE→WATCH→DETECTED→PURSUE→ENCIRCLE。
- PURSUE/ENCIRCLE 用「瞬時隊形」而非路徑跟隨（每 tick 給每台目標點），
  修掉移動目標下 wp_index 歸零 + follower 外推造成的往返振盪。
- 偵測 latch（≤R_detect 持續 dwell）、moving-target 重算（位移≥2m 或封頂 1s）、
  切圓 hysteresis（R_engage=15 進、R_engage_exit=20 退）。
- 高度分層 _alt_for：A 組走上層、B 組走下層（不低於地面下限），
  PURSUE/ENCIRCLE 都套用 → 消掉同高度交叉撞機風險。
- 前置攔截 _aim_point：GPS 差分估敵速，瞄「敵位+敵速×lead_time」的攔截點，
  治純追尾追不上；敵機靜止時退化為瞄當下。
- EngagementPanel 交戰面板：敵機下拉、A/B 組下拉、即時距離讀數、階段顯示、
  重編隊/停止、以及「套用速度」（友機 V + 敵/友比例 r → DO_CHANGE_SPEED）。

mission_executor.py：加 complete_stops=False（hover-hold）+ update_plan()
（熱替換航點、保留 RUNNING 閉環狀態）。

communication.py：加 set_speed()（用共用 client 泛用方法發 DO_CHANGE_SPEED(178)，
維持 GUI-only scope）。

gui.py：新增「交戰」分頁、engagement timer(5Hz)、orchestrator 接線、
_on_engagement_apply_speed（友方下 V、敵方下 r×V、同步 friendly_speed）。

SITL 實測通過：高度分層 A/B 正確分開、前置攔截追得上、套用速度後追擊/包圍穩定收斂。

Co-Authored-By: Claude Opus 4.8 <noreply@anthropic.com>
 1 month ago
wenchun 8d65e92634 fix(GUI): 共用 command/position client 啟動預建，修切mode觸發的OOM/CPU暴衝 
實飛/SITL 對無人機下第一個控制指令（切 mode）時，python GUI 行程
CPU 衝到 112%、記憶體一路爬向 30GB 被 OOM killer 幹掉。

根因（切 mode 是執行期第一個走 get_or_create_client 的動作）：
- get_or_create_client / get_or_create_position_client 原本 per-drone
  於執行期新建 ROS2 node 並 executor.add_node()。
- CPU：add_node 從 asyncio/Qt 執行緒呼叫，同時 _ros_spin_thread 在另一
  執行緒 spin_once 同一個 SingleThreadedExecutor → wait set 損毀 → 空轉。
- 記憶體：執行期新建 node = 新 DDS participant，discovery 撞壞封包 →
  FastRTPS bad_alloc。解釋了「開機沒事、切 mode 才炸」。

兩個 client 都只打單一 service（send_command_long / pos_global_int），
靠 request 的 target_sysid 路由、無 per-drone 狀態 → 每台一個節點無意義。

修法：改成「共用節點 + 啟動預建 + 執行期只重用」。
- communication.py: 兩個 per-drone dict → 單一 command_long_client /
  position_target_client；新增 init_shared_command_clients()；
  get_or_create_*(drone_id=None) 回傳共用 client（僅留一次性 lazy fallback）。
- gui.py: executor 設好後、spin thread 啟動前於主執行緒預建；cleanup 改
  銷毀兩個共用節點。

飛行中不再新建 participant + add_node 不再跨執行緒 → 兩症狀同時消。
SITL 切 mode 實測不再暴衝。

Co-Authored-By: Claude Opus 4.8 <noreply@anthropic.com>
 1 month ago
wenchun 4e476f80f6 fix(GUI): 多機跑點閉環化，解決實飛只有一台跑點的問題 
根因：adapter 的 pos_global_int service 被序列化(預設 mutually-exclusive
callback group) + 阻塞等 msg87 echo。實飛慢速鏈路下多機序列化，只有頭一台
能在 client timeout 內拿到 echo，其餘被判失敗 → 重試 → fallback LOITER 停飛。
(SITL echo 快故全過)。指令其實在等 echo 前就已送達飛控。

閉環改法(全在 src/GUI/，繞過 adapter 瓶頸)：
- mission_executor: 每點只送一次 → 每 resend_interval_sec(預設2.5s) 週期性
  重送當前 setpoint(GUIDED 目標冪等，掉包自癒)；換點純靠 GPS 到達判定；
  _on_send_result 降級為觀測，不再累計失敗切 LOITER。
- command_sender: Ros2CommandSender echo timeout 2.0→0.5s，echo miss 快速
  放棄換下一台，避免序列化塞爆 client poll。
- gui: 建構子接 resend_interval_sec。

順帶：總覽表新增「任務狀態」列，每台一格即時顯示 WP 進度 + 通訊狀態
(送出OK/送出未驗證/等待同伴)，實飛可一眼分辨哪台通訊不穩 vs 卡住；
此列獨立保存，不被遙測 refresh 蓋掉。

SITL 驗證通過。

Co-Authored-By: Claude Opus 4.8 <noreply@anthropic.com>
 2 months ago
ken910606 79e95d7547 2.7.1 map movement 3 months ago
ken910606 f141311173 2.7.0 logs 3 months ago
wenchun ae984ecad4 refactor(GUI): 移除規劃路徑的死高度，不再把 GNSS 絕對高度餵進規劃 
_collect_drone_gps 原本把 drone_gps['alt']（GNSS AMSL）放進規劃輸入的 z，
但四種任務的指令高度一律取自 mission params，從不讀飛機回報的當下高度，
planner 與驗證視窗也都丟棄該 z。改填 0.0 placeholder、移除沒用的 base_alt
參數，讓「高度非規劃輸入」語意明確化；並移除 gps 更新路徑未使用的 alt 變數。
行為不變，SITL 四模式驗證通過。

Co-Authored-By: Claude Opus 4.8 <noreply@anthropic.com>
 3 months ago
wenchun 415aed088a fix: 修正實飛 Circle 高度爆衝與 Leader-Follower 卡點 
1. mavlinkROS2Nodes: position_gnss topic 改發 relative_altitude 而非 AMSL，
   讓 drone_gps['alt'] 在實飛與 SITL 都代表「相對 home 高度」
2. mission_planner: Circle stage1.z 改用 final_z（不再用 current_z 做中點插值），
   避免實飛時 current_z 是 AMSL 而把過渡高度衝到海拔值的一半
3. mission_executor: 到達判定改為 hover-stable（radius * 1.5 hysteresis +
   穩定計時），預設 arrival_radius 2→4m，解決實飛 GPS 抖動永遠進不了
   2m radius 的卡死問題
4. mission_executor: 新增 progress log，每 3 秒印一行距離與穩定度，
   方便實飛 debug 卡點問題
5. mission_group + gui: 暴露 arrival_radius / hover_stable_sec 給 GUI 任務參數面板，
   每次 start 重讀以支援中途調整

Co-Authored-By: Claude Opus 4.7 <noreply@anthropic.com>
 4 months ago
ken910606 5231cffcb2 Update GUI 2.6.0: trajectory, color, window, serial JSON 4 months ago
ken910606 c75537a977 Update GUI 2.5.0: Drone reboot 4 months ago
ken910606 003f8988c5 Update GUI 2.4.1 4 months ago
ken910606 d2aef78a4b Update GUI 2.4.0: GPS Status 4 months ago
ken910606 0b41ea0a1e Update GUI 2.3.1 4 months ago
ken910606 d2a5f6fad7 Update GUI 2.3.0: JSON in Serial 5 months ago
wenchun 730c3e2420 feat(GUI): 新增模擬驗證滑動開關（ToggleSwitch） 
在清除軌跡按鈕左邊加入滑動開關，可控制執行任務時是否開啟 matplotlib 驗證視窗。
預設開啟，OFF 時跳過驗證。

Co-Authored-By: Claude Opus 4.6 <noreply@anthropic.com>
 5 months ago
ken910606 1426a618f4 Update GUI 2.2.0: Settings tab 5 months ago
ken910606 edd15df3fc Update GUI 2.1.0: logs history tab, drone panel attitude, linear twist overview 5 months ago
ken910606 be52c4bd22 Update GUI 2.0.8 group selected list 5 months ago
ken910606 b9d6e0e2e0 Update GUI 2.0.7 group selected list 5 months ago
wenchun 0edc477df8 feat(mission): virtual-leader path following + 固定領隊 + barrier 
- mission_planner: Leader-Follower 改用 arc-length 參數化（virtual
  leader），_build_center_path 以同心圓弧連接直線段，銳角退化成 hover
  單點並在該點放 rendezvous barrier，避免暴衝與編隊交叉
- mission_planner: rank 改以輸入順序為準，不再對投影排序，避免浮點噪音
  導致 run-to-run leader 漂移
- mission_group / gui: 新增 leader_drone_id 與「領隊」下拉選單，handle_
  route_confirmed 把指定領隊重排到 rank 0，整個縱隊順序固定如軍隊行進
- mission_executor: rendezvous barrier 釋放邏輯、fallback LOITER、send
  retry；加 barrier_timeout 保護
- command_sender / communication / navigation: 配合 setpoint 送達與
  Ros2 bridge 更新

Co-Authored-By: Claude Opus 4.6 <noreply@anthropic.com>
 5 months ago
ken910606 fc00ecb762 Update GUI 2.0.6 components and longCommand 5 months ago
ken910606 fc2c642d6c Force sync local master to remote ken 5 months ago
ken910606 2c38376f9c Update master with local 2.0.5 5 months ago
ken910606 20e8397f5a Update master with local 2.0.4 5 months ago
ken910606 f28dcca361 Update master with local 2.0.4 5 months ago
ken910606 f34693a400 longCommand 6 months ago
ken910606 989d3ad2d2 Update GUI 2.0.2 from local 6 months ago
ken910606 a1efcf5664 Update GUI 2.0.1 from local 6 months ago
ken910606 a303a3538e Update GUI 2.0.1 from local 6 months ago
ken910606 cb58ba2121 Update GUI 2.0.1 from local 6 months ago
ken910606 71321d4839 Update GUI 2.0.0 from local 6 months ago
wenchun c2196153ff feat: 多任務群組系統 — 四欄式面板、地圖框選分配、可調參數 
- 新增 mission_group.py：MissionGroup 資料結構、DroneAssignDialog、GroupPanel
- GroupPanel 四欄式佈局：控制指令 / 任務規劃 / 任務參數 / 選取與分組
- 任務參數欄依任務類型動態切換（間距、高度、偏移量等），規劃時從 UI 讀值
- 框選/全選可直接分配無人機到群組，清除分組一鍵重置
- 地圖清理：移除右下角 overlay，功能整合至 GroupPanel
- 修復 JS clearSelectionMode 引用已移除元素導致框選/Grid Sweep 失效
- 每群組獨立 MissionExecutor，共用 MavlinkSender

Co-Authored-By: Claude Opus 4.6 <noreply@anthropic.com>
 6 months ago
ken910606 2937610938 Merge GUI 1.0.1 from ken 6 months ago