CN111522353B - 一种无人机制导方法、无人机及存储介质 - Google Patents
一种无人机制导方法、无人机及存储介质 Download PDFInfo
- Publication number
- CN111522353B CN111522353B CN202010507816.9A CN202010507816A CN111522353B CN 111522353 B CN111522353 B CN 111522353B CN 202010507816 A CN202010507816 A CN 202010507816A CN 111522353 B CN111522353 B CN 111522353B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- track route
- distance
- guidance
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C39/00—Aircraft not otherwise provided for
- B64C39/02—Aircraft not otherwise provided for characterised by special use
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
Abstract
本发明涉及无人机领域,公开一种无人机制导方法、无人机及存储介质,方法包括:获取目标轨迹路线;若目标轨迹路线与当前轨迹路线的曲率不相等,则根据当前轨迹路线和目标轨迹路线确定转弯点;获取无人机的转弯准备距离及实时距离;当实时距离小于或等于转弯准备距离时,根据目标轨迹路线获取无人机的飞行方向和制导律模型,并控制无人机飞行。根据无人机当前的飞行状态计算其转弯准备距离,以使无人机在进入转弯准备距离时,及时的切换飞行方向及制导律模型以控制无人机飞行,以确保无人机在转弯点时准确的切入目标轨迹路线,进而使无人机飞行在目标轨迹路线,从而提高了无人机对目标轨迹路线的跟踪精度。
Description
技术领域
本发明涉及无人机领域,特别是涉及一种无人机制导方法、无人机及存储介质。
背景技术
固定翼无人机由于其飞行距离远、飞行速度快等特点而在多个领域广泛的运用。其中,固定翼无人机在飞行时,主要通过其双翼来提供升力,且仅当无人机的速度达到一定程度时才能提供足够的升力。
由于固定翼无人机在飞行过程中无法悬停,从而固定翼无人机在飞行转弯时,对于曲率不相等的轨迹,就会出现轨迹跟踪效果不好,从而导致其跟踪误差较大。
发明内容
本发明实施例的一个目的旨在提供一种无人机制导方法、无人机及存储介质,其能够提高无人机轨迹跟踪的精度。
为了解决上述技术问题,本发明提供以下技术方案:
第一方面,本发明实施例提供一种无人机制导方法,包括:获取目标轨迹路线;
若所述目标轨迹路线与当前轨迹路线的曲率不相等,则根据当前轨迹路线和所述目标轨迹路线确定转弯点;
获取所述无人机的转弯准备距离,以及所述无人机的引导起点与所述转弯点之间的实时距离,其中,所述引导起点为所述无人机的当前位置点;
当所述实时距离小于或者等于所述转弯准备距离时,根据所述目标轨迹路线获取所述无人机的飞行方向和制导律模型,并根据所述飞行方向和所述制导律模型控制所述无人机飞行。
可选地,所述根据所述目标轨迹路线获取所述无人机的飞行方向,包括:
根据所述目标轨迹路线确定引导距离;
根据所述引导距离、所述目标轨迹路线和所述无人机的引导起点获取所述无人机的飞行方向,其中,所述引导距离为所述引导起点与引导终点的距离,所述引导终点位于所述目标轨迹路线上。
可选地,所述根据所述目标轨迹路线获取所述无人机的制导律模型,包括:
当所述目标轨迹路线为直线时,确定所述制导律模型为直线制导律模型;
当所述目标轨迹路线为曲线时,确定所述制导律模型为曲线制导律模型。
可选地,所述根据所述引导距离、所述目标轨迹路线和所述无人机的引导起点获取所述无人机的飞行方向,包括:
以所述引导起点为坐标系的原点,所述当前轨迹路线的飞行方向为X轴正方向,根据右手定则建立所述无人机的坐标系;
计算所述引导起点与所述引导终点所在的直线与所述X轴正方向的夹角α;
根据所述夹角α确定所述无人机的飞行方向。
可选地,根据所述飞行方向和所述制导律模型控制所述无人机飞行,包括:
计算所述当前位置点与当前期望位置点之间的误差距离;
根据所述误差距离,修正所述制导律模型;
根据修正的制导律模型及所述飞行方向,控制所述无人机持续在当前轨迹路线上实施制导操作。
可选地,所述制导律模型包括所述直线制导律模型或所述曲线制导律模型,其中:
修正后的直线制导律模型为:
修正后的曲线制导律模型为:
KV为速度制导因子,Kφ为横滚角制导因子,Kx和Ky为误差制导因子,Vc max为用户设定的最大速度,φc max为飞机的控制系统设置的最大横滚角,Vc为前置导引速度,φc为前置导引横滚角,α为引导起点P0与引导终点PN所在的直线与所述X轴正方向的夹角。
可选地,所述计算所述无人机的转弯准备距离,包括:
根据以下公式,计算所述无人机的转弯准备距离:
SR=3ηTV
SR为转弯准备距离,η为横滚角先导率,T为横滚姿态角控制时间常数,V为飞行速度。
可选地,所述引导距离小于2倍的所述当前轨迹路线的曲率半径。
第二方面,本发明实施例提供一种非易失性计算机可读存储介质,所述非易失性计算机可读存储介质存储有计算机可执行指令,所述计算机可执行指令用于使无人机执行如上述任一项所述的无人机制导方法。
第三方面,本发明实施例提供一种无人机,包括
机身;
机翼,安装于所述机身;
动力装置,安装于所述机身内,用于为所述无人机提供动力;
其中,所述动力装置包括:
至少一个处理器;以及,
与所述至少一个处理器通信连接的存储器;其中,
所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行如上述任一项所述的无人机制导方法。
相对于传统技术,在本发明各个实施例提供的一种无人机制导方法、无人机及存储介质,获取目标轨迹路线;若所述目标轨迹路线与当前轨迹路线的曲率不相等,则根据当前轨迹路线和所述目标轨迹路线确定转弯点;获取所述无人机的转弯准备距离,以及所述无人机的引导起点与所述转弯点之间的实时距离;当所述实时距离小于或者等于所述转弯准备距离时,根据所述目标轨迹路线获取所述无人机的飞行方向和制导律模型,并根据所述飞行方向和所述制导律模型控制所述无人机飞行。根据无人机当前的飞行状态计算其转弯准备距离,以使无人机在进入转弯准备距离时,及时的切换飞行方向及制导律模型以控制无人机飞行,以确保无人机在转弯点时准确的切入目标轨迹路线,进而使无人机飞行在目标轨迹路线,从而提高了无人机对目标轨迹路线的跟踪精度。
附图说明
一个或多个实施例通过与之对应的附图中的图片进行示例性说明,这些示例性说明并不构成对实施例的限定,附图中具有相同参考数字标号的元件表示为类似的元件,除非有特别申明,附图中的图不构成比例限制。
图1为本发明实施例提供的一种无人机的结构示意图;
图2为本发明实施例提供的曲率不相等的轨迹路线示意图;
图3为本发明实施例提供的一种无人机制导方法的流程示意图;
图4为本发明实施例提供的一种确定无人机飞行方向的流程示意图;
图5为本发明实施例提供的无人机不同轨迹路线时的飞行夹角的示意图;
图6为本发明实施例提供的一种修正无人机制导方法的流程示意图;
图7为本发明实施例提供的无人机飞行转弯轨迹路线的示意图;
图8为本发明实施例提供的无人机飞行转弯轨迹路线的示意图;
图9为本发明实施例提供的无人机飞行转弯轨迹路线的示意图;
图10为本发明实施例提供的无人机飞行转弯轨迹路线的示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整的描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,当元件被表述“固定于”另一个元件,它可以直接在另一个元件上、或者其间可以存在一个或多个居中的元件。当一个元件被表述“连接”另一个元件,它可以是直接连接到另一个元件、或者其间可以存在一个或多个居中的元件。本说明书所使用的术语“垂直的”、“水平的”、“左”、“右”以及类似的表述只是为了说明的目的。
此外,下面所描述的本发明各个实施例中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
请参阅图1,图1为本发明实施例提供的一种无人机的结构示意图,如图1所示,无人机100包括:机身11、机翼12及动力装置13。机翼12安装于机身11,与机身11固定连接,其中,机翼12与机身11一体成型。在机翼12的后缘设置有副翼舵面,用于控制无人机100的横滚运动。需要说明的是,图1中仅示例性的示出了无人机100的几个舵面,在其他实施例中,也可以包括其他舵面或数量更多的舵面。
动力装置13安装于机身11内,动力装置13包括电机以及与电机轴连接的螺旋桨,电机能够带动螺旋桨旋转以为无人机100提供动力,实现飞行;电机还能够通过改变螺旋桨的转速来改变无人机100的飞行速度。当动力装置13与飞控系统通信连接时,飞控系统能够通过控制电机来控制无人机100的飞行。
动力装置13还包括主控制器,无人机100执行飞行转弯时,主控制器控制副翼舵面倾转至目标倾转角度,所述无人机100根据该倾转角度发生横滚运动,从而产生横滚角,所述无人机100根据该横滚角产生的向心力实现转弯。
可以理解的,当转弯轨迹的曲率相等时,所述无人机根据当前的飞行状态控制无人机在期望的飞行轨迹上飞行,从而能对无人机的飞行轨迹进行精确的跟踪。然而,当转弯轨迹的曲率不相等时,由于无人机控制副翼舵面倾转而产生横滚角需要一定的响应时间,以致于无人机在未完全准备好转弯的情况下执行转弯飞行,使得无人机实际的飞行轨迹与期望的飞行轨迹出现了偏差,从而无法精准的跟踪无人机的目标轨迹路线,降低了无人机的轨迹跟踪精度。
具体的,请参阅图2,以下例举出几种无人机转弯时出现的曲率不相等的情况:
情况1:如图2-1所示的转弯曲率半径由∞变成半径R;
情况2:如图2-2所示的转弯曲率半径由半径R变成∞;
情况3:如图2-3所示的转弯曲率的方向不相同;
情况4:如图2-4所示的转弯曲率的半径大小和方向均发生变化。
需要说明的是,图2中仅示例性的示出了无人机在转弯时遇到的曲率变化情况,在其他实施例中,也可以包括其他情况的曲率变化。
制导方法是指导引和控制无人机按照预定的飞行轨迹飞向目标位置的方法,可以理解的,在无人机的制导过程中,无人机的主控制器不断的检测无人机与目标位置的相对位置关系,并产生制导信息以控制无人机的飞行。
本发明实施例提供的一种无人机制导方法,该方法应用于无人机,使得无人机能够在曲率不相等的轨迹路线飞行时,根据轨迹路线选择相适应的制导律模型,从而根据该制导律模型控制无人机能够根据期望的轨迹路线飞行,从而提高无人机的轨迹跟踪精度。
本发明中的无人机可以是任何合适类型的高空无人机或者低空无人机,包括固定翼无人机、旋翼无人机、伞翼无人机或者扑翼无人机等。
具体的,请参阅图3,所述制导方法包括:
S20:获取目标轨迹路线;
S21:若所述目标轨迹路线与当前轨迹路线的曲率不相等,则根据当前轨迹路线和所述目标轨迹路线确定转弯点;
曲率是指针对曲线上某个点的切线方向角对弧长的转动率,用于表示曲线偏离直线的程度,曲率越大,曲线的弯曲程度越大。曲率不相等是指两条曲线在接触点的曲率半径不同和/或方向不同,具体的,所述曲率不相等是指两条曲线在接触点的曲率半径不同,曲率方向相同;或者,两条曲线在接触点的曲率半径相同,曲率方向不同;或者,两条曲线在接触点的曲率半径和方向均不相同。
在本发明实施例中,所述转弯点即为为当前轨迹路线与目标轨迹路线的接触点,所述无人机可沿着所述当前轨迹路线在所述转弯点转弯至目标轨迹路线。所述制导方法则用于控制无人机由当前轨迹路线在转弯点时准确的切入目标轨迹路线。
可以理解的,轨迹路线包括直线轨迹路线和曲线轨迹路线,其中,所述曲线轨迹路线是指规则的圆弧曲线。在本发明实施例中,所述当前轨迹路线与所述目标轨迹路线中至少有一个轨迹路线为曲线轨迹路线,例如,当前轨迹路线为直线轨迹路线,则目标轨迹路线为曲线轨迹路线;当前轨迹路线为曲线轨迹路线,则目标轨迹路线为直线轨迹路线或曲线轨迹路线。
具体的,所述当前轨迹路线与所述目标轨迹路线的曲率不相等,包括曲率半径不同和/或曲率方向不同,其中,曲率方向包括顺时针曲率方向或逆时针曲率方向。可以理解的,直线轨迹路线的曲率半径为∞,曲线轨迹路线的曲率半径为R。当所述当前轨迹路线与所述目标轨迹路线中任意一条为直线轨迹路线,另一条为曲线轨迹路线时,则所述当前轨迹路线与所述目标轨迹路线的曲率半径及曲率方向均不相同;当所述当前轨迹路线与所述目标轨迹路线均为曲线轨迹路线时,则当所述当前轨迹路线与所述目标轨迹路线的曲率方向不同和/或曲率半径不同。
S22:获取所述无人机的转弯准备距离,以及所述无人机的引导起点与所述转弯点之间的实时距离,其中,所述引导起点为所述无人机的当前位置点;
转弯准备距离是指在当前飞行状态下,控制无人机产生转弯时的横滚角所需的安全距离。在该安全距离内,控制无人机产生横滚角,以使无人机能准确的在转弯点切入目标轨迹路线。可以理解的,由于无人机产生目标轨迹路线相应的横滚角需要一定的时间,若无人机在到达转弯点时才开始产生横滚角,则会导致无人机的飞行轨迹路线偏离所述目标轨迹路线而产生轨迹跟踪误差。因此,在本发明实施例中,根据所述无人机自身的性能特点,计算出无人机在当前飞行状态下的转弯准备距离,以确保无人机在到达所述转弯点时能准确的在转弯点切入所述目标轨迹路线。其中,所述飞行状态包括所述无人机当前的飞行速度。
具体的,根据以下公式,计算所述无人机的转弯准备距离:
SR=3ηTV
SR为转弯准备距离,η为横滚角先导率,T为横滚姿态角控制时间常数,V为飞行速度。
其中,横滚角先导率η及横滚姿态角控制时间常数T预存在所述无人机中,在本发明实施例中,横滚姿态角控制时间常数T为无人机产生所述横滚角所需的时间,可以理解的,各无人机根据其自身参数的不同,预存的横滚姿态角控制时间常数T的值亦不相同;横滚角先导率η取值于0.3~0.5之间。可见,转弯准备距离SR与无人机当前的飞行速度V正相关,当前的飞行速度V越快,所述无人机的转弯准备距离SR也越大。
在一些实施例中,还可以根据所述无人机的综合性能确定所述所述转弯准备距离,将所述转弯准备距离设定为一个恒定值预存于所述无人机。
实时距离是指所述无人机的当前位置点与转弯点之间的距离,当所述无人机的当前轨迹路线为直线轨迹路线时,所述实时距离即为所述无人机的当前位置点与转弯点之间的直线距离;当所述无人机的当前轨迹路线为曲线轨迹路线时,所述实时距离即为所述无人机的当前位置点与转弯点之间的曲线长度。
S23:当所述实时距离小于或者等于所述转弯准备距离时,根据所述目标轨迹路线获取所述无人机的飞行方向和制导律模型,并根据所述飞行方向和所述制导律模型控制所述无人机飞行。
其中,飞行方向用于指示无人机相对于当前飞行方向的偏移,用偏移角度来标识其大小及方向,若所述偏移角度大于零,则控制所述无人机向顺时针方向飞行;若所述偏移角度等于零,则控制所述无人机直线向前飞行;若所述偏移角度小于零,则控制所述无人机向逆时针方向飞行。
制导律模型用于定义无人机根据轨迹路线飞行的规律,决定无人机飞行的轨迹路线。其中,轨迹路线包括直线轨迹路线或曲线轨迹路线,可以理解的,每一种轨迹路线对应一种制导律模型,在本发明实施例中,所述制导律模型包括直线制导律模型或曲线制导律模型。当轨迹路线为直线轨迹路线时,选择直线制导率模型制导所述无人机飞行;当轨迹路线为曲线轨迹路线时,选择曲线制导率模型制导所述无人机飞行。
在本发明实施例中,根据所述所述实时距离与所述转弯准备距离以确定所述无人机的飞行方向及制导律模型。首先,判断所述实时距离是否小于或者等于所述转弯准备距离;
若否,则所述无人机还未进入转弯准备距离范围,所述无人机根据所述当前轨迹路线获取其飞行方向和制导律模型,并根据所述飞行方向和所述制导律模型控制所述无人机飞行。具体的,当所述当前轨迹路线为直线时,确定所述制导律模型为直线制导律模型;当所述当前轨迹路线为曲线时,确定所述制导律模型为曲线制导律模型。
若是,则所述无人机已进入转弯准备距离范围,所述无人机根据所述目标轨迹路线获取其飞行方向和制导律模型,并根据所述飞行方向和所述制导律模型控制所述无人机飞行。具体的,当所述目标轨迹路线为直线时,确定所述制导律模型为直线制导律模型;当所述目标轨迹路线为曲线时,确定所述制导律模型为曲线制导律模型。
需要说明的是,在本发明实施例中,将制导所述无人机从当前轨迹路线飞入目标轨迹路线的过程称之为一个完整的制导过程。可以理解的,当所述无人机接收到转弯飞行指令时,所述无人机根据所述转弯飞行指令产生当前轨迹路线及目标轨迹路线,并在当前轨迹路线及目标轨迹路线上执行上述的制导方法,直至所述无人机在转弯点时切入目标轨迹路线后,所述无人机将根据目标轨迹路线对应的制导律模型飞行,直到无人机接收到转弯飞行指令或其他飞行指令。
还需要说明的是,在所述无人机的一个完整制导过程中,所述无人机根据所述制导律模型飞行一个步长时间后,返回步骤S22,以根据所述无人机当前的飞行状况计算转弯准备距离及实时距离,进而确定无人机的飞行方向和制导律模型,以制导所述无人机飞行。当然,上述所述无人机根据所述制导律模型飞行的时间可以设定为比一个步长时间更长或者更短的时间,在此不做限定。
在本发明实施例中,获取目标轨迹路线;若所述目标轨迹路线与当前轨迹路线的曲率不相等,则根据当前轨迹路线和所述目标轨迹路线确定转弯点;计算所述无人机的转弯准备距离,以及所述无人机的引导起点与所述转弯点之间的实时距离;当所述实时距离小于或者等于所述转弯准备距离时,根据所述目标轨迹路线获取所述无人机的飞行方向和制导律模型,并根据所述飞行方向和所述制导律模型控制所述无人机飞行。根据无人机当前的飞行状态计算其转弯准备距离,以使无人机在进入转弯准备距离时,及时的切换飞行方向及制导律模型以控制无人机飞行,以确保无人机在转弯点时准确的切入目标轨迹路线,进而使无人机飞行在目标轨迹路线,从而提高了无人机对目标轨迹路线的跟踪精度。
飞行方向用于指示无人机相对于当前飞行方向的偏移,可以理解的,当所述无人机在不同轨迹路线飞行时,根据其飞行的轨迹路线,获取所述无人机的飞行方向。具体的,请参阅图4,根据无人机的轨迹路线获取所述无人机的飞行方向,包括:
S31:根据所述轨迹路线确定引导距离;
S32:根据所述引导距离、所述轨迹路线和所述无人机的引导起点获取所述无人机的飞行方向。
其中,所述无人机的轨迹路线包括当前轨迹路线和/或目标轨迹路线,具体的,当所述实时距离小于或者等于所述转弯准备距离时,所述无人机根据所述目标轨迹路线确定引导距离,并根据所述引导距离、所述目标轨迹路线和所述无人机的引导起点获取所述无人机的飞行方向;当所述实时距离大于所述转弯准备距离时,所述无人机根据所述当前轨迹路线确定引导距离,并根据所述引导距离、所述当前轨迹路线和所述无人机的引导起点获取所述无人机的飞行方向。
在本发明实施例中,所述引导距离是指引导起点与引导终点的直线距离,其中,引导起点是指无人机当前时刻的位置点,引导终点则是以无人机当前时刻的位置点为起点,以引导距离为长度,在轨迹路线或轨迹路线延长线上的交点。其中,所述轨迹路线是指无人机当前制导律模型对应的轨迹路线。当所述实时距离大于所述转弯准备距离时,所述无人机根据制导律模型飞行在当前轨迹路线,亦即,所述轨迹路线为当前轨迹路线;当所述实时距离小于或等于所述转弯准备距离时,所述无人机根据制导律模型飞行在目标轨迹路线,亦即,所述轨迹路线为当前轨迹路线。
为了更直观准确的确定所述飞行方向,所述根据所述引导距离、所述目标轨迹路线和所述无人机的引导起点获取所述无人机的飞行方向,包括:
S321:以所述引导起点为坐标系的原点,以所述无人机在所述引导起点的飞行方向为X轴正方向,根据右手定则建立所述无人机的坐标系;
S322:计算所述引导起点与所述引导终点所在的直线与所述X轴正方向的夹角α;
S323:根据所述夹角α确定所述无人机的飞行方向。
具体的,请参阅图5,当所述轨迹路线为如图5-1所示的曲线轨迹时,所述引导起点P0与所述引导终点PN所在的直线与所述X轴正方向的夹角α>0,则所述无人机的飞行方向为顺时针方向飞行;当所述轨迹路线为如图5-2所示的直线轨迹时,所述引导起点P0与所述引导终点PN所在的直线与所述X轴正方向的夹角α=0,则所述无人机的飞行方向为向前直线飞行;当所述轨迹路线为如图5-3所示的曲线轨迹时,所述引导起点P0与所述引导终点PN所在的直线与所述X轴正方向的夹角α<0,则所述无人机的飞行方向为逆时针方向飞行。
可见,所述引导距离用于辅助所述无人机确定其相对于当前飞行方向的偏移方向,在本发明实施例中,所述引导距离的取值小于2倍的所述当前轨迹路线的曲率半径,并且,在引导过程中,所述引导距离为固定值。
在本发明实施例中,根据轨迹路线确定引导距离,并以所述无人机的当前位置点为坐标原点,以所述无人机在当前位置点的飞行方向为X轴正方向,根据右手定则建立坐标系,在该坐标系中计算所述无人机的飞行方向,提高了计算所述无人机飞行方向的准确性。
可以理解的是,在无人机的飞行控制中,难免会出现飞行误差,为了提高飞行控制的精度,减小飞行误差,请参阅图6,本发明实施例提供一种无人机飞行控制方法,以修正无人机在飞行时出现的误差,所述方法包括:
S41:计算所述当前位置点与当前期望位置点之间的误差距离;
具体的,分别计算所述当前期望位置点在所述坐标系的X轴坐标与所述当前位置点的X轴坐标的差值,得到所述第一坐标差值;分别计算所述当前期望位置点在所述无人机坐标系的Y轴坐标与所述当前位置点的Y轴坐标的第二坐标差值,得到所述第二坐标差值。假设当前期望位置点为P0c,其在上述坐标系中对应的坐标位置为当前位置点为P0,其在上述坐标系中对应的坐标位置为那么,所述无人机当前位置点与当前期望位置点之间的坐标差为:
其中,ex为所述第一坐标差值,ey为所述第二坐标差值。
S42:根据所述误差距离,修正所述制导律模型;
在本发明实施例中,所述制导律模型包括直线制导律模型或曲线制导律模型,将上述计算得到的所述误差距离用以修正所述直线制导律模型或曲线制导律模型,修正后的直线制导律模型为:
修正后的曲线制导律模型为:
其中,KV为速度制导因子,Kφ为横滚角制导因子,Kx和Ky为误差制导因子,Vc max为用户设定的最大速度,φc max为飞机的控制系统设置的最大横滚角,Vc为前置导引速度,φc为前置导引横滚角,α为引导起点P0与所述引导终点PN所在的直线与所述X轴正方向的夹角。
可以理解的,前置导引速度Vc和前置导引横滚角φc即为所述无人机根据制导律模型生成的制导参数,所述无人机根据上述制导参数控制所述无人机飞行。
S43:根据修正的制导律模型及所述飞行方向,控制所述无人机持续在当前轨迹路线上实施制导操作。
在本发明实施例中,通过计算所述无人机当前位置点与当前期望位置点之间的误差距离,并将所述误差距离用以修正所述直线制导律模型或曲线制导律模型,以使所述无人机根据修正后的所述制导律模型飞行,减小了无人机的飞行误差,提高了无人机对轨迹路线的跟踪精度。
为了更详细了说明所述无人机通过上述制导方法,使其在转弯点时由所述当前轨迹路线准确切入所述目标轨迹路线,以下以上述所述的无人机转弯时出现的曲率不相等的情况为例,详细说明所述无人机在飞行时制导过程:
请参阅图7,当所述当前轨迹路线为直线轨迹路线,所述目标轨迹路线为曲线轨迹路线时,获取所述无人机的转弯准备距离及实时距离,判断所述实时距离是否小于所述转弯准备距离;若否,选择直线制导律模型;若是,选择曲线制导律模型。
具体的,如图7所示,P0所述无人机的当前位置点,以所述当前位置点P0为坐标系的原点,所述当前轨迹路线的飞行方向为X轴正方向,根据右手定则建立所述无人机的坐标系;PN为以P0为引导起点,以引导距离L为长度在当前轨迹路线产生的交点,即引导终点;PT为转弯点,α为所述引导起点P0与所述引导终点PN所在的直线与所述X轴正方向的夹角,所述无人机的飞行主要包括以下三个阶段:
阶段Ⅰ:当无人机在所述直线轨迹路线上飞行,且未进入转弯准备距离范围时,即所述实时距离大于所述转弯准备距离时,所述引导起点P0与所述引导终点PN所在的直线与所述X轴重合,所述夹角α=0,则所述无人机根据当前的直线轨迹路线选择直线制导律模型作为当前飞行的制导律模型,并根据所述直线制导律模型制导所述无人机直线向前飞行。
阶段Ⅱ:当所述无人机进入所述转弯准备距离范围内时,即所述实时距离小于或等于所述转弯准备距离时,所述无人机的制导律模型由直线制导律模型切换成曲线制导律模型,其中,所述引导终点PN位于目标轨迹路线上,所述引导起点P0与所述引导终点PN所在的直线与所述X轴的夹角α>0,所述无人机根据曲线制导律模型制导所述无人机向顺时针方向飞行。需要说明的是,所述无人机在该阶段时的飞行为由当前轨迹路线转向目标轨迹路线飞行的过渡阶段,因此,在该阶段的飞行轨迹路线既不近似于直线轨迹路线,也不近似于曲线轨迹路线,而是介于直线轨迹路线与曲线轨迹路线之间的轨迹路线。
阶段Ⅲ:当所述无人机到达或飞过转弯点PT时,所述无人机由直线轨迹路线准确的切入所述目标轨迹路线,即曲线轨迹路线,并继续根据曲线制导律模型及飞行方向控制所述无人机飞行。应该说明的是,当所述无人机飞过所述转弯点时,可以理解为,所述无人机根据上述无人机的制导方法,完成了所述无人机由当前轨迹路线飞入目标轨迹路线的轨迹路线跟踪。
当所述当前轨迹路线为曲线轨迹路线,所述目标轨迹路线为直线轨迹路线时,获取所述无人机的转弯准备距离及实时距离,判断所述实时距离是否小于所述转弯准备距离;若否,选择曲线制导律模型;若是,选择直线制导律模型。
具体的,请参阅图8,P0所述无人机的当前位置点,以所述当前位置点P0为坐标系的原点,所述当前轨迹路线的飞行方向为X轴正方向,根据右手定则建立所述无人机的坐标系;PN为以P0为引导起点,以引导距离L为长度在当前轨迹路线产生的交点,即引导终点;PT为转弯点,α为所述引导起点P0与所述引导终点PN所在的直线与所述X轴正方向的夹角,所述无人机的飞行主要包括以下三个阶段:
阶段Ⅰ:当无人机在所述曲线轨迹路线上飞行,且未进入转弯准备距离范围时,即所述实时距离大于所述转弯准备距离时,所述引导起点P0与所述引导终点PN所在的直线与所述X轴正方向的夹角α<0,则所述无人机根据当前的曲线轨迹路线选择曲线制导律模型作为当前飞行的制导律模型,并根据所述曲线制导律模型制导所述无人机向逆时针方向飞行。
阶段Ⅱ:当所述无人机进入所述转弯准备距离范围内时,即所述实时距离小于或等于所述转弯准备距离时,所述无人机的制导律模型由曲线制导律模型切换成直线制导律模型,其中,所述引导终点PN位于目标轨迹路线上,所述引导起点P0与所述引导终点PN所在的直线与所述X轴的夹角α<0,所述无人机根据曲线制导律模型制导所述无人机向逆时针方向飞行。需要说明的是,所述无人机在该阶段时的飞行为由当前轨迹路线转向目标轨迹路线飞行的过渡阶段,因此,在该阶段的飞行轨迹路线既不近似于直线轨迹路线,也不近似于曲线轨迹路线,而是介于直线轨迹路线与曲线轨迹路线之间的轨迹路线。
阶段Ⅲ:当所述无人机到达或飞过转弯点PT时,所述无人机由曲线轨迹路线准确的切入所述目标轨迹路线,即直线轨迹路线,并继续根据直线制导律模型及飞行方向控制所述无人机飞行。应该说明的是,当所述无人机飞过所述转弯点时,可以理解为,所述无人机根据上述无人机的制导方法,完成了所述无人机由当前轨迹路线飞入目标轨迹路线的轨迹路线跟踪。
当所述当前轨迹路线为第一曲线轨迹路线,所述目标轨迹路线为第二曲线轨迹路线,其中,所述第一曲线轨迹路线与第二曲线轨迹路线的曲率不相等。
具体的,请一并参阅图9和图10,在图9中,所述第一曲线轨迹路线与第二曲线轨迹路线的曲率半径相同,方向不同;在图10中,所述第一曲线轨迹路线与第二曲线轨迹路线的曲率半径与方向均不相同。
可以理解的,上述第一曲线轨迹路线与第二轨迹路线所对应的制导律模型均为曲线制导律模型,所述曲线制导律模型根据不同曲线轨迹时的曲率半径及方向夹角不同而输出不同的制导参数。
具体的,以所述当前位置点P0为坐标系的原点,所述当前轨迹路线的飞行方向为X轴正方向,根据右手定则建立所述无人机的坐标系;PN为以P0为引导起点,以引导距离L为长度在当前轨迹路线或当前轨迹路线的延长线产生的交点,即引导终点;PT为转弯点,α为所述引导起点P0与所述引导终点PN所在的直线与所述X轴正方向的夹角,所述无人机的飞行主要包括以下三个阶段:
阶段Ⅰ:当无人机在所述第一曲线轨迹路线上飞行,且未进入转弯准备距离范围时,即所述实时距离大于所述转弯准备距离时,所述引导起点P0与所述引导终点PN所在的直线与所述X轴正方向的夹角α<0,则所述无人机根据第一曲线轨迹路线选择曲线制导律模型作为当前飞行的制导律模型,并根据所述曲线制导律模型制导所述无人机向逆时针方向飞行。
阶段Ⅱ:当所述无人机进入所述转弯准备距离范围内时,即所述实时距离小于或等于所述转弯准备距离时,所述无人机的制导律模型仍然为曲线制导律模型,与阶段Ⅰ不同的是,在该阶段时,所述引导终点PN位于目标轨迹路线上,所述引导起点P0与所述引导终点PN所在的直线与所述X轴的夹角α>0,所述无人机根据曲线制导律模型制导所述无人机向顺时针方向飞行。需要说明的是,所述无人机在该阶段时的飞行为由第一曲线轨迹路线转向第二曲线轨迹路线飞行的过渡阶段,因此,在该阶段的飞行轨迹路线既不近似于第一曲线轨迹路线,也不近似于第二曲线轨迹路线,而是介于第一曲线轨迹路线与第二曲线轨迹路线之间的轨迹路线。
阶段Ⅲ:当所述无人机到达或飞过转弯点PT时,所述无人机由第一曲线轨迹路线线准确的切入第一曲线轨迹路线,并继续根据曲线制导律模型及飞行方向控制所述无人机飞行。应该说明的是,当所述无人机飞过所述转弯点时,可以理解为,所述无人机根据上述无人机的制导方法,完成了所述无人机由当前轨迹路线飞入目标轨迹路线的轨迹路线跟踪。
以上所描述的装置或设备实施例仅仅是示意性的,其中所述作为分离部件说明的单元模块可以是或者也可以不是物理上分开的,作为模块单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络模块单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到各实施方式可借助软件加通用硬件平台的方式来实现,当然也可以通过硬件实现。基于这样的理解,上述技术方案本质上或者说对相关技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。
本发明实施例提供了一种非易失性计算机可读存储介质,所述计算机可读存储介质存储有计算机可执行指令,该计算机可执行指令被一个或多个处理器执行,例如,执行以上描述的图3、图4和图6的方法步骤。
本发明实施例提供了一种计算机程序产品,包括一个或多个处理器以及存储器,处理器和存储器可以通过总线或者其他方式连接。
存储器作为一种非易失性计算机可读存储介质,可用于存储非易失性软件程序、非易失性计算机可执行程序以及模块。处理器通过运行存储在存储器中的非易失性软件程序、指令以及模块,从而执行服务器的各种功能应用以及数据处理。
存储器可以包括高速随机存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器件、闪存器件、或其他非易失性固态存储器件。在一些实施例中,存储器可选包括相对于处理器远程设置的存储器,这些远程存储器可以通过网络连接至处理器。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
所述程序指令/模块存储在所述存储器中,当被所述一个或者多个处理器执行时,执行上述任意方法实施例中的无人机制导方法,例如,执行以上描述的图3、图4和图6的方法步骤。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;在本发明的思路下,以上实施例或者不同实施例中的技术特征之间也可以进行组合,步骤可以以任意顺序实现,并存在如上所述的本发明的不同方面的许多其它变化,为了简明,它们没有在细节中提供;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (10)
1.一种无人机制导方法,其特征在于,包括:
获取目标轨迹路线;
若所述目标轨迹路线与当前轨迹路线的曲率不相等,则根据当前轨迹路线和所述目标轨迹路线确定转弯点;
获取所述无人机的转弯准备距离,以及所述无人机的引导起点与所述转弯点之间的实时距离,其中,所述引导起点为所述无人机的当前位置点;
当所述实时距离小于或者等于所述转弯准备距离时,根据所述目标轨迹路线获取所述无人机的飞行方向和制导律模型,并根据所述飞行方向和所述制导律模型控制所述无人机飞行。
2.根据权利要求1所述的方法,其特征在于,所述根据所述目标轨迹路线获取所述无人机的飞行方向,包括:
根据所述目标轨迹路线确定引导距离;
根据所述引导距离、所述目标轨迹路线和所述无人机的引导起点获取所述无人机的飞行方向,其中,所述引导距离为所述引导起点与引导终点的距离,所述引导终点位于所述目标轨迹路线上。
3.根据权利要求2所述的方法,其特征在于,所述根据所述引导距离、所述目标轨迹路线和所述无人机的引导起点获取所述无人机的飞行方向,包括:
以所述引导起点为坐标系的原点,所述当前轨迹路线的飞行方向为X轴正方向,根据右手定则建立所述无人机的坐标系;
计算所述引导起点与所述引导终点所在的直线与所述X轴正方向的夹角α;
根据所述夹角α确定所述无人机的飞行方向。
4.根据权利要求1至3任一项所述的方法,其特征在于,根据所述目标轨迹路线获取所述无人机的制导律模型,包括:
当所述目标轨迹路线为直线时,确定所述制导律模型为直线制导律模型;
当所述目标轨迹路线为曲线时,确定所述制导律模型为曲线制导律模型。
5.根据权利要求4所述的方法,其特征在于,所述根据所述飞行方向和所述制导律模型控制所述无人机飞行,包括:
计算所述当前位置点与当前期望位置点之间的误差距离;
根据所述误差距离,修正所述制导律模型;
根据修正后的制导律模型及所述飞行方向,控制所述无人机飞行。
7.根据权利要求1所述的方法,其特征在于,所述获取所述无人机的转弯准备距离,包括:
根据以下公式,计算所述无人机的转弯准备距离:
SR=3ηTV
其中,SR为转弯准备距离,η为横滚角先导率,T为横滚姿态角控制时间常数,V为飞行速度。
8.根据权利要求2或3所述的方法,其特征在于,所述引导距离小于2倍的所述当前轨迹路线的曲率半径。
9.一种非易失性计算机可读存储介质,其特征在于,所述非易失性计算机可读存储介质存储有计算机可执行指令,所述计算机可执行指令用于使无人机执行如权利要求1至8任一项所述的无人机制导方法。
10.一种无人机,其特征在于,包括
机身;
机翼,安装于所述机身;
动力装置,安装于所述机身内,用于为所述无人机提供动力;
其中,所述动力装置包括:
至少一个处理器;以及,
与所述至少一个处理器通信连接的存储器;其中,
所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行如权利要求1至8任一项所述的无人机制导方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010507816.9A CN111522353B (zh) | 2020-06-05 | 2020-06-05 | 一种无人机制导方法、无人机及存储介质 |
PCT/CN2021/097755 WO2021244545A1 (zh) | 2020-06-05 | 2021-06-01 | 一种无人机制导方法、无人机及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010507816.9A CN111522353B (zh) | 2020-06-05 | 2020-06-05 | 一种无人机制导方法、无人机及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111522353A CN111522353A (zh) | 2020-08-11 |
CN111522353B true CN111522353B (zh) | 2023-01-31 |
Family
ID=71909752
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010507816.9A Active CN111522353B (zh) | 2020-06-05 | 2020-06-05 | 一种无人机制导方法、无人机及存储介质 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN111522353B (zh) |
WO (1) | WO2021244545A1 (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111522353B (zh) * | 2020-06-05 | 2023-01-31 | 深圳市道通智能航空技术股份有限公司 | 一种无人机制导方法、无人机及存储介质 |
CN111976981A (zh) * | 2020-08-14 | 2020-11-24 | 深圳市道通智能航空技术有限公司 | 一种无人机控制方法、装置及存储介质 |
CN114115316A (zh) * | 2021-11-29 | 2022-03-01 | 中国南方电网有限责任公司超高压输电公司大理局 | 无人机稳定性控制方法、装置、无人机设备、存储介质 |
CN114126045B (zh) * | 2022-01-19 | 2022-06-03 | 深圳市华芯云创科技有限公司 | 一种uwb室内外一体智能导航定位方法和系统 |
CN114664120B (zh) * | 2022-03-15 | 2023-03-24 | 南京航空航天大学 | 一种基于ads-b的航空器自主间隔控制方法 |
CN115016528B (zh) * | 2022-05-23 | 2023-03-10 | 贵州丰立空间科技有限公司 | 一种基于无人机的光伏板巡查系统 |
CN114995418B (zh) * | 2022-05-31 | 2023-10-20 | 郑州北斗七星通讯科技有限公司 | 一种水上机器人路线规划方法 |
CN115079723A (zh) * | 2022-07-20 | 2022-09-20 | 中国人民解放军国防科技大学 | 一种任意时间到达的固定翼无人机制导方法 |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9494941B2 (en) * | 2009-06-26 | 2016-11-15 | Luminati Aerospace Llc | Method of guidance of unmanned aerial vehicles |
CN101750090B (zh) * | 2009-12-30 | 2011-08-10 | 东软集团股份有限公司 | 利用轨迹点导航的导航装置 |
CN105259913B (zh) * | 2015-08-11 | 2018-12-11 | 中国航空工业集团公司西安飞机设计研究所 | 确定飞行器自动着陆引导指令的方法及装置 |
WO2018126355A1 (zh) * | 2017-01-04 | 2018-07-12 | 深圳配天智能技术研究院有限公司 | 机器人运动轨迹规划方法及相关装置 |
CN107515617B (zh) * | 2017-08-15 | 2020-08-07 | 西安爱生技术集团公司 | 一种固定翼无人机航线平滑切换控制方法 |
CN108469832B (zh) * | 2018-02-07 | 2020-06-09 | 北京航天时代激光导航技术有限责任公司 | 一种自动驾驶下的转弯控制方法和系统 |
US20190354116A1 (en) * | 2018-05-18 | 2019-11-21 | Qualcomm Incorporated | Trajectory determination in a drone race |
CN109343528A (zh) * | 2018-10-30 | 2019-02-15 | 杭州电子科技大学 | 一种节能的无人机路径规划避障方法 |
CN109582035A (zh) * | 2018-11-29 | 2019-04-05 | 沈阳无距科技有限公司 | 一种飞行器航迹导航方法、装置及电子设备 |
CN110617818A (zh) * | 2019-10-15 | 2019-12-27 | 中国人民解放军军事科学院国防科技创新研究院 | 一种无人机航迹生成方法 |
CN111158392B (zh) * | 2020-01-09 | 2023-05-26 | 辽宁壮龙无人机科技有限公司 | 无人机转弯的规划控制方法、装置、电子设备及存储介质 |
CN111522353B (zh) * | 2020-06-05 | 2023-01-31 | 深圳市道通智能航空技术股份有限公司 | 一种无人机制导方法、无人机及存储介质 |
-
2020
- 2020-06-05 CN CN202010507816.9A patent/CN111522353B/zh active Active
-
2021
- 2021-06-01 WO PCT/CN2021/097755 patent/WO2021244545A1/zh active Application Filing
Also Published As
Publication number | Publication date |
---|---|
WO2021244545A1 (zh) | 2021-12-09 |
CN111522353A (zh) | 2020-08-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111522353B (zh) | 一种无人机制导方法、无人机及存储介质 | |
CN109947123B (zh) | 一种基于视线导引律的无人机路径跟踪与自主避障方法 | |
US10241520B2 (en) | System and method for vision-based flight self-stabilization by deep gated recurrent Q-networks | |
US20060015247A1 (en) | Bezier curve flightpath guidance using moving waypoints | |
CN107515617B (zh) | 一种固定翼无人机航线平滑切换控制方法 | |
CN111290440B (zh) | 基于双虚拟结构的多无人机编队Standoff跟踪控制及跟踪方法 | |
CN111443709A (zh) | 车辆变道路线规划方法、装置、终端和存储介质 | |
CN105045284A (zh) | 一种抗干扰无人飞行器路径跟踪控制方法 | |
CN110789530B (zh) | 一种四轮独立转向-独立驱动车辆轨迹跟踪方法和系统 | |
WO2020258066A1 (zh) | 无人机的控制方法、设备、无人机及存储介质 | |
CN112415999B (zh) | 自动驾驶路径点的处理方法、装置、设备及存储介质 | |
CN113110588B (zh) | 一种无人机编队及其飞行方法 | |
CN111665867B (zh) | 飞行器侧向机动制导方法、装置、电子设备及存储介质 | |
Mills et al. | Vision based control for fixed wing UAVs inspecting locally linear infrastructure using skid-to-turn maneuvers | |
CN114715196A (zh) | 一种跟随误差确定方法、装置、设备及存储介质 | |
CN112622933A (zh) | 车辆停靠点的确定方法及装置 | |
CN106873615B (zh) | 应急返场着陆速度指令集设计方法 | |
CN111338379B (zh) | 自动控制飞行器的协同路径规划方法 | |
CN113515138A (zh) | 一种固定翼无人机航线重规划方法 | |
CN105094144A (zh) | 一种无人飞艇自适应抗风路径跟踪控制方法 | |
Hoy et al. | Collision-free navigation of an autonomous unmanned helicopter in unknown urban environments: sliding mode and MPC approaches | |
CN114771551A (zh) | 自动驾驶车辆轨迹规划方法、装置和自动驾驶车辆 | |
CN108801262B (zh) | 一种船舶自动航行控制器航路规划与纠偏修正方法 | |
CN115993089B (zh) | 基于pl-icp的在线四舵轮agv内外参标定方法 | |
CN115542899A (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 | ||
CB02 | Change of applicant information |
Address after: 518055 Guangdong city of Shenzhen province Nanshan District Xili Street Xueyuan Road No. 1001 Chi Yuen Building 9 layer B1 Applicant after: Shenzhen daotong intelligent Aviation Technology Co.,Ltd. Address before: 518055 Guangdong city of Shenzhen province Nanshan District Xili Street Xueyuan Road No. 1001 Chi Yuen Building 9 layer B1 Applicant before: AUTEL ROBOTICS Co.,Ltd. |
|
CB02 | Change of applicant information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |