CN108986555A - A kind of flight anticollision cognitive method, system, storage medium and equipment - Google Patents

A kind of flight anticollision cognitive method, system, storage medium and equipment Download PDF

Info

Publication number
CN108986555A
CN108986555A CN201810934824.4A CN201810934824A CN108986555A CN 108986555 A CN108986555 A CN 108986555A CN 201810934824 A CN201810934824 A CN 201810934824A CN 108986555 A CN108986555 A CN 108986555A
Authority
CN
China
Prior art keywords
aircraft
relative
initial state
collision
error
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201810934824.4A
Other languages
Chinese (zh)
Other versions
CN108986555B (en
Inventor
温昶煊
高扬
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Technology and Engineering Center for Space Utilization of CAS
Original Assignee
Technology and Engineering Center for Space Utilization of CAS
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Technology and Engineering Center for Space Utilization of CAS filed Critical Technology and Engineering Center for Space Utilization of CAS
Priority to CN201810934824.4A priority Critical patent/CN108986555B/en
Publication of CN108986555A publication Critical patent/CN108986555A/en
Application granted granted Critical
Publication of CN108986555B publication Critical patent/CN108986555B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G5/00Traffic control systems for aircraft
    • G08G5/80Anti-collision systems
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G5/00Traffic control systems for aircraft
    • G08G5/50Navigation or guidance aids
    • G08G5/55Navigation or guidance aids for a single aircraft
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G5/00Traffic control systems for aircraft
    • G08G5/50Navigation or guidance aids
    • G08G5/59Navigation or guidance aids in accordance with predefined flight zones, e.g. to avoid prohibited zones

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明涉及一种飞行防碰撞感知方法、系统、存储介质和设备,其方法包括对相遇的两个飞行器分别进行初始化,获取其中一个飞行器相对于另一个飞行器的初始状态信息;根据初始状态信息计算其中一个飞行器在给定时间内受到过程噪声影响的相对可达范围,同时根据初始状态信息确定另一个飞行器的禁飞区;根据相对可达范围与禁飞区判断两个飞行器之间是否存在碰撞风险。本发明的飞行防碰撞感知方法,在三维空间内考虑初始状态误差和过程噪声的影响的基础上进行飞行器的防碰撞感知,得到一个飞行器的相对可达范围和另一个飞行器的禁飞区,从而判断两个飞行器是否存在碰撞风险,解决了传统方法“漏判”、没有考虑飞行器尺寸的问题,提高了防碰撞感知的可靠性。

The present invention relates to a flight anti-collision sensing method, system, storage medium and equipment. The method includes initializing the two aircrafts that meet each other, and obtaining the initial state information of one aircraft relative to the other aircraft; calculating according to the initial state information The relative reachable range of one of the aircraft affected by the process noise within a given time, and at the same time determine the no-fly zone of the other aircraft based on the initial state information; judge whether there is a collision between the two aircraft based on the relative reachable range and the no-fly zone risk. The flight anti-collision perception method of the present invention performs the anti-collision perception of the aircraft on the basis of considering the influence of the initial state error and process noise in the three-dimensional space, and obtains the relative reachable range of one aircraft and the no-fly zone of another aircraft, thereby Judging whether there is a risk of collision between two aircraft solves the problem of "missing judgment" and not considering the size of the aircraft in the traditional method, and improves the reliability of anti-collision perception.

Description

一种飞行防碰撞感知方法、系统、存储介质及设备A flight anti-collision perception method, system, storage medium and device

技术领域technical field

本发明涉及飞行控制技术领域,尤其涉及一种飞行防碰撞感知方法、系统、存储介质及设备。The present invention relates to the technical field of flight control, in particular to a flight anti-collision sensing method, system, storage medium and equipment.

背景技术Background technique

防碰撞问题一直都是飞行器(航空或航天)重点关注的技术。设两个近距离相遇的飞行器分别为主飞行器和从飞行器,由于实际任务中不可避免地存在系统不确定误差,这些不确定误差可能直接导致主从飞行器之间发生碰撞。防碰撞感知就是要综合导航误差、随机扰动误差、相对飞行轨道等信息,快速地评估未来一段时间是否有碰撞威胁。防碰撞感知是保证两个飞行器之间长时间近距离相对飞行不发生碰撞的前提。The problem of anti-collision has always been the technology that aircraft (aviation or aerospace) focuses on. Assuming that two aircrafts that meet at close range are the master aircraft and the slave aircraft, due to the inevitable system uncertain errors in actual missions, these uncertain errors may directly lead to collisions between the master aircraft and the slave aircraft. Anti-collision perception is to integrate navigation error, random disturbance error, relative flight trajectory and other information to quickly assess whether there is a collision threat in the future. Anti-collision perception is the premise to ensure that there is no collision between two aircrafts flying relatively close to each other for a long time.

传统的防碰撞感知方法采用误差椭球冲突判定法,该方法存在以下缺点:The traditional anti-collision perception method uses the error ellipsoid conflict determination method, which has the following disadvantages:

(1)没有考虑飞行器的尺寸。例如,对尺寸结构比较大的航天器,在误差椭球不相交的时候也可能发生碰撞。(1) The size of the aircraft is not considered. For example, for a spacecraft with a relatively large size structure, collisions may also occur when the error ellipsoids do not intersect.

(2)容易出现“漏判”情况。误差椭球的重叠并不一定发生在名义距离最近的位置。事实上,由于误差椭球在空间中的指向是在不断演变的,因此很难预先确定误差椭球发生接触的具体时刻。因此,即使主从飞行器在名义最小距离处误差椭球没有相交,但它们仍然可能在非最小距离处相交,仍然具有较大的碰撞可能性,因此该方法容易出现“漏判”的情况。(2) "Misjudgment" is prone to occur. The overlapping of the error ellipsoids does not necessarily occur at the nominally closest position. In fact, since the orientation of the error ellipsoids in space is constantly evolving, it is difficult to predetermine the specific moment when the error ellipsoids touch. Therefore, even if the error ellipsoids of the master and slave aircraft do not intersect at the nominal minimum distance, they may still intersect at a non-minimum distance, and there is still a high possibility of collision, so this method is prone to "missing judgment".

发明内容Contents of the invention

本发明所要解决的技术问题是针对上述现有技术的不足,提供一种基于三维位置空间噪声作用下的相对可达范围的飞行防碰撞感知方法、系统、存储介质及设备。The technical problem to be solved by the present invention is to provide a flight anti-collision perception method, system, storage medium and equipment based on the relative reachable range under the action of three-dimensional positional space noise in view of the above-mentioned deficiencies in the prior art.

本发明解决上述技术问题的技术方案如下:一种飞行防碰撞感知方法,包括如下步骤:The technical solution of the present invention to solve the above-mentioned technical problems is as follows: a flight anti-collision sensing method, comprising the following steps:

步骤1:对空中飞行的两个飞行器分别进行初始化,获取其中一个飞行器相对于另一个飞行器的初始状态信息;Step 1: Initialize the two aircraft flying in the air respectively, and obtain the initial state information of one aircraft relative to the other aircraft;

步骤2:根据所述初始状态信息确定所述其中一个飞行器在相对位置子空间的相对可达范围,以及根据所述初始状态信息确定所述另一个飞行器的禁飞区;Step 2: Determine the relative reachable range of one of the aircraft in the relative position subspace according to the initial state information, and determine the no-fly zone of the other aircraft according to the initial state information;

步骤3:根据所述其中一个飞行器的相对可达范围与所述另一个飞行器的禁飞区在三维空间内的位置关系判断所述两个飞行器之间是否存在碰撞风险。Step 3: Judging whether there is a risk of collision between the two aircraft according to the positional relationship between the relative reachable range of the one aircraft and the no-fly zone of the other aircraft in three-dimensional space.

本发明的有益效果是:本发明的飞行防碰撞感知方法,在三维空间内考虑初始状态误差和干扰噪声的影响的基础上进行飞行器的防碰撞感知,得到一个飞行器的相对可达范围和另一个飞行器的禁飞区,从而判断两个飞行器是否存在碰撞风险,解决了传统方法“漏判”、没有考虑飞行器尺寸的问题,提高了防碰撞感知的可靠性。The beneficial effects of the present invention are: the flight anti-collision perception method of the present invention, on the basis of considering the influence of the initial state error and the interference noise in the three-dimensional space, the anti-collision perception of the aircraft is carried out, and the relative reachable range of one aircraft and the relative reachable range of another aircraft are obtained. The no-fly zone of the aircraft, so as to judge whether there is a risk of collision between two aircraft, solve the problem of "missing judgment" and not considering the size of the aircraft in the traditional method, and improve the reliability of anti-collision perception.

在上述技术方案的基础上,本发明还可以做如下改进:On the basis of above-mentioned technical scheme, the present invention can also be improved as follows:

进一步:所述步骤1中,所述初始状态信息具体包括:名义初始状态初始状态误差分布P0、干扰噪声w(t)的强度Q、评估时间长度Δt和最小安全距离ρ;Further: in the step 1, the initial state information specifically includes: nominal initial state Initial state error distribution P 0 , intensity Q of interference noise w(t), evaluation time length Δt and minimum safety distance ρ;

其中,所述其中一个飞行器相对于所述另一个飞行器的初始状态x(t0)满足高斯分布,所述名义初始状态为所述初始状态x(t0)的期望,初始状态误差分布P0为所述初始状态x(t0)的协方差矩阵,评估时间长度Δt为从初始时刻t0开始的评估碰撞风险发生的时间区间[t0,t0+Δt],最小安全距离ρ为两个飞行器的质心到对应飞行器最远边缘处之间的距离之和。Wherein, the initial state x(t 0 ) of one of the aircraft relative to the other aircraft satisfies a Gaussian distribution, and the nominal initial state is the expectation of the initial state x(t 0 ), the initial state error distribution P 0 is the covariance matrix of the initial state x(t 0 ), and the evaluation time length Δt is the estimated collision risk occurrence from the initial time t 0 [t 0 ,t 0 +Δt], the minimum safe distance ρ is the sum of the distances from the centroids of the two aircraft to the farthest edge of the corresponding aircraft.

上述进一步方案的有益效果是:通过获取所述初始状态信息中的初始状态、初始状态误差分布和干扰噪声强度,可以便于后续确定一个飞行器的相对可达范围时考虑到两个飞行器之间的初始状态误差和过程噪声的影响,从而使得所述其中一个飞行器的相对可达范围更加准确,通过所述初始状态信息中的最小安全距离可以比较精确的确定所述另一个飞行器的禁飞区,便于后续对两个飞行器的碰撞可能性进行准确感知。The beneficial effect of the above further solution is: by acquiring the initial state, initial state error distribution and interference noise intensity in the initial state information, it is convenient to take into account the initial distance between two aircraft when determining the relative reachable range of an aircraft. state error and process noise, so that the relative reachable range of one of the aircraft is more accurate, and the no-fly zone of the other aircraft can be determined more accurately through the minimum safe distance in the initial state information, which facilitates Follow up to accurately perceive the possibility of collision between the two aircraft.

进一步:所述步骤2具体包括:Further: said step 2 specifically includes:

步骤21:根据所述初始状态信息建立三维空间误差模型;Step 21: Establishing a three-dimensional space error model according to the initial state information;

步骤22:根据所述三维空间误差模型确定其中一个飞行器在相对位置子空间的相对位置误差范围;Step 22: Determine the relative position error range of one of the aircraft in the relative position subspace according to the three-dimensional space error model;

步骤23:根据其中一个飞行器在相对位置子空间的相对位置误差范围确定其相对可达范围;Step 23: Determine the relative reachable range of one of the aircraft according to its relative position error range in the relative position subspace;

步骤24:根据所述初始状态信息确定所述另一个飞行器的禁飞区。Step 24: Determine a no-fly zone of the other aircraft according to the initial state information.

上述进一步方案的有益效果是:通过建立三维空间误差模型,可以考虑相对飞行过程中的初始状态误差和过程噪声的影响,从而可以更加精确的确定其中一个飞行器在相对飞行过程中的位置误差范围,这样即可根据该飞行器在相对飞行过程中的位置误差范围准确的确定其相对可达范围,结合另一个飞行器的禁飞区实现高精度的碰撞感知。The beneficial effect of the above-mentioned further scheme is: by establishing a three-dimensional space error model, the influence of the initial state error and process noise during the relative flight process can be considered, so that the position error range of one of the aircraft during the relative flight process can be determined more accurately, In this way, the relative reachable range of the aircraft can be accurately determined according to the position error range of the aircraft in the relative flight process, and high-precision collision sensing can be realized in combination with the no-fly zone of another aircraft.

进一步:所述步骤21中所述三维空间误差模型为:Further: the three-dimensional space error model described in the step 21 is:

初始状态x(t0)满足高斯分布 The initial state x(t 0 ) satisfies the Gaussian distribution

其中为状态矢量x(t)相对于时间t的导数,F(t)为系统矩阵,w(t)为干扰噪声,G为系数矩阵,I3×3为单位矩阵,03×3为零矩阵。in is the derivative of the state vector x(t) relative to time t, F(t) is the system matrix, w(t) is the interference noise, G is the coefficient matrix, I 3×3 is the identity matrix, 0 3×3 is the zero matrix .

上述进一步方案的有益效果是:通过建立所述三维空间误差模型,可以便于后续根据所述三维空间误差模型准确的确定其中一个飞行器在相对位置子空间的相对位置误差范围。The beneficial effect of the above further solution is: by establishing the three-dimensional space error model, it is convenient to accurately determine the relative position error range of one of the aircraft in the relative position subspace subsequently according to the three-dimensional space error model.

进一步:根据所述三维空间误差模型确定所述其中一个飞行器在全空间的状态误差范围,具体包括:Further: determining the state error range of one of the aircraft in the whole space according to the three-dimensional space error model, specifically including:

初始状态x(t0)满足高斯分布,且干扰噪声w(t)为高斯白噪声,则飞行器在任一时刻t的状态矢量x(t)满足高斯分布,其统计特性满足:The initial state x(t 0 ) satisfies the Gaussian distribution, and the interference noise w(t) is Gaussian white noise, then the state vector x(t) of the aircraft at any time t satisfies the Gaussian distribution, and its statistical characteristics satisfy:

为名义轨道状态,为从飞行器相对于所述另一个飞行器的初始状态,为状态矢量x(t)相对于时间t的导数,F(t)为系统矩阵,Φ(t,t0)为由三维空间误差模型确定的任意时刻t(t>t0)时的状态转移矩阵,为状态矢量x(t)的期望,G为系数矩阵,P0为初始状态误差分布,Q为干扰噪声强度,根据上式(6)-(9)计算出全空间内其中一个飞行器的状态矢量x(t)在任意时刻的均值和协方差矩阵为P; is the nominal orbital state, is the initial state of the slave aircraft relative to the other aircraft, is the derivative of the state vector x(t) relative to time t, F(t) is the system matrix, Φ(t,t 0 ) is the state transition at any time t(t>t 0 ) determined by the three-dimensional space error model matrix, is the expectation of the state vector x(t), G is the coefficient matrix, P 0 is the initial state error distribution, Q is the interference noise intensity, and the state vector of one of the aircraft in the whole space is calculated according to the above formulas (6)-(9) The mean value of x(t) at any time and the covariance matrix is P;

根据所述均值和协方差矩阵P确定所述其中一个飞行器在全空间的状态误差范围为椭球,表示为:According to the mean and the covariance matrix P determine that the state error range of one of the aircraft in the whole space is an ellipsoid, expressed as:

A=P-1/k2 (11)A=P -1 /k 2 (11)

其中,所述其中一个飞行器在全空间的状态矢量x(t)在任意时刻的期望是椭球的中心,A为全空间误差椭球矩阵,k2由概率密度大小的马氏距离确定;Among them, the expectation of the state vector x(t) of one of the aircraft in the whole space at any time is the center of the ellipsoid, A is the full-space error ellipsoid matrix, and k 2 is determined by the Mahalanobis distance of the probability density;

步骤222:根据所述其中一个飞行器在全空间的状态误差范围确定所述其中一个飞行器在相对位置子空间的相对位置误差范围,具体为:Step 222: Determine the relative position error range of one of the aircraft in the relative position subspace according to the state error range of one of the aircraft in the whole space, specifically:

所述其中一个飞行器在相对位置子空间的相对位置误差范围r满足如下关系式:The relative position error range r of one of the aircraft in the relative position subspace satisfies the following relationship:

r=Lx (12)r=Lx (12)

L=[I3×3 03×3] (13)L=[I 3×3 0 3×3 ] (13)

其中,L为当仅考虑相对位置子空间的投影矩阵,Arr为位置误差椭球矩阵,位置状态误差分布矩阵Prr=LPLTWherein, L is the projection matrix when only the relative position subspace is considered, A rr is the position error ellipsoid matrix, and the position state error distribution matrix P rr = LPL T .

上述进一步方案的有益效果是:根据所述三维空间误差模型可以准确的确定所述其中一个飞行器在全空间的状态误差范围,并通过所述投影矩阵从所述全空间中提取出所述其中一个飞行器在相对位置子空间的相对位置误差范围。The beneficial effect of the above further solution is that: according to the three-dimensional space error model, the state error range of one of the aircraft in the whole space can be accurately determined, and the one of the aircraft is extracted from the whole space through the projection matrix. The relative position error range of the aircraft in the relative position subspace.

进一步:所述步骤23具体包括:Further: said step 23 specifically includes:

在相对位置子空间里,对任意时刻t总存在一个由式(15)中Arr(t)定义的相对位置误差范围为椭球C(t,r),满足如下方程:In the relative position subspace, for any time t, there is always a relative position error range defined by A rr (t) in formula (15) as the ellipsoid C(t,r), which satisfies the following equation:

C(t,r)=0 (16)C(t,r)=0 (16)

联立上述方程(16)和(17)消除时间参数t,得到相对可达范围包络面。Combine the above equations (16) and (17) to eliminate the time parameter t, and obtain the envelope surface of the relative reachable range.

上述进一步方案的有益效果是:通过确定所述相对位置误差范围的包络面即可准确的确定所述其中一个飞行器在相对位置子空间内的可达范围。The beneficial effect of the above further solution is that the reachable range of one of the aircrafts in the relative position subspace can be accurately determined by determining the envelope surface of the relative position error range.

进一步:所述步骤24中,所述根据所述初始状态信息确定所述另一个飞行器的禁飞区的具体实现为:根据所述最小安全距离ρ确定所述禁飞区。Further: in the step 24, the specific implementation of determining the no-fly zone of the other aircraft according to the initial state information is: determining the no-fly zone according to the minimum safety distance ρ.

上述进一步方案的有益效果是:通过由飞行器的外形尺寸确定的最小安全距离可以对禁飞区的几何外形进行约束,从而准确的限定禁飞区的边界。The beneficial effect of the above further solution is that the geometric shape of the no-fly zone can be restricted by the minimum safety distance determined by the external dimensions of the aircraft, thereby accurately defining the boundary of the no-fly zone.

进一步:所述步骤3具体包括:Further: said step 3 specifically includes:

若所述其中一个飞行器的相对可达范围与所述另一个飞行器禁飞区在三维空间无交集,则在给定的时间段内两个飞行器相对飞行无发生碰撞风险;否则,两个飞行器相对飞行存在发生碰撞风险。If the relative reachable range of one of the aircraft does not intersect with the no-fly zone of the other aircraft in three-dimensional space, there is no risk of collision between the two aircrafts flying relative to each other within a given period of time; There is a risk of collision in flight.

上述进一步方案的有益效果是:通过判断所述其中一个飞行器的相对可达范围和所述另一个飞行器禁飞区在三维空间的位置关系,可以准确的判断两个所述飞行器有无碰撞风险,简单直观,可靠性高。The beneficial effect of the above further solution is: by judging the relative reachable range of one of the aircraft and the positional relationship of the no-fly zone of the other aircraft in three-dimensional space, it is possible to accurately determine whether there is a risk of collision between the two aircraft, Simple and intuitive, high reliability.

本发明还提供了一种飞行防碰撞感知系统,包括初始化模块、计算模块和判断模块;The present invention also provides a flight anti-collision perception system, including an initialization module, a calculation module and a judgment module;

所述初始化模块,用于对空中飞行的两个飞行器分别进行初始化,获取其中一个飞行器相对于另一个飞行器的初始状态信息;The initialization module is used to initialize the two aircraft flying in the air respectively, and obtain the initial state information of one aircraft relative to the other aircraft;

所述计算模块,用于根据所述初始状态信息确定所述其中一个飞行器在给定时间内的相对可达范围,以及根据所述初始状态信息确定所述另一个飞行器的禁飞区;The calculation module is configured to determine the relative reachable range of one of the aircraft within a given time according to the initial state information, and determine the no-fly zone of the other aircraft according to the initial state information;

所述判断模块,用于根据所述其中一个飞行器的相对可达范围与所述另一个飞行器的禁飞区在三维空间内的位置关系判断所述两个飞行器之间是否存在碰撞风险。The judgment module is configured to judge whether there is a risk of collision between the two aircraft according to the positional relationship between the relative reachable range of one of the aircraft and the no-fly zone of the other aircraft in three-dimensional space.

本发明的有益效果是:本发明的飞行防碰撞感知系统,在三维空间内考虑初始状态误差和干扰噪声的影响的基础上进行飞行器的防碰撞感知,得到一个飞行器的相对可达范围和另一个飞行器的禁飞区,从而判断两个飞行器是否存在碰撞风险,解决了传统方法“漏判”、没有考虑飞行器尺寸的问题,提高了防碰撞感知的可靠性。The beneficial effects of the present invention are: the flight anti-collision sensing system of the present invention, on the basis of considering the influence of the initial state error and the interference noise in the three-dimensional space, carries out the anti-collision sensing of the aircraft, and obtains the relative reachable range of one aircraft and the other The no-fly zone of the aircraft, so as to judge whether there is a risk of collision between two aircraft, solve the problem of "missing judgment" and not considering the size of the aircraft in the traditional method, and improve the reliability of anti-collision perception.

本发明还提供了一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时,实现所述的飞行防碰撞感知方法。The present invention also provides a computer-readable storage medium, on which a computer program is stored, wherein, when the computer program is executed by a processor, the above-mentioned flight anti-collision perception method is realized.

本发明还提供了一种基于摄影的地物采集设备,其特征在于,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现所述的飞行防碰撞感知方法的步骤。The present invention also provides a photography-based feature acquisition device, which is characterized in that it includes a memory, a processor, and a computer program stored in the memory and operable on the processor, and the processor executes the The steps of realizing the described flight anti-collision perception method when the computer program is described.

附图说明Description of drawings

图1为本发明的飞行防碰撞感知方法流程示意图;Fig. 1 is a schematic flow chart of the flight anti-collision sensing method of the present invention;

图2为本发明的从飞行器的相对可达范围示意图;Fig. 2 is a schematic diagram of the relative reachable range of the slave aircraft of the present invention;

图3为本发明的从飞行器的误差椭球和相对可达范围包络示意图;3 is a schematic diagram of the error ellipsoid and the relative reachable range envelope of the slave aircraft of the present invention;

图4a为本发明的主飞行器的相对可达范围与从飞行器的禁飞区无交集时的示意图;Fig. 4a is a schematic diagram when the relative reachable range of the master aircraft of the present invention does not intersect with the no-fly zone of the slave aircraft;

图4b为本发明的主飞行器的相对可达范围与从飞行器的禁飞区有交集时的示意图;Fig. 4b is a schematic diagram when the relative reachable range of the master aircraft of the present invention intersects with the no-fly zone of the slave aircraft;

图5为本发明的飞行防碰撞感知系统结构示意图。Fig. 5 is a schematic structural diagram of the flight anti-collision perception system of the present invention.

具体实施方式Detailed ways

以下结合附图对本发明的原理和特征进行描述,所举实例只用于解释本发明,并非用于限定本发明的范围。The principles and features of the present invention are described below in conjunction with the accompanying drawings, and the examples given are only used to explain the present invention, and are not intended to limit the scope of the present invention.

本发明中,假设两个飞行器分别为主飞行器和从飞行器,两个飞行器近距离飞行并在空中相遇,并且主飞行器和从飞行器可互换角色。参考坐标系Sxyz的原点位于主飞行器的质心位置处,如图2所示,设从飞行器相对于主飞行器的飞行状态(为矢量)为x=[rT vT],其中r是相对位置(为矢量),是相对速度(为矢量)。In the present invention, it is assumed that two aircrafts are respectively the master aircraft and the slave aircraft, the two aircrafts fly close to each other and meet in the air, and the roles of the master aircraft and the slave aircraft can be exchanged. The origin of the reference coordinate system S xyz is located at the center of mass position of the main aircraft, as shown in Figure 2, assuming that the flight state (being a vector) of the slave aircraft relative to the main aircraft is x=[r T v T ], where r is the relative position (for a vector), is the relative velocity (as a vector).

如图1所示,一种飞行防碰撞感知方法,包括如下步骤:As shown in Figure 1, a flight anti-collision perception method includes the following steps:

步骤1:对空中飞行的两个飞行器分别进行初始化,获取其中从飞行器相对于主飞行器的初始状态信息;Step 1: Initialize the two aircraft flying in the air respectively, and obtain the initial state information of the slave aircraft relative to the master aircraft;

步骤2:根据所述初始状态信息确定所述其中从飞行器在相对位置子空间的相对可达范围,以及根据所述初始状态信息确定所述主飞行器的禁飞区;Step 2: Determine the relative reachable range of the slave aircraft in the relative position subspace according to the initial state information, and determine the no-fly zone of the master aircraft according to the initial state information;

步骤3:根据所述从飞行器的相对可达范围与所述主飞行器的禁飞区在三维空间内的位置关系判断所述两个飞行器之间是否存在碰撞风险。Step 3: Judging whether there is a risk of collision between the two aircraft according to the positional relationship between the relative reachable range of the slave aircraft and the no-fly zone of the master aircraft in three-dimensional space.

本发明的飞行防碰撞感知方法,在三维空间内考虑初始状态误差和过程噪声的影响的基础上进行飞行器的防碰撞感知,得到从飞行器的相对可达范围和主飞行器的禁飞区,从而判断两个飞行器是否存在碰撞风险,解决了传统方法“漏判”、没有考虑飞行器尺寸的问题,提高了防碰撞感知的可靠性。The flight anti-collision perception method of the present invention is based on considering the influence of the initial state error and process noise in the three-dimensional space to perform anti-collision perception of the aircraft, and obtains the relative reachable range of the slave aircraft and the no-fly zone of the main aircraft, thereby judging Whether there is a risk of collision between two aircrafts solves the problem of "missing judgment" in traditional methods and does not consider the size of the aircraft, and improves the reliability of anti-collision perception.

在本发明提供的实施例中,所述初始状态信息具体包括:名义初始状态初始状态误差分布P0、干扰噪声w(t)的强度Q、评估时间长度Δt和最小安全距离ρ。In the embodiment provided by the present invention, the initial state information specifically includes: nominal initial state The initial state error distribution P 0 , the intensity Q of the disturbance noise w(t), the evaluation time length Δt and the minimum safety distance ρ.

在初始时刻t0,从飞行器相对于主飞行器在全空间(包括相对位置子空间和相对速度子空间)的不确定初始状态为x(t0)满足高斯分布,即At the initial time t 0 , the uncertain initial state of the slave aircraft relative to the master aircraft in the whole space (including the relative position subspace and the relative velocity subspace) is x(t 0 ) that satisfies the Gaussian distribution, namely

则定义初始状态的期望为名义初始状态,定义不确定初始状态的协方差矩阵为初始状态误差分布P0Then define the expectation of the initial state is the nominal initial state, and defines the covariance matrix of the uncertain initial state as the initial state error distribution P 0 ;

设在两个飞行器相对飞行的过程中干扰噪声为w(t),通常情况下,干扰噪声w(t)近似为零均值的高斯白噪声,其噪声强度用谱密度函数Q表示,满足:Assuming that the interference noise is w(t) during the relative flight of the two aircraft, under normal circumstances, the interference noise w(t) is approximately zero-mean Gaussian white noise, and its noise intensity is expressed by the spectral density function Q, which satisfies:

E[w(t)wT(t-τ)]=Qδ(τ) (2)E[w(t)w T (t-τ)]=Qδ(τ) (2)

其中,E(·)表示期望,δ(τ)为狄拉克函数;Among them, E(·) represents expectation, δ(τ) is Dirac function;

评估时间长度用来定义从t0时刻开始、评估碰撞风险发生的时间区间,该区间表示为[t0,t0+Δt];The evaluation time length is used to define the time interval from the time t 0 to evaluate the occurrence of collision risk, which is expressed as [t 0 ,t 0 +Δt];

假设两个飞行器的质心到对应飞行器最远边缘处之间的距离分别为ρc和ρd,则最小安全距离ρ可表示为:Assuming that the distances between the centroids of the two aircraft and the farthest edges of the corresponding aircraft are ρc and ρd respectively, the minimum safe distance ρ can be expressed as:

ρ=ρcd (3)ρ = ρ c + ρ d (3)

如果两个飞行器结构近似为球形,那么最小安全距离可表示为两个球形半径之和。If the two aircraft structures are approximately spherical, then the minimum safety distance can be expressed as the sum of the radii of the two spheres.

通过获取所述初始状态信息中的初始状态初始状态误差分布P0和干扰噪声强度Q,可以便于后续确定从飞行器的相对可达范围时考虑到两个飞行器之间的初始状态误差和过程噪声的影响,从而使得所述其中从飞行器的相对可达范围更加准确,通过所述初始状态信息中的最小安全距离可以比较精确的确定所述主飞行器的禁飞区,便于后续对两个飞行器的碰撞可能性进行准确感知。By obtaining the initial state in the initial state information The initial state error distribution P 0 and the interference noise intensity Q can facilitate subsequent determination of the relative reachable range of the slave aircraft by taking into account the influence of the initial state error and process noise between the two aircraft, so that the relative range of the slave aircraft The reachable range is more accurate, and the no-fly zone of the main aircraft can be determined relatively accurately through the minimum safe distance in the initial state information, so as to facilitate subsequent accurate perception of the collision possibility of the two aircraft.

在本发明提供的实施例中,所述步骤2具体包括:In the embodiment provided by the present invention, the step 2 specifically includes:

步骤21:根据所述初始状态信息建立三维空间误差模型:Step 21: Establish a three-dimensional space error model according to the initial state information:

初始状态x(t0)满足高斯分布 The initial state x(t 0 ) satisfies the Gaussian distribution

其中为状态矢量x(t)相对于时间t的导数,F(t)为系统矩阵,w(t)为干扰噪声,G为系数矩阵,I3×3为单位矩阵,03×3为零矩阵;in is the derivative of the state vector x(t) relative to time t, F(t) is the system matrix, w(t) is the interference noise, G is the coefficient matrix, I 3×3 is the identity matrix, 0 3×3 is the zero matrix ;

步骤22:根据所述三维空间误差模型计算其中从飞行器在相对飞行过程中的位置误差范围,包括:Step 22: Calculate the position error range of the slave aircraft during relative flight according to the three-dimensional space error model, including:

步骤221:根据所述三维空间误差模型确定所述其中一个飞行器在全空间的状态误差误差范围,具体包括:Step 221: Determine the state error error range of one of the aircraft in the whole space according to the three-dimensional space error model, specifically including:

初始状态x(t0)满足高斯分布,且干扰噪声w(t)为高斯白噪声,则从飞行器在任一时刻t的状态矢量x(t)满足高斯分布,其统计特性满足:The initial state x(t 0 ) satisfies the Gaussian distribution, and the interference noise w(t) is Gaussian white noise, then the state vector x(t) of the slave aircraft at any time t satisfies the Gaussian distribution, and its statistical characteristics satisfy:

为名义轨道状态,为从飞行器相对于主飞行器的初始状态,为状态矢量x(t)相对于时间t的导数,F(t)为系统矩阵,Φ(t,t0)为由三维空间误差模型确定的任意时刻t(t>t0)时的状态转移矩阵,为状态矢量x(t)的期望,G为系数矩阵,P0为初始状态误差分布,Q为干扰噪声强度,根据上式(6)-(9)计算出全空间内其中一个飞行器的状态矢量x(t)在任意时刻的均值和协方差矩阵为P; is the nominal orbital state, is the initial state of the slave aircraft relative to the master aircraft, is the derivative of the state vector x(t) relative to time t, F(t) is the system matrix, Φ(t,t 0 ) is the state transition at any time t(t>t 0 ) determined by the three-dimensional space error model matrix, is the expectation of the state vector x(t), G is the coefficient matrix, P 0 is the initial state error distribution, Q is the interference noise intensity, and the state vector of one of the aircraft in the whole space is calculated according to the above formulas (6)-(9) The mean value of x(t) at any time and the covariance matrix is P;

根据所述均值和协方差矩阵P确定所述其中一个飞行器在全空间的状态误差范围为椭球,表示为:According to the mean and the covariance matrix P determine that the state error range of one of the aircraft in the whole space is an ellipsoid, expressed as:

A=P-1/k2 (11)A=P -1 /k 2 (11)

其中,所述其中一个飞行器在全空间的状态矢量x(t)在任意时刻的期望是椭球的中心,A为误差椭球矩阵,k2由概率密度大小的马氏距离确定;Among them, the expectation of the state vector x(t) of one of the aircraft in the whole space at any time is the center of the ellipsoid, A is the error ellipsoid matrix, and k 2 is determined by the Mahalanobis distance of the probability density;

步骤222:根据所述其中一个飞行器在全空间的状态误差范围确定所述其中一个飞行器在相对位置子空间的相对位置误差范围,具体为:Step 222: Determine the relative position error range of one of the aircraft in the relative position subspace according to the state error range of one of the aircraft in the whole space, specifically:

所述从飞行器在相对位置子空间的相对位置误差范围r满足如下关系式:The relative position error range r of the slave aircraft in the relative position subspace satisfies the following relational expression:

r=Lx (13)r=Lx (13)

L=[I3×3 03×3] (14)L=[I 3×3 0 3×3 ] (14)

其中,L为当仅考虑相对位置子空间的投影矩阵,Arr为位置误差椭球矩阵,位置状态误差分布矩阵Prr=LPLTWherein, L is the projection matrix when only the relative position subspace is considered, A rr is the position error ellipsoid matrix, and the position state error distribution matrix P rr = LPL T .

步骤23:根据其中从飞行器在相对飞行过程中的位置误差范围确定其相对可达范围。Step 23: Determine the relative reachable range of the secondary aircraft according to the position error range during the relative flight process.

如图2所示,由于存在随机误差,从飞行器相对于主飞行器的实际飞行轨道是随机分布在名义飞行轨道(如图2中虚线所示)附近的范围内。三维位置空间噪声作用下相对可达范围是指在初始状态随机不确定误差和过程噪声条件下,在给定时间区间[t0,t0+Δt]上可能的相对飞行轨道的集合(此处“可能的”是指某一条相对飞行轨道的出现是“非小概率事件”)。相对可达范围用符号表示,其中ri(t)表示任意一条可能出现的实际相对飞行轨道。As shown in Figure 2, due to random errors, the actual flight trajectory of the slave aircraft relative to the master aircraft is randomly distributed in the nominal flight trajectory (as shown by the dotted line in Figure 2). The relative reachable range under the influence of three-dimensional position space noise refers to the set of possible relative flight trajectories on a given time interval [t 0 ,t 0 +Δt] under the condition of random uncertain error in the initial state and process noise (here "Possible" means that the occurrence of a certain relative flight trajectory is a "non-small probability event"). Symbol for relative reachable range , where ri (t) represents any possible actual relative flight trajectory.

相对可达范围可从位置误差椭球的演化方程来进行求解。由概率统计理论可知,在相对位置子空间里,对任意时刻t总存在一个由式(15)中Arr(t)定义的相对位置误差范围为椭球(或椭圆),记为C(t,r),且该椭球中心位于名义飞行轨道上,如图3所示。在一个时间段[t0,tf]上,误差椭球是空间中一簇随时间演变的曲面,并扫出一片区域,该区域则是要求解的不确定条件下的相对可达范围。要确定相对可达范围,也就是要求解相对可达范围的边界,也称之为包络。对三维空间中的相对可达范围,这个边界包络是一个二维曲面;对二维的相对可达范围,该边界是一个一维曲线。The relative reachable range can be solved from the evolution equation of the position error ellipsoid. According to the theory of probability and statistics, in the relative position subspace, for any time t, there is always a relative position error range defined by A rr (t) in formula (15), which is an ellipsoid (or ellipse), denoted as C(t ,r), and the center of the ellipsoid is located in the nominal flight path on, as shown in Figure 3. In a period of time [t 0 ,t f ], the error ellipsoid is a cluster of surfaces evolving with time in space, and sweeps out a region, which is the relative reachable range under the uncertain conditions to be solved. To determine the relative reachable range, it is required to solve the boundary of the relative reachable range, also known as the envelope. For the relative reachable range in three-dimensional space, the boundary envelope is a two-dimensional surface; for the two-dimensional relative reachable range, the boundary envelope is a one-dimensional curve.

相对可达范围的包络就是曲面簇C(t,r)的包络。因此,相对可达范围满足方程:The envelope of the relative reach is the envelope of the surface family C(t,r). Therefore, the relative reach satisfies the equation:

C(t,r)=0 (16)C(t,r)=0 (16)

联立上述方程(16)和(17)即可消除时间参数t,得到不含时间参量的相对可达范围包络面。三维位置空间噪声作用下相对可达范围是一个环绕名义飞行轨道的管状区域。By combining the above equations (16) and (17), the time parameter t can be eliminated, and the envelope surface of the relative reachable range without the time parameter can be obtained. The relative reachable range under the effect of three-dimensional positional space noise is a tubular region around the nominal flight trajectory.

步骤24:根据所述初始状态信息中的最小安全距离ρ确定所述主飞行器的禁飞区Z(r),相对飞行的禁飞区是由飞行器的几何外形决定的。一旦相对飞行中,从飞行器质心进入主飞行器的禁飞区,则认为发生了飞行器之间发生了物理接触,禁飞区用Z(r)可以表示成一个不等式约束:Step 24: Determine the no-fly zone Z(r) of the host aircraft according to the minimum safety distance ρ in the initial state information, and the no-fly zone for relative flight is determined by the geometric shape of the aircraft. Once in the relative flight, from the center of mass of the aircraft into the no-fly zone of the main aircraft, it is considered that physical contact has occurred between the aircraft, and the no-fly zone can be expressed as an inequality constraint with Z(r):

Z:g(r)≤0 (18)Z:g(r)≤0 (18)

通常情况下,飞行器是不规则的形状,此时,禁飞区需要根据由飞行器的形状和尺寸确定的最小安全距离ρ预先设定;当两个飞行器的外形为球形时,禁飞区可以定义为以从飞行器为圆心、最小安全距离ρ为半径的球形范围,记为符号Z。假设该飞行器质心位于参考坐标系原点,则禁飞区可表示为:Usually, the aircraft is of irregular shape. At this time, the no-fly zone needs to be preset according to the minimum safe distance ρ determined by the shape and size of the aircraft; when the shape of the two aircraft is spherical, the no-fly zone can be defined It is a spherical range with the center of the circle from the aircraft and the radius of the minimum safety distance ρ, marked as the symbol Z. Assuming that the center of mass of the aircraft is located at the origin of the reference coordinate system, the no-fly zone can be expressed as:

Z:g(r)=rTr-ρ2≤0 (19)Z:g(r)=r T r-ρ 2 ≤0 (19)

其中,r为主飞行器的位置变量,ρ为最小安全距离。Among them, r is the position variable of the main aircraft, and ρ is the minimum safe distance.

通过建立三维空间误差模型,可以考虑相对飞行过程中的初始状态误差和过程噪声的影响,从而可以更加精确的确定其中从飞行器在相对飞行过程中的位置误差范围,这样即可根据该飞行器在相对飞行过程中的位置误差范围准确的确定其相对可达范围,结合主飞行器的禁飞区实现高精度的碰撞感知。By establishing a three-dimensional space error model, the influence of the initial state error and process noise during the relative flight process can be considered, so that the position error range of the slave aircraft during the relative flight process can be determined more accurately, so that the relative flight process can be based on the aircraft. The position error range during the flight accurately determines its relative reachable range, combined with the no-fly zone of the main aircraft to achieve high-precision collision perception.

对一个从飞行器在三维空间中相对于主飞行器的相对飞行,在存在初始状态随机误差和过程噪声干扰的情况下,能够计算得到给定的时间段上的从飞行器飞行的相对可达范围。利用相对可达范围和位于主飞行器的禁飞区,通过对它们的几何关系进行判断,能够给出一种比传统方法更加可靠的碰撞风险感知方法。For the relative flight of a slave aircraft relative to the master aircraft in three-dimensional space, in the presence of random errors in the initial state and process noise interference, the relative reachable range of the slave aircraft in a given time period can be calculated. Utilizing the relative reachable range and the no-fly zone located on the main aircraft, and judging their geometric relationship, a more reliable collision risk perception method than the traditional method can be given.

在本发明提供的实施例中,所述步骤3具体包括:In the embodiment provided by the present invention, the step 3 specifically includes:

若所述其中从飞行器的相对可达范围与所述主飞行器禁飞区在三维空间无交集(即相离),则在给定的时间段内两个飞行器相对飞行无发生碰撞风险,相对飞行是安全的;否则,两个飞行器相对飞行存在发生碰撞风险,相对飞行是不安全的。If the relative reachable range of the slave aircraft and the no-fly zone of the main aircraft have no intersection (i.e., separation) in three-dimensional space, then there is no risk of collision between the two aircraft relative to each other within a given period of time. It is safe; otherwise, there is a risk of collision between two aircrafts flying relative to each other, and the relative flight is unsafe.

通过判断所述其中从飞行器的相对可达范围和所述主飞行器禁飞区在三维空间的位置关系,可以准确的判断两个所述飞行器有无碰撞风险,简单直观,可靠性高。By judging the relative reachable range of the slave aircraft and the positional relationship of the no-fly zone of the master aircraft in three-dimensional space, it is possible to accurately determine whether there is a risk of collision between the two aircraft, which is simple, intuitive and highly reliable.

上述判定方法的示意图如图4(a)和4(b)所示,其中安全的相对飞行对应的相对可达范围和禁飞区是相离的,如图4a所示,而有碰撞风险的不安全的相对飞行,相对可达范围和禁飞区会有交集,如图4b所示。这一基于相对可达范围的碰撞风险预判条件比传统方法更加可靠,因为该条件考虑了相对飞行时间段内所有的可能情况,而非某些特定的时刻,从而能够避免传统预判方法出现漏判的情况。The schematic diagrams of the above determination methods are shown in Figures 4(a) and 4(b), where the relative reachable range corresponding to the safe relative flight is separated from the no-fly zone, as shown in Figure 4a, while those with a risk of collision Unsafe relative flight, relative reachable range and no-fly zone will have intersection, as shown in Figure 4b. This collision risk prediction condition based on the relative reachable range is more reliable than the traditional method, because this condition considers all possible situations in the relative flight time period, rather than some specific moments, so that it can avoid the occurrence of traditional prediction methods. Situations of misjudgment.

如图5所示,本发明还提供了一种飞行防碰撞感知系统,包括初始化模块、计算模块和判断模块;As shown in Figure 5, the present invention also provides a flight anti-collision perception system, including an initialization module, a calculation module and a judgment module;

所述初始化模块,用于对空中飞行的两个飞行器分别进行初始化,获取其中一个飞行器相对于另一个飞行器的初始状态信息;The initialization module is used to initialize the two aircraft flying in the air respectively, and obtain the initial state information of one aircraft relative to the other aircraft;

所述计算模块,用于根据所述初始状态信息确定所述其中一个飞行器在给定时间内的相对可达范围,以及根据所述初始状态信息确定所述另一个飞行器的禁飞区;The calculation module is configured to determine the relative reachable range of one of the aircraft within a given time according to the initial state information, and determine the no-fly zone of the other aircraft according to the initial state information;

所述判断模块,用于根据所述其中一个飞行器的相对可达范围与所述另一个飞行器的禁飞区在三维空间内的位置关系判断所述两个飞行器之间是否存在碰撞风险。The judgment module is configured to judge whether there is a risk of collision between the two aircraft according to the positional relationship between the relative reachable range of one of the aircraft and the no-fly zone of the other aircraft in three-dimensional space.

本发明的飞行防碰撞感知系统,在三维空间内考虑初始状态误差和过程噪声的影响的基础上进行飞行器的防碰撞感知,得到从飞行器的相对可达范围和主飞行器的禁飞区,从而判断两个飞行器是否存在碰撞风险,解决了传统方法“漏判”、没有考虑飞行器尺寸的问题,提高了防碰撞感知的可靠性。The flight anti-collision perception system of the present invention performs the anti-collision perception of the aircraft on the basis of considering the influence of the initial state error and process noise in the three-dimensional space, and obtains the relative reachable range of the slave aircraft and the no-fly zone of the main aircraft, thereby judging Whether there is a risk of collision between two aircrafts solves the problem of "missing judgment" in traditional methods and does not consider the size of the aircraft, and improves the reliability of anti-collision perception.

在本发明提供的实施例中,所述初始状态信息包括名义初始状态初始状态误差分布P0、干扰噪声w(t)的强度Q、评估时间长度Δt和最小安全距离ρ。In the embodiment provided by the present invention, the initial state information includes nominal initial state The initial state error distribution P 0 , the intensity Q of the disturbance noise w(t), the evaluation time length Δt and the minimum safety distance ρ.

其中,所述其中一个飞行器相对于所述另一个飞行器的初始状态x(t0)满足高斯分布,所述名义初始状态为所述初始状态x(t0)的期望,初始状态误差分布P0为所述初始状态x(t0)的协方差矩阵,评估时间长度Δt为从初始时刻t0开始的评估碰撞风险发生的时间区间[t0,t0+Δt],最小安全距离ρ为两个飞行器的质心到对应飞行器最远边缘处之间的距离之和。Wherein, the initial state x(t 0 ) of one of the aircraft relative to the other aircraft satisfies a Gaussian distribution, and the nominal initial state is the expectation of the initial state x(t 0 ), the initial state error distribution P 0 is the covariance matrix of the initial state x(t 0 ), and the evaluation time length Δt is the estimated collision risk occurrence from the initial time t 0 [t 0 ,t 0 +Δt], the minimum safe distance ρ is the sum of the distances from the centroids of the two aircraft to the farthest edge of the corresponding aircraft.

通过获取所述初始状态信息中的初始状态初始状态误差分布P0和干扰噪声强度Q,可以便于后续确定从飞行器的相对可达范围时考虑到两个飞行器之间的初始状态误差和过程噪声的影响,从而使得所述其中从飞行器的相对可达范围更加准确,通过:所述初始状态信息中的最小安全距离可以比较精确的确定所述主飞行器的禁飞区,便于后续对两个飞行器的碰撞可能性进行准确感知。By obtaining the initial state in the initial state information The initial state error distribution P 0 and the interference noise intensity Q can facilitate subsequent determination of the relative reachable range of the slave aircraft by taking into account the influence of the initial state error and process noise between the two aircraft, so that the relative range of the slave aircraft The reachable range is more accurate, and the no-fly zone of the main aircraft can be relatively accurately determined through the minimum safe distance in the initial state information, so as to facilitate subsequent accurate perception of the collision possibility of the two aircraft.

在本发明提供的实施例中,所述计算模块具体用于:In the embodiments provided by the present invention, the calculation module is specifically used for:

根据所述初始状态信息建立三维空间误差模型;Establishing a three-dimensional space error model according to the initial state information;

根据所述三维空间误差模型确定其中从飞行器在相对位置子空间的相对位置误差范围:Determine wherein the relative position error range of the slave aircraft in the relative position subspace according to the three-dimensional space error model:

根据其中从飞行器在相对位置子空间的相对位置误差范围确定其相对可达范围;Determine its relative reachable range according to the relative position error range of the slave aircraft in the relative position subspace;

根据所述初始状态信息确定所述主飞行器的禁飞区。A no-fly zone of the host aircraft is determined according to the initial state information.

通过建立三维空间误差模型,可以考虑相对飞行过程中的初始状态误差和过程噪声的影响,从而可以更加精确的确定其中从飞行器在相对飞行过程中的位置误差范围,这样即可根据该飞行器在相对飞行过程中的位置误差范围准确的确定其相对可达范围,结合主飞行器的禁飞区实现高精度的碰撞感知。By establishing a three-dimensional space error model, the influence of the initial state error and process noise during the relative flight process can be considered, so that the position error range of the slave aircraft during the relative flight process can be determined more accurately, so that the relative flight process can be based on the aircraft. The position error range during the flight accurately determines its relative reachable range, combined with the no-fly zone of the main aircraft to achieve high-precision collision perception.

在本发明提供的实施例中,所述根据所述三维空间误差模型确定其中从飞行器在相对位置子空间的相对位置误差范围包括:In the embodiment provided by the present invention, the determination of the relative position error range of the slave aircraft in the relative position subspace according to the three-dimensional space error model includes:

根据所述三维空间误差模型确定所述其中一个飞行器在全空间的状态误差范围;determining the state error range of one of the aircraft in the whole space according to the three-dimensional space error model;

根据所述其中一个飞行器在全空间的状态误差范围确定所述其中一个飞行器在相对位置子空间的相对位置误差范围。The relative position error range of the one of the aircraft in the relative position subspace is determined according to the state error range of the one of the aircraft in the whole space.

根据所述三维空间误差模型可以准确的确定所述其中一个飞行器在全空间的状态误差范围,并通过所述投影矩阵从所述全空间中提取出所述其中一个飞行器在相对位置子空间的相对位置误差范围。According to the three-dimensional space error model, the state error range of one of the aircraft in the whole space can be accurately determined, and the relative position of the one of the aircraft in the relative position subspace can be extracted from the whole space through the projection matrix. Position error range.

在本发明提供的实施例中,所述禁飞区由两个飞行器的质心到对应飞行器最远边缘处之间的距离确定,通过不等式约束表示。通过不等式可以对禁飞区的几何外形进行约束,从而准确的限定禁飞区的边界。In the embodiment provided by the present invention, the no-fly zone is determined by the distance between the centroids of the two aircrafts and the farthest edge of the corresponding aircraft, represented by an inequality constraint. The geometric shape of the no-fly zone can be constrained by the inequality, so as to accurately define the boundary of the no-fly zone.

在本发明提供的实施例中,所述判断模块判断所述两个飞行器之间是否存在碰撞风险的具体实现为:In the embodiment provided by the present invention, the specific implementation of the judging module judging whether there is a risk of collision between the two aircrafts is as follows:

若所述其中从飞行器的相对可达范围和所述主飞行器禁飞区在三维空间无交集,则在给定的时间段内两个飞行器相对飞行无发生碰撞风险,相对飞行是安全的;否则,两个飞行器相对飞行存在发生碰撞风险,相对飞行是不安全的。If there is no intersection between the relative reachable range of the slave aircraft and the no-fly zone of the master aircraft in three-dimensional space, there is no risk of collision between the two aircraft in a given period of time, and the relative flight is safe; otherwise , there is a risk of collision between two aircrafts flying relative to each other, and it is unsafe to fly relative to each other.

通过判断所述其中从飞行器的相对可达范围和所述主飞行器禁飞区在三维空间的位置关系,可以准确的判断两个所述飞行器有无碰撞风险,简单直观,可靠性高。By judging the relative reachable range of the slave aircraft and the positional relationship of the no-fly zone of the master aircraft in three-dimensional space, it is possible to accurately determine whether there is a risk of collision between the two aircraft, which is simple, intuitive and highly reliable.

本发明还提供了一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时,实现所述的飞行防碰撞感知方法。The present invention also provides a computer-readable storage medium, on which a computer program is stored, wherein, when the computer program is executed by a processor, the above-mentioned flight anti-collision perception method is realized.

本发明还提供了一种基于摄影的地物采集设备,其特征在于,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现所述的飞行防碰撞感知方法的步骤。The present invention also provides a photography-based feature acquisition device, which is characterized in that it includes a memory, a processor, and a computer program stored in the memory and operable on the processor, and the processor executes the The steps of realizing the described flight anti-collision perception method when the computer program is described.

以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。The above descriptions are only preferred embodiments of the present invention, and are not intended to limit the present invention. Any modifications, equivalent replacements, improvements, etc. made within the spirit and principles of the present invention shall be included in the protection of the present invention. within range.

Claims (11)

1.一种飞行防碰撞感知方法,其特征在于,包括如下步骤:1. A flight anti-collision perception method, is characterized in that, comprises the steps: 步骤1:对空中飞行的两个飞行器分别进行初始化,获取其中一个飞行器相对于另一个飞行器的初始状态信息;Step 1: Initialize the two aircraft flying in the air respectively, and obtain the initial state information of one aircraft relative to the other aircraft; 步骤2:根据所述初始状态信息确定所述其中一个飞行器在相对位置子空间的相对可达范围,以及根据所述初始状态信息确定所述另一个飞行器的禁飞区;Step 2: Determine the relative reachable range of one of the aircraft in the relative position subspace according to the initial state information, and determine the no-fly zone of the other aircraft according to the initial state information; 步骤3:根据所述其中一个飞行器的相对可达范围与所述另一个飞行器的禁飞区在三维空间内的位置关系判断所述两个飞行器之间是否存在碰撞风险。Step 3: Judging whether there is a risk of collision between the two aircraft according to the positional relationship between the relative reachable range of the one aircraft and the no-fly zone of the other aircraft in three-dimensional space. 2.根据权利要求1所述的飞行防碰撞感知方法,其特征在于,所述步骤1中,所述初始状态信息具体包括:名义初始状态初始状态误差分布P0、干扰噪声w(t)的强度Q、评估时间长度Δt和最小安全距离ρ;2. The flight anti-collision perception method according to claim 1, characterized in that, in the step 1, the initial state information specifically includes: a nominal initial state Initial state error distribution P 0 , intensity Q of interference noise w(t), evaluation time length Δt and minimum safety distance ρ; 其中,所述其中一个飞行器相对于所述另一个飞行器的初始状态x(t0)满足高斯分布,所述名义初始状态为所述初始状态x(t0)的期望,初始状态误差分布P0为所述初始状态x(t0)的协方差矩阵,评估时间长度Δt为从初始时刻t0开始的评估碰撞风险发生的时间区间[t0,t0+Δt],最小安全距离ρ为两个飞行器的质心到对应飞行器最远边缘处之间的距离之和。Wherein, the initial state x(t 0 ) of one of the aircraft relative to the other aircraft satisfies a Gaussian distribution, and the nominal initial state is the expectation of the initial state x(t 0 ), the initial state error distribution P 0 is the covariance matrix of the initial state x(t 0 ), and the evaluation time length Δt is the estimated collision risk occurrence from the initial time t 0 [t 0 ,t 0 +Δt], the minimum safe distance ρ is the sum of the distances from the centroids of the two aircraft to the farthest edge of the corresponding aircraft. 3.根据权利要求1所述的飞行防碰撞感知方法,其特征在于,所述步骤2具体包括:3. flight anti-collision perception method according to claim 1, is characterized in that, described step 2 specifically comprises: 步骤21:根据所述初始状态信息建立三维空间误差模型;Step 21: Establishing a three-dimensional space error model according to the initial state information; 步骤22:根据所述三维空间误差模型确定其中一个飞行器在相对位置子空间的相对位置误差范围;Step 22: Determine the relative position error range of one of the aircraft in the relative position subspace according to the three-dimensional space error model; 步骤23:根据其中一个飞行器在相对位置子空间的相对位置误差范围确定其相对可达范围;Step 23: Determine the relative reachable range of one of the aircraft according to its relative position error range in the relative position subspace; 步骤24:根据所述初始状态信息确定所述另一个飞行器的禁飞区。Step 24: Determine a no-fly zone of the other aircraft according to the initial state information. 4.根据权利要求3所述的飞行防碰撞感知方法,其特征在于,所述步骤21中所述三维空间误差模型为:4. flight anti-collision perception method according to claim 3, is characterized in that, the three-dimensional space error model described in the described step 21 is: 初始状态x(t0)满足高斯分布 The initial state x(t 0 ) satisfies the Gaussian distribution 其中,为状态矢量x(t)相对于时间t的导数,F(t)为系统矩阵,w(t)为干扰噪声,G为系数矩阵,I3×3为单位矩阵,03×3为零矩阵。in, is the derivative of the state vector x(t) relative to time t, F(t) is the system matrix, w(t) is the interference noise, G is the coefficient matrix, I 3×3 is the identity matrix, 0 3×3 is the zero matrix . 5.根据权利要求3所述的飞行防碰撞感知方法,其特征在于,所述步骤22具体包括:5. The flight anti-collision sensing method according to claim 3, wherein said step 22 specifically comprises: 步骤221:根据所述三维空间误差模型确定所述其中一个飞行器在全空间的状态误差范围,具体包括:Step 221: Determine the state error range of one of the aircraft in the whole space according to the three-dimensional space error model, specifically including: 初始状态x(t0)满足高斯分布,且干扰噪声w(t)为高斯白噪声,则所述其中一个飞行器在任一时刻t的状态矢量x(t)满足高斯分布,其统计特性满足:The initial state x(t 0 ) satisfies the Gaussian distribution, and the interference noise w(t) is Gaussian white noise, then the state vector x(t) of one of the aircraft at any time t satisfies the Gaussian distribution, and its statistical characteristics satisfy: 为名义轨道状态,为其中一个飞行器相对于所述另一个飞行器的初始状态,为状态矢量x(t)相对于时间t的导数,F(t)为系统矩阵,Φ(t,t0)为由三维空间误差模型确定的任意时刻t(t>t0)时的状态转移矩阵,为状态矢量x(t)的期望,G为系数矩阵,P0为初始状态误差分布,Q为干扰噪声强度,根据上式(6)-(9)计算出全空间内其中一个飞行器的状态矢量x(t)在任意时刻的均值和协方差矩阵为P; is the nominal orbital state, is the initial state of one of the aircraft relative to the other aircraft, is the derivative of the state vector x(t) relative to time t, F(t) is the system matrix, Φ(t,t 0 ) is the state transition at any time t(t>t 0 ) determined by the three-dimensional space error model matrix, is the expectation of the state vector x(t), G is the coefficient matrix, P 0 is the initial state error distribution, Q is the interference noise intensity, and the state vector of one of the aircraft in the whole space is calculated according to the above formulas (6)-(9) The mean value of x(t) at any time and the covariance matrix is P; 根据所述均值和协方差矩阵P确定所述其中一个飞行器在全空间的状态误差范围为椭球,表示为:According to the mean and the covariance matrix P determine that the state error range of one of the aircraft in the whole space is an ellipsoid, expressed as: A=P-1/k2 (11)A=P -1 /k 2 (11) 其中,所述其中一个飞行器在全空间的状态矢量x(t)在任意时刻的期望是椭球的中心,A为全空间误差椭球矩阵,k2由概率密度大小的马氏距离确定;Among them, the expectation of the state vector x(t) of one of the aircraft in the whole space at any time is the center of the ellipsoid, A is the full-space error ellipsoid matrix, and k 2 is determined by the Mahalanobis distance of the probability density; 步骤222:根据所述其中一个飞行器在全空间的状态误差范围确定所述其中一个飞行器在相对位置子空间的相对位置误差范围,具体为:Step 222: Determine the relative position error range of one of the aircraft in the relative position subspace according to the state error range of one of the aircraft in the whole space, specifically: 所述其中一个飞行器在相对位置子空间的相对位置误差范围r满足如下关系式:The relative position error range r of one of the aircraft in the relative position subspace satisfies the following relationship: r=Lx (13)r=Lx (13) L=[I3×3 03×3] (14)L=[I 3×3 0 3×3 ] (14) 其中,L为当仅考虑相对位置子空间的投影矩阵,Arr为位置误差椭球矩阵,位置状态误差分布矩阵Prr=LPLTWherein, L is the projection matrix when only the relative position subspace is considered, A rr is the position error ellipsoid matrix, and the position state error distribution matrix P rr = LPL T . 6.根据权利要求4所述的飞行防碰撞感知方法,其特征在于,所述步骤23具体包括:6. The flight anti-collision sensing method according to claim 4, wherein said step 23 specifically comprises: 在相对位置子空间里,对任意时刻t总存在一个由式(15)中Arr(t)定义的相对位置误差范围为椭球C(t,r),满足如下方程:In the relative position subspace, for any time t, there is always a relative position error range defined by A rr (t) in formula (15) as the ellipsoid C(t,r), which satisfies the following equation: C(t,r)=0 (16)C(t,r)=0 (16) 联立(16)和(17)两个方程消除时间参数t,得到相对可达范围包络面。Simultaneously combine the two equations (16) and (17) to eliminate the time parameter t, and obtain the envelope surface of the relative reachable range. 7.根据权利要求3所述的飞行防碰撞感知方法,其特征在于,所述步骤24中,所述根据所述初始状态信息确定所述另一个飞行器的禁飞区的具体实现为:根据所述最小安全距离ρ确定所述禁飞区Z。7. The flight anti-collision perception method according to claim 3, characterized in that, in the step 24, the specific implementation of determining the no-fly zone of the other aircraft according to the initial state information is: according to the The minimum safety distance ρ determines the no-fly zone Z. 8.根据权利要求1所述的飞行防碰撞感知方法,其特征在于,所述步骤3具体包括:8. The flight anti-collision sensing method according to claim 1, wherein said step 3 specifically comprises: 若所述其中一个飞行器的相对可达范围与所述另一个飞行器禁飞区在三维空间无交集,则在给定的时间段内两个飞行器相对飞行无发生碰撞风险;否则,两个飞行器相对飞行存在发生碰撞风险。If the relative reachable range of one of the aircraft does not intersect with the no-fly zone of the other aircraft in three-dimensional space, there is no risk of collision between the two aircrafts flying relative to each other within a given period of time; There is a risk of collision in flight. 9.一种飞行防碰撞感知系统,其特征在于:包括初始化模块、计算模块和判断模块;9. A flight anti-collision perception system, characterized in that: comprising an initialization module, a calculation module and a judgment module; 所述初始化模块,用于对空中飞行的两个飞行器分别进行初始化,获取其中一个飞行器相对于另一个飞行器的初始状态信息;The initialization module is used to initialize the two aircraft flying in the air respectively, and obtain the initial state information of one aircraft relative to the other aircraft; 所述计算模块,用于根据所述初始状态信息确定所述其中一个飞行器在给定时间内的相对可达范围,以及根据所述初始状态信息确定所述另一个飞行器的禁飞区;The calculation module is configured to determine the relative reachable range of one of the aircraft within a given time according to the initial state information, and determine the no-fly zone of the other aircraft according to the initial state information; 所述判断模块,用于根据所述其中一个飞行器的相对可达范围与所述另一个飞行器的禁飞区在三维空间内的位置关系判断所述两个飞行器之间是否存在碰撞风险。The judgment module is configured to judge whether there is a risk of collision between the two aircraft according to the positional relationship between the relative reachable range of one of the aircraft and the no-fly zone of the other aircraft in three-dimensional space. 10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时,实现权利要求1-8任一项所述的飞行防碰撞感知方法。10. A computer-readable storage medium, on which a computer program is stored, wherein when the computer program is executed by a processor, the flight collision avoidance sensing method according to any one of claims 1-8 is realized. 11.一种飞行防碰撞感知设备,其特征在于,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如权利要求1至8任一项所述的飞行防碰撞感知方法的步骤。11. A flight anti-collision sensing device, characterized in that it comprises a memory, a processor, and a computer program stored in the memory and operable on the processor, and the processor implements the computer program when executing the computer program. The steps of the flight anti-collision sensing method according to any one of claims 1 to 8.
CN201810934824.4A 2018-08-16 2018-08-16 A flight anti-collision perception method, system, storage medium and device Active CN108986555B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810934824.4A CN108986555B (en) 2018-08-16 2018-08-16 A flight anti-collision perception method, system, storage medium and device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810934824.4A CN108986555B (en) 2018-08-16 2018-08-16 A flight anti-collision perception method, system, storage medium and device

Publications (2)

Publication Number Publication Date
CN108986555A true CN108986555A (en) 2018-12-11
CN108986555B CN108986555B (en) 2020-06-26

Family

ID=64553261

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810934824.4A Active CN108986555B (en) 2018-08-16 2018-08-16 A flight anti-collision perception method, system, storage medium and device

Country Status (1)

Country Link
CN (1) CN108986555B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109658742A (en) * 2018-12-28 2019-04-19 北京信息科技大学 The autonomous conflict Resolution method of intensively flight based on preamble flight information
CN110322733A (en) * 2019-06-21 2019-10-11 中国民航大学 A kind of lateral runway protection zone reaches the window method for building up that takes off
CN110855246A (en) * 2019-11-08 2020-02-28 成都天奥测控技术有限公司 Method for generating Gaussian white noise with arbitrary variance

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102160006A (en) * 2008-07-15 2011-08-17 空中侦察辨识和避免技术有限责任公司 System and method for preventing a collis
CN102184646A (en) * 2011-05-11 2011-09-14 四川九洲电器集团有限责任公司 Conflict detection method for aerial target
CN102411851A (en) * 2011-11-01 2012-04-11 四川川大智胜软件股份有限公司 Method for realizing ACAS conflict alert in blank pipe ATC system
CN105023468A (en) * 2015-08-06 2015-11-04 北京航空航天大学 Terminal area airline safety tolerance monitoring method based on collision risk model and system thereof
US20170200380A1 (en) * 2014-03-17 2017-07-13 DM3 Aviation LLC Airplane collision avoidance
CN107909856A (en) * 2017-12-19 2018-04-13 四川九洲空管科技有限责任公司 One kind collision conflict probe method and system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102160006A (en) * 2008-07-15 2011-08-17 空中侦察辨识和避免技术有限责任公司 System and method for preventing a collis
CN102184646A (en) * 2011-05-11 2011-09-14 四川九洲电器集团有限责任公司 Conflict detection method for aerial target
CN102411851A (en) * 2011-11-01 2012-04-11 四川川大智胜软件股份有限公司 Method for realizing ACAS conflict alert in blank pipe ATC system
US20170200380A1 (en) * 2014-03-17 2017-07-13 DM3 Aviation LLC Airplane collision avoidance
CN105023468A (en) * 2015-08-06 2015-11-04 北京航空航天大学 Terminal area airline safety tolerance monitoring method based on collision risk model and system thereof
CN107909856A (en) * 2017-12-19 2018-04-13 四川九洲空管科技有限责任公司 One kind collision conflict probe method and system

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
张兆宁: "自由飞行下基于高斯白噪声的碰撞风险模型", 《中国安全生产科学技术》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109658742A (en) * 2018-12-28 2019-04-19 北京信息科技大学 The autonomous conflict Resolution method of intensively flight based on preamble flight information
CN109658742B (en) * 2018-12-28 2020-07-10 北京信息科技大学 Dense flight autonomous conflict resolution method based on preorder flight information
CN110322733A (en) * 2019-06-21 2019-10-11 中国民航大学 A kind of lateral runway protection zone reaches the window method for building up that takes off
CN110855246A (en) * 2019-11-08 2020-02-28 成都天奥测控技术有限公司 Method for generating Gaussian white noise with arbitrary variance
CN110855246B (en) * 2019-11-08 2023-04-11 成都天奥测控技术有限公司 Method for generating Gaussian white noise with arbitrary variance

Also Published As

Publication number Publication date
CN108986555B (en) 2020-06-26

Similar Documents

Publication Publication Date Title
CN110456823B (en) Double-layer path planning method aiming at unmanned aerial vehicle calculation and storage capacity limitation
CN107077148B (en) UAV obstacle avoidance control method, flight controller and unmanned aerial vehicle
CN105629989B (en) Based on the barrier zone division methods to take all of outside minimum with maximum inscribed circle
CN106774380B (en) Unmanned vehicle plane automatic obstacle avoiding method under a kind of dynamic uncertain environments
CN108986555A (en) A kind of flight anticollision cognitive method, system, storage medium and equipment
CN102737525B (en) Method for generating warning envelope curve of helicopter terrain awareness and warning system
CN104793201B (en) A kind of amendment structure changes grid Interactive Multiple-Model filtering method for tracking the hypersonic target of near space
WO2019119199A1 (en) Control method and control device for unmanned aerial vehicle, unmanned aerial vehicle and agricultural unmanned aerial vehicle
CN105204515B (en) The measurement parsing of unmanned plane independent landing and control method and device
WO2018094626A1 (en) Unmanned aerial vehicle obstacle-avoidance control method and unmanned aerial vehicle
CN111028550B (en) Collision conflict detection method and related device
US11656637B2 (en) Cooperative path planning method and device for automatic control aerocraft and aerocraft system
CN114815863A (en) Control method and device of unmanned aerial vehicle and method and device for prompting obstacle
WO2018222253A1 (en) System and method of dynamically filtering depth estimates to generate a volumetric map of a three-dimensional environment having an adjustable maximum depth
CN108694863B (en) Method for transmitting flight parameters of a guiding aircraft to an intruding aircraft
CN104180808A (en) Aerial autonomous refueling circular taper sleeve vision position and attitude resolving method
CN107300377A (en) A kind of rotor wing unmanned aerial vehicle objective localization method under track of being diversion
CN109383763A (en) It is a kind of for predicting the prediction technique of the displacement of vortex wake caused by aircraft
Shakernia et al. Passive ranging for UAV sense and avoid applications
CN106959702A (en) A kind of autonomous preventing collision method of unmanned plane and system
Berdonosov et al. Implementation of the speed approach for UAV collision avoidance in dynamic environment
CN114510068A (en) A multi-UAV cooperative situational awareness method and system based on information fusion
US20230316924A1 (en) Method and device for determining a collision probability of a vehicle with an object in a three-dimensional space
CN108475065A (en) Method of controlling security, equipment and the machine readable storage medium of unmanned plane during flying
CN106647812B (en) A kind of unmanned vehicle space barrier-avoiding method based on conformal projection analysis

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant