無人飛行器機載穩(wěn)定云臺控制系統(tǒng)的設計

王康南 鄭州外國語學校(河南鄭州 450001)，王利霞 鄭州輕工業(yè)學院(河南 鄭州 450002)

　　近些年來，無人飛行器在航空攝影、高空遙感以及高空地形勘探等領域得到了廣泛發(fā)展，機載穩(wěn)定云臺的其應用的關(guān)鍵所在[1-3]。但是在飛行過程中，云臺極易受到機體姿態(tài)變化、振動以及氣流擾動等因素的影響，從而造成機載圖像抖動、模糊[4]。針對這一問題，設計出一種適用于無人飛行器的機載穩(wěn)定云臺控制系統(tǒng)。該云臺系統(tǒng)采用了三軸穩(wěn)定結(jié)構(gòu)，控制部分由主控單元模塊、姿態(tài)檢測模塊、無刷電機驅(qū)動模塊等等構(gòu)成。主控單元通過對姿態(tài)檢測模塊反饋的數(shù)據(jù)進行互補濾波解算，驅(qū)動無刷電機對云臺姿態(tài)進行實時控制。通過對該云臺控制系統(tǒng)的測試與實驗，無人飛行器搭載該云臺后，機載視頻圖像更加清晰、穩(wěn)定，滿足了系統(tǒng)設計要求。

　　1 系統(tǒng)硬件方案設計

　　1.1總體方案設計

　　機載穩(wěn)定云臺控制系統(tǒng)主要是通過主控制器對機體擾動的隔離和對其他擾動的補償或抑制來實現(xiàn)載荷在慣性空間上的穩(wěn)定，從而使得地面站獲取到的機載視頻圖像穩(wěn)定且清晰。系統(tǒng)的結(jié)構(gòu)主要包括：主控單元、慣性測量單元、電機驅(qū)動單元、圖像傳輸單元、遙控器控制單元以及人機界面。其結(jié)構(gòu)框圖如圖1所示。

　　圖1 系統(tǒng)總體方案框圖

　　整個工作流程大致可以描述為機載云臺系統(tǒng)上電之后，對MEMS傳感器的初始姿態(tài)信息進行自校準，進行初始姿態(tài)信息的解算，驅(qū)動力矩電機對機載云臺調(diào)整到初始姿態(tài)位置，完成機載云臺的初始化過程。在飛行器的飛行過程中，根據(jù)傳感器的實時信息不斷對姿態(tài)信息進行更新，主控單元依據(jù)更新后的姿態(tài)信息不斷地調(diào)整機載云臺在慣性控制中的位置，保持光學載荷視軸的穩(wěn)定。光學載荷通過圖像傳輸鏈路和視頻采集卡實時地將機載視頻圖像傳輸?shù)降孛姹O(jiān)控系統(tǒng)，并在監(jiān)視設備中顯示。RC遙控器依據(jù)設定的工作模式，通過操作手的實時操作和RC控制鏈路對機載云臺進行控制，從不同角度對地面目標進行實時監(jiān)測。機載云臺系統(tǒng)工作的流程如圖2所示。

　　圖2 系統(tǒng)工作流程圖

　　1.2 主控單元設計

　　在本系統(tǒng)中，主控單元基于嵌入式微控制器STM32F103開發(fā)。主要功能是實時完成對MEMS傳感器獲取的姿態(tài)信息的融合，同時接收上位機或RC發(fā)來的指令，對俯仰、滾轉(zhuǎn)和偏航3個自由度的電機運動控制單元發(fā)送驅(qū)動指令，實現(xiàn)隔離機體姿態(tài)擾動、保持機載云臺在慣性空間中的穩(wěn)定以及RC控制操作。此外，還應具備與上位機進行人機交互，實現(xiàn)控制參數(shù)、電機配置、MEMS傳感器校正等基本設置。實現(xiàn)陀螺儀和加速計的補償、RC遙控模式和范圍的設定等高級設置以及MEMS傳感器實時數(shù)據(jù)的顯示等等。

　　1.3電機驅(qū)動單元設計

