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

214 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
Chiyu Chen fd949fca47 (modify) serialManager.py 
- 修正 POLL-DONE 程序的 timeout 判定方式
- 修正為 py3.8 語法
- 不在判定要求量跟實收量一致性
 3 months ago
Chiyu Chen d734a7bfee 完善Xbee新功能整合到 mainOrchestrator 
- Added support for a new XBee communication type (XBee(API-API) espv1) in mainOrchestrator.py.
- Changed logging level for publisher creation in mavlinkROS2Nodes.py from info to debug for improved verbosity.
- 移除 mainOrchestrator 啟動時的版本檢驗 改為用 logger 紀錄
- Py3.8 語法修正
 3 months ago
Chiyu Chen 4c3fe226d6 Update serialManager.py to support XBEE new mode (combine ESP32 function) 
- Introduce XBeeFrameProcessor_ESPv1 class for handling send and process special MAGIC header for esp32
- Refactored request_discovery and request_poll methods for thread-safe operation.
 3 months ago
Chiyu Chen ab616ceb54 add vehicleDiagShow.py for vehicle diagnostics 
- Introduced vehicleDiagShow.py, 這個簡易的終端機介面 顯示載具的自檢驗與狀態
 3 months ago
Chiyu Chen bc841156cb Merge branch 'chiyu' 3 months ago
Chiyu Chen 324fced754 Enhance mavlink handling and add status text support 
- Added handling for SYS_STATUS and STATUSTEXT messages in mainOrchestrator.py and mavlinkObject.py.
- Introduced a new StatusTextEntry data class in mavlinkVehicleView.py to manage status text messages.
- Updated topic management in mavlinkROS2Nodes.py to include new status text functionality.
 3 months ago
Chiyu Chen 0a84bb68fe Add SystemDiagnostics message and integrate into network adapter 
- Added SystemDiagnosticsRaw.msg to define system diagnostics data structure.
- Enhanced mainOrchestrator.py and mavlinkObject.py to handle SYS_STATUS messages and publish system diagnostics.
- Introduced a new method in VehicleStatusPublisher to publish system diagnostics data.
- Updated mavlinkVehicleView.py to include SystemDiagnostics data class.
 3 months ago
wenchun d15c2d0a2d chore: 忽略 MAVProxy/SITL 產生的 tlog 與參數 dump 
誤在專案目錄開 SITL 會產生 mav.tlog / mav.tlog.raw / mav.parm，
加入忽略規則避免誤入版控。

Co-Authored-By: Claude Opus 4.8 <noreply@anthropic.com>
 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 32aa489462 revert: 還原 mavlinkROS2Nodes 高度發布改動，回到 GUI-only 修改範圍 
415aed0 為修 Circle 高度爆衝曾把 position_gnss topic 改發 relative_altitude
（GUI 外的 ROS2 node），違反「修改只動 src/GUI/」的範圍規則。還原回發
AMSL（pos.altitude）。Bug A 的實際修法在 GUI 端（mission_planner stage1.z
改用 final_z）仍保留，故還原後 Circle 高度問題不會復發；後續高度 debug 一律
在 GUI 內處理（需相對高度時讀 NED local_pose z，不讀 drone_gps['alt']）。

Co-Authored-By: Claude Opus 4.8 <noreply@anthropic.com>
 3 months ago
Chiyu Chen cc9d005392 (update) ntrip_client.py 
Introduced threading locks and stop event for safer socket management. Updated the receive loop to handle connection interruptions.
 3 months ago
Chiyu Chen 2c7f2afc45 (Add) ntrip_client.py GGA sentence generation and sending 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
Chiyu Chen 0ee7dd1fcf (hot_fix) 
1. 把測試用參數關閉
2. 修正錯誤回傳值
3. 臨時加入 node 失效後 自動重啟功能
 4 months ago
Chiyu Chen 61e283cd25 node重啟功能 與 定義檔優化 
---
(Adding)
1. mavlinkROS2Nodes.py 各別 node 重啟的功能
2.  mainRochestrator.py 開發對應介面
(modify)
 1. 定義檔優化 移除 ackEnum.py 新增 ServiceAckResult.msg
 4 months ago
ken910606 4e08b18a03 Update GUI 2.5.0: Drone reboot 4 months ago
ken910606 81de964778 Merge branch 'master' of http://140.120.108.238:49308/chiyu1468/AirTrapMine 4 months ago
ken910606 c75537a977 Update GUI 2.5.0: Drone reboot 4 months ago
wenchun 8c62f891a8 fix(GUI): 修正實飛三個關鍵 bug — 高度偏移累加、Leader-Follower 不動、起點重疊 
1. mission_planner: origin_alt 固定為 0，避免 GPS 橢球高度疊加到相對高度指令
2. mission_planner: 移除圓弧插值，直接用路徑點作為航點，消除微航點導致飛控無法執行
3. mission_planner: lookup 改為外推（extrapolate），解決偶數 rank 起終點重疊
4. communication: UDP/Serial 的 GLOBAL_POSITION_INT 補上 relative_alt 欄位

Co-Authored-By: Claude Opus 4.6 <noreply@anthropic.com>
 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
Chiyu Chen 5c14c45823 # RTK function update 
---
1. mavlinkROS2Node 新增 RtcmRelay Node 監聽 RTCM topic 並轉發到 mavlinkObject bus (GPS_RTCM_DATA)
2. 新增 fc_network_module ros2 package 作為協同附屬模組的放置空間
3. Create a new fc_network_module with NtripClientNode for connecting to NTRIP casters and publishing RTCM data to ROS2 topics.
4. (modify) mainOrchestrator adjust the publishing rates for GNSS topics
 4 months ago
Chiyu Chen c8f070bfb9 1. (modify) 更新 ros2 對於 GNSS topic 的發佈, 使其包涵 epv eph 衛星數與 fix_type 
2. (adding) 新增相應的 msg 檔案與修改 CMakeLists, package
3. (adding) test_vehicleStatusPublisher 相對應修正
 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
Chiyu Chen 7f8babfa5e (update) 
1. mavlinkROS2Nodes.py 更新姿態發佈的 topic
2. 新增 interface AttitudeRaw 與對應的 package.xml & CMakeList
 5 months ago
lenting89 75d9d260e1 add esp32 and udptest8-2 to unitdev04 5 months ago
lenting89 b720bb6ffd Merge branch 'lunu' 5 months ago
Chiyu Chen 38d8d23514 Merge branch 'chiyu' 5 months ago
Chiyu Chen cc00427848 # (update) 
1. serialManager.py - AT command 支援與架構重整
2. mainOrchestrator.py - serial 介面功能開啟
 5 months ago
lenting89 6ef06e7cb7 Merge branch 'lunu' of http://140.120.108.238:49308/chiyu1468/AirTrapMine into lunu 5 months ago
lenting89 1cb818b3a3 Merge branch 'master' into lunu 5 months ago
lenting89 415cf1585f update before merging 5 months ago
Chiyu Chen 7b7e02a9e7 (update) serialManager: 增加 AT 指令處理功能與串口寫入支持，更新版本號至 0.80 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
Chiyu Chen 06463d71bc (modify) serialManager 架構調整 詳見改版記錄 5 months ago
Chiyu Chen 7ce094d211 (temp) 整理檔案與註解 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
wenchun 5c0d21fc1d Merge remote-tracking branch 'origin/master' into wenchun 5 months ago
wenchun 3483864a2e chore: 移除無關的模擬資料檔與 README 過時段落 
刪除歷史 merge 夾帶進來的 obstacles_data.mat 與 uav_simulation_data.mat
（屬於另一個研究的資料，與本專案無關），並移除 README 末尾 0328 的
test_transform / close_loop 敘述。

Co-Authored-By: Claude Opus 4.6 <noreply@anthropic.com>
 5 months ago