電力多旋翼無人機巡檢安全間距保持系統(tǒng)

摘要：針對電力多旋翼無人機巡檢較高的安全性要求，提出基于klaman濾波融合和模糊控制技術(shù)的電力多旋翼無人機巡檢安全間距保持系統(tǒng)。該系統(tǒng)主要依據(jù)GPS、超聲波測距模塊、電磁場強度測距模塊等進行數(shù)據(jù)采集，并通過klaman濾波數(shù)據(jù)融合[4][5]和模糊控制[1]技術(shù)計算、監(jiān)測無人機與線路間距離。通過對系統(tǒng)的實驗，結(jié)果表明設(shè)計的安全間距保持系統(tǒng)安全可靠。

Abstract：? For power multi-rotor UAV patrol high security requirements，this paper proposed keeping safety distance system based on kalman Filtering Fusion and Fuzzy Control Technology. The system is collecting data mainly based on GPS， ultrasonic ranging module， electromagnetic field strength ranging modules，and monitoring the distance between the UVA and the line through kalman Filtering Fusion and Fuzzy Control Technology. The results showed the keeping safety distance system proposed in this paper is secure and reliable.

關(guān)鍵詞：超聲波;klaman濾波融合;模糊控制;無人機

Key words： ultrasonic;kalman filtering fusion;fuzzy control technology;UAV

中圖分類號：V279+.2? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? 文獻標識碼：A? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? ? 文章編號：1006-4311（2019）17-0217-03

0? 引言

對于電力多旋翼無人機巡檢而言，由于其載重能力有限無法安裝大載重、遠距離機載檢測裝置，所以需要沿線路近距離飛行懸停檢測，如圖1。與輸電線路保持安全距離飛行是多旋翼無人機在電力巡檢中重要的安全保障之一，同時也是電力多旋翼無人機巡檢的強制要求。隨著近幾年無人機行業(yè)的快速發(fā)展，在電力巡檢中多旋翼無人機以其成本低、操作簡單、使用靈活、方便運輸?shù)葍?yōu)勢得以廣泛使用。傳統(tǒng)的無人機與輸電線路安全間距保持方法為GPS定位控制，缺點在于其精度低、抗風性差、實時修正能力弱等原因，使其安全系數(shù)較低[2]，優(yōu)點在于其載重輕，有效減小飛機負載，延長續(xù)航時間。綜合分析傳統(tǒng)安全間距保持方法的優(yōu)缺點，本文應用klaman濾波融合和模糊控制技術(shù)，設(shè)計了一種新型的安全間距保持系統(tǒng)來實現(xiàn)多旋翼無人機巡檢的實時性和準確性避障。相對于傳統(tǒng)的安全間距保持系統(tǒng)，該系統(tǒng)能夠?qū)崟r、準確采集無人機與輸電線路之間的距離，并通過快速計算和動作控制，從而實現(xiàn)無人機與輸電線路的安全間距保持。

1? 系統(tǒng)硬件結(jié)構(gòu)組成

系統(tǒng)根據(jù)檢測距離信號控制多旋翼無人機與輸電線路之間距離，當?shù)竭_一定范圍時控制多旋翼無人機飛行速度，使其退出危險區(qū)域。使用GPS、超聲波傳感器和霍爾傳感器分別檢測多旋翼無人機與輸電線路之間距離，將三路距離信號經(jīng)過klaman濾波融合及信號處理后送至模糊控制器進行處理，輸出飛行控制處理命令到飛行控制器，調(diào)節(jié)飛行姿態(tài)，從而改變兩者之間距離到達安全范圍。傳感器實時檢測兩者之間距離，多旋翼無人機實時做出相應調(diào)整。為了滿足超聲波傳感器360°檢測，故采用如圖3分布方式，且檢測電場強度傳感器放置在多旋翼無人機中心位置。

檢測傳感器包括超聲波傳感器和霍爾傳感器兩種。超聲波傳感器優(yōu)點是控制簡單、技術(shù)成熟、價格低廉，成為距離檢測的常用傳感器;缺點是超聲波傳感器利用物體上產(chǎn)生的反射超聲波來檢測距離，當兩者水平成一定角度時，將會產(chǎn)生幻影[3]?；魻杺鞲衅鲀?yōu)點在于靈敏度高、體積小、適用于各種特殊設(shè)計要求;而缺點在于互換性差、信號隨溫度影響而變化、非線性輸出等。

2? 安全距離處理技術(shù)

2.1 kalman濾波融合技術(shù)

目前比較常用的濾波融合技術(shù)有綜合平均法、貝葉斯估計法、D-S法、模糊邏輯法、神經(jīng)邏輯法、kalman濾波法、專家系統(tǒng)方法等。kalman濾波經(jīng)在控制領(lǐng)域得以推廣后，便成為多傳感器信息融合的主要技術(shù)手段之一，其基本思想是先分散處理，再全局融合，即以一個信號為主體，與其他信號兩兩結(jié)合，在其結(jié)合信號的基礎(chǔ)上獲得全局估計。本設(shè)計以超聲波傳感器信號為主體，GPS和霍爾傳感器信號為輔助信號，進行濾波融合，首先將超聲波傳感器信號與其他兩個信號結(jié)合，通過式（1）～（7）得到兩個濾波后的信號。

離散系統(tǒng)狀態(tài)方程：

其中Xk是系統(tǒng)的狀態(tài)向量，Zk是系統(tǒng)觀測序列，Wk是系統(tǒng)過程噪聲序列，Vk是系統(tǒng)觀測噪聲序列， 椎k，k-1是系統(tǒng)的狀態(tài)轉(zhuǎn)移矩陣? 祝k，k-1噪聲輸入矩陣，Hk是觀測

矩陣。

基本Kalman濾波方程：

將X視為超聲波信號輸入值，Z視為GPS或霍爾傳感器的輸入值。在濾波處理之后，將兩個濾波后的局部最優(yōu)估計信號經(jīng)過式（8）、式（9）進一步融合。全局最優(yōu)估計方程：

由以上式（8）、式（9）得到kalman濾波融合的全局最優(yōu)估計，將這個結(jié)果進行模糊控制處理。

當多旋翼無人機以不同的角度接近輸電線路時，會出現(xiàn)兩種情況：第一，當超聲波傳感器發(fā)出超聲波的傳播方向與線路垂直，則只需要進行Kalman濾波融合就可以得到準確的間距;第二，當超聲波傳感器發(fā)出超聲波的傳播方向與線路不垂直，則需要姿態(tài)模塊確定飛行姿態(tài)，通過三角公式換算得到垂直離。

2.2 模糊控制技術(shù)

2.2.1 模糊控制器的輸入、輸出變量模糊語言描述

輸入量和輸出量隸屬度函數(shù)，如圖4。

輸入量和輸出量模糊變量賦值，如表2。

通過模糊化規(guī)則的語言描述，得其矩陣表達式：

2.2.4 模糊量的去模糊化

最大隸屬度法是比較常用的反模糊化方法。其隸屬度最大的元素就是精確化后對應的精確值。如果同時出現(xiàn)多個隸屬度最大的元素，則取其平均值作為判決結(jié)果。

3? 實驗結(jié)果與分析

為了驗證系統(tǒng)的可靠性，將多旋翼無人機搭載安全間距保持系統(tǒng)設(shè)備到空中指定位置，對系統(tǒng)的電機轉(zhuǎn)速控制信號進行記錄。表3、圖5為0°位置超聲波傳感器靠近輸電線路電機轉(zhuǎn)速控制信號與距離之間關(guān)系。

在輸電線路垂直方向在兩個傳感器之間時，其準確距離需要三角換算得到。例如在0°、45°之間，夾角為22.5°時電機轉(zhuǎn)速控制信號與距離之間關(guān)系，數(shù)據(jù)如表5、圖7所示。

由于室外試驗，空中氣流對多旋翼無人機飛行造成了一定影響，使電機轉(zhuǎn)速與理論值有所差距。但是從圖中可以明顯看出，多旋翼無人機與輸電線路之間距離越小電機轉(zhuǎn)速越快，推動無人機快速倒退，使其遠離危險區(qū)域，繼續(xù)保持安全間距。

參考文獻：

[1]李士勇.模糊控制[M].哈爾濱：哈爾濱工業(yè)大學出版社，2011，9：64-94.

[2]鄭天茹，王海濱，劉俍，王騫，張晶晶.電力巡線無人直升機障礙規(guī)避系統(tǒng)[J].山東電力技術(shù)，2012（01）：14-17.

[3]周興超，段智敏.移動機器人避障的模糊算法[J].沈陽理工大學學報，2008，27（04）：23-25.

[4]付夢印，鄧志紅，張繼偉.Kalman濾波理論及其在導航系統(tǒng)中的應用[M].北京：科技出版社，2003：16-25，158-160.

[5]馮智勇，曾瀚，張力，趙亦欣，黃偉.基于陀螺儀及加速度計信號融合的姿態(tài)角度測量[J].西南師范大學學報（自然科學版），2011，36（04）：37-41.

作者簡介：劉風春（1990-），男，山東濟南人，本科，助理工程師，研究方向為電力巡檢、新能源系統(tǒng)設(shè)計。