　　驅(qū)動單元起到的是功率放大的作用，即將主控處理器的控制信號轉(zhuǎn)換成可以直接驅(qū)動機載云臺直流力矩電機的功率信號。由于系統(tǒng)采用的直流力矩電機的堵轉(zhuǎn)電流為2 A，為了保證驅(qū)動安全，所選驅(qū)動芯片的最大輸出電流應大于4 A。因此采用ST公司生產(chǎn)的集成三項半橋驅(qū)動芯片L6234D，該芯片具有很強的驅(qū)動能力，其驅(qū)動電壓可達58 V，連續(xù)工作時的驅(qū)動電流可以達到5 A，具有過流保護和低電壓鎖存功能。圖3是俯仰通道的電機驅(qū)動單元的電路原理圖，滾轉(zhuǎn)與偏航通道的電機驅(qū)動單元與此類似。

　　圖3 電機驅(qū)動單元電路原理圖

　　1.4 慣性測量單元設計

　　整個系統(tǒng)中要求慣性測量單元(Inertial Measurement Unit，IMU)能夠提供控制算法中所需的角速度和加速度信號。此外，還考慮機載云臺結(jié)構(gòu)和安裝位置，要求角速度傳感器、加速度傳感器及其外圍電路的尺寸盡量小，便于整體結(jié)構(gòu)的緊湊?；谏鲜鲆?，采用6軸運動傳感器MPU6050作為慣性測量元件。IMU單元測量相機在三維空間中的角速度和加速度，并通過自適應互補濾波算法解算出相機的姿態(tài)。慣性測量單元的電路原理圖及電路實現(xiàn)如圖4所示。

　　圖4 MPU6050電路原理圖與電路板

　　2 系統(tǒng)軟件方案設計

　　2.1 主控單元軟件設計

　　主控單元軟件完成的主要功能有：對主控處理器I/O口、定時器、串行通信、IIC協(xié)議、MPU6050內(nèi)存儲器、位置參數(shù)、速度參數(shù)、控制參數(shù)以及中斷向量和優(yōu)先級進行初始化;確定機載云臺在慣性空間內(nèi)的坐標位置，輸出PWM信號驅(qū)動電機達到預先設定位置等。主控程序流程圖如圖5所示。

　　圖5主控程序流程圖

　　在每個控制周期內(nèi)，外部中斷子程序需要完成以下工作：(1)對陀螺儀和加速度計輸出信號進行采集;(2)根據(jù)RC指令，完成相應位置環(huán)的校正運算;(3)完成速度環(huán)和穩(wěn)定環(huán)的校正運算;(4)執(zhí)行PID控制算法;(5)生成PWM信號驅(qū)動直流電機。因此，外部中斷子程序流程如圖6所示。

　　圖6 外部中斷子程序流程圖

　　2.2 基于自適應濾波的姿態(tài)解算設計

　　為消除加速度計的噪聲干擾和陀螺儀的漂移，獲得準確的姿態(tài)信息，綜合加速度計和陀螺儀各自的優(yōu)點，應用互補濾波算法(Complementary Filtering, CF)，從頻域的角度分別加入低通和高通濾波器，將兩傳感器的姿態(tài)信息加以融合，可去除干擾，消除零位誤差，提高解算精度[5]。

　　以俯仰通道為例，互補濾波的原理可描述為：

　　(1)

　　其中， f1(s) 為一階低通濾波器傳遞函數(shù)， f2(s)為一階高通濾波器傳遞函數(shù)，且f1(s)+ f2(s)=1。ωm為陀螺儀測得的旋轉(zhuǎn)角速度。為俯仰角預估值，可通過式(2)計算得到。

　　(2)

　　其中，分別為在一段時間內(nèi)在俯仰、滾轉(zhuǎn)和偏航通道上的加速度平均值。

　　從式(1)可以看出，濾波效果取決于參數(shù)K的選取。但是在噪聲較大時低通的阻帶衰減較慢，難以獲得較好的濾波效果。為了提高姿態(tài)角的解算精度，本文基于常規(guī)互補濾波原理，采用一種自適應互補濾波(Adaptive Complementary Filtering, ACF)算法，其原理如圖7所示。

　　圖7 ACF原理圖

　　圖7中，Kp為比例系數(shù)，Ki為積分系數(shù)?？紤]實時性問題，通常設定Ki保持不變，通過Kp的動態(tài)調(diào)整實現(xiàn)俯仰角誤差的動態(tài)補償。自適應補償系數(shù)Kp的算法如下：

