基于MWC開源飛控軟件的航拍設計與實現

宋玉春，唐途亮，吳創彬，劉思廣，宋鴻輝，謝國灝

（韶關學院物理與機電工程學院自動化系，韶關 512000）

基于MWC開源飛控軟件的航拍設計與實現

宋玉春，唐途亮，吳創彬，劉思廣，宋鴻輝，謝國灝

（韶關學院物理與機電工程學院自動化系，韶關 512000）

1　飛行器的工作原理

四軸飛行器是4個電機驅動的一種飛行器。它的修正原理跟直立小車以及倒立擺都有很多類似的地方，例如都是通過陀螺儀與加速度計采回數據擬合成角度數據，供給系統計算后得到電機的修正量再轉化成電機輸出。這里我們暫且將飛行器、小車、倒立擺稱為對象，當對象處于平衡自穩狀態時，假設有一個外力使其向前傾，系統得到角度數據后轉化為電機輸出，對象向哪邊偏，電機便往哪邊輸出更多的占空比。就像我們用手托著一根木棒想使其平衡，當我們的眼睛看到木棒往哪邊倒，大腦變回控制我們的手部動作使其像傾倒的地方運動，來回運動從而實現平衡。在這里木棒就是我們的對象，大腦就像處理數據的系統，手掌則為執行機構，眼睛就可以當做角度采集的傳感器。

1.2四軸飛行器的飛行狀態

四軸飛行器按照電機軸的布置方式可分為十字模式和X模式，以下飛行狀態在X模式下討論。

上升與下降：當四個電機同時增大或減少輸出量時，飛行器便可上升或減少；

圖1　保持木棒平衡的反饋控制

前后及左右：當相鄰的兩個電機的輸出量大于另外兩個電機時，飛行器便可實現前后左右運動，運動方向為電機輸出較弱的一方；

旋轉：當四個電機轉速不完全相同時，不平衡的反扭矩會引起四旋翼飛行器轉動；

翻轉：當對邊的兩個電機轉速比另一邊的兩個電機大到一定程度時，飛行器變回翻轉。

2　控制器硬件設計

四軸飛行器由飛控板、電池、電調、電機、螺旋槳、機架和遙控器等基本部件組成。而飛控板為核心。除此之外，本項目還將搭載一臺攝像頭以及用于攝像頭穩定的云臺進行圖像采集。

圖2　X模式的四軸飛行器

本項目采用MWC開源項目的飛控板，其成品如圖3，主要有以下部分構成：主控芯片ATmega328P、加速度計和陀螺儀MPU6050、磁力計HMC5883L、氣壓計MS5611。

圖3　MWC飛控板

MPU6050（圖4）是InvenSense公司生產的芯片，其內部集成了三軸加速度計和三軸陀螺儀 （即三軸角速度計），其數據通過I2C來讀取相應地址獲得相應數據，同時可以設置適當的低通濾波頻率和陀螺儀采樣率來調節加速度計和陀螺儀的靈敏度。

HMC5883L（圖5）磁力計三軸磁阻傳感器和ASIC都被封裝在的LCC表面裝配中，12-bit的ADC與低干擾AMR傳感器能在±8高斯的磁場中實現5毫高斯分辨率，能讓羅盤航向精度精確到1°～2°。低工作電壓（2.16-33.6V）和低功耗（100μA）。內置驅動電路，帶置位/復位和偏置驅動器用于消磁、自測和偏移補償。同時使用I2C通訊手段。

圖4　加速度傳感器MPU6050模塊原理圖

圖5　磁力計HMC5883L模塊原理圖

MS5611（圖6）氣壓傳感器的通訊方式是SPI和I2C總線接口的氣壓傳感器，分辨率可達到10cm。該傳感器模塊包括一個高線性度的壓力傳感器和一個低功耗的24位數模轉換器。MS5611提供了24位數字壓力值和溫度值以及其他的操作模式，可以提高轉換速率并優化電流消耗。通信協議簡單，無需在設備內部寄存器編程。MS5611壓力傳感器本身尺寸較小可以集成在微型設備當中。

ATmega328P（圖6）芯片是高性能，低功耗的AVR （R）8位微控制器，具備2個8位定時器/計數器，具有獨立比較模式和預分頻器；1個16位定時器/計數器具有獨立預分頻器、比較功能和捕捉模式；實時計數器有6個PWM通道且有獨立振蕩器。

圖6　氣壓計MS5611模塊原理圖

圖7　ATmege328P芯片控制原理圖

3　實時拍攝系統

為了實現遠程即時監控，本文設計了一個四軸航模專用的視頻采集、圖像壓縮和無線傳輸系統。系統主要分為空中系統和地面系統兩部分。空中系統要求采集裝置安裝在四軸航模機身上，完成錄像與以5.8GHz無線技術完成圖像的無線傳輸。地面系統在地面上利用液晶顯示屏為主體，配合無線數據接受裝置與A/D，完成視頻的接受、顯示工作。四軸航模可由地面人員遙控飛行，整個系統運行時可將航模飛行地區的視頻信號實時傳輸給地面接收，受地面條件影響較小，可以無風險地監視人類無法進入或者難以進入的地方。其主要的工作原理如圖8。

同時，同時出于對于航拍穩定性的要求，本設計將采取將攝像頭搭載在云臺系統中的方式保證航拍圖像的穩定。

云臺系統能夠在飛行過程中削減飛行抖動對拍攝系統采集圖像穩定的影響。他能在系統發生傾斜時迅速做出分析處理保證拍攝系統的穩定。其基本原理是通過加速度傳感器采集云臺當前的狀態之后，跟標準狀態進行比較之后得到偏差，將此偏差通過云臺系統進行PID運算之后得到對應的修正量，再把修正量輸出到電機進行修正。

圖8　遠程即時監控原理

若需要把視頻接收并用PC處理的話，便需要把視頻信號數字化，無線接收模塊輸出的為PAL格式的模擬視頻信號，720×625的分辨率。視頻簡單地說就是活動圖像。模擬視頻信號解碼并量化成連續的數字視頻流后所包含的一些信號元素：模擬視頻信號每秒25幀，每幀周期40ms，而每幀又分為2場，每場20ms，先輸出的是奇場，然后是偶場，奇場的行號為第l至312．5行，偶場的行號為第312.5至625行，其中，奇場的第23.5至310行包含有效的視頻信號，偶場的第336至622．5行包含有效的視頻信號．把模擬視頻信號解碼為ⅥⅣ分量后，分別進行A/D量化樣，轉換為數字視頻流，時間上也應該是按上面的順序依次輸出。

圖9　參數調試界面GUI

主要的視頻壓縮算法包括：M-JPEG、Mpeg、H.264、Wavelet（小波壓縮）、JPEG2000、AVS。

H.264是一種高性能的視頻編解碼技術，視頻信號數字化后的數據量是驚人得，為了需要對圖像進行壓縮處理，可以嘗試采用H.264標準進行壓縮，更好地實現系統的實時性。

4　調試

飛行器在安裝完畢之后需要經過調試之后才可試飛。調試項目包括接收機與遙控器的對碼、電調油門行程校準、MWC飛控板的各項參數配置。飛控板的GUI界面如下，通過調整合適的參數保證飛行器在飛行過程的穩定。

通過GUI調整好飛行器各項參數后，飛行能夠進行穩定的飛行。本項目小組在飛行器能夠穩定飛行的基礎上搭載云臺及攝像頭，在編寫適當的程序之后通過5.8GHz的無線傳輸技術進行圖像的即時傳輸。

［1］劉煥曄.小型四旋翼飛行器飛行控制系統研究與設計［D］.上海：上海交通大學，2011.

［2］岳基隆，張慶杰，朱華勇.微小型四旋翼無人機研究進展及關鍵技術淺析［J］.電光與控制，2010-10，17（10）：40-50.

［3］周權，黃向華.四旋翼微型飛行平臺姿態穩定控制試驗研究［J］.傳感器與微系統，2009：70-79.

［4］劉慶，劉元盛.直升機模型航拍視頻采集傳輸系統的研制［D］.第十四屆全國青年通訊學術會議論文文集，2009.

［5］王冬來，呂強，劉峰.小型四軸飛行器動力學參數測定方法設計［J］.科技導報，2011，29（36）：42-45.

［6］劉榮科，張曉林．無人機載圖像實時傳輸方案的研究.北京航空航天大學學報，2002，28（2）：208-212.

［7］高珍，鄧甲吳，孫驥，宋崧．微型無人機圖像無線傳輸系統方案與關鍵技術.北京理工大學學報，2008，12：1078-1082.

Four Axis Aircraft；Aerial Photography；MWC；Open Source

Design and Implementation of Aerial Photography on Open Source and Aircraft Control MWC Software

SONG Yu-chun，TANG Tu-liang，WU Chuang-bin，LIU Si-guang，SONG Hong-hui，XIE Guo-hao
（Department of Physics and Electrical Engineering，Shaoguan College of Automation，Shaoguan 512005）

1007-1423（2015）36-0054-05

10.3969/j.issn.1007-1423.2015.36.013

宋玉春（1973-），男，遼寧凌源人，碩士研究生，副教授，研究方向為機器人技術、工業控制

唐途亮（1994-），男，廣東佛山人，韶關學院自動化系學生

吳創彬（1994-），男，廣東惠來人，韶關學院自動化系學生

劉思廣（1994-），男，廣東汕尾人，韶關學院自動化系學生

宋鴻輝（1996-），男，廣東湛江人，韶關學院自動化系學生

謝國灝（1994-），男，廣東湛江人，韶關學院自動化系學生

2015-11-03

2015-12-03

四軸飛行器可用于運輸貨物、拍攝、飛行研究、玩具等眾多領域，也是當前研究的一個熱門課題。介紹四軸飛行器的飛行原理、基本控制思路、調試、操縱，和低空拍攝的實現。然后以MWC開源飛控為設計核心，設計一套四軸飛行器的控制系統，并通過外圍模塊編寫適當的程序實現飛行器航拍的即時傳輸。由于四軸飛行器具有高度靈活性，所以使用它做載具可以代替人類輕易跨越復雜的地形進行航拍、實時采集信息。

四軸飛行器；航拍；MWC；開源

韶關學院大學生創新創業訓練計劃立項項目（No.201510576009）

The application of four axis aircraft to transportation，aerial photography，flight research，toy and in many other fields，is also a topical issue in the currently research.Discusses the flight principle，essential control conception，debugging and low-altitude photography of four axis aircraft.Designs a control system of four axis aircraft，which is based on the opened source and flight control of MWC and the instant transmission of aerial photography is programmed with peripheral module.With high flexibility，four axis aircraft takes place of human being used as a vehicle for aerial photography and information acquisition in the complex topography.