喬夢甜,冀保峰,2,吳文樂,范世朝,李 鵬

(1.河南科技大學(xué),信息工程學(xué)院, 河南 洛陽 471023; 2.電子科技大學(xué)航空航天學(xué)院,四川 成都 611731;3.西藏民族大學(xué),信息工程學(xué)院,陜西 咸陽 712082)

0 前言

依托方便的人機交互功能，目前無人機技術(shù)涉及的范圍極廣。本文基于用戶需求設(shè)計一款基于ARM Cotex-M3內(nèi)核的STM32F106ZET6開發(fā)板，讀寫數(shù)據(jù)更高效，采用串級PID算法，提高無人機在自然環(huán)境下的自適應(yīng)能力。從機械結(jié)構(gòu)、電路設(shè)計和軟件控制方面設(shè)計微型四旋翼無人機，在傳統(tǒng)的算法基礎(chǔ)上運用四元數(shù)法和串級PID進行優(yōu)化。

1 四旋翼無人機的總體設(shè)計方案

四旋翼無人機是在傳統(tǒng)螺旋槳式直升機的基礎(chǔ)上發(fā)展起來的新型結(jié)構(gòu)，通過四個功率大小相同、距離相等對稱分布的電機以及固定在電機上半徑和構(gòu)造都相同的槳葉相互配合，實現(xiàn)在六個自由度上任意變換飛行姿態(tài)和位置，屬于經(jīng)典欠驅(qū)動系統(tǒng)[1]。目前有“+”和“×”兩種不同機械結(jié)構(gòu)的四旋翼，“×”型系統(tǒng)需要四個電機同時協(xié)調(diào)運作才能達到飛行的穩(wěn)定性，對控制算法的精確度要求太高不易實現(xiàn)，故大都采用“+”型系統(tǒng)。利用可充電型3.7 V動力性鋰電池為各個模塊提供穩(wěn)定的3.3 V和5 V的電壓，并通過OLED顯示屏將無人機飛行的高度、偏角、速度和PID參數(shù)進行動態(tài)顯示，通過NRF24L01無線通信模塊將檢測數(shù)據(jù)傳回遙控器上的OLED顯示器，完成人機交互[2]。

圖1 四旋翼無人機總體架構(gòu)

2 系統(tǒng)硬件電路設(shè)計

2.1 微控制單元

STM32開發(fā)板作為一款功能強大，讀寫速度高的核心微處理器，采用3.3 V供電，它本身并不能單獨工作，必須由晶振時鐘、復(fù)位電路、電源和串口下載接口構(gòu)成最小系統(tǒng)單元才能工作，提供多路輸入輸出。此系列的開發(fā)板具有112個GPIO端口、512字節(jié)FLASH、64位RAM，3個SPI和2個IIC總線接口，數(shù)據(jù)處理速度快，工作效率高，定時器的高級設(shè)計完全滿足項目需求。本實驗選用的晶振是8 MHz為核心單元提供系統(tǒng)時鐘。

2.2 電源管理模塊

電源管理模塊作為整個系統(tǒng)的能源端口，必須給各個模塊提供穩(wěn)定有效的電壓，在此本文選擇的是可重復(fù)充電提供穩(wěn)定3.7 V的動力型鋰離子電池。而姿態(tài)采集、無線通信模塊等都是采用3.3 V供電,因此需要通過XC6204將3.7 V的電池電壓降為3.3 V。為了給串口和OLED模塊供電，必須要將3.3 V利用升壓LM2940模塊變?yōu)?.2 V，再通過TPS7350做降壓處理。

2.3 姿態(tài)采集模塊

