無人機遂行純方位無源定位的建模研究

李唯 施一飛 劉凱

摘要：如今，無人機被廣泛應(yīng)用于輔助導(dǎo)航技術(shù)，且通常由多架無人機通過編隊協(xié)同完成。為提升無人機編隊飛行的效果，無人機遂行編隊飛行的純方位無源定位是當前的主流做法。文章基于最佳控制模型（FHOCP）與決策算法，快速有效地完成錐形編隊中無人機的位置判斷，通過設(shè)計最優(yōu)調(diào)整方案，對問題進行求解與分析。文章設(shè)計的模型和算法對日常場景的無人機編隊飛行具有較好的實用性。

關(guān)鍵詞：輔助駕駛技術(shù)；無人機遂行編隊；最佳控制模型；決策算法

中圖分類號：TN95

文獻標志碼：A

0 引言

隨著智能輔助駕駛技術(shù)的普及，無人機的定位技術(shù)顯得尤為重要。對無人機進行定位有兩種手段，一種是有源定位，主要是基于姿態(tài)測量或激光測距定位模型；另一種是通過無源定位，被動地接收電磁信號來確定位置。本次主要研究無人機遂行編隊純方位無源定位問題。先要解決無人機在同一平面的問題，在此基礎(chǔ)上，由圓形編隊拓展為錐形編隊，本文分兩部分完成無人機錐形編隊的調(diào)度方案。（1）模型建立。無人機互相定位時有著重要的關(guān)系，無人機移動到指定位置，需要滿足一定的條件，得到最佳控制模型的定位優(yōu)化。（2）建立算法，進行模型求解。將無人機編號帶入模型，得到無人機定位編號。此后再通過校準，確定所建模型在同一平面上。

1 模型的建立

為使問題得到簡化，假設(shè)無人機之間在接收信號前后保持相對靜止狀態(tài)。

1.1 同一平面無人機定位模型

確定一個平面及任選2架無人機同時發(fā)射信號，使其余任意的1架無人機中收到的夾角為60°，其余2架無人機分別定為FY02和FY03。調(diào)整3架無人機兩兩間發(fā)射信號，使剩余1架收到的夾角都為60°的條件，形成等邊三角形，而其需要滿足的等式如下所示：

∠FY01=∠FY02=∠FY03=60°（1）

由于等邊三角形的三邊相等，無人機移動位置時，無人機須滿足避讓條件為：

∠n_i≠∠m_j

確定每架無人機的優(yōu)先級，具體的優(yōu)先選擇情況如下：

其中，∠n為收到的角度最接近60°的無人機。

1.2 同一平面圓形編隊無人機定位模型

已知3架無人機形成的平面，以FY01為圓心，F(xiàn)Y02，F(xiàn)Y03之間的距離為半徑建立圓形，通過圓上和圓心的無人機發(fā)射信號，讓其余無人機移動到相對應(yīng)的點位，建立同一平面上的圓形編隊。如圖1所示。

其調(diào)整的具體方案為：FY01和FY02發(fā)射信號，使其余未定位的無人機收到的角度選取一個最接近60°的無人機，讓其移動到收到角度為60°的線上，所以FY01和FY02發(fā)射信號后能形成在同一平面上且收到的角度為60°的點一共有4個。FY03和FY01發(fā)射信號與∠3處形成的夾角?為30°。

推導(dǎo)過程如下：FY0M所處的位置和FY03所處的位置在同一個圓面上對稱，所以右邊的三角也為等邊三角形且與左邊的三角形全等，由于FY03與FY01發(fā)射信號形成的夾角由l_FY03FY0M與l_FY03FY0M組成，且l_FY03FY0M為角平分線而FY0M處收到FY01和FY02發(fā)射信號收到的角度為60°，所以FY03和FY01發(fā)射信號與FY0M處形成的夾角?為30°。當無人機位于FY0P或FY0Q處時，F(xiàn)Y03和FY01發(fā)射信號與FY03和FY01處形成的夾角?為2asin（6/4），效果如圖2所示。

最終得出，若?的值為30°，則表示位于同一平面上；若?=2asin（6/4）時，則表示與圓面不在同一平面上，須由無人機FY01與FY03發(fā)射信號，使其?轉(zhuǎn)為30°的同時也滿足FY01和FY02發(fā)射信號時無人機x收到的角度為60°，此時，可將無人機x為FY04。

