基于OpenMV的四旋翼無人機目標跟蹤系統(tǒng)設(shè)計與實現(xiàn)

馬曉琳，周弘斌，黃福龍

（陸軍工程大學石家莊校區(qū)，河北石家莊，050003）

1 概述

四旋翼無人機因靈巧、方便、易操作，等優(yōu)點，搭載攝像頭可實現(xiàn)偵察監(jiān)視和目標搜索任務，在軍事和民用領(lǐng)域得到廣泛的應用。四旋翼無人機通過相機獲得的視覺信息計算得到目標與無人機間的水平位移，將信息回傳給飛控，進而自動調(diào)整無人機的姿態(tài)和位置，實現(xiàn)目標鎖定與跟蹤[1]。在跟蹤過程中，如何實現(xiàn)自主定位、尋找并跟隨目標等復雜功能是無人機識別跟蹤的關(guān)鍵，涉及圖像的實時采集、高效高精度的目標跟蹤算法和圖像數(shù)據(jù)反饋與飛控指令的配合等多個難點問題。本文旨在基于四旋翼無人機為平臺，應用計算機視覺技術(shù)完成對地面任務目標的偵查、監(jiān)視、跟蹤，通過智能分析技術(shù)，迅速辨別運動目標；配合算法研究，對目標進行精準跟蹤，從而獲取目標信息并進行有效跟蹤。

2 系統(tǒng)總體設(shè)計

本系統(tǒng)由數(shù)據(jù)信息采集、數(shù)據(jù)信號處理、飛行姿態(tài)穩(wěn)定和航向控制等部分組成。系統(tǒng)以STM32F407飛控單元為核心，完成飛機的自穩(wěn)，通過光流傳感器來定位飛行高度，將Openmv4模塊鏡頭獲取的圖像經(jīng)過處理識別，發(fā)送數(shù)據(jù)給飛控，飛控對接收的數(shù)據(jù)進行旋轉(zhuǎn)解耦、濾波、PID調(diào)節(jié)，控制飛機姿態(tài)，從而實現(xiàn)對地面目標的自動跟蹤[2]。整個系統(tǒng)采用開源設(shè)計，可進行目標識別跟蹤算法移植，按需更換Openmv4攝像頭，方便靈活，通用性強。

3 系統(tǒng)硬件組成

四旋翼無人機硬件系統(tǒng)如圖1所示，主要包括：動力系統(tǒng)、遙控器模塊、無線數(shù)傳、STM32F407飛控模塊、識別定位系統(tǒng)等。四旋翼無人機的動力系統(tǒng)主要包括電機、電調(diào)、螺旋槳和電池；飛控模塊為四旋翼無人機的核心部分，通過接收遙控器端的指令，采集并處理傳感器模塊返回的姿態(tài)位置信息，根據(jù)控制算法的結(jié)果向動力系統(tǒng)發(fā)送指令，控制無人機完成飛行任務；無線數(shù)傳模塊一端接入計算機（地面站軟件），一端接入四旋翼無人機飛控系統(tǒng)，通信采用一定協(xié)議進行，從而保持無人機與地面站的雙向通訊[3]；光流模塊與飛控相連，集成光流傳感器和慣性傳感器，實現(xiàn)對四旋翼無人機的高精度定位；OpenMV是一款基于STM32F765VI ARM Cortex M7處理器的單片機和OV2640圖像傳感器的機械視覺模塊。圖像傳感器為OV9V034彩色標配，本項目選用5MP 2.8mm 1/2.5"無畸變鏡頭，提高畫面清晰度，從而大大提高自動跟蹤過程有效性。

圖1 四旋翼無人機平臺硬件系統(tǒng)結(jié)構(gòu)

4 軟件系統(tǒng)設(shè)計

4.1 軟件系統(tǒng)總體設(shè)計

如圖2所示，軟件系統(tǒng)由視覺模塊、串口通信模塊、飛行控制模塊組成，視覺模塊進行圖像獲取并識別，通過串口通信模塊發(fā)送數(shù)據(jù)到飛行控制模塊進行四旋翼姿態(tài)控制，自動跟蹤。

圖2 軟件系統(tǒng)總體設(shè)計框圖

4.2 解耦與色塊跟蹤算法

STM32F07飛控對Openmv傳回的數(shù)據(jù)進行處理，并解除因機體俯仰、橫滾旋轉(zhuǎn)而造成追蹤目標坐標變化的耦合，也稱作“旋轉(zhuǎn)解耦”或“旋轉(zhuǎn)補償”。并用解算出的像素偏差耦合高度計算到地面偏差，用地面偏差控制期望速度，以減小偏差，實現(xiàn)自動跟蹤。STM32F07飛控對Openmv傳回的數(shù)據(jù)進行處理并解析數(shù)據(jù)，通過旋轉(zhuǎn)解耦解除因機體俯仰、橫滾旋轉(zhuǎn)而造成追蹤目標坐標變化的耦合，解算出的像素偏差耦合高度計算到地面偏差，用地面偏差控制期望速度，進入色塊計算處理模塊，得到地面偏差，計算微分偏差，得到地面目標的速度，通過距離偏差PD控制和速度前饋處理，進行飛行跟蹤控制，自動跟隨地面目標。

5 系統(tǒng)調(diào)試

5.1 四旋翼無人機的調(diào)試

飛控連接電腦地面站，成功打開連接后，觀察地面站主界面的RX計數(shù)器，開始增長表示連接成功。在飛控已正確連接地面站并打開連接的情況下，進行飛控參數(shù)配置。最后進行電調(diào)與電機檢查，接電解鎖，推油門讓電機開始旋轉(zhuǎn)，然后讓飛機傾斜，確認處于低處的電機轉(zhuǎn)速上升，高處的電機轉(zhuǎn)速下降，四個方向都確認一遍。確認完所有電機后，分別根據(jù)不同電機的轉(zhuǎn)向，安裝相應螺旋槳，保證每個螺旋槳都向下吹風[4]。

5.2 OpenMV圖像調(diào)試

運用OpenMV IDE顯示圖像，并標記識別的圖像，如圖3所示。解析串口數(shù)據(jù)后，按照串口通信協(xié)議，將用戶數(shù)據(jù)打包發(fā)送到飛控。在進行自動跟蹤與識別的調(diào)試時，為確保四旋翼與人員的安全，將螺旋槳拆卸掉后，將色塊放置于OpenMV鏡頭下方，移動色塊觀察電機轉(zhuǎn)向及趨勢模擬四旋翼實際飛行姿態(tài)的變化。四旋翼安裝發(fā)送端數(shù)傳，電腦連接接收端數(shù)傳，通過無線數(shù)傳將四旋翼飛行數(shù)據(jù)實時發(fā)送到電腦端地面站，實時檢驗自動跟蹤效果，如圖4所示。

圖3 OpenMV IDE

圖4 實時監(jiān)控圖

6 結(jié)語

本文應用模塊化思想，應用STM32F103C8T6 控制器，采用姿態(tài)結(jié)算、坐標系轉(zhuǎn)換、PID 調(diào)節(jié)等算法，配合硬件外設(shè)實現(xiàn)四旋翼飛行器的穩(wěn)定飛行；光流法與GPS配合，在室內(nèi)外對飛行器實現(xiàn)高精度的定位和穩(wěn)定的控制，搭建四旋翼識別跟蹤平臺。結(jié)果表明，所述系統(tǒng)飛行穩(wěn)定，可對地移動目標智能化進行識別、標記和跟蹤。