為了實時獲取無人機在飛行過程中的俯仰、偏航和橫滾的飛行姿態(tài)，本文決定選用集三軸加速度傳感器和三軸陀螺儀為一體的六軸姿態(tài)MPU6050芯片，該芯片由3.3 V電源供電，可以有效消除在分開安裝的情況下由于兩個坐標(biāo)軸不完全一致導(dǎo)致的誤差，進而造成角度測量誤差，便于數(shù)據(jù)歸一化處理和姿態(tài)融合，而且MUP6050留有一個從機IIC接口，方便連接數(shù)字羅盤，實現(xiàn)主從結(jié)合，共用一條傳輸數(shù)據(jù)線，節(jié)省了微處理器的IIC接口，而且獲取的姿態(tài)解算數(shù)據(jù)更加準(zhǔn)確高效。

圖2 電源管理模塊電路圖

圖3 姿態(tài)采集模塊電路圖

圖4 無線通信模塊電路圖

2.4 無線通信模塊

為了實現(xiàn)機身和地面接收機之間的數(shù)據(jù)收發(fā)，本文選擇了在通信傳輸領(lǐng)域應(yīng)用最廣泛的NRF24L01芯片作為無線通信芯片，它是用3.3 V供電，可以直接與開發(fā)板引腳相連，實現(xiàn)高速全雙工同步通信，它的傳輸頻段為全球通用的2.4 GHz,具有高速低能的優(yōu)點。

2.5 電機驅(qū)動模塊

無刷電機依靠驅(qū)動器將直流信號變?yōu)槿嘟涣麟妬砜刂齐姍C轉(zhuǎn)速和轉(zhuǎn)向，其電路結(jié)構(gòu)比較復(fù)雜，會增加微型無人機的負荷，經(jīng)實際測量后發(fā)現(xiàn)，電機實際輸出和理論存在較大偏差[3]。有刷電機的結(jié)構(gòu)較為復(fù)雜，內(nèi)部電流的變化是靠電刷和換相器的協(xié)調(diào)運作實現(xiàn)的，電機轉(zhuǎn)速的大小只與硬件電路中電流的大小有關(guān)，開發(fā)板控制起來比較方便，誤差較小。在3.7 V的電源下可以正常工作，滿足對電流和轉(zhuǎn)速的要求，故本文選用有刷空心杯電機。電流式驅(qū)動方法是首先考慮的，在測試電機轉(zhuǎn)速時發(fā)現(xiàn)存在門限效應(yīng)，一旦提高到某一閾值，電機就無法提速，三極管電流就不再線性變化，產(chǎn)生失真，這說明傳統(tǒng)BTN的驅(qū)動能力已無法滿足電機對轉(zhuǎn)速的要求。故最終采用電壓式MOSFET驅(qū)動，實際上驅(qū)動電流可看作是由柵極和漏極、柵極和源極之間寄生電容的充放電過程產(chǎn)生的。在充電的瞬時狀態(tài)下，電容可以被看作為短路，將會產(chǎn)生比較大的電流[4]。

2.6 人機交互模塊

為方便對系統(tǒng)參數(shù)實時性監(jiān)控和修改，實現(xiàn)與PC端的通信，適應(yīng)不同高度、氣壓和風(fēng)速下的飛行，在機身上設(shè)計了按鍵、OLED屏顯示、蜂鳴器報警模塊以及USB口下載模塊。

3 軟件編程

3.1 PID及串級PID控制算法

采集到機身當(dāng)前姿態(tài)數(shù)據(jù)后，本文用PID算法對數(shù)據(jù)優(yōu)化。傳統(tǒng)PID算法便是通過系統(tǒng)產(chǎn)生的誤差來消除誤差，對過去誤差和當(dāng)前誤差進行比例微分積分加權(quán)去消除誤差值。但該方法的誤差值難以準(zhǔn)確獲得，且加權(quán)系數(shù)很難權(quán)衡。故本文采用三級串級PID控制算法。通過控制角度來控制速度，構(gòu)成“速度—角度—角速度”，將速度量轉(zhuǎn)換為角度量，再將角度量轉(zhuǎn)換為角速度量，由外到內(nèi)的三級串級控制系統(tǒng)。具體的實現(xiàn)方法如下：