　　(3)

　　其中，Kp0為初始補償系數(shù);Kp1姿態(tài)臨界發(fā)散系數(shù)。ωmax為陀螺儀的最大量程，ωc為陀螺儀的截止角速度(ωc<ωmax)。

　　從圖7可以看出，加速度計的實時數(shù)據(jù)由式(2)解算得到俯仰角預估值θ，經(jīng)過低通環(huán)節(jié)增加的PI 控制器與陀螺儀的實時數(shù)據(jù)積分后得到的角度相融合，得到機載云臺當前俯仰角 。同時， 作為負反饋，實時機載云臺的姿態(tài)角。姿態(tài)更新算法流程見圖8所示。

　　圖8 姿態(tài)更新算法流程圖

　　3 實驗研究

　　本文搭建了以ST公司的STM32F103為主控制器，InvenSense公司的MPU6050芯片作為慣性測量單元的機載云臺控制器硬件平臺，并將其搭載于某多旋翼無人飛行器上進行了機載測試實驗，如圖9所示。

　　圖9 機載飛行測試實驗

　　依據(jù)所選用的慣性測量元件參數(shù)可知，陀螺儀的最大量程ωmax =2000°/sec，截止角速度ωc=2πf，陀螺儀截止頻率f為100Hz，由PID參數(shù)工程整定法得到KP0、KP1分別為5和20。因此自適應補償系數(shù)Kp為：

　　通過與常規(guī)互補濾波算法的對比試驗，驗證自適應互補濾波算法的有效性。試驗結(jié)果如圖10所示。

　　圖10 算法對比測試試驗

　　其中，圖10(a)為采用互補濾波時解算得到的俯仰角和滾轉(zhuǎn)角，其解算誤差的均方值約為1.65°和0.39°。圖10(b)為采用自適應互補濾波時解算得到的俯仰角和滾轉(zhuǎn)角，其解算誤差的均方值約為1.26°和0.15°。初始時刻的俯仰角和滾轉(zhuǎn)角均不處于0°是由于機載云臺并非絕對水平導致。

　　以俯仰通道為例，在機載云臺給定俯仰角為0時，通過機載云臺的視軸穩(wěn)定誤差實驗來驗證系統(tǒng)的穩(wěn)態(tài)性能。實驗結(jié)果如圖11所示。從圖中可以看出，其穩(wěn)定誤差在±0.02°之間，穩(wěn)定精度約為0.26 mrad，具有較高的穩(wěn)定精度。

　　圖11視軸穩(wěn)定誤差曲線

　　4結(jié)論

　　為了實現(xiàn)多旋翼無人飛行器機載慣性云臺的穩(wěn)定控制，使得機載視頻圖像穩(wěn)定清晰，本文設計了一種基于STM32和自適應互補濾波算法的機載穩(wěn)定云臺。姿態(tài)解算對比試驗結(jié)果表明，自適應互補濾波算法效地提高了機載云臺姿態(tài)的解算精度。視軸穩(wěn)態(tài)精度的實驗表明，穩(wěn)定精度達到0.26 mrad，具有良好的穩(wěn)態(tài)性能，完全滿足了多旋翼無人飛行器機載云臺的穩(wěn)定性要求。

　　參考文獻：

　　[1]申斌,吳一波,林冬生.旋翼機的發(fā)展與應用[J].科技傳播,2013,(23):145-146.

　　[2]王日俊,白越,續(xù)志軍等. 多旋翼無人飛行器機載云臺的復合穩(wěn)定控制方法[J].電光與控制,2016,23(4):17-22.

　　[3]王日俊. 多旋翼無人飛行器載荷穩(wěn)像技術(shù)研究[D].北京:中國科學院大學,2015.

　　[4]MILLER RICK, MOOTY GREG. HILKERT.J. M. Gimbal system configurations and line-of-sight control techniques for small UAV applications[C].Proc. SPIE 8713, Airborne Intelligence, Surveillance, Reconnaissance (ISR) Systems and Applications X, 871308. Baltimore,Maryland,USA,201

　　[5]傅忠云,劉文波,孫金秋,等.自適應混合濾波算法在微型飛行器姿態(tài)估計中的應用[J].傳感技術(shù)學報,2014,27(5):698-703.