四旋翼反恐飛行器設(shè)計

顧臣務(wù)+紀(jì)延俊+宋海洋

摘要：以ARM系列的STM32處理器為主控制器對四個電機(jī)調(diào)速器進(jìn)行控制，用電調(diào)電路調(diào)節(jié)無刷直流電機(jī)的轉(zhuǎn)速，模擬四旋翼飛行器模型。通過實驗、調(diào)試等手段確定了最符合模型樣機(jī)的姿態(tài)控制算法，從而實現(xiàn)飛行器的平衡和姿態(tài)控制。在飛行器上搭載微光攝像頭，從而實現(xiàn)對夜間或陰暗環(huán)境的檢測。飛行器可通過遙控飛行，同時將拍攝的視頻或圖片發(fā)送到控制室，也可發(fā)送警報，實時追蹤，大大增加了飛行器的利用率。

關(guān)鍵詞：四旋翼飛行器；實時監(jiān)測平臺；電機(jī)控制；姿態(tài)解算

中圖分類號：G642.0 文獻(xiàn)標(biāo)志碼：A 文章編號：1674-9324（2016）51-0068-02

一、引言

小型四旋翼飛行器在遠(yuǎn)程偵察、監(jiān)控、軍事等領(lǐng)域具有巨大的優(yōu)勢，在無人機(jī)應(yīng)用與實驗領(lǐng)域，小型四旋翼無人機(jī)被認(rèn)為是最好的平臺。目前世界上的四旋翼飛行器基本都是微小型無人飛行器，可分為三類：遙控航模四旋翼飛行器、小型四旋翼飛行器以及微型四旋翼飛行器[1]。遙控航模四旋翼飛行器的典型代表是美國Draganglyer公司研制的Draganglyer3，它主要用于航拍[2]。其機(jī)載電子設(shè)備采用了碳纖維和高性能塑料作為機(jī)體材料，電子設(shè)備可控制四個電機(jī)的轉(zhuǎn)速，另外電晶體螺旋儀進(jìn)行姿勢控制。

小型四旋翼飛行器的研究方向主要在三個方面，分別是基于慣導(dǎo)的自主飛行控制，基于視覺的自主飛行控制，和自主飛行器系統(tǒng)方案[3]，其最典型代表分別是：瑞士洛桑聯(lián)邦科技學(xué)院的OS4，賓夕法尼亞大學(xué)的HMX4和佐助亞理工大學(xué)的GTMARS[4]。OS4是EPFL自動化系統(tǒng)實驗室開發(fā)的一種小型四旋翼飛行器研究重點是機(jī)構(gòu)設(shè)計方法和自主飛行控制算法。HMX4在結(jié)構(gòu)上與Draganglyer3相似，使用的控制算法是Backstepping。GTMARS是佐治亞理工大學(xué)面向火星探測任務(wù)二設(shè)計的CAD無人機(jī)系統(tǒng)[5]。

本文設(shè)計了一種小型四旋翼飛行器，并讓飛行器搭載微光攝像頭，從而能在夜間或陰暗環(huán)境下進(jìn)行航拍監(jiān)控，應(yīng)用于車站、廣場、小區(qū)等大多數(shù)人口相對密集的場所，自動巡邏，進(jìn)行反恐監(jiān)控，飛行器能將拍攝的視頻或圖片發(fā)送到控制室，也可以通過遙控控制飛行器的飛行，大大增加了飛行器的利用率。

二、飛行器系統(tǒng)設(shè)計

1.空間模型設(shè)計。由于四旋翼飛行器就實際來說是一個非線性高耦合欠控制的系統(tǒng)，在建立數(shù)學(xué)模型時往往會忽略某些外界不穩(wěn)定因素以及旋翼之間的相互作用等難以精準(zhǔn)描述的影響[6]，因此要建立一個較為理想的動力學(xué)模型。

首先定義平面坐標(biāo)系，地坐標(biāo)系與機(jī)身坐標(biāo)系，如圖1，（a）中α表示偏航角，（b）中β表示俯仰角，（c）中θ表示翻滾角，其中地坐標(biāo)系為以地面某個參考點為原點的靜止笛卡爾坐標(biāo)系，機(jī)身坐標(biāo)系為以四旋翼飛行器的幾何中心為原點的動坐標(biāo)系。

2.控制系統(tǒng)設(shè)計。本文所設(shè)計的四旋翼飛行器控制系統(tǒng)由五部分構(gòu)成，如下頁圖2所示。（1）ARM系列的STM32微處理器，它用來控制整個系統(tǒng)的運(yùn)行，STM32系列處理器具有12位A/D轉(zhuǎn)換器、D/A轉(zhuǎn)換器、多通道的PWM定時計數(shù)器、異步串行口、UART、I2C、總線模塊等接口電路[7]。（2）動力系統(tǒng)，包括4套電子調(diào)速器、無刷直流電機(jī)和螺旋槳。動力系統(tǒng)采用直流無刷直流電機(jī)。直流無刷電機(jī)具有力矩大、質(zhì)量輕等特點，用非接觸式的電子換向方法，消除了電刷磨損，較好地解決了傳統(tǒng)直流有刷電機(jī)的缺點[8]。（3）傳感器部分，使用MM6050加速度傳感器作為角度傳感器。（4）遙控部分，包括地面遙控器和無線通信模塊。WiFi作為收發(fā)電路，地面遙控器發(fā)送加速、啟動、減速、停止等命令。（5）電源系統(tǒng)，系統(tǒng)以11.8V的航模鋰電池作為電源供應(yīng)，為控制器、方向傳感器、陀螺儀、電子調(diào)速器、無刷直流電機(jī)提供直流電源。

三、實物測試

采用十字四旋翼飛行方式，由攝像頭及其外設(shè)電路產(chǎn)生WiFi區(qū)域網(wǎng)，通過終端連接WiFi即可實時監(jiān)控地面狀況，模塊化有利于避免沖突和誤判。圖3為攝效果實測圖。

四、結(jié)束語

本文所設(shè)計的小型四旋翼飛行器系統(tǒng)，以STM32為控制核心，采用MM6050實時采集飛行器飛行過程中姿態(tài)信息，通過控制無刷直流電機(jī)來提供飛行器的飛行動力，可以實現(xiàn)按規(guī)定路線巡邏，以及終端控制飛行和報警。另外，該小型四旋翼飛行器的難點在于夜間的監(jiān)測，由于夜間拍攝光線不足，飛行高度需要降低，飛行難度上升，夜間航拍效果雖然不及白天，但是基本可見，能實現(xiàn)監(jiān)控效果。

參考文獻(xiàn)：

[1]宿敬亞，樊鵬輝，蔡開元.四旋翼飛行器的非線性姿態(tài)控制[J].北京航空航天大學(xué)學(xué)報，2011，37（9）：1054-1058.

[2]甄紅濤，齊曉慧，李杰，等.四旋翼無人機(jī)L1自適應(yīng)塊控反步姿態(tài)控制器設(shè)計[J].控制與決策，2014，（6）：1076-1082.

[3]張鎮(zhèn)，李浩.四旋翼飛行器模糊姿態(tài)控制[J].計算機(jī)仿真，2014，（08）：73-77.

[4]呂國強(qiáng)，鄭德峰.四旋翼飛行器控制系統(tǒng)設(shè)計[J].價值工程，2014，（20）：213-213，214.

[5]趙述龍，安宏雷，劉建平，等.四旋翼飛行器模型的氣動參數(shù)辨識[J].電子測量與儀器學(xué)報，2013，27（8）：744-749.

[6]劉麗麗.四旋翼飛行仿真器的建模及控制方法的研究[D].中南大學(xué)，2009.

[7]孫鵬.微小孢無人良升機(jī)姿態(tài)控制及實驗研究[D].長沙：國防科技人學(xué)，2008.

[8]張嘉鐘，魏英杰，曹偉.飛行器動力學(xué)與控制[J].哈爾濱工業(yè)大學(xué)出版社，2011.

Design of Four Rotor Aircraft on Terror

GU Chen-wu，JI Yan-jun，SONG Hai-yang

（Institute of Aviation engineering，Bingzhou University，Bingzhou，Shandong 256600，China）

Abstract：The four motor speed regulators were controlled by ARM STM32 processor，the speed of brushless dc motor was adjusted by circuit，and the four rotor aircraft model was simulated. The attitude control algorithm of model prototype was determined by experiment，thus to realize the balance and attitude control of aircraft. A low light level camera was installed on the aircraft，so as to realize the detection of the night or dark environment. The aircraft flying through remote control can send video or photos to the control room at the same time，can send alarm and real-time tracking. This increases greatly the utilization of the aircraft.

Key words：four rotor aircraft；real-time monitoring platform；motor control；attitude algorithm