首先，在調(diào)節(jié)串級控制系統(tǒng)的時候，內(nèi)環(huán)作為副調(diào)節(jié)器，目的是為了穩(wěn)定主變量而引入的輔助變量。所以需要先調(diào)節(jié)角速度環(huán)。先給定一個0目標(biāo)角速度，即角度環(huán)的輸出為0，增大P值，用手來回撥動機身，直到感覺到明顯阻力為止，再增大D值，直到阻力減弱并且感覺較為平緩為止，在此基礎(chǔ)上再增大P值，即完成角速度環(huán)的調(diào)試。

其次，調(diào)整角度環(huán)，給定目標(biāo)角度為機械零點的角度，逐漸增大P值，直至機身抖動為止，再增大D值，直到抖動消失，最后再增大一點P，即完成角度環(huán)的調(diào)試。串級系統(tǒng)的優(yōu)點在于加快了系統(tǒng)的響應(yīng)速度，且參數(shù)范圍大易于調(diào)節(jié)。由于副回路存在，系統(tǒng)的控制時間常數(shù)縮短，提高了系統(tǒng)的抗干擾，本文在調(diào)試過程中擬合的姿態(tài)角如圖5所示。

圖5 四旋翼無人機擬合姿態(tài)角變化圖

3.2 姿態(tài)解算

MPU6050將實時采集的原始姿態(tài)數(shù)據(jù)通過它本身自帶的DMP模塊，通過經(jīng)典四元數(shù)姿態(tài)解算法，直接得到角度四元組數(shù)據(jù)，簡化了大量數(shù)據(jù)和濾波操作，然后通過IIC總線傳回開發(fā)板。四元數(shù)法避免了原始歐拉角計算中對三角運算復(fù)雜的要求，通過四個基本元素將機身的旋轉(zhuǎn)姿態(tài)表示出來，利用方向余弦矩陣和坐標(biāo)軸的映射關(guān)系得到增量旋轉(zhuǎn)，融合后可獲得姿態(tài)角。在姿態(tài)角數(shù)據(jù)處理部分主要采用互補濾波法，消除信號采集的累積效應(yīng)和噪聲干擾?；パa濾波法和卡爾曼濾波法思想相同，都是通過線性加權(quán)得到。主要濾除加速度計在瞬時狀態(tài)下各個方向的電機機械振動產(chǎn)生的噪聲加速度，及陀螺儀隨時間累積推移積分產(chǎn)生的溫漂誤差，所以加速度計在連續(xù)時間積分時得到的數(shù)據(jù)可靠性高，而在瞬時狀態(tài)有較大的誤差，即在高頻情況下會產(chǎn)生較大的傾角誤差。而陀螺儀在較長時間積分的過程中即低頻會因為零點漂移產(chǎn)生較大的偏角誤差?；パa濾波是結(jié)合兩個傳感器的優(yōu)點，抑制加速度計在高頻下的作用，增大低頻比重，即低頻抑制高頻；相反，增加陀螺儀在低頻下的作用，而抑制高頻效果；兩者取長補短，選擇合適的加權(quán)系數(shù)，與互補濾波和串行PID相結(jié)合得到最優(yōu)角度[5]。調(diào)試結(jié)果如圖6所示。

圖6 四旋翼無人機通信傳輸仿真調(diào)試結(jié)果

4 結(jié)束語

本文所設(shè)計的硬件方案在實際操作中證明是可行的，通過姿態(tài)解算將六軸傳感器數(shù)值結(jié)合數(shù)字羅盤得到的高度值轉(zhuǎn)換為實際所需的數(shù)據(jù)值即四元數(shù)法。有效的結(jié)合互補濾波法和串級PID，濾除各種干擾項，盡可能減小誤差值。在自然條件下，微型四旋翼無人機可以完成各種姿態(tài)變換，得到的數(shù)據(jù)值也到達了平滑變化的效果。在無人機飛行過程中也可以與地面基站或者遙控器實現(xiàn)實時數(shù)據(jù)接收和交換，并做出快速應(yīng)答，這說明設(shè)計的微型四旋翼無人機可滿足各種控制和飛行要求。