发明内容
针对现有技术中存在的没有一种有效的对空中目标冲突的解决方法,导致飞行员难以正确解决冲突,因此有必要提供一种空中目标的冲突解决方法,为飞行员提供合理有效的冲突解决建议。
本发明公开了一种空中目标的冲突解决方法,其具体方法如下:在本机周围设置保护区域,所述保护区域为圆柱体,本机内设置冲突检测模块和冲突解决模块,所述冲突检测模块检测是否有目标飞机进入或将进入本机保护区域,如果目标飞机进入或将进入本机保护区域,报警模块启动,发出报警信号,其中目标飞机将进入本机保护区域的阀值时间为T;所述冲突解决模块根据检测模块检测到的数据调整本机的航行方式。
上述突检测模块的具体检测方法为:当目标飞机和本机相对垂直速度为0时,冲突产生的条件为目标飞机垂直方向上已处于本机保护区:
,且目标飞机水平方向上将进入本机保护区:
<T且
> 0;
其中:
,
,
,
,
,
,
,
为本机位置,
为本机速度,
为目标飞机位置,
为目标飞机速度;
、
、
、
均为三维分量,D为保护区域底面半径,H为保护区域垂直半高,
为本机和目标飞机的垂直高度差。
上述突检测模块的检测方法为:当目标飞机和本机相对垂直速度不为0,冲突产生的条件为目标飞机垂直方向及水平方向将进入本机保护区:
< T、
> 0、
<T、
>0,
<
,
<
;
其中:
为目标飞机垂直方向进入本机保护区的时间,
目标飞机垂直方向离开保护区的时间,
,
,
,
,
,
,
,
,
,
为本机位置,
为本机速度,
为目标飞机位置,
为目标飞机速度,
为本机和目标飞机相对垂直速度;
、
、
、
均为三维分量,D为保护区域底面半径,H为保护区域垂直半高,
为本机和目标飞机的垂直高度差。
优选地,上述圆柱体的保护区域底面半径D为5海里,垂直半高H为500英尺。
优选地,上述冲突检测方法还进一步包括计算产生冲突的时间,当目标飞机在垂直方向位于本机保护区内,且当水平方向进入保护区时,冲突时间等于水平方向进入保护区的时间 :
=
;当目标飞机在水平方向位于本机保护区,且当垂直方向进入保护区时,冲突时间等于垂直方向进入保护区的时间:
=
;当垂直方向和水平方向都进入保护区时,冲突时间等于水平、垂直方向均位于保护区的时间,即
或
的最大值。
优选地,上述冲突检测方法还进一步包括计算产生冲突的位置:根据本机的三维坐标位置(
,
,
)和x、y、z轴方向的速度(
,
,
),可得冲突位置:
优选地,上述冲突解决模块包括垂直方向上的冲突解决方式和水平方向的冲突解决方式。
优选地,上述垂直方向的冲突解决方式是改变本机的高度,通过计算发生冲突的时间和需要改变的本机高度,以及飞机当前的垂直速度,可得本机避免冲突需要的上升/下降垂直速度:上升速度vup和下降速度vdown分别为:
其中:
为本机在垂直方向上的初始速度,
为发生冲突的时间,H为保护区域垂直半高,
的为需要改变的本机高度。
优选地,上述水平方向的冲突解决方式包括改变本机的水平飞行速度和水平角度,通过改变本机的水平速度和角度使目标飞机的飞行轨迹与本机保护区边沿相切,该切线即为最低改变解决冲突的飞行运动轨迹。
本发明的有益效果为:通过使用检测模块检测是否有目标飞机进入或将进入本机保护区域,使得飞行员较早获知飞机发生的冲突和碰撞的可能性,及时调整飞行方案,避免冲突发生,通过冲突解决模块调整本机的航行方式,给出飞行员的建议航行方式,更好地避免冲突的发生。
具体实施方式
下面结合说明书附图详细描述本发明的具体实施方式。
本发明公开了一种空中目标的冲突解决方法,其具体方法如下:在本机周围设置保护区域,所述保护区域为圆柱体,本机内设置冲突检测模块和冲突解决模块,所述冲突检测模块检测是否有目标飞机进入或将进入本机保护区域,如果目标飞机进入或将进入本机保护区域,报警模块启动,发出报警信号,其中目标飞机将进入本机保护区域的阀值时间为T;所述冲突解决模块根据检测模块检测到的数据调整本机的航行方式。通过使用检测模块检测是否有目标飞机进入或将进入本机保护区域,使得飞行员较早获知飞机发生的冲突和碰撞的可能性,及时调整飞行方案,避免冲突发生,通过冲突解决模块调整本机的航行方式,给出飞行员的建议航行方式,更好地避免冲突的发生。
上述检测模块的具体检测方法为:当目标飞机和本机相对垂直速度为0时,冲突产生的条件为目标飞机垂直方向上已处于本机保护区:
,且目标飞机水平方向上将进入本机保护区:
<T且
> 0;
其中:
,
,
,
,
,
,
,
为本机位置,
为本机速度,
为目标飞机位置,
为目标飞机速度;
、
、
、
均为三维分量,D为保护区域底面半径,H为保护区域垂直半高,
为本机和目标飞机的垂直高度差。
冲突检测的建模使用以下概念:本机位置
,本机速度
,目标飞机位置
,目标飞机速度
,均为三维分量,如
。利用相对的系统概念,以本机为参考原点,目标飞机和本机两机相对位置为
,相对速度为
。目标飞机处于坐标s,并以相对速度v向原点移动。飞行安全保护区域是水平半径D和垂直半高H的圆柱体,告警时间阀值为T。当垂直速度为0时,冲突产生条件为垂直方向上已处于保护区内,即
,且水平方向上将进入保护区,即
式(1)
由式(1)可得 式(2)
式(2)中是一个关于t 的一元二次方程,其它量都为已知量或可测量。设
为目标飞机水平方向进入本机保护区的时间,单位为秒,表示
秒后目标飞机将进入本机保护区;当该值为负时表示目标飞机已经处于本机的保护区内,且进入时间为
秒(指以当前速度推测︳
︳秒前目标飞机会进入本机保护区。
为目标飞机水平方向离开本机保护区的时间;当该值为负时表示目标飞机已经离开本机保护区,且离开时间为
秒(指以当前速度推测︳
︳前目标飞机会离开本机保护区。
检测方法的目的是检测未来T秒内是否存在冲突(即进入对方保护区)。因此冲突条件需满足
< T和
> 0。
> T表示报警时间阀值内飞机未进入对方保护区,
< 0表示飞机已经离开保护区。
上述检测模块的具体检测方法为:目标飞机和本机相对垂直速度不为0,冲突产生的条件为目标飞机垂直方向及水平方向将进入本机保护区:
< T、
> 0、
<T、
>0,
<
,
<
;
其中:
为目标飞机垂直方向进入本机保护区的时间,
目标飞机垂直方向离开保护区的时间,
,
,
,
,
,
,
,
,
,
为本机位置,
为本机速度,
为目标飞机位置,
为目标飞机速度,
为本机和目标飞机相对垂直速度;
、
、
、
均为三维分量,D为保护区域底面半径,H为保护区域垂直半高,
为本机和目标飞机的垂直高度差。(其中sign函数为符号函数,自变量为正值时,sign函数值为1,自变量为负值时,sign函数值为0)。
在目标飞机和本机垂直速度不为0时,需要同时考虑水平方向和垂直方向进入保护区的时间。垂直方向进入保护区的时间为,离开时间为:
因为垂直半高H>0,所以
<
,即垂直方向进入保护区的时间总是小于离开时间。特殊情况下,两机的水平速度和方向相同,水平相对速度为0,即
=0,
=0,此时产生冲突条件为水平方向已进入保护区,即
<
,且垂直方向进入保护区满足
<T,
>0。
因此,垂直速度不为0时产生冲突的条件为:目标在垂直和水平方向均将进入保护区,且某个时间段水平与垂直方向同时位于保护区内。即水平进入保护区时间
< T、水平离开保护区时间
> 0、垂直进入保护区时间
<T、 垂直离开保护区时间
>0,
<
,
<
(表示目标飞机在本机水平和垂直冲突区内同时有一个时间段存在)。检测方法的流程如图1所示,其中判别式
。
优选地,上述圆柱体的保护区域底面半径D为5海里,垂直半高H为500英尺。此处如此设置保护区域可以让空间域比较宽广,让系统有充裕的时间检测到冲突;并在解决冲突过程中有冲突的时间处理;在解决冲突时可以让解决冲突的动作较小,改变的速度和角度较小,便于冲突解决操作。
上述保护区域是以飞机为中心点,包含水平安全间距和垂直安全间距的柱状区域。水平方向是以本机为中心,水平安全间距为半径的圆,是目标从水平方向与本机威胁的判断依据;垂直方向安全间距通过与高度差比较判断目标与本机在垂直方向的冲突。基于该原则,我们为飞机建立两个保护区域:间隔保护区PAZ(Protected Airspace Zone)和冲突避免区CAZ(Collision Avoidance Zone)。当目标飞机侵入不同区域即产生不同级别的告警。
所述保护区域根据保护区域的范围设置3级告警的机制:以目标飞机侵入本机CAZ区产生CAZ告警(最高告警级别),此时目标对本机威胁极为严重;侵入PAZ区产生PAZ告警;以及低级别告警。冲突检测的实现是根据当前和未来告警时间内,计算目标飞机与本机不同保护区域的相对位置,判断得到3级告警(PAZ告警、CAZ告警和低级别告警)。保护区域范围和告警级别的设置如表1和表2所示。
表1 保护区的区域值
保护区域 |
水平半径 |
垂直半高 |
PAZ |
5海里 |
500英尺 |
CAZ |
0.15海里 |
300英尺 |
表2 告警级别
报警级别 |
何时发出告警 |
告警时间 |
低级别报警 |
进入PAZ区域前发生 |
大于300秒 |
PAZ报警 |
如果不及时采取行动PAZ入侵将发生 |
300秒 |
CAZ报警 |
如果不及时采取行动CAZ入侵将发生 |
60秒 |
本发明所述的冲突检测实现方法实现3级冲突检测,按照表1和表2的门限设定,目标在60秒内侵入CAZ保护区时触发CAZ告警;在300秒内进入PAZ保护区时触发PAZ告警;提供大于300秒的低级别告警。
在冲突检测实现方式上,3级冲突检测方法流程如图2所示。由于低级别和PAZ告警均为对PAZ区域的入侵检测,因此将冲突判决一并实现,有效减少计算量,提高了检测方法效率。CAZ告警的检测优先级较高,其产生必然同时存在PAZ告警,因此判决CAZ告警是检测到PAZ告警后的进一步判决,检测方法与PAZ告警的判决方式一致,仅保护区范围和时间等参数不同。
优选地,上述冲突检测方法还进一步包括当检测到存在冲突时,计算产生冲突的时间。当目标飞机在垂直方向位于本机保护区内,且当水平方向进入保护区时,冲突时间等于水平方向进入保护区的时间 :
=
;当目标飞机在水平方向位于本机保护区,且当垂直方向进入保护区时,冲突时间等于垂直方向进入保护区的时间,
=
;当垂直方向和水平方向都进入保护区时,冲突时间等于水平、垂直方向均位于保护区的时间,即
或
的最大值。
优选地,上述冲突检测方法还进一步包括当检测到存在冲突时,计算产生冲突的位置。根据冲突告警的时间
,本机的三维坐标位置(
,
,
)和x、y、z轴方向的速度(
,
,
),可得冲突位置:
。
优选地,所述冲突解决模块包括垂直方向上的冲突解决方式和水平方向的冲突解决方式。
垂直方向的冲突解决方式是改变本机的高度,使目标飞机未来的航迹不会进入本机的保护区域。通过计算发生冲突的时间和需要改变的飞机高度,以及飞机当前的垂直速度,可得本机避免冲突需要的上升/下降垂直速度:上升速度vup和下降速度vdown分别为:
其中:
为本机在垂直方向上的初始速度,
为发生冲突的时间, H为保护区域垂直半高,
的为需要改变的飞机高度。
例如,如图3所示,以本机b为坐标原点,目标机a以相对速度v时将进入本机b的冲突区域(图3线段2)。仅当本机b上升或下降后沿保护区域外侧飞行时(图3线段1和线段3)时冲突消除,上升速度vup和下降速度vdown分别为:
水平方向的冲突解决方式包括改变飞机的水平飞行速度和水平角度。通过改变本机的水平速度和角度使目标飞机的飞行轨迹与本机保护区边沿相切,该切线即为最低改变解决冲突的飞行运动轨迹。
如图4所示,所有飞机垂直速度不变,以本机为坐标原点设立平面坐标系。目标飞机坐标位置为
(
,
),初始水平速度v。当出现与本机冲突时,为避免对本机保护区域的入侵,本机将更改速度或航向避免目标飞机航迹进入本机保护区。这里考虑到本机为原点,通过坐标平移可视为目标机以新的相对速度
飞行的航迹与本机的以D为半径的圆形冲突保护区域相切,该航迹为冲突解决后理想态的飞行航迹。该相对速度的斜率
,其中:由
,可得,
F点(原航迹与保护区相交点)的坐标Fx=D*cosβ,Fy=D*sinβ
G点(切点)坐标
Gx=D*[cos(β+α)]
=D* cosβ*cosα-D* sinβ*sinα
=Fxcosα-Fysinα
Gy=D*[sin(β+α)]
= D* cosβ*sinα+ D* sinβ**cos
=Fxsinα+Fycosα
改变水平角度解决冲突
如图5所示,所有飞机垂直速度不变,以本机为原点建立平面坐标系,目标机速度
,本机速度为
,存在冲突时,目标机将以相对速度v进入本机保护区。为避免冲突,本机在速率不变的前提下改变水平角度,新速度为
(
,
),则坐标平移后目标机新的相对速度为
,外推航迹与本机保护区域相切。
式1
通过当前目标飞机的相对位置和保护区水平半径D,计算得到目标飞机到保护区边沿的切线斜率k:
其中
是改变后的自己飞机x轴方向的速度,
是改变后的自己飞机y轴方向的速度,
是对方飞机x轴方向的速度,
是对方飞机y轴方向的速度。通过解式1和式2可以的出要改后的速度
,
。
飞行角度表示飞机方向与x轴正方向的夹角,取值范围为(-180,180)。
本机原来速度在第一相区或第四相区时,由该式求出的
就是本机本来的水平速度角度,如果本机的本来速度位于第二相区或第三相区时,本机本来
值调整如下:
当本机的水平速度位于第二相区,即
<0,
>0时,飞机的飞行角度为
; 式3.1
当本机的水平速度位于第三相区,即
<0,
<0时,飞机的飞行角度为
式4求出的角度范围为(-90,90),即本机改变后速度在第一或第四相区时,由该式求出的
就是飞机本来的水平速度角度,如果本机的改变后速度位于第二相区或第三相区时,目标机本来的水平速度角度值调整如下:
当本机改变飞行状态后的水平速度位于第二相区,即
<0,
>0时,本机改变后的飞行角度为:
当本机改变飞行状态后的水平速度位于第三相区,即
<0,
<0时,本机改变后的飞行角度为:
由上述可得,本机避开冲突需要改变的角度为:
飞行员按照改变飞机航向角即可解决冲突。
改变水平速度解决冲突
如图6所示,所有飞机垂直速度不变,以本机为原点建立平面坐标系,目标机速度
,本机速度为
,存在冲突时,目标机将以相对速度v进入本机保护区。
为避免冲突,本机在航向角不变的前提下改变水平速率,新速度为
(
,
),则坐标平移后目标机新的相对速度为
,外推航迹与本机保护区域相切。
通过当前的相对位置和保护区水平半径D,可得,当前点到保护区的切线角斜率k。
式2.4
解式2.4可求得速率变化系数值
其中
是改变后的本机x轴方向的速度,
是改变后的自己飞机y轴方向的速度,
是改变后的本机x轴方向的速度,
是改变后的自己飞机y轴方向的速度。飞行员按照速率变化系数
计算得到的本机新速度
飞行即可解决冲突。
以上所述的具体实施例,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。