無錫漢和航空自動駕駛飛行控制系統(tǒng)(APFC-1)簡介
Autopilot Flight Control System for Unmanned Helicopters

漢和航空無人直升機自動駕駛控制系統(tǒng)（APFC-1）是無錫漢和航空技術(shù)有限公司經(jīng)過多年艱苦研發(fā)，數(shù)千架次的試飛，與國內(nèi)外頂級專業(yè)研發(fā)機構(gòu)長期合作研發(fā)成功的一款用于工程無人直升機定制自動駕駛儀。APFC-1擁有完全的自主知識產(chǎn)權(quán),多項創(chuàng)新和專利技術(shù)。適合于不同大小的工程用無人駕駛直升飛機的自動駕駛。

APFC-1是一款集GPS/INS組合導航與自動飛行控制于一體化的產(chǎn)品。特別是對使用多沖程燃油發(fā)動機的無人直升機這類穩(wěn)定性差、高度耦合和高頻振動環(huán)境下，進行穩(wěn)定，可靠的控制，并實現(xiàn)在多種模式下自動導航飛行。

硬件技術(shù)上以系統(tǒng)的可靠性為設(shè)計的最高準則，采用工業(yè)級成熟的浮點型DSP、ARM控 制器芯片，各個模塊都有自己獨立的控制器進行工作，各種數(shù)據(jù)的輸入輸出都進行了有效的電路保護和隔離，考慮到多沖程燃油發(fā)動機的高頻振動，野外的環(huán)境和電 磁干擾等惡劣情況,傳感器采用了國外工業(yè)級,軍用級的產(chǎn)品，以獲得高精度、高可靠性的飛行狀態(tài)測量數(shù)據(jù)。系統(tǒng)預留多種串口、GPIO、PWM輸入/輸出外 部接口，方便用戶設(shè)備與飛控系統(tǒng)的集成。飛控計算機高達50Hz的解算和控制刷新率，為實現(xiàn)對無人直升機的高精度控制提供硬件保障。

導航技術(shù)上采用擴展卡爾曼濾波器（EKF）算法，對各類傳感器（高抗震性能的3軸 MEMS垂直陀螺、3軸加速度計、WMM算法的3軸磁場計、GPS、氣壓高度計、轉(zhuǎn)速傳感器）、操控輸入量等進行采集與深度融合處理，可精確的推算出位 置、速度、姿態(tài)、航向、角速率和加速度6維空間中修正的值，大大提高了導航數(shù)據(jù)的穩(wěn)定性與精度。為控制提供了可靠的數(shù)據(jù)來源。

控制技術(shù)上以系統(tǒng)的安全性為設(shè)計最高準則，采用先進PID控制方法，通過對漢和航空無人直升機平臺進行大量的實驗和掃頻數(shù)據(jù)進行分析，兼顧系統(tǒng)的安全性，操控性以及魯棒性的最佳參數(shù)配合。飛行控制過程中可應對外界對無人機的擾動，增強應付不確定性的能力。APFC-1具有對GPS信號丟失，數(shù)據(jù)鏈斷裂，電源監(jiān)控報警等緊急情況的處理功能，可以一鍵懸停，自動返航和失控保護等功能。

基于小型無人直升機動力學模型（SUHDM），結(jié)合計算機3D場景構(gòu)建了包含飛控計算機、舵機，地面控制站等硬件在整個系統(tǒng)的實時仿真環(huán)境，實現(xiàn)對飛行控制策略、控制邏輯的有效驗證，最大程度上確保飛控系統(tǒng)安全可靠。

APFC-1地面站采用基于Google Earth/InfoMap設(shè)計方案，飛行航路可以預先在Google Earth/InfoMap上簡單地設(shè)置，實現(xiàn)全自動飛行，同時飛行狀態(tài)信息通過無線電臺實時地傳送到地面站進行監(jiān)控，記錄和管理以及“第一人稱”飛行等功能。

      

APFC-1硬件實物                  APFC-1地面站界面               APFC-1仿真環(huán)境 
 

飛行控制
控制模式	遙控、指令導航、自動導航、自動返航、自動失控保護
飛行模態(tài)	定點懸停，定速/定高巡航，協(xié)調(diào)轉(zhuǎn)彎，斜爬升/盤旋爬升，增穩(wěn)起飛/降落，自動起飛/降落
控制距離	視數(shù)據(jù)鏈通訊距離和飛行任務半徑能力而定（默認5km）
航速	8-10 m/s（空速）
懸停定位精度	< 3m
航線精度	< 5m
速度控制精度	< 10%
抗風能力	< 5級
地面站
控制地面站	Windows系統(tǒng)，具備電子地圖、虛擬儀表、綜合顯示、指令面板、航路設(shè)定、狀態(tài)監(jiān)控和報警功能。
調(diào)試參數(shù)地面站	Windows系統(tǒng)，姿態(tài)，速度，位置等各環(huán)節(jié)控制參數(shù)，部分傳感器的精度的設(shè)置與讀取。
GPS（NovAtel OEMSTAR 10HZ）
定位精度	1.5 M  (單點定位L1)
數(shù)據(jù)更新率	10Hz
GPS天線	航空級天線
IMU
航向角范圍	±180 º
航向角精度	< 1 º （磁羅盤數(shù)據(jù),WMM融合校正）
橫滾角，俯仰角范圍	±180 º，±90 º
橫滾角，俯仰角精度	靜態(tài)< 0.3 º,動態(tài)<2.0º
姿態(tài)角速率	±200 º/sec
X,Y,Z加速度范圍	3g（標準），5g（大范圍）
氣壓計范圍	300－2000mbar
數(shù)傳電臺
工作頻率	902-928 MHz，
發(fā)送功率	Max 1W
供電電壓	6-30 Vdc
數(shù)傳距離	5-20 Km根據(jù)環(huán)境以及天線高度
接口
GPS天線	1通道
串口I/O	RS232 5通道，RS422 1通道
PWM輸入	10通道
PWM舵機輸出	9通道
電源
電源	12±2VDC
功耗	< 6w
工作溫度	-40－80℃
尺寸/重量
IMU	76(D) X 93(W) X 77(H)  650g  內(nèi)部減震
飛控計算機	81(D) X 110(W) X 41(H) 390g
外設(shè)控制器	71(D) X 75(W) X 25(H)  130g
GPS等采集器	55(D) X 82(W) X 23(H)  110g

APFC-1系統(tǒng)框架圖   

   
    全自動飛行視頻效果請點擊此鏈接：http://www.tudou.com/programs/view/fDSDltyYvE4/