CN106020236A - 一种自适应引导长度的无人机航迹跟踪方法 - Google Patents
一种自适应引导长度的无人机航迹跟踪方法 Download PDFInfo
- Publication number
- CN106020236A CN106020236A CN201610626290.XA CN201610626290A CN106020236A CN 106020236 A CN106020236 A CN 106020236A CN 201610626290 A CN201610626290 A CN 201610626290A CN 106020236 A CN106020236 A CN 106020236A
- Authority
- CN
- China
- Prior art keywords
- lead
- length
- flight path
- unmanned plane
- track
- 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 abstract description 24
- 230000003044 adaptive effect Effects 0.000 title abstract 2
- 238000005070 sampling Methods 0.000 claims abstract description 41
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 18
- 238000011156 evaluation Methods 0.000 claims abstract description 9
- 238000004422 calculation algorithm Methods 0.000 claims description 35
- 230000006978 adaptation Effects 0.000 claims description 14
- 230000033001 locomotion Effects 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 4
- 230000007547 defect Effects 0.000 abstract description 2
- 230000000694 effects Effects 0.000 abstract 1
- 238000013461 design Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000012360 testing method Methods 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000009514 concussion Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 210000004556 brain Anatomy 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000004899 motility Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
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
技术领域
本发明属于无人机技术领域,具体涉及一种自适应引导长度的无人机航迹跟踪方法。
背景技术
无人机具有重量轻、成本低和适应性强等特点,已成为世界许多国家的研究热点。在无人机的相关研究中,航迹跟踪是无人机安全飞行,完成飞行任务的基础,更是多机协同编队飞行的重要支撑,因此成为学者研究的重点。在航迹跟踪的过程中,必须综合考虑无人机的跟踪精度与自身稳定性,以保证无人机的安全性和追踪的可靠性。
无人机飞行控制***作为无人机的“大脑”,是机上设备进行操纵指令传递,舵面运动控制的所有装置和部件的总和。目前对飞行器控制***的研究,主要有两种实现方法:一类实现方式将飞行器控制***进行分解,分为外环制导与内环控制两个回路,分别对应航迹跟踪与姿态控制两方面的功能。该方法将复杂的问题进行分解,设计与实现比较容易,但是难以对完整***的稳定性进行分析;另一类实现方式将整个控制***统一求解,通过统一的算法进行设计,是一种综合式的方法,主要采用滚动时域法、微分平滑算法、模型预测控制等现代控制方法。这种方式容易分析***的稳定性,但是设计与实现较困难。综合各种因素,目前采用较多的仍然是第一类实现方式。
在分层设计的飞行控制***结构中,针对外环的制导回路,目前主要的几种航迹跟踪算法包括:基于PID(Proportional-Integral-Differential)控制的跟踪算法、视场制导(Line of Sight Guidance)算法、PLOS(Pure Pursuit and Line-of-Sight Based)算法、向量场(Vector-Field)算法以及非线性制导算法等。其中,非线性制导算法因原理简单、易于实现、具有较好抗风性等优点,在近些年成为研究热点。
非线性制导算法是利用期望航迹上的虚拟目标点以及虚拟目标点与无人机实际位置之间的“虚拟距离”作引导的跟踪算法,跟踪航迹具有一定的通用性。在非线性制导算法的基础上,考虑制导回路计算所得的期望侧向加速度指令与无人机实际状态之间存在的偏差,在制导回路加入反馈项,能有效提高跟踪精度。
通过飞行试验和相关的仿真结果,可以得到引导长度与跟踪性能之间的关系:
1)在飞行速度范围内,相同的引导长度下,随着飞机地速的增加,紧密跟踪航迹的能力变差,直接体现在飞机稳定跟踪上期望轨迹的时间较长,同时拐弯段震荡超调明显;
2)在曲率变化较小的稳定跟踪段,飞行速度恒定时,引导长度越短,跟踪精度越高,但引导长度在小范围内增加,跟踪精度依然会保持很高;
3)引导长度越短,滚转角变化越剧烈,由于无人机在实际飞行中存在滚转角幅值和速率限幅,引导长度过短很可能会导致飞机失稳.
发明内容
针对引导长度如果选取不当,会使得航迹追踪的精度不高、易出现震荡等缺陷,本发明提供一种自适应引导长度的无人机航迹跟踪方法。
本方法的原理示意图如图1所示。图1中,飞机当前位置坐标为(xe,ye),航向角为γ,飞行速度为v,引导长度L下的引导点坐标为(xref,yref),η为飞机速度方向与引导长度的夹角。由飞机当前位置到引导点之间的预测航迹用圆弧近似表示,预测航迹的圆心坐标为(x0,y0),dcr_0为飞机当前点到期望轨迹的投影距离,(x00,y00)为投影点坐标,(x0n,y0n)为期望轨迹上的采样点坐标,(x0n’,y0n’)为预测轨迹上的采样点坐标,dcr_n为两者之间的距离。Δθ为预测航迹与期望航迹在引导点处的角度偏差。
本发明的滚转通道闭环传递函数的结构图如图2所示:图2中e表示输出滚转角与输入滚转角的偏差,Kp、Kd分别表示测速反馈控制中的比例项与微分项系数,s以及1/s分别代表拉普拉斯变换中的微分计算与积分计算。在求得以副翼偏转增量Δδa为控制输入,滚转角增量Δφ为输出的传递函数G(s)的基础上,采用测速反馈控制进行滚转角回路的控制,可以解算出副翼偏转增量Δδa,从而可以得到滚转角通道的闭环控制传递函数H(s)。进而估算出无人机飞行控制***的带宽ωUAV,最终求得飞行速度v下的引导长度搜索下限。
具体地,本发明的技术方案是:
一种自适应引导长度的无人机航迹跟踪方法,包括以下步骤:
S1.根据非线性制导算法的动态特性、无人机飞行器控制***的动态特性及控制***的实时性要求,确定无人机飞行速度与非线性制导算法中引导长度范围的关系;
S2.根据引导长度与当前的无人机位置/航向,计算预测航迹与期望航迹;
S3.在引导长度变化范围内,对引导长度等间距离散采样,计算每一个引导长度下的预测航迹与期望航迹之间的距离偏差;
S4.对每一个离散采样的引导长度,分别计算预测航迹与期望航迹在引导点处的航向角,并计算预测航迹与期望航迹之间的航向偏差;
S5.根据S3、S4求得的距离偏差和航向偏差,根据设定的评价准则,对每一个离散采样的引导长度进行评估,确定最优的引导长度,引导无人机进行航迹跟踪。
其中,本发明的S1通过以下步骤方法实现:
S1.1,利用非线性制导算法跟踪航迹的近似线性模型,得到非线性制导算法的带宽表达式,表达式如下;
其中:v为无人机的速度,L为引导长度;
S1.2,从非线性制导算法的动态特性与无人机飞行控制***的动态特性约束角度考虑,若要实现航迹跟踪,应保证制导算法的动态变化情况在无人机飞行控制***的动态范围内,根据香农采样定理,即应保证制非线性制导算法的带宽小于无人机飞行控制***的带宽的一半,即
从而得到速度v下的L的下限Lmin:
其中ωUAV可用无人机横向滚转通道的闭环控制带宽ωH表示,ωH可通过气动计算和***辨识计算得到。
S1.3,结合无人机飞行控制***的实时性要求,设无人机每个控制周期允许的引导长度计算时间为ta,以S1.2计算得到的引导长度下限为初始值,不断增加引导长度进行优化,直至计算时间大于ta时停止,从而得到速度v下的引导长度上限,无人机飞行速度与非线性制导算法中引导长度范围的关系也自动确定。
本发明的S2通过以下步骤方法实现:
S2.1对于无人机实时速度,确定引导长度范围,并由当前的无人机位置/航向与引导点计算每个采样的引导长度值下的预测航迹。
以圆周运动近似表示无人机飞向引导点的预测航迹,首先应求解出预测航迹圆心(x0,y0)的坐标值:
式中,ψ为无人机当前时刻的航向角,η为引导线与无人机航向角之间的角度偏差,其中引导线是无人机当前位置坐标与引导点坐标的连线。
再结合无人机当前位姿信息与引导点的坐标,结合圆弧(前面提到预测航迹看作是圆周运动)的几何关系,可求解出该引导长度下的预测航迹。
S2.2根据无人机在期望航迹上的投影点与引导点,确定当前引导点下的期望航迹;
首先计算出飞机当前点f(xe,ye)在期望轨迹上的投影点(x00,y00):
其中:dcr_i为飞机当前点到期望轨迹上某点fi的距离,desired path是期望航迹,对其离散采样了N个点。
根据飞机当前点f(xe,ye)在期望轨迹上的投影点(x00,y00)与引导点坐标,结合需要跟踪的航迹表达式,可得到对应的引导长度下的期望轨迹。
本发明的S3通过以下步骤方法实现:
S3.1对预测航迹进行等间距离散采样,得到L个采样点,其坐标为(x01',y01')、(x02',y02')··(x0n',y0n'),(1≤n≤L),具体计算如下:
式中:ΔL为预测航迹上采样点之间的间隔。
S3.2对期望航迹同样进行等间距离散采样,得到L个采样点,坐标分别为(x01,y01)、(x02,y02)··(x0n,y0n),(1≤n≤L)。
S3.3计算预测航迹与期望航迹对应采样点之间的距离,并搜索出最大的距离偏差,作为预测航迹与期望航迹之间的距离偏差;
式中:dn为预测航迹与期望航迹对应采样点之间的距离。
本发明的S4通过以下步骤方法实现:
S4.1根据期望航迹的表达式计算出期望航迹在引导点处的期望航向角:
式中:Δx、Δy分别为期望航迹在引导点处沿x轴、y轴的微小变化量,可通过期望航迹离散的相邻两点坐标做差获得;kr为期望航迹在引导点处的切线斜率。
S4.2根据引导长度与当前的无人机航向角计算出预测航迹在引导点处的航向角θ2,θ2可以通过η和ψ求得:
S4.3计算预测航迹与期望航迹之间的航向偏差Δθ:
Δθ=|θ1-θ2|。
本发明的S5通过以下步骤方法实现:
采用预测航迹与期望航迹之间的距离偏差dmax及引导点处的航向偏差Δθ加权作为评价准则记为P,得到如下的具体表达式:
P=w1*dmax+w2*Δθ
其中,w1和w2分别是距离偏差和航向偏差的权重。根据调试结果,w2的值一般固定,通常取w2=0.2~0.5。
w1的值随着无人机与期望航迹之间的侧偏距的变化而变化,通过下式进行计算:
式中:n0为飞行试验和理论仿真得到的经验值,通常取5-10。Dcr表示侧偏距,通过下式计算:
通过对所有离散采样的引导长度进行评价得到该控制周期内最优的引导长度Lbest,过程如下:
式中:m为当前控制周期对引导长度的离散采样数,Pj为不同引导长度下的代价函数,Pbest为最优评价函数值,J表示对应最优评价函数值的采样周期数,step为引导长度的采样步长。本发明的优点是:
本方法弥补了固定引导长度在航迹追踪过程中可能出现的跟踪精度不高、飞行稳定性和安全性难以保证的不足,提高了非线性制导算法在航迹跟踪过程中的灵活性和实用性。另外,该发明能够满足各种实时飞行任务的需求,较好地解决了较大的初始偏差情况下及航路点切换过程中易出现的超调严重问题。
附图说明
图1是本发明原理示意图
图2是本发明的滚转通道闭环传递函数的结构图
图3是本发明流程图
具体实施方式
具体地,一种自适应引导长度的无人机航迹跟踪方法,包括以下步骤:
S1.根据非线性制导算法的动态特性、无人机飞行器控制***的动态特性及控制***的实时性要求,确定无人机飞行速度与非线性制导算法中引导长度范围的关系。
S1.1,利用非线性制导算法跟踪航迹的近似线性模型,得到非线性制导算法的带宽表达式,表达式如下;
其中:v为无人机的速度,L为引导长度;
S1.2,从非线性制导算法的动态特性与无人机飞行控制***的动态特性约束角度考虑,若要实现航迹跟踪,应保证制导算法的动态变化情况在无人机飞行控制***的动态范围内,根据香农采样定理,即应保证非线性制导算法的带宽小于无人机飞行控制***的带宽的一半,即
从而得到速度v下的L的下限Lmin:
其中ωUAV可用无人机横向滚转通道的闭环控制带宽ωH表示,ωH可通过气动计算和***辨识计算得到。
S1.3,结合无人机飞行控制***的实时性要求,设无人机每个控制周期允许的引导长度计算时间为ta,以S1.2计算得到的引导长度下限为初始值,不断增加引导长度进行优化,直至计算时间大于ta时停止,从而得到速度v下的引导长度上限,无人机飞行速度与非线性制导算法中引导长度范围的关系也自动确定。
S2.根据引导长度与当前的无人机位置/航向,计算预测航迹与期望航迹。
S2.1对于无人机实时速度,确定引导长度范围,并由当前的无人机位置/航向与引导点计算每个采样的引导长度值下的预测航迹。
将无人机飞向引导点的预测航迹看作是圆周运动,首先应求解出预测航迹圆心(x0,y0)的坐标值:
式中,ψ为无人机当前时刻的航向角,η为引导线与无人机航向角之间的角度偏差,其中引导线是无人机当前位置坐标与引导点坐标的连线。
再结合无人机当前位姿信息与引导点的坐标,结合圆弧(前面提到预测航迹看作是圆周运动)的几何关系,可求解出该引导长度下的预测航迹。
S2.2根据无人机在期望航迹上的投影点与引导点,确定当前引导点下的期望航迹;
首先计算出飞机当前点f(xe,ye)在期望轨迹上的投影点(x00,y00):
其中:dcr_i为飞机当前点到期望轨迹上某点fi的距离,desired path是期望航迹,对其离散采样了N个点。
根据飞机当前点f(xe,ye)在期望轨迹上的投影点(x00,y00)与引导点坐标,结合需要跟踪的航迹表达式,可得到对应的引导长度下的期望轨迹。
S3.在引导长度变化范围内,对引导长度等距离离散采样,计算每一个引导长度下的预测航迹与期望航迹之间的距离偏差。
S3.1对预测航迹进行等间距离散采样,得到L个采样点,其坐标为(x01',y01')、(x02',y02')··(x0n',y0n'),(1≤n≤L),具体计算如下:
式中:ΔL为预测航迹上采样点之间的间隔。
S3.2对期望航迹同样进行等间距离散采样,得到L个采样点,坐标分别为(x01,y01)、(x02,y02)··(x0n,y0n),(1≤n≤L)。
S3.3计算预测航迹与期望航迹对应采样点之间的距离,并搜索出最大的距离偏差,作为预测航迹与期望航迹之间的距离偏差;
式中:dn为预测航迹与期望航迹对应采样点之间的距离。
S4.对每一个离散采样的引导长度,分别计算预测航迹与期望航迹在引导点处的航向角,并计算预测航迹与期望航迹之间的航向偏差。
S4.1根据期望航迹的表达式计算出期望航迹在引导点处的期望航向角:
式中:Δx、Δy分别为期望航迹在引导点处沿x轴、y轴的微小变化量,可通过期望航迹离散的相邻两点坐标做差获得;kr为期望航迹在引导点处的切线斜率。
S4.2根据引导长度与当前的无人机航向角计算出预测航迹在引导点处的航向角θ2,θ2可以通过η和ψ求得:
S4.3计算预测航迹与期望航迹之间的航向偏差Δθ:
Δθ=|θ1-θ2|。
S5.根据S3、S4求得的距离偏差和航向偏差,根据设定的评价准则,对每一个离散采样的引导长度进行评估,确定最优的引导长度,引导无人机进行航迹跟踪。
采用预测航迹与期望航迹之间的距离偏差dmax及引导点处的航向偏差Δθ加权作为评价准则记为P,得到如下的具体表达式:
P=w1*dmax+w2*Δθ
其中,w1和w2分别是距离偏差和航向偏差的权重。根据调试结果,w2的值一般固定,通常取w2=0.2~0.5。
w1的值随着无人机与期望航迹之间的侧偏距的变化而变化,通过下式进行计算:
式中:n0为飞行试验和理论仿真得到的经验值,通常取5-10。Dcr表示侧偏距,通过下式计算:
通过对所有离散采样的引导长度进行评价得到该控制周期内最优的引导长度Lbest,过程如下:
式中:m为当前控制周期对引导长度的离散采样数,Pj为不同引导长度下的评价函数值,Pbest为最优评价函数值,J表示对应最优评价函数值的采样周期数,step为引导长度的采样步长。
Claims (9)
1.一种自适应引导长度的无人机航迹跟踪方法,其特征在于,包括以下步骤:
S1.根据非线性制导算法的动态特性、无人机飞行器控制***的动态特性及控制***的实时性要求,确定无人机飞行速度与非线性制导算法中引导长度范围的关系;
S2.根据引导长度与当前的无人机位置/航向,计算预测航迹与期望航迹;
S3.在引导长度变化范围内,对引导长度等间距离散采样,计算每一个引导长度下的预测航迹与期望航迹之间的距离偏差;
S4.对每一个离散采样的引导长度,分别计算预测航迹与期望航迹在引导点处的航向角,并计算预测航迹与期望航迹之间的航向偏差;
S5.根据S3、S4求得的距离偏差和航向偏差,根据设定的评价准则,对每一个离散采样的引导长度进行评估,确定最优的引导长度,引导无人机进行航迹跟踪。
2.根据权利要求1所述的自适应引导长度的无人机航迹跟踪方法,其特征在于,步骤S1包括以下分步骤:
S1.1,利用非线性制导算法跟踪航迹的近似线性模型,得到非线性制导算法的带宽表达式,表达式如下:
其中:v为无人机的速度,L为引导长度;
S1.2,从非线性制导算法的动态特性与无人机飞行控制***的动态特性约束角度考虑,若要实现航迹跟踪,应保证制导算法的动态变化情况在无人机飞行控制***的动态范围内,根据香农采样定理,即应保证非线性制导算法的带宽小于无人机飞行控制***的带宽的一半,即
从而得到速度v下的L的下限Lmin:
S1.3,结合无人机飞行控制***的实时性要求,设无人机每个控制周期允许的引导长度计算时间为ta,以S1.2计算得到的引导长度下限为初始值,不断增加引导长度进行优化,直至计算时间大于ta时停止,从而得到速度v下的引导长度上限,无人机飞行速度与非线性制导算法中引导长度范围的关系也自动确定。
3.根据权利要求2所述的自适应引导长度的无人机航迹跟踪方法,其特征在于,步骤S1.2中,ωUAV可用无人机横向滚转通道的闭环控制带宽ωH表示,ωH可通过气动计算和***辨识计算得到。
4.根据权利要求2所述的自适应引导长度的无人机航迹跟踪方法,其特征在于,步骤S2包括以下分步骤:
S2.1对于无人机实时速度,确定引导长度范围,并由当前的无人机位置/航向与引导点计算每个采样的引导长度值下的预测航迹;
以圆周运动近似表示无人机飞向引导点的预测航迹,首先应求解出预测航迹圆心(x0,y0)的坐标值:
式中,ψ为无人机当前时刻的航向角,η为引导线与无人机航向角之间的角度偏差,其中引导线是无人机当前位置坐标与引导点坐标的连线;
再结合无人机当前位姿信息与引导点的坐标,可求解出该引导长度下的预测航迹;
S2.2根据无人机在期望航迹上的投影点与引导点,确定当前引导点下的期望航迹;
首先计算出飞机当前点f(xe,ye)在期望轨迹上的投影点(x00,y00):
其中:dcr_ i为飞机当前点到期望轨迹上某点fi的距离,desired path是期望航迹,对其离散采样了N个点。
根据飞机当前点在期望轨迹上的投影点(x00,y00)与引导点坐标,结合需要跟踪的航迹表达式,可得到对应的引导长度下的期望轨迹。
5.根据权利要求4所述的自适应引导长度的无人机航迹跟踪方法,其特征在于,步骤S3包括以下分步骤:
S3.1对预测航迹进行等间距离散采样,得到L个采样点,其坐标为(x01',y01')、(x02',y02')..(x0n',y0n'),(1≤n≤L),具体计算如下:
式中:ΔL为预测航迹上采样点之间的间隔;
S3.2对期望航迹同样进行等间距离散采样,得到L个采样点,坐标分别为(x01,y01)、(x02,y02)..(x0n,y0n),(1≤n≤L);
S3.3计算预测航迹与期望航迹对应采样点之间的距离,并搜索出最大的距离偏差,作为预测航迹与期望航迹之间的距离偏差;
式中:dn为预测航迹与期望航迹对应采样点之间的距离。
6.根据权利要求5所述的自适应引导长度的无人机航迹跟踪方法,其特征在于,步骤S4包括以下分步骤:
S4.1根据期望航迹的表达式计算出期望航迹在引导点处的期望航向角;
式中:Δx、Δy分别为期望航迹在引导点处沿x轴、y轴的微小变化量,可通过期望航迹离散的相邻两点坐标做差获得;kr为期望航迹在引导点处的切线斜率;
S4.2根据引导长度与当前的无人机航向角计算出预测航迹在引导点处的航向角θ2,θ2可以通过η和ψ求得:
S4.3计算预测航迹与期望航迹之间的航向偏差Δθ:
Δθ=|θ1-θ2|。
7.根据权利要求6所述的自适应引导长度的无人机航迹跟踪方法,其特征在于,步骤S5包括以下分步骤:
采用预测航迹与期望航迹之间的距离偏差dmax及引导点处的航向偏差Δθ加权作为评价准则记为P,得到如下的具体表达式:
P=w1*dmax+w2*Δθ
其中,w1和w2分别是距离偏差和航向偏差的权重;
通过对所有离散采样的引导长度进行评价得到该控制周期内最优的引导长度Lbest,过程如下:
式中:m为当前控制周期对引导长度的离散采样数,Pj为不同引导长度下的评价函数值,Pbest为最优评价函数值,J表示对应最优评价函数值的采样周期数,step为引导长度的采样步长。
8.根据权利要求7所述的自适应引导长度的无人机航迹跟踪方法,其特征在于,步骤S5中的w1通过下式进行计算:
式中:n0取5-10;Dcr表示侧偏距,通过下式计算:
9.根据权利要求7所述的自适应引导长度的无人机航迹跟踪方法,其特征在于,步骤S5中的w2=0.2~0.5。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610626290.XA CN106020236B (zh) | 2016-08-02 | 2016-08-02 | 一种自适应引导长度的无人机航迹跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610626290.XA CN106020236B (zh) | 2016-08-02 | 2016-08-02 | 一种自适应引导长度的无人机航迹跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106020236A true CN106020236A (zh) | 2016-10-12 |
CN106020236B CN106020236B (zh) | 2019-09-06 |
Family
ID=57134247
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610626290.XA Active CN106020236B (zh) | 2016-08-02 | 2016-08-02 | 一种自适应引导长度的无人机航迹跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106020236B (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106647287A (zh) * | 2017-02-20 | 2017-05-10 | 南京航空航天大学 | 一种基于自适应动态规划的输入受限微分对策制导方法 |
CN107450586A (zh) * | 2017-09-15 | 2017-12-08 | 广州杰赛科技股份有限公司 | 航路的调整方法和***以及无人机*** |
CN107544259A (zh) * | 2017-10-20 | 2018-01-05 | 中国科学院长春光学精密机械与物理研究所 | 一种引导伺服控制实现快速无超调跟踪的方法及*** |
CN108205327A (zh) * | 2016-12-20 | 2018-06-26 | 昊翔电能运动科技(昆山)有限公司 | 用于无人机的辅助操控方法和*** |
CN108319296A (zh) * | 2018-03-26 | 2018-07-24 | 中国人民解放军国防科技大学 | 一种融合全局信息与局部信息的编队控制方法 |
CN109597426A (zh) * | 2018-11-13 | 2019-04-09 | 上海无线电设备研究所 | 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法 |
CN109947126A (zh) * | 2019-03-07 | 2019-06-28 | 中国科学院深圳先进技术研究院 | 四旋翼无人机的控制方法、装置、设备及可读介质 |
JP2020500763A (ja) * | 2016-12-01 | 2020-01-16 | エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd | 静止及び移動体に対する無人航空機の飛行方法 |
WO2020087277A1 (zh) * | 2018-10-30 | 2020-05-07 | 深圳市大疆创新科技有限公司 | 一种飞行轨迹复演方法、装置、服务器及存储介质 |
CN111857185A (zh) * | 2020-08-10 | 2020-10-30 | 南京航空航天大学 | 一种基于动态参考点的无人机轨迹成型制导律设计方法 |
CN112099528A (zh) * | 2020-09-18 | 2020-12-18 | 中国航空无线电电子研究所 | 基于化学反应优化算法的制导方法 |
CN112333638A (zh) * | 2020-11-20 | 2021-02-05 | 广州极飞科技有限公司 | 路线导航方法、装置、无人设备及存储介质 |
CN112764432A (zh) * | 2019-10-21 | 2021-05-07 | 上海大学 | 一种无人艇航迹跟踪***及方法 |
CN113110588A (zh) * | 2021-04-29 | 2021-07-13 | 南京航空航天大学 | 一种无人机编队及其飞行方法 |
CN113126644A (zh) * | 2021-06-03 | 2021-07-16 | 北京理工大学 | 基于自适应视线法的无人机三维航迹跟踪方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101807081A (zh) * | 2010-04-07 | 2010-08-18 | 南京航空航天大学 | 一种用于无人飞机的自主导航制导方法 |
CN105512769A (zh) * | 2015-12-16 | 2016-04-20 | 上海交通大学 | 基于遗传规划的无人机航迹规划***及方法 |
-
2016
- 2016-08-02 CN CN201610626290.XA patent/CN106020236B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101807081A (zh) * | 2010-04-07 | 2010-08-18 | 南京航空航天大学 | 一种用于无人飞机的自主导航制导方法 |
CN105512769A (zh) * | 2015-12-16 | 2016-04-20 | 上海交通大学 | 基于遗传规划的无人机航迹规划***及方法 |
Non-Patent Citations (4)
Title |
---|
CHAOYONG LI: "Application of PID controller to 2D differential geometric guidance problem", 《JOURNAL OF CONTROL THEORY AND APPLICATIONS》 * |
MANUAL KOTHARI等: "UAV Path Following in Windy Urban Environments", 《J INTELL ROBOT SYST》 * |
冒云慧等: "无人机航迹跟踪抗侧风制导算法", 《航空工程进展》 * |
陈清阳等: "Ribbon model based path tracking method for autonomous ground vehicles", 《J.CENT.SOUTH UNIV.》 * |
Cited By (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020500763A (ja) * | 2016-12-01 | 2020-01-16 | エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd | 静止及び移動体に対する無人航空機の飛行方法 |
CN108205327A (zh) * | 2016-12-20 | 2018-06-26 | 昊翔电能运动科技(昆山)有限公司 | 用于无人机的辅助操控方法和*** |
CN106647287A (zh) * | 2017-02-20 | 2017-05-10 | 南京航空航天大学 | 一种基于自适应动态规划的输入受限微分对策制导方法 |
CN106647287B (zh) * | 2017-02-20 | 2019-02-12 | 南京航空航天大学 | 一种基于自适应动态规划的输入受限微分对策制导方法 |
CN107450586A (zh) * | 2017-09-15 | 2017-12-08 | 广州杰赛科技股份有限公司 | 航路的调整方法和***以及无人机*** |
CN107450586B (zh) * | 2017-09-15 | 2020-07-28 | 广州杰赛科技股份有限公司 | 航路的调整方法和***以及无人机*** |
CN107544259A (zh) * | 2017-10-20 | 2018-01-05 | 中国科学院长春光学精密机械与物理研究所 | 一种引导伺服控制实现快速无超调跟踪的方法及*** |
CN108319296B (zh) * | 2018-03-26 | 2021-03-23 | 中国人民解放军国防科技大学 | 一种融合全局信息与局部信息的编队控制方法 |
CN108319296A (zh) * | 2018-03-26 | 2018-07-24 | 中国人民解放军国防科技大学 | 一种融合全局信息与局部信息的编队控制方法 |
WO2020087277A1 (zh) * | 2018-10-30 | 2020-05-07 | 深圳市大疆创新科技有限公司 | 一种飞行轨迹复演方法、装置、服务器及存储介质 |
CN109597426A (zh) * | 2018-11-13 | 2019-04-09 | 上海无线电设备研究所 | 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法 |
CN109947126B (zh) * | 2019-03-07 | 2020-04-14 | 中国科学院深圳先进技术研究院 | 四旋翼无人机的控制方法、装置、设备及可读介质 |
CN109947126A (zh) * | 2019-03-07 | 2019-06-28 | 中国科学院深圳先进技术研究院 | 四旋翼无人机的控制方法、装置、设备及可读介质 |
CN112764432B (zh) * | 2019-10-21 | 2022-02-11 | 上海大学 | 一种无人艇航迹跟踪***及方法 |
CN112764432A (zh) * | 2019-10-21 | 2021-05-07 | 上海大学 | 一种无人艇航迹跟踪***及方法 |
CN111857185A (zh) * | 2020-08-10 | 2020-10-30 | 南京航空航天大学 | 一种基于动态参考点的无人机轨迹成型制导律设计方法 |
CN112099528A (zh) * | 2020-09-18 | 2020-12-18 | 中国航空无线电电子研究所 | 基于化学反应优化算法的制导方法 |
CN112099528B (zh) * | 2020-09-18 | 2023-02-28 | 中国航空无线电电子研究所 | 基于化学反应优化算法的制导方法 |
CN112333638A (zh) * | 2020-11-20 | 2021-02-05 | 广州极飞科技有限公司 | 路线导航方法、装置、无人设备及存储介质 |
CN113110588B (zh) * | 2021-04-29 | 2022-04-08 | 南京航空航天大学 | 一种无人机编队及其飞行方法 |
CN113110588A (zh) * | 2021-04-29 | 2021-07-13 | 南京航空航天大学 | 一种无人机编队及其飞行方法 |
CN113126644A (zh) * | 2021-06-03 | 2021-07-16 | 北京理工大学 | 基于自适应视线法的无人机三维航迹跟踪方法 |
CN113126644B (zh) * | 2021-06-03 | 2022-04-19 | 北京理工大学 | 基于自适应视线法的无人机三维航迹跟踪方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106020236B (zh) | 2019-09-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106020236A (zh) | 一种自适应引导长度的无人机航迹跟踪方法 | |
CN111103890B (zh) | 一种高精度强鲁棒的进场着陆引导控制方法 | |
Kothari et al. | Uav path following in windy urban environments | |
Medagoda et al. | Synthetic-waypoint guidance algorithm for following a desired flight trajectory | |
Osborne et al. | Waypoint guidance for small UAVs in wind | |
CN102768539B (zh) | 基于迭代的自主水下航行器三维曲线路径跟踪控制方法 | |
CN109634293B (zh) | 一种固定翼无人机翻滚机动控制方法 | |
Li et al. | Vision-based target tracking and motion estimation using a small UAV | |
CN104648695A (zh) | 一种基于倾侧角可用性的再入走廊最优规划方法 | |
Oliveira et al. | Ground target tracking control system for unmanned aerial vehicles | |
CN103700286A (zh) | 一种舰载无人机自动着舰引导方法 | |
CN109708639A (zh) | 飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法 | |
CN103728981A (zh) | 一种无人机的非线性导航寻迹控制方法 | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN105628045A (zh) | 一种无人机跟拍路径规划与跟踪方法 | |
Yamasaki et al. | Sliding mode based pure pursuit guidance for UAV rendezvous and chase with a cooperative aircraft | |
Scheuermann et al. | Combined lateral and longitudinal control of parafoils using upper-surface canopy spoilers | |
CN111221354A (zh) | 一种基于改进的转弯半径的固定翼编队控制方法 | |
Manjunath et al. | Application of virtual target based guidance laws to path following of a quadrotor UAV | |
Zhang et al. | Path planning for carrier aircraft based on geometry and dijkstra's algorithm | |
Yamasaki et al. | Sliding mode-based pure pursuit guidance for unmanned aerial vehicle rendezvous and chase with a cooperative aircraft | |
CN103048997A (zh) | 一种无缆自治水下航行体的航迹控制方法 | |
Lei et al. | A small unmanned polar research aerial vehicle based on the composite control method | |
Hota et al. | Time-optimal convergence to a rectilinear path in the presence of wind | |
Jantawong et al. | Automatic landing control based on GPS for fixed-wing aircraft |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |