一種飛行沖突檢測系統(tǒng)的研究與設計

Research and Design of the Flight Conflict Detection System

楊新　高春燕　王　智

(中國民航大學空中交通管理學院，天津　300300)

一種飛行沖突檢測系統(tǒng)的研究與設計

Research and Design of the Flight Conflict Detection System

(中國民航大學空中交通管理學院，天津300300)

摘要：針對小型飛行器的飛行沖突問題，提出了一種飛行沖突預測的算法。結合該飛行沖突的預測算法，設計了一種基于GPS/IMU的飛行沖突檢測系統(tǒng)。該系統(tǒng)以STM32為核心處理單元，采用GPS/IMU作為飛行器的位置和姿態(tài)傳感器，接收其他飛行器的飛行位置信息、航向、高度等信息;通過飛行沖突預測算法計算飛行沖突概率，判斷是否存在飛行沖突。模型機試驗結果證明，該系統(tǒng)可以實現(xiàn)飛行沖突的預先判斷，能夠及時檢測到小型飛行器的飛行沖突。

關鍵詞：飛行沖突沖突檢測沖突概率STM32GPS/IMU

Abstract：Aiming at the flight conflict problem of small aircrafts, the prediction algorithm of flight conflict is proposed. Combining with this prediction algorithm, the flight conflict detection system based on GPS/IMU is designed. With STM32 as the core processing unit, and GPS/IMU as the position and attitude sensors for the aircraft, the information of other aircrafts, including position, heading, altitude, etc., can be received by the system. Then the flight conflict probability is calculated through flight conflict prediction algorithm, thus the existence of the flight conflict can be judged. The model machine experimental results prove that the system can prejudge the flight conflict, and promptly detect the flight conflict of small aircrafts.

Keywords：Flight conflictConflict detectionConflict probabilitySTM32GPS/IMU

0引言

飛行沖突探測是指預測兩架或者多架飛行器在某個同高度的地點出現(xiàn)相遇的情況。目前，飛行沖突探測一般是通過民航客機的大型機載計算機或者監(jiān)視雷達實現(xiàn)的，不適用于小型或者微型飛行器。隨著小型飛行器和無人機的應用越來越廣泛，飛行沖突的檢測成為了一項關鍵技術。它是保證飛行安全的前提。

本文提出一種基于飛行沖突預測算法的飛行沖突檢測系統(tǒng)的設計方案。該系統(tǒng)的創(chuàng)新點在于可以實現(xiàn)飛行沖突探測系統(tǒng)的小型化，通過沖突預測算法實現(xiàn)飛行沖突探測，從而更好地實現(xiàn)風險隔離。該設計用STM32作為核心處理器系統(tǒng)，采用GPS和慣性導航模塊、氣壓高度測量模塊等作為信息源，利用無線模塊與對方交互飛行信息，并通過飛行沖突預測算法，計算飛行沖突概率，判斷是否存在飛行沖突。

1系統(tǒng)設計

飛行沖突探測系統(tǒng)主要由STM32系統(tǒng)、GPS模塊、氣壓傳感器模塊、空速測量模塊、無線傳輸模塊組成。系統(tǒng)框圖如圖1所示。

圖1　系統(tǒng)框圖

處理器系統(tǒng)采用了STM32F103VET6 的32位72 MHz主頻的處理器，主要用于飛行器姿態(tài)提取、位置消息提取、飛行速度和飛行高度解算、飛行數(shù)據(jù)接收、飛行沖突檢測等。GPS模塊用于收集飛行器的經(jīng)緯度位置和速度，IMU模塊、氣壓傳感器、空速管用于采集飛行器航向、氣壓傳感器、飛行速度等信息。

1.1　GPS模塊設計

GPS模塊采用的是UM220芯片。和芯星通的低功耗GNSS芯片，是目前市場上尺寸最小的完全國產(chǎn)化的北斗/GPS模塊混合定位模塊，集成度高、功耗低，非常適合對尺寸、功耗要求高的北斗規(guī)模應用[1]。整個GPS模塊還包括AMS1117-3.3電源芯片，提供3.3 V的工作電壓；SMA有源天線接口，保證獲取位置的精確度。UM220原理如圖2所示。

圖2　UM220原理圖

1.2　氣壓傳感器模塊設計

為了提高氣壓傳感器的精度，模塊采用MS5611芯片作為氣壓傳感器。通過MS5611氣壓傳感器內(nèi)部出廠校驗的6個補償系數(shù)和未經(jīng)過補償?shù)臏囟群蜌鈮簻y量數(shù)值，實現(xiàn)溫度和氣壓數(shù)值的校正，提高氣壓測量的精度。其原理圖如圖3所示。

圖3　MS5611原理圖

1.3　IMU模塊和空速測量模塊設計

IMU模塊采用MPU6050和HMC5883L，實現(xiàn)飛行姿態(tài)和航向的測量，以及飛行的控制，從而達到?jīng)_突解除的目的。空速測量模塊使用的是MPXV7002壓阻式傳感器。該傳感器應用范圍廣泛，特別適用于那些采用帶A/D輸入的微控制器或微處理器，能夠滿足STM32系統(tǒng)的設計需求。

IMU模塊原理如圖4所示。

圖4　IMU模塊原理圖

2軟件設計

軟件設計部分主要包括系統(tǒng)初始化、參數(shù)設置、飛行姿態(tài)解算、飛行高度測量、飛行沖突檢測、飛行數(shù)據(jù)接收等部分。系統(tǒng)的初始化是讀取SD卡的初始化數(shù)據(jù)，并在初始化中對其賦值；姿態(tài)解算采用四元數(shù)算法實現(xiàn)，與歐拉角相比，四元數(shù)算法不僅計算簡單，而且避免了歐拉角的奇異性問題，從而實現(xiàn)飛行器全姿態(tài)工作的能力[2]；飛行高度測量使用二階溫度補償?shù)姆椒ㄓ嬎銡鈮焊叨葦?shù)值；飛行沖突的預測是通過預測最大沖突概率點實現(xiàn)的。

2.1　程序流程

飛行沖突探測系統(tǒng)的程序設計主要包括系統(tǒng)的初始化、數(shù)據(jù)采集、數(shù)據(jù)處理、信息接收與發(fā)送、沖突檢測等。其流程圖如圖5所示。

圖5　系統(tǒng)流程框圖

首先，對系統(tǒng)進行初始化，配置STM32工作時鐘頻率，并配置I2C接口，初始化IMU模塊；配置串口模塊，讀取GPS模塊的數(shù)據(jù)；配置系統(tǒng)定時器，用來獲取時間，計算姿態(tài)數(shù)據(jù)；最后，配置無線模塊，讀取和發(fā)送模塊數(shù)據(jù)。

系統(tǒng)通過定時器讀取各個模塊的數(shù)據(jù)，并通過相應的算法計算飛行器當前的狀態(tài)和位置；接收對方飛行器的飛行數(shù)據(jù)，并進行數(shù)據(jù)的校驗和驗證，判斷是否存在飛行沖突。

2.2　飛行沖突預測算法

如果兩架飛行器高度相差不大，并且飛行航線存在交叉點，則會出現(xiàn)飛行交叉的現(xiàn)象，有可能出現(xiàn)飛行沖突。

為了計算飛行沖突的概率，本文提出了飛行沖突的預測算法，即通過計算航跡交叉相遇時刻，得到飛行沖突最大概率的時刻，并通知是否沖突報警。該算法分為以下幾個步驟：計算飛行交叉點、計算飛行距離和預計到達時刻、計算飛行沖突概率。

(1) 飛行交叉點的計算

假設兩架飛行器的航跡上的兩個點分別為P1A(N11,E11)、P1B(N12,E12)和P2A(N21,E21)、P2B(N22,E22)，交叉點為P(N,E)。轉換為球坐標系為θ11、φ11、θ12、φ12、θ21、φ21、θ22、φ22和θ、φ。

球坐標示意圖如圖6所示。

圖6　球坐標示意圖

(1)

φ=E

(2)

假設地球半徑為R，則中心點O到點P1A、P1B、P2A、P2B矢量分別為：

r11=Rsinθ11cosφ11i+Rsinθ11sinφ11j+Rcosθ11k

r12=Rsinθ12cosφ12i+Rsinθ12sinφ11j+Rcosθ12k

r21=Rsinθ21cosφ21i+Rsinθ21sinφ21j+Rcosθ21k

r22=Rsinθ22cosφ22i+Rsinθ22sinφ22j+Rcosθ22k

r=Rsinθcosφi+Rsinθsinφj+Rcosθk

由其矢量關系可以計算得到：

A1Dsinθcosφ-B1sinθsinφ+C1cosθ=0

(3)

A2sinθcosφ-B2sinθsinφ+C2cosθ=0

(4)

Ai=sinθi1sinφi1cosθi2-sinθi2sinφi2cosθi1i取1或2

Bi=sinθi1sinφi1cosθi2-sinθi2cosφi2cosθi1i取1或2

Ci=sinθi1cosφi1sinθi2cosφi2-

sinθi2cosφi2sinθi1cosφi1i取1或2

(5)

通過上式計算得到θ、φ ，進而計算出P(N，E)。

(2) 飛行距離計算

為了計算飛行器當前的位置與航跡交叉點的距離，采用了以下方法進行距離的計算。假設P1點緯經(jīng)度(N1, E1)和P2點緯經(jīng)度(N2， E2)[3]，則:

式中：Δ為P1和P2的距離。

(3) 飛行沖突的概率模型

飛行器的飛行存在諸多的影響因素，飛行位置可能會受到各種噪聲的干擾。建立一個飛行器運動航跡的模型：

Dt=Dt-1+VΔt+vt-1+nt

(6)

式中：Dt為不同飛機在t 時刻的航跡位置；V為飛行速度；vt為測量誤差；nt為飛行器飛行過程中的干擾誤差。同理，可以測算出各個飛行器預計到達相遇點的交叉時間td。

Pt=∫p(lt)dltlt≤Δ

(7)

式中：Δ為飛行器保護圈范圍；p(lt)為其概率密度函數(shù)。

根據(jù)文獻[4]和[5]可以獲知，經(jīng)過線性變換之后，其對應的沖突概率密度為標準正態(tài)分布。又由于航跡在三維空間中為獨立的函數(shù)，所以該時間段內(nèi)的沖突概率如下：

式中：ψ()為標準正態(tài)分布的概率分布函數(shù)；lti為lt在i軸的投影分量；Δi為i軸的規(guī)避范圍。

(4)由步驟(3)中計算得到的到達航跡交叉點的時刻，獲取飛行沖突概率，并判斷是否沖突警告。

2.3　沖突檢測流程

沖突檢測流程圖如圖7所示。沖突檢測設計主要包含了數(shù)據(jù)的校驗，保障接收到的數(shù)據(jù)為真實有效的數(shù)據(jù)；通過對方飛行器的兩個飛行點以及飛行器本身的飛行位置點的坐標計算兩者的交叉地點，并根據(jù)自己的飛行速度來計算相遇的飛行時間，進而計算飛行概率。如果飛行概率大于預定值，則產(chǎn)生沖突報警。

圖7　沖突檢測流程圖

3仿真測試

為了驗證沖突算法的可行性，本文利用Matlab對沖突算法進行了仿真測試。航跡與飛行沖突概率曲線如圖8所示。

圖8　航跡與飛行沖突概率

假設飛行器A以0.7單位的速度由點(1，10)飛往點(16,12)，飛行器B以1單位的速度由點(2,2)飛往點(12,16)，如圖8(a)所示。由該方法可以確定兩者航跡相交于點(8.42,10.98)，并且飛行器的規(guī)避保護圈為4個單位。其仿真結果如圖8(b)所示。由于飛行器相交于點(8.42,10.98)，飛行器B最先到達，則A、B之間的飛行沖突主要集中于B飛行器達到時刻，則飛行沖突主要預測B到達預定地點的時刻。

為了驗證外界因素對沖突概率的影響，本文在仿真結果中加入了一個風的影響因子，其中順風和逆風因子均為0.15。不同情況下的沖突概率比較如圖9所示。由圖9看出，在不同影響因素下，其沖突預測概率是不一樣的，在逆風條件下，兩者的飛行速度減慢，飛行沖突時間增大。

圖9　不同情況下的沖突概率比較

4結束語

本文在提出飛行沖突預測算法的基礎上[6-7]，設計了基于GSP/IMU的飛行沖突檢測系統(tǒng)。利用GSP和IMU模塊檢測飛行器的飛行狀態(tài)，并通過接收對方飛行器的飛行信息，計算兩架飛行器存在飛行沖突的概率。本文利用Matlab軟件驗算了飛行沖突預測算法，并在該基礎上設計相關的硬件仿真軟件，驗證了該系統(tǒng)能夠及時識別飛行沖突的有效性。

參考文獻

[1] 懷洋,邵瓊玲,路振民.北斗/GPS混合定位模塊UM220應用研究[J].國外電子測量技術,2014(3)：76-79.

[2] 喬相偉.基于四元數(shù)非線性濾波的飛行器姿態(tài)確定算法研究[D].哈爾濱:哈爾濱工程大學,2011.

[3] 韓忠民.知經(jīng)緯度計算兩點精確距離[J].科技傳播,2011(11).

[4] Hu J H,Lygeros J,Prandidi M.Aircraft conflict prediction and resolution using brownian motion[C]//IEEE Conference Decision Control,1999.

[5] 曾艷,周杰,吳耀國.基于UPF的中程飛行沖突探測[J].四川大學學報:自然科學版,2008,45(6):1299-1303.

[6] 曹平軍,楊昌茂,王曉峰,等.飛行體姿態(tài)測量誤差校正方法研究[J].自動化儀表,2014(2):20-23.

[7] 劉欣,翟成瑞,張會新.多路隔離信號采集存儲系統(tǒng)設計[J].自動化儀表,2014(8):27-30.

《自動化儀表》郵發(fā)代號： 4-304, 2015年定價： 18.00元，全年價： 216.00元； 國外代號： M 721

歡迎賜稿， 歡迎訂閱， 歡迎寶貴建議， 歡迎惠刊各類廣告

中圖分類號：TH7;TP368

文獻標志碼：A

DOI:10.16086/j.cnki.issn1000-0380.201507001

中央高校基本科研業(yè)務費資金資助項目(編號：3122013Z006)。

修改稿收到日期：2014-11-10。

第一作者楊新湦(1966-)，男，1991年畢業(yè)于法國國立民航大學交通運輸專業(yè)，獲碩士學位，教授；主要從事空中交通管理方面的研究。