CN111240360A - 用于导引飞行装置跟踪目标的方法、计算机系统和介质 - Google Patents
用于导引飞行装置跟踪目标的方法、计算机系统和介质 Download PDFInfo
- Publication number
- CN111240360A CN111240360A CN202010057775.8A CN202010057775A CN111240360A CN 111240360 A CN111240360 A CN 111240360A CN 202010057775 A CN202010057775 A CN 202010057775A CN 111240360 A CN111240360 A CN 111240360A
- Authority
- CN
- China
- Prior art keywords
- target
- flying device
- track
- guiding
- flying
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 55
- 238000012544 monitoring process Methods 0.000 claims abstract description 9
- 230000004044 response Effects 0.000 claims description 14
- 239000000126 substance Substances 0.000 claims description 7
- 230000001133 acceleration Effects 0.000 claims description 2
- 238000003860 storage Methods 0.000 description 16
- 238000010586 diagram Methods 0.000 description 15
- 238000004590 computer program Methods 0.000 description 11
- 238000004088 simulation Methods 0.000 description 8
- 238000013459 approach Methods 0.000 description 7
- 230000006870 function Effects 0.000 description 4
- 238000012545 processing Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000012271 agricultural production Methods 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种用于导引飞行装置跟踪目标的方法,其中,飞行装置以围绕目标在圆形期望航迹上做圆周飞行的跟踪模式跟踪目标,该方法包括:通过第一指令导引飞行装置从第一位置向靠近目标的方向飞行,其中,第一位置到目标的距离大于等于第一阈值,监测飞行装置与目标之间的距离,响应于距离小于第一阈值,通过第二指令导引飞行装置以预设偏航角速率飞行,响应于距离小于等于第二阈值,监测第一方向和第二方向之间的第一角度,第一方向为飞行装置的水平速度方向,第二方向为无人机与目标的连线在圆形期望航迹上的交点的切线方向,响应于第一角度小于等于角度阈值或者距离小于等于第三阈值,通过第三指令导引飞行装置进入圆形期望航迹。
Description
技术领域
本发明属于无人机技术领域,涉及一种用于导引飞行装置跟踪目标的方法、计算机系统和介质。
背景技术
随着人工智能、自动控制、通信和计算机技术的快速发展,无人机被越来越多地应用于工农业生产、建筑、物流、和日常生活等诸多领域。
针对固定或移动目标的跟踪是无人机的重要作战任务之一。例如,可以通过由无人机与目标保持指定距离,并以一定速度和高度围绕目标在圆形期望航迹上做圆周飞行的跟踪模式对目标进行跟踪。
然而,在实现本发明构思的过程中,发明人发现现有技术中至少存在如下问题:无人机收敛到圆形期望航迹上的效率不高。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种用于导引飞行装置跟踪目标的方法、计算机系统和介质。
技术方案
本发明公开的一个方面提供了一种用于导引飞行装置跟踪目标的方法,其中,所述飞行装置以围绕所述目标在圆形期望航迹上做圆周飞行的跟踪模式跟踪所述目标,所述方法包括:通过第一指令导引所述飞行装置从第一位置向靠近所述目标的方向飞行,其中,所述第一位置到所述目标的距离大于等于第一阈值;监测所述飞行装置与所述目标之间的距离;响应于所述距离小于所述第一阈值,通过第二指令导引所述飞行装置以预设偏航角速率飞行;响应于所述距离小于等于第二阈值,监测第一方向和第二方向之间的第一角度,所述第一方向为所述飞行装置的水平速度方向,所述第二方向为所述无人机与所述目标的连线在所述圆形期望航迹上的交点的切线方向,其中,所述第二阈值小于所述第一阈值;以及响应于所述第一角度小于等于角度阈值或者所述距离小于等于第三阈值,通过第三指令导引所述飞行装置进入所述圆形期望航迹,其中,所述第三阈值小于所述第二阈值。
可选地,所述通过第一指令导引所述飞行装置从第一位置向靠近所述目标的方向飞行,包括:在所述目标为做直线运动的目标情况下,通过第一指令导引所述飞行装置在所述直线运动的轨迹所在的延长线上向靠近所述目标的方向飞行。
可选地,在所述目标为静止的目标的情况下,所述第一阈值表示为:
其中,d1为所述第一阈值,R为所述圆形期望航迹的半径,L1为所述飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度,Rm为所述飞行装置的预设转弯半径,kl为预设参数,其中,kl∈(0,1)。
可选地,在所述目标为做直线运动的目标的情况下,所述第一阈值表示为:
d1′=d1-Vt×t1
其中,d1′为所述第一阈值,V为所述飞行装置当前时刻的飞行速度,Vt为所述目标当前时刻的运动速度,R为所述圆形期望航迹的半径、L1为所述飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度、Rm为所述飞行装置的预设转弯半径,kl为预设参数,其中,kl∈(0,1)。
可选地,所述预设偏航角速率与所述预设转弯半径相关。
可选地,所述第二阈值表示为:
r2=R+L1
其中,所述r2为所述第二阈值,R为所述圆形期望航迹的半径,L1为所述飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度。
可选地,所述第三阈值表示为:
r1=R+kl×L1
其中,所述r1为所述第三阈值,R为所述圆形期望航迹的半径,L1为所述飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度,kl为预设参数,其中,kl∈(0,1)。
可选地,所述角度阈值为接近于零的小角度值。
可选地,所述通过第三指令导引所述飞行装置进入所述圆形期望航迹,包括:在所述目标为静止的目标的情况下,通过第一导引律指令导引所述飞行装置进入所述圆形期望航迹,其中,所述第一导引律指令表示为:
其中,为所述第一导引律指令,V为所述飞行装置当前时刻的飞行速度,L1为所述飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度,R为所述圆形期望航迹的半径,d为所述飞行装置到所述圆形期望航迹的侧向偏差。
可选地,所述通过第三指令导引所述飞行装置进入所述圆形期望航迹,包括:在所述目标为做直线运动的目标的情况下,通过第二导引律指令导引所述飞行装置进入所述圆形期望航迹,其中,所述第二导引律指令表示为:
其中,为所述第二导引律指令,ψ为所述飞行装置的速度矢量的方向角,ψt为所述目标的速度矢量的方向角,V为所述飞行装置当前时刻的飞行速度,Vr为所述飞行装置相对于所述目标的相对速度,为所述目标的加速度,L1为所述飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度,R为所述圆形期望航迹的半径,d为所述飞行装置到所述圆形期望航迹的侧向偏差。
本发明公开的另一方面提供了一种计算机系统,包括:一个或多个处理器,计算机可读存储介质,用于存储一个或多个程序,其中,当所述一个或多个程序被所述一个或多个处理器执行时,使得所述一个或多个处理器实现如上所述的方法。
本发明公开的另一方面提供了一种计算机可读存储介质,存储有计算机可执行指令,所述指令在被执行时用于实现如上所述的方法。
本发明公开的另一方面提供了一种计算机程序,所述计算机程序包括计算机可执行指令,所述指令在被执行时用于实现如上所述的方法。
有益效果
本发明提出的一种用于导引飞行装置跟踪目标的方法、计算机系统和介质,本方法通过限制无人机进入圆形期望航迹的初始条件,满足了线性化的参考点法跟踪圆形期望航迹时参考视线矢量和无人机当前位置与目标点连线在圆形期望航迹上交点与参考点连线夹角η1以及无人机相对目标速度方向与无人机当前位置与目标点连线在圆形期望航迹上交点切线方向的夹角η2的小角度假设,从而避免了无人机收敛到圆形期望航迹会存在效率不高情形的问题。
附图说明
图1示意性示出了根据本公开实施例的用于导引飞行装置跟踪目标的方法的应用场景;
图2示意性示出了根据本公开实施例的用于导引飞行装置跟踪目标的方法的流程图;
图3示意性示出了根据本公开实施例的静止目标与飞行装置之间的参数示意图;
图4示意性示出了根据本公开实施例的做直线运动的目标与飞行装置之间的参数示意图;
图5示意性示出了根据本公开实施例的跟踪静止目标的仿真结果示意图;
图6示意性示出了根据本公开实施例的跟踪做直线运动的目标的仿真结果示意图;
图7示意性示出了根据本公开实施例的计算机系统的框图。
具体实施方式
以下,将参照附图来描述本公开的实施例。但是应该理解,这些描述只是示例性的,而并非要限制本公开的范围。在下面的详细描述中,为便于解释,阐述了许多具体的细节以提供对本公开实施例的全面理解。然而,明显地,一个或多个实施例在没有这些具体细节的情况下也可以被实施。此外,在以下说明中,省略了对公知结构和技术的描述,以避免不必要地混淆本公开的概念。
在此使用的术语仅仅是为了描述具体实施例,而并非意在限制本公开。在此使用的术语“包括”、“包含”等表明了所述特征、步骤、操作和/或部件的存在,但是并不排除存在或添加一个或多个其他特征、步骤、操作或部件。
在此使用的所有术语(包括技术和科学术语)具有本领域技术人员通常所理解的含义,除非另外定义。应注意,这里使用的术语应解释为具有与本说明书的上下文相一致的含义,而不应以理想化或过于刻板的方式来解释。
在使用类似于“A、B和C等中至少一个”这样的表述的情况下,一般来说应该按照本领域技术人员通常理解该表述的含义来予以解释(例如,“具有A、B和C中至少一个的系统”应包括但不限于单独具有A、单独具有B、单独具有C、具有A和B、具有A和C、具有B和C、和/或具有A、B、C的系统等)。在使用类似于“A、B或C等中至少一个”这样的表述的情况下,一般来说应该按照本领域技术人员通常理解该表述的含义来予以解释(例如,“具有A、B或C中至少一个的系统”应包括但不限于单独具有A、单独具有B、单独具有C、具有A和B、具有A和C、具有B和C、和/或具有A、B、C的系统等)。
附图中示出了一些方框图和/或流程图。应理解,方框图和/或流程图中的一些方框或其组合可以由计算机程序指令来实现。这些计算机程序指令可以提供给通用计算机、专用计算机或其他可编程数据处理装置的处理器,从而这些指令在由该处理器执行时可以创建用于实现这些方框图和/或流程图中所说明的功能/操作的装置。本公开的技术可以硬件和/或软件(包括固件、微代码等)的形式来实现。另外,本公开的技术可以采取存储有指令的计算机可读存储介质上的计算机程序产品的形式,该计算机程序产品可供指令执行系统使用或者结合指令执行系统使用。
本公开的实施例提供了一种用于导引飞行装置跟踪目标的方法,其中,飞行装置以围绕目标在圆形期望航迹上做圆周飞行的跟踪模式跟踪目标,该方法包括:通过第一指令导引飞行装置从第一位置向靠近目标的方向飞行,其中,第一位置到目标的距离大于等于第一阈值,监测飞行装置与目标之间的距离,响应于距离小于第一阈值,通过第二指令导引飞行装置以预设偏航角速率飞行,响应于距离小于等于第二阈值,监测第一方向和第二方向之间的第一角度,第一方向为飞行装置的水平速度方向,第二方向为无人机与目标的连线在圆形期望航迹上的交点的切线方向,其中,第二阈值小于第一阈值,以及响应于第一角度小于等于角度阈值或者距离小于等于第三阈值,通过第三指令导引飞行装置进入圆形期望航迹,其中,第三阈值小于第二阈值。
图1示意性示出了根据本公开实施例的用于导引飞行装置跟踪目标的方法的应用场景100。
需要注意的是,图1所示仅为可以应用本公开实施例的场景的示例,以帮助本领域技术人员理解本公开的技术内容,但并不意味着本公开实施例不可以用于其他设备、系统、环境或场景。
如图1所示,该应用场景100可以包括飞行装置110和目标120。
根据本公开实施例,飞行装置110可以是无人机。例如,飞行装置110可以是固定翼无人机。
根据本公开实施例,目标120可以是静止目标或者运动目标。例如,目标120可以做直线运动等。
在本公开实施例中,目标120例如可以是在地面上行驶的汽车,飞行装置110例如可以在空中飞行。飞行装置110可以对目标120进行跟踪。例如,飞行装置110可以通过围绕目标120在圆形期望航迹130上做圆周飞行的跟踪模式跟踪目标120。
例如,飞行装置110可以通过Standoff跟踪模式跟踪目标120。Standoff跟踪模式是一种由目标的运动特性、威胁特性以及无人机机动能力、传感器探测能力等因素决定,由无人机与目标保持指定距离,并以一定速度和高度围绕目标做圆周飞行的典型目标跟踪模式。
图2示意性示出了根据本公开实施例的用于导引飞行装置跟踪目标的方法的流程图。
根据本公开实施例,飞行装置可以通过围绕目标在圆形期望航迹上做圆周飞行的跟踪模式跟踪目标。例如,飞行装置可以通过Standoff跟踪模式跟踪目标。
如图2所示,该方法包括操作S201~S205。
在操作S201,通过第一指令导引飞行装置从第一位置向靠近目标的方向飞行,其中,第一位置到目标的距离大于等于第一阈值。
根据本公开实施例,可以导引飞行装置从远距离接近目标。目标可以静止或者做直线运动。
根据本公开实施例,第一指令例如可以是导引飞行装置的偏航角指令。
在本公开一实施例中,当目标为静止的目标的情况下,第一指令可以为ψi=θ,其中,ψi可以为飞行装置的偏航角指令,θ可以为飞行装置到目标的连线的方向角。即,可以通过飞行装置的偏航角导引飞行装置靠近目标。
在本公开另一实施例中,当目标为做直线运动的目标的情况下,通过第一指令导引飞行装置在目标的直线运动的轨迹所在的延长线上,向靠近目标的方向飞行。即,导引飞行装置沿着目标运动轨迹的延长线上飞行。
根据本公开实施例,针对静止的目标和做直线运动的目标,第一阈值不同。
在本公开实施例中,在目标为静止的目标的情况下,第一阈值可以表示为:
其中,参考图3和图4,d1为所述第一阈值,R为所述圆形期望航迹的半径,L1为所述飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度,Rm为所述飞行装置的预设转弯半径,kl为预设参数,其中,kl∈(0,1)。
根据本公开实施例,Rm可以为满足飞行装置飞行条件的以最大偏航角速率转弯时的转弯半径。
在本公开另一实施例中,在目标为做直线运动的目标的情况下,第一阈值可以表示为:
d1′=d1-Vt×t1
其中,参考图3和图4,d1′为所述第一阈值,V为所述飞行装置当前时刻的飞行速度,Vt为所述目标当前时刻的运动速度,R为所述圆形期望航迹的半径、L1为所述飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度、Rm为所述飞行装置的预设转弯半径,kl为预设参数,其中,kl∈(0,1)。
根据本公开实施例,可以每隔周期T判断一次飞行装置到目标的距离是否大于等于第一阈值,若距离大于等于第一阈值,则继续通过第一指令导引飞行装置从第一位置向靠近目标的方向飞行。周期T例如可以为0.02s。
在操作S202,监测飞行装置与目标之间的距离。
根据本公开实施例,监测飞行装置与目标之间距离例如可以是每隔周期T获取飞行装置与目标之间的距离,也可以是实时获取飞行装置与目标之间的距离。
在本公开实施例中,可以通过获取飞行装置的坐标位置和目标的坐标位置获得飞行装置与目标之间的距离。可以理解,本公开不限制获取距离的方式,本领域技术人员可以根据实际情况进行设定。
在操作S203,响应于距离小于第一阈值,通过第二指令导引飞行装置以预设偏航角速率飞行。
根据本公开实施例,当监测到飞行装置与目标之间的距离小于第一阈值时,可以切换为通过第二指令导引飞行装置以预设偏航角速率飞行。
根据本公开实施例,预设偏航角速率与预设转弯半径相关。例如,预设转弯半径可以是飞行装置以预设偏航角速率转弯时的转弯半径。在本公开实施例中,预设偏航角速率可以是满足飞行装置飞行条件的最大偏航角速率(例如,3°/s),预设转弯半径可以是以最大偏航角速率转弯时的转弯半径。
在本公开实施例中,第二指令例如可以是导引飞行装置的偏航角速率指令。例如,第二指令对应的偏航角速率可以是:
其中,为飞行装置当前偏航角速率指令,为飞行装置的预设偏航角速率(例如,满足飞行装置飞行条件的最大偏航角速率)。上述第二指令对应的偏航角速率表达式可以应用于飞行装置沿顺时针方向跟踪目标的情形。在飞行装置沿逆时针方向跟踪目标时,第二指令对应的偏航角速率表达式可以为
在本公开实施例中,在目标为静止目标的情况下,响应于飞行装置与目标之间的距离小于d1,导引飞行装置以预设偏航角速率转弯。在目标为做直线运动的目标的情况下,响应于飞行装置与目标之间的距离小于d1′,导引飞行装置以预设偏航角速率转弯。
在操作S204,响应于距离小于等于第二阈值,监测第一方向和第二方向之间的第一角度,第一方向为飞行装置的水平速度方向,第二方向为无人机与目标的连线在圆形期望航迹上的交点的切线方向,其中,第二阈值小于第一阈值。
根据本公开实施例,监测第一角度可以是每隔周期T获取一次第一角度。
在本公开实施例中,第二阈值可以表示为:
r2=R+L1
其中,参考图3和图4,,r2为第二阈值,R为圆形期望航迹的半径,L1为飞行装置至圆形期望航迹上的虚拟目标点的参考视线矢量长度。
在本公开实施例中,第一角度可以表示为:
η2=|ψ-χ|
其中,参考图3和图4,ψ为飞行装置当前水平速度矢量的方向角,χ为飞行装置实时位置与目标连线在圆形期望航迹上的交点的切线的方向角。
在操作S205,响应于第一角度小于等于角度阈值或者距离小于等于第三阈值,通过第三指令导引飞行装置进入圆形期望航迹,其中,第三阈值小于第二阈值。
根据本公开实施例,第三阈值可以表示为:
r1=R+kl×L1
其中,参考图3和图4,r1为第三阈值,R为圆形期望航迹的半径,L1为飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度,kl为预设参数,其中,kl∈(0,1)。
根据本公开实施例,角度阈值ε可以为接近于零的小角度值,例如可以为5°。
在本公开实施例中,判断当飞行装置到目标距离r满足r1<r≤r2,且η2≤ε条件,或当飞行装置到目标距离r满足r≤r1条件时,通过第三指令导引飞行装置进入圆形期望航迹。例如,可以使用参考点方法实现对目标的standoff跟踪。
根据本公开实施例,通过第三指令导引飞行装置进入所述圆形期望航迹,可以包括:在目标为静止的目标的情况下,通过第一导引律指令导引飞行装置进入所述圆形期望航迹,其中,第一导引律指令可以表示为:
在本公开实施例中,参考图3,上述η=η1+η2+η3,其中,η1为参考视线矢量和飞行装置当前位置与目标的连线在圆形期望航迹上交点与参考点连线夹角,η2为上述第一角度,η3为飞行装置当前位置与目标的连线在圆形期望航迹上交点与参考点连线和飞行装置当前位置与目标的连线在圆形期望航迹上交点切线方向的夹角。
根据本公开实施例,通过第三指令导引飞行装置进入圆形期望航迹,可以包括:在目标为做直线运动的目标的情况下,通过第二导引律指令导引飞行装置进入所述圆形期望航迹,其中,第二导引律指令可以表示为:
其中,参考图3和图4,为第二导引律指令,ψ为所述飞行装置的速度矢量的方向角,ψt为目标的速度矢量的方向角,V为飞行装置当前时刻的飞行速度,Vr为飞行装置相对于目标的相对速度,为目标的加速度,L1为飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度,R为圆形期望航迹的半径,d为飞行装置到圆形期望航迹的侧向偏差。
本公开实施例通过限制飞行装置进入圆形期望航迹的初始条件,满足了线性化的参考点法跟踪圆形期望航迹时参考视线矢量和飞行装置当前位置与目标点连线在圆形期望航迹上交点与参考点连线夹角以及飞行装置相对目标速度方向与飞行装置当前位置与目标的连线在圆形期望航迹上交点切线方向的夹角的小角度假设,从而避免了飞行装置收敛到圆形期望航迹会存在效率不高情形的问题,提高了收敛效率。
图5示意性示出了根据本公开实施例的跟踪静止目标的仿真结果示意图。
如图5所示,飞行装置从远距离接近静止目标,沿顺时针方向基于参考点法standoff跟踪静止目标。
步骤1:通过第一指令导引飞行装置从远距离接近目标,第一指令为:
ψi=θ
其中,ψi为无人机当前偏航角指令,θ为无人机到目标连线的方向角。
每隔周期T(例如,0.02s)进行判断,当飞行装置到目标的距离r满足r≥d1条件时,按上述导引方法导引飞行装置沿飞行装置当前位置与目标的连线方向飞行,使无人机接近圆形期望航迹。
步骤2:通过第二指令导引飞行装置以预设角速率转弯,第二指令为:
当飞行装置到目标距离r满足r<d1条件时,切换至第二指令的导引方法,导引飞行装置按最大偏航角速率转弯。
步骤3:每隔周期T进行如下操作:
1)计算r1=R+kl×L1,r2=R+L1,得r1=1600m,r2=1700m。
2)计算η2=|ψ-χ|
其中,ψ为飞行装置当前水平速度矢量的方向角,χ为飞行装置实时位置与目标的连线在圆形期望航迹上的交点的切线的方向角。
3)判断当飞行装置到目标距离r满足r1<r≤r2,且η2≤ε条件,或当飞行装置到目标距离r满足r≤r1条件时,使用参考点方法实现对静止目标的standoff跟踪,导引方法为:
其中,ε=5°,仿真取飞行装置初始水平坐标为(-6500m,100m),飞行装置初始水平速度矢量方向角为ψ1(0)=90°,飞行装置水平速度为50m/s,静止目标坐标为(0,0)。仿真结果如图5所示。
图6示意性示出了根据本公开实施例的跟踪做直线运动的目标的仿真结果示意图。
如图6所示,飞行装置从远距离接近做直线运动的目标,飞行装置被导引到目标直线运动轨迹所在的延长线上,沿顺时针方向基于参考点法standoff跟踪移动目标。
步骤1:通过第一指令导引飞行装置从远距离接近目标,第一指令为:
ψi=θ
其中,ψi为无人机当前偏航角指令,θ为无人机到目标连线的方向角。
每隔周期T(例如,0.02s):
其中,V可以取值为50m/s,kl可以取值为0.5,Rm可以取值为716m,计算得t1=17.995s。
2)计算d1′=d1-Vt×t1
其中,Vt可以取值为20m/s,计算得d1′=1843.1m。
3)判断当飞行装置到目标距离r满足r≥d1′条件时,按上述导引方法导引飞行装置沿目标直线运动的轨迹所在的延长线上飞行,使飞行装置接近圆形期望航迹。
步骤2:通过第二指令导引飞行装置以预设角速率转弯,第二指令为:
当飞行装置到目标距离r满足r<d1′条件时,切换至第二指令的导引方法,导引飞行装置按最大偏航角速率转弯。
步骤3:每隔周期T进行如下操作:
1)计算r1=R+kl×L1,r2=R+L1,得r1=1600m,r2=1700m。
2)计算η2=|ψ-χ|
其中,ψ为飞行装置当前水平速度矢量的方向角,χ为飞行装置实时位置与目标的连线在圆形期望航迹上的交点的切线的方向角。
3)判断当飞行装置到目标距离r满足r1<r≤r2,且η2≤ε条件,或当飞行装置到目标距离r满足r≤r1条件时,使用参考点方法实现对静止目标的standoff跟踪,导引方法为:
其中,ε=5°,仿真取飞行装置初始水平坐标为(-6500m,100m),飞行装置初始水平速度矢量方向角为ψ1(0)=90°,飞行装置水平速度为50m/s,静止目标坐标为(0,0),目标速度方向为90度方向,目标做匀速直线运动。仿真结果如图6所示。
图7示意性示出了根据本公开实施例的适于实现上文描述的方法的计算机系统的方框图。图7示出的计算机系统仅仅是一个示例,不应对本公开实施例的功能和使用范围带来任何限制。
如图7所示,计算机系统700包括处理器710、计算机可读存储介质720。该计算机系统700可以执行根据本公开实施例的方法。
具体地,处理器710例如可以包括通用微处理器、指令集处理器和/或相关芯片组和/或专用微处理器(例如,专用集成电路(ASIC)),等等。处理器710还可以包括用于缓存用途的板载存储器。处理器710可以是用于执行根据本公开实施例的方法流程的不同动作的单一处理单元或者是多个处理单元。
计算机可读存储介质720,例如可以是非易失性的计算机可读存储介质,具体示例包括但不限于:磁存储装置,如磁带或硬盘(HDD);光存储装置,如光盘(CD-ROM);存储器,如随机存取存储器(RAM)或闪存;等等。
计算机可读存储介质720可以包括计算机程序721,该计算机程序721可以包括代码/计算机可执行指令,其在由处理器710执行时使得处理器710执行根据本公开实施例的方法或其任何变形。
计算机程序721可被配置为具有例如包括计算机程序模块的计算机程序代码。例如,在示例实施例中,计算机程序721中的代码可以包括一个或多个程序模块,例如包括721A、模块721B、……。应当注意,模块的划分方式和个数并不是固定的,本领域技术人员可以根据实际情况使用合适的程序模块或程序模块组合,当这些程序模块组合被处理器710执行时,使得处理器710可以执行根据本公开实施例的方法或其任何变形。
本公开还提供了一种计算机可读存储介质,该计算机可读存储介质可以是上述实施例中描述的设备/装置/系统中所包含的;也可以是单独存在,而未装配入该设备/装置/系统中。上述计算机可读存储介质承载有一个或者多个程序,当上述一个或者多个程序被执行时,实现根据本公开实施例的方法。
根据本公开的实施例,计算机可读存储介质可以是非易失性的计算机可读存储介质,例如可以包括但不限于:便携式计算机磁盘、硬盘、随机访问存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。在本公开中,计算机可读存储介质可以是任何包含或存储程序的有形介质,该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。
附图中的流程图和框图,图示了按照本公开各种实施例的系统、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序段、或代码的一部分,上述模块、程序段、或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意,在有些作为替换的实现中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个接连地表示的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,框图或流程图中的每个方框、以及框图或流程图中的方框的组合,可以用执行规定的功能或操作的专用的基于硬件的系统来实现,或者可以用专用硬件与计算机指令的组合来实现。
本领域技术人员可以理解,本公开的各个实施例和/或权利要求中记载的特征可以进行多种组合和/或结合,即使这样的组合或结合没有明确记载于本公开中。特别地,在不脱离本公开精神和教导的情况下,本公开的各个实施例和/或权利要求中记载的特征可以进行多种组合和/或结合。所有这些组合和/或结合均落入本公开的范围。
尽管已经参照本公开的特定示例性实施例示出并描述了本公开,但是本领域技术人员应该理解,在不背离所附权利要求及其等同物限定的本公开的精神和范围的情况下,可以对本公开进行形式和细节上的多种改变。因此,本公开的范围不应该限于上述实施例,而是应该不仅由所附权利要求来进行确定,还由所附权利要求的等同物来进行限定。
Claims (10)
1.一种用于导引飞行装置跟踪目标的方法,用于导引飞行装置跟踪目标的方法,其中,所述飞行装置以围绕所述目标在圆形期望航迹上做圆周飞行的跟踪模式跟踪所述目标,所述方法包括:
通过第一指令导引所述飞行装置从第一位置向靠近所述目标的方向飞行,其中,所述第一位置到所述目标的距离大于等于第一阈值;
监测所述飞行装置与所述目标之间的距离;
响应于所述距离小于所述第一阈值,通过第二指令导引所述飞行装置以预设偏航角速率飞行;
响应于所述距离小于等于第二阈值,监测第一方向和第二方向之间的第一角度,所述第一方向为所述飞行装置的水平速度方向,所述第二方向为所述无人机与所述目标的连线在所述圆形期望航迹上的交点的切线方向,其中,所述第二阈值小于所述第一阈值;以及响应于所述第一角度小于等于角度阈值或者所述距离小于等于第三阈值,通过第三指令导引所述飞行装置进入所述圆形期望航迹,其中,所述第三阈值小于所述第二阈值。
2.根据权利要求1所述的用于导引飞行装置跟踪目标的方法,其中,所述通过第一指令导引所述飞行装置从第一位置向靠近所述目标的方向飞行,包括:
在所述目标为做直线运动的目标情况下,通过第一指令导引所述飞行装置在所述直线运动的轨迹所在的延长线上向靠近所述目标的方向飞行。
5.根据权利要求1所述的用于导引飞行装置跟踪目标的方法,其中,所述预设偏航角速率与所述预设转弯半径相关。
6.根据权利要求1所述的用于导引飞行装置跟踪目标的方法,其中,所述第二阈值表示为:
r2=R+L1
其中,所述r2为所述第二阈值,R为所述圆形期望航迹的半径,L1为所述飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度。
7.根据权利要求1所述的用于导引飞行装置跟踪目标的方法,其中,所述第三阈值表示为:
r1=R+kl×L1
其中,所述r1为所述第三阈值,R为所述圆形期望航迹的半径,L1为所述飞行装置至所述圆形期望航迹上的虚拟目标点的参考视线矢量长度,kl为预设参数,kl∈(0,1)。
8.根据权利要求1所述的用于导引飞行装置跟踪目标的方法,其中,所述角度阈值为接近于零的小角度值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010057775.8A CN111240360B (zh) | 2020-01-19 | 2020-01-19 | 用于导引飞行装置跟踪目标的方法、计算机系统和介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010057775.8A CN111240360B (zh) | 2020-01-19 | 2020-01-19 | 用于导引飞行装置跟踪目标的方法、计算机系统和介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111240360A true CN111240360A (zh) | 2020-06-05 |
CN111240360B CN111240360B (zh) | 2022-09-02 |
Family
ID=70869526
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010057775.8A Active CN111240360B (zh) | 2020-01-19 | 2020-01-19 | 用于导引飞行装置跟踪目标的方法、计算机系统和介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111240360B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112684810A (zh) * | 2020-12-18 | 2021-04-20 | 彩虹无人机科技有限公司 | 一种固定翼无人机环绕飞行的导航方法 |
CN113805605A (zh) * | 2021-08-30 | 2021-12-17 | 湖北航天技术研究院总体设计所 | 一种飞行轨迹规划方法及系统 |
CN113961016A (zh) * | 2021-10-25 | 2022-01-21 | 华东计算技术研究所(中国电子科技集团公司第三十二研究所) | 基于a*算法的无人机动态目标航迹规划方法及系统 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7431243B1 (en) * | 2006-03-23 | 2008-10-07 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Guidance and control for an autonomous soaring UAV |
US9442485B1 (en) * | 2014-08-13 | 2016-09-13 | Trace Live Network Inc. | Pixel based image tracking system for unmanned aerial vehicle (UAV) action camera system |
CN106406359A (zh) * | 2016-08-30 | 2017-02-15 | 南京航空航天大学 | 一种基于虚拟目标的固定翼无人机跟踪地面目标制导方法 |
CN106529073A (zh) * | 2016-11-24 | 2017-03-22 | 哈尔滨工业大学 | 基于拦截几何的高超声速目标拦截弹交接班条件分析方法 |
CN106802669A (zh) * | 2017-03-16 | 2017-06-06 | 广西师范大学 | 一种基于速度矢量合成的航迹规划算法及其飞行器 |
CN107515617A (zh) * | 2017-08-15 | 2017-12-26 | 西安爱生技术集团公司 | 一种固定翼无人机航线平滑切换控制方法 |
CN107992069A (zh) * | 2017-11-29 | 2018-05-04 | 上海无线电设备研究所 | 一种无人机路径跟踪控制的制导律设计方法 |
CN108469837A (zh) * | 2018-04-20 | 2018-08-31 | 广州亿航智能技术有限公司 | 无人机环绕角度飞行控制方法、设备及存储介质 |
CN110069077A (zh) * | 2019-04-28 | 2019-07-30 | 北京航空航天大学 | 一种针对无人飞行器飞行线路的验证方法 |
CN110262547A (zh) * | 2019-06-21 | 2019-09-20 | 西安电子科技大学 | 一种基于路径跟踪的圆形编队起飞方法 |
CN110488875A (zh) * | 2019-09-02 | 2019-11-22 | 中国人民解放军海军航空大学 | 基于动态逆的无人机跟踪目标初始段航向误差修正方法 |
-
2020
- 2020-01-19 CN CN202010057775.8A patent/CN111240360B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7431243B1 (en) * | 2006-03-23 | 2008-10-07 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Guidance and control for an autonomous soaring UAV |
US9442485B1 (en) * | 2014-08-13 | 2016-09-13 | Trace Live Network Inc. | Pixel based image tracking system for unmanned aerial vehicle (UAV) action camera system |
CN106406359A (zh) * | 2016-08-30 | 2017-02-15 | 南京航空航天大学 | 一种基于虚拟目标的固定翼无人机跟踪地面目标制导方法 |
CN106529073A (zh) * | 2016-11-24 | 2017-03-22 | 哈尔滨工业大学 | 基于拦截几何的高超声速目标拦截弹交接班条件分析方法 |
CN106802669A (zh) * | 2017-03-16 | 2017-06-06 | 广西师范大学 | 一种基于速度矢量合成的航迹规划算法及其飞行器 |
CN107515617A (zh) * | 2017-08-15 | 2017-12-26 | 西安爱生技术集团公司 | 一种固定翼无人机航线平滑切换控制方法 |
CN107992069A (zh) * | 2017-11-29 | 2018-05-04 | 上海无线电设备研究所 | 一种无人机路径跟踪控制的制导律设计方法 |
CN108469837A (zh) * | 2018-04-20 | 2018-08-31 | 广州亿航智能技术有限公司 | 无人机环绕角度飞行控制方法、设备及存储介质 |
CN110069077A (zh) * | 2019-04-28 | 2019-07-30 | 北京航空航天大学 | 一种针对无人飞行器飞行线路的验证方法 |
CN110262547A (zh) * | 2019-06-21 | 2019-09-20 | 西安电子科技大学 | 一种基于路径跟踪的圆形编队起飞方法 |
CN110488875A (zh) * | 2019-09-02 | 2019-11-22 | 中国人民解放军海军航空大学 | 基于动态逆的无人机跟踪目标初始段航向误差修正方法 |
Non-Patent Citations (3)
Title |
---|
HYONDONG OH ET AL.: "Rendezvous and Standoff Target Tracking Guidance Using Differential Geometry", 《SPRINGER》 * |
SHULEI WANG ET AL.: "Unmanned Aerial Vehicle Standoff Target Tracking using Modified Reference Point Guidance", 《PROCEEDINGS OF 2014 IEEE CHINESE GUIDANCE, NAVIGATION AND CONTROL CONFERENCE》 * |
王树磊等: "面向机动目标跟踪的无人机横侧向制导规律", 《北京航空航天大学学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112684810A (zh) * | 2020-12-18 | 2021-04-20 | 彩虹无人机科技有限公司 | 一种固定翼无人机环绕飞行的导航方法 |
CN113805605A (zh) * | 2021-08-30 | 2021-12-17 | 湖北航天技术研究院总体设计所 | 一种飞行轨迹规划方法及系统 |
CN113805605B (zh) * | 2021-08-30 | 2023-08-01 | 湖北航天技术研究院总体设计所 | 一种飞行轨迹规划方法及系统 |
CN113961016A (zh) * | 2021-10-25 | 2022-01-21 | 华东计算技术研究所(中国电子科技集团公司第三十二研究所) | 基于a*算法的无人机动态目标航迹规划方法及系统 |
CN113961016B (zh) * | 2021-10-25 | 2023-11-10 | 华东计算技术研究所(中国电子科技集团公司第三十二研究所) | 基于a*算法的无人机动态目标航迹规划方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN111240360B (zh) | 2022-09-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111240360B (zh) | 用于导引飞行装置跟踪目标的方法、计算机系统和介质 | |
US10656661B2 (en) | Methods and apparatus of tracking moving targets from air vehicles | |
Thomas et al. | Autonomous flight for detection, localization, and tracking of moving targets with a small quadrotor | |
US8996207B2 (en) | Systems and methods for autonomous landing using a three dimensional evidence grid | |
US20170097640A1 (en) | Autonomous vehicle control system | |
US20090157233A1 (en) | System and methods for autonomous tracking and surveillance | |
CN109871031B (zh) | 一种固定翼无人机的轨迹规划方法 | |
Mcfadyen et al. | Aircraft collision avoidance using spherical visual predictive control and single point features | |
Oh et al. | Coordinated standoff tracking using path shaping for multiple UAVs | |
CN112198886B (zh) | 一种跟踪机动目标的无人机控制方法 | |
Saska et al. | Navigation, localization and stabilization of formations of unmanned aerial and ground vehicles | |
CN108020226B (zh) | 一种固定翼无人机自主避障的航迹规划方法 | |
US20140200744A1 (en) | Method and system for steering an unmanned aerial vehicle | |
CN105425819A (zh) | 一种无人机自动跟踪地面目标的制导方法 | |
Potena et al. | Effective target aware visual navigation for uavs | |
Mejias et al. | Sense and avoid technology developments at Queensland University of Technology | |
Pluckter et al. | Precision UAV landing in unstructured environments | |
Hoy et al. | Collision-free navigation of an autonomous unmanned helicopter in unknown urban environments: sliding mode and MPC approaches | |
CN112684810B (zh) | 一种固定翼无人机环绕飞行的导航方法 | |
CN107272736B (zh) | 一种基于鸽子被动式避障飞行的无人机避障导引方法 | |
Morais et al. | Trajectory and Guidance Mode for autonomously landing an UAV on a naval platform using a vision approach | |
Yomchinda | A study of autonomous evasive planar-maneuver against proportional-navigation guidance missiles for unmanned aircraft | |
Wang et al. | Non-singular moving path following control for an unmanned aerial vehicle under wind disturbances | |
Al-Jarrah et al. | Blimp based on embedded computer vision and fuzzy control for following ground vehicles | |
CN114217639A (zh) | 基于无人机指定航向穿越视觉目标点的导引方法及系统 |
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 |