由于已知同一平面上圓形編隊無人機的位置，而錐形編隊變成是利用圓上的無人機來繼續(xù)定位其余未知無人機的任務(wù)，其定位方法也和圓形編隊的定位方法相同，先定位到60°角的位置，后利用檢測無人機判斷是否在同一平面上，若不在，則同時根據(jù)兩個定角去移動未知無人機的位置，直到都滿足兩個條件時完成定位。具體的操作如圖3所示。

1.3 最佳控制的定位優(yōu)化模型的建立

1.3.1 決策變量的確定

因為最開始確定一個平面的算法和后面定位其余無人機的算法都不相同，所以需要知道是無人機調(diào)整的第幾階段，其決策變量為：

1.3.2 目標函數(shù)的確定

由于需要給出無人機的調(diào)整方案，而無人機每階段的方案又不同，且在無人機定位階段需要考慮平面和立體的結(jié)構(gòu)，故確定目標函數(shù)為計算每架無人機位于錐形編隊的位置函數(shù)，記為：

1.3.3 約束條件的確定

約束條件1：無人機確定位置后，直線上距離限制由于是錐形編隊，所以直線上相鄰的2架無人機之間的距離相等。即：

l_FT0iFY0i+1=l_FT0i+1FY0i+2（i=1，2…13）（6）

約束條件2：無人機確定位置后，角度限制由于是錐形編隊，所以直線上相鄰的2架無人機之間的夾角相等。即：

∠l_FT0iFY0i+1=∠l_FT0i+1FY0i+2=60°（i=1，2…13）（7）

約束條件3：無人機確定位置前，移動限制由于需要調(diào)整無人機的位置，可能會碰撞上其他無人機，所以需要滿足無人機在飛行過程中與其他無人機接收到的角度不同。即：

∠n_i≠∠m_j（i=1，2…15;j=1，2…15;i≠j）（8）

綜上所述，建立基于最佳控制的定位優(yōu)化模型：

2 模型求解

2.1 基于無人機的決策與最優(yōu)控制模型

求解模型分為決策算法與最優(yōu)控制算法兩部分，需要給無序的無人機群編排隊為錐形無人機群，且無人機之間只能通過接收信號形成的夾角來互相定位^［1］。一共有15架無人機，且先定位的無人機都會影響到后面定位的無人機，記無人機定位的集合為P，可以表示為：

P=｛FY01，F(xiàn)Y02…FY0n｝，n=15（11）

對無人機定位集合進行最優(yōu)控制的調(diào)度算法，得到最優(yōu)的調(diào)度方式。

步驟1：進行無人機平面的決策，采用最短優(yōu)先調(diào)度算法，先定位一架無人機為FY01，再以最短優(yōu)先算法搜索，其他無人機發(fā)射信號到FY01形成的角度最接近60°的兩架無人機，后通過互相發(fā)射信號來調(diào)整無人機兩兩之間的角度為60°，命名為FY02和FY03，由此定位了一個基礎(chǔ)的平面，記為P₀。

步驟2：基礎(chǔ)的平面P₀定位完成后，就可以在此基礎(chǔ)上通過P₀上任意兩架無人機發(fā)射信號來定位下一架無人機的位置^［2］。如FY01和FY02發(fā)射信號可以定位3架新無人機，后FY01和FY03再發(fā)射信號，3架新無人機中最終收到的信號形成角度為30°的無人機才是在同一平面上的無人機，命名為FY04，以此類推，可以再定位3架無人機形成一個圓形編隊，記為P₁。

步驟3：在圓形平面P₁上，除了FY04和FY06與FY05和FY07外，任意相鄰的兩架無人機也可以定位新的3架無人機，后只需讓其中一架與FY01同時發(fā)射信號便可定位在同一錐形平面上的無人機，記為P₂。

2.2 貪心算法和AHP層次分析法評價模型

2.2.1 建模的建立

將9架無人機均勻分布在某個圓周上，先確定圓的圓心和半徑，通過數(shù)據(jù)分析，將圓心定位F0，半徑可選擇98 m或105 m兩個同心圓，通過圓心，無人機和圓上3架無人機（即4架無人機）確定其他無人機預(yù)到達的位置。使其運動到滿足對應(yīng)的α₁，α₂，α₃，α₄，α₅，α₆角度關(guān)系，如圖4所示。

由灰狼捕獵算法推導(dǎo)出調(diào)整方案，主要分為3個步驟。

步驟一：由圓上的已有3架無人機和圓心無人機，確定FY01運動到理想的位置上（R，0），此時一個圓上分布4架無人機。

步驟二：此時有圓上的已有無人機、F1無人機和圓心無人機，先后讓已有3架無人機移動到理想的位置。

步驟三：圓上3架無人機和圓心無人機同時發(fā)射信號，讓其他位置略有偏差的無人機移動到理想位置。最后建立一個層次分析法評價模型，對角度變化量、平均位移量、發(fā)射信號次數(shù)等多個指標進行分析，對變化方案，進行評價。

2.2.2 模型的求解

方向信息命名：編號0、編號1、編號2發(fā)射信號，編號3接收信號，其方向信息F₁₂α_3，1和F₁₂α_3，2分別表示兩個夾角，即編號0。編號i、編號j發(fā)射信號，編號m接收信號，其方向信息表示為F_ijα_m，1和F_ijα_m，2；理想方向信息表示為U_ijα_m，1和U_ijα_m，2。編號n初始位置為F_n，運動位移為V_n，理想位置為U_n，角度變化P_n（極坐標體系中極點為參考點）。

極坐標系的建立：選取F0，F(xiàn)1作為極軸建立極坐標系。

模型理想化：已知忽略運動時間且僅僅略有偏差，所以將無人機運動過程只取兩點之間最短且無碰撞情況。

3 建立層次分析法的評價模型

通過比較98 m方案與112 m方案選擇最小的變動方案。以無人機變化角度、位移量、發(fā)射信號次數(shù)作為指標，對方案進行評價。

3.1 無人機角度平均變化量β

滿足式（12）的線性條件時，偏轉(zhuǎn)角度越小，變動越小。并且，角度平均變化為：

3.2 各方案無人機位移變化量D

每個無人機位移變化計算公式：

無人機群位移距離D越小，變動越小。

3.3 信號發(fā)射次數(shù)γ

γ發(fā)射次數(shù)越少，能量消耗越少。由上面步驟可

知兩個方案γ相同，并且γ₁=γ₂=7。

對方案變動值進行評價比較。評價指標確定后，需要確定評價方法以建立評價模型。評價方法主要分為主觀評價法和客觀評價法，這里采取主觀評價法對問題進行深入分析，將問題分解為若干層次。然后在相對簡單的層次上再進行分析，從而為多個目標或無結(jié)構(gòu)的復(fù)雜問題提供簡單的解決方法。分析3種指標的特點及其相對重要性，對指標進行兩兩比較獲得判斷矩陣，如表1所示。

AHP層次分析法用于研究專家打分權(quán)重計算。第一，AHP層次分析法用于計算權(quán)重，并且需要進行一致性檢驗。第二，逐一描述各項指標所得權(quán)重情況。

針對角度平均變化量、位移變化量和信號發(fā)射次數(shù)3項構(gòu)建三階矩陣進行AHP層次法研究，分析得到特征向量（0.772，1.485，0.743），并且，可得出3項對應(yīng)的權(quán)重值分別是40%，50%，10%。

綜上所述，選擇將無人機均勻分布在半徑為98 m的圓周上方案比較合理。

參考文獻

［1］崔文冰.基于分布式的多無人機容錯均勻編隊算法研究［D］.北京：北京化工大學(xué)，2021.

［2］都若塵，許江濤.多無人機協(xié)同編隊控制研究現(xiàn)狀及進展［J］.高師理科學(xué)刊，2022（2）：42-46.

（編輯 沈 強）

Modeling research on bearing only passive location of UAV

Li Wei， Shi Yifei^*， Liu Kai

（Geely University of China， Chengdu 611731， China）

Abstract： In order to improve the effectiveness of drone formation flying， the current mainstream approach is to use passive localization with pure bearing for drone formation flying. This article is based on the Best Control Model （FHOCP） and decision algorithm to quickly and effectively determine the position of unmanned aerial vehicles in conical formations. By designing the optimal adjustment scheme， the problem is solved and analyzed.

Key words： assisted driving technology; unmanned aerial vehicle formation; the optimal control model; decision algorithm