宋玉春，唐途亮，吳創(chuàng)彬，劉思廣，宋鴻輝，謝國灝

（韶關(guān)學院物理與機電工程學院自動化系，韶關(guān) 512000）

基于MWC開源飛控軟件的航拍設(shè)計與實現(xiàn)

宋玉春，唐途亮，吳創(chuàng)彬，劉思廣，宋鴻輝，謝國灝

（韶關(guān)學院物理與機電工程學院自動化系，韶關(guān) 512000）

1　飛行器的工作原理

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

1.2四軸飛行器的飛行狀態(tài)

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

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

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

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

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

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

2　控制器硬件設(shè)計

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

圖2　X模式的四軸飛行器

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

圖3　MWC飛控板

MPU6050（圖4）是InvenSense公司生產(chǎn)的芯片，其內(nèi)部集成了三軸加速度計和三軸陀螺儀 （即三軸角速度計），其數(shù)據(jù)通過I2C來讀取相應地址獲得相應數(shù)據(jù)，同時可以設(shè)置適當?shù)牡屯V波頻率和陀螺儀采樣率來調(diào)節(jié)加速度計和陀螺儀的靈敏度。

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

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

圖5　磁力計HMC5883L模塊原理圖

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

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

圖6　氣壓計MS5611模塊原理圖

圖7　ATmege328P芯片控制原理圖

3　實時拍攝系統(tǒng)

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

同時，同時出于對于航拍穩(wěn)定性的要求，本設(shè)計將采取將攝像頭搭載在云臺系統(tǒng)中的方式保證航拍圖像的穩(wěn)定。

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

圖8　遠程即時監(jiān)控原理

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

圖9　參數(shù)調(diào)試界面GUI

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

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

4　調(diào)試

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

通過GUI調(diào)整好飛行器各項參數(shù)后，飛行能夠進行穩(wěn)定的飛行。本項目小組在飛行器能夠穩(wěn)定飛行的基礎(chǔ)上搭載云臺及攝像頭，在編寫適當?shù)某绦蛑笸ㄟ^5.8GHz的無線傳輸技術(shù)進行圖像的即時傳輸。

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

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

［3］周權(quán)，黃向華.四旋翼微型飛行平臺姿態(tài)穩(wěn)定控制試驗研究［J］.傳感器與微系統(tǒng)，2009：70-79.

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

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

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

［7］高珍，鄧甲吳，孫驥，宋崧．微型無人機圖像無線傳輸系統(tǒng)方案與關(guān)鍵技術(shù).北京理工大學學報，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-），男，遼寧凌源人，碩士研究生，副教授，研究方向為機器人技術(shù)、工業(yè)控制

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

吳創(chuàng)彬（1994-），男，廣東惠來人，韶關(guān)學院自動化系學生

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

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

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

2015-11-03

2015-12-03

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

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

韶關(guān)學院大學生創(chuàng)新創(chuàng)業(yè)訓練計劃立項項目（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.