CN109708639B - 飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法 - Google Patents
飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法 Download PDFInfo
- Publication number
- CN109708639B CN109708639B CN201811491434.0A CN201811491434A CN109708639B CN 109708639 B CN109708639 B CN 109708639B CN 201811491434 A CN201811491434 A CN 201811491434A CN 109708639 B CN109708639 B CN 109708639B
- Authority
- CN
- China
- Prior art keywords
- aircraft
- path
- flight
- angle
- tracking
- 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
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000013461 design Methods 0.000 claims description 25
- 230000008859 change Effects 0.000 claims description 10
- 230000001276 controlling effect Effects 0.000 claims description 7
- 238000009499 grossing Methods 0.000 claims description 3
- 230000001105 regulatory effect Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 230000008569 process Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及飞行器平飞时跟踪直线和圆弧路径的侧向制导指令生成方法,使飞行器的飞行路径逐渐趋向收敛到预先设定要经过的直线或圆弧路径,控制飞行器与预先设定的直线路径或/和圆弧路径的垂直距离越来越短,同时控制飞行器的飞行方向收敛到直线方向或/和圆弧切线方向上。本发明的方法,容易控制,而不要求飞行器在特定的时间飞过某一个点,从而能够很好的满足小型飞行器在巡航平飞时易受风等外界环境干扰的前提下,有效跟随预设路径的要求,为小型飞行器巡航平飞时完成预设任务提供了技术支持,提高系统的可靠性和准确性。
Description
技术领域
本发明属于飞行器导航制导和控制的技术领域,具体涉及一种飞行器平飞时跟踪直线和圆弧路径的侧向制导指令生成方法。
背景技术
小型无人飞行器因体积小、造价成本低、地勤保障要求低,广泛应用与军事与民用领域,例如远程监视、侦查和打击等军事领域,以及航拍、植保、快递运输、灾难救援和测绘等民事领域,具有广阔的军用和民用前景。
随着小型无人飞行器使用用途的不断扩展,特别是无人飞行器自主化程度要求的不断提高,设计先进的导航、制导和控制方法是飞行器自主飞行的前提。小型飞行器的起飞、空中巡航和降落等飞行任务中,主要的飞行时间集中在空中巡航飞行。然而由于小型飞行器体积小、重量轻、飞行速度慢的特点,当环境中存在风干扰时,风的速度可能与飞行速度在同一量级,要使小型飞行器在风中灵活地按照预定航线飞行,传统的机器人控制领域中的轨迹跟踪方法很难应用,因为传统的轨迹跟踪算法中要求在确定的时间到达确定的地点,而这在由于环境风速未知变化而导致小型飞行器实际飞行速度极易变化的情况下难以精确实现。
小型飞行器在巡航平飞航线管理过程中,需要使飞行器经过设定的飞行路径点,这些一系列的路径点(位置和方向)连接在一起通常可以分解为一系列的直线路径和弧形路径的组合。因此针对小型飞行器在风干扰下巡航飞行的特殊使用环境,如何使飞行器经过设定的路径点,实现生成跟踪直线和圆弧路径的侧向制导指令方法是亟待研究解决的问题。
发明内容
针对现有技术的不足,本发明改变传统的轨迹跟踪算法中要求在确定的时间到达确定的地点的做法,有效避免了由于环境风速未知变化而导致小型飞行器实际飞行速度容易变化的情况下难以精确实现的问题。
实现本发明目的所采用的技术方案具体如下:
飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法,其特征在于使飞行器的飞行路径逐渐趋向收敛到预先设定要经过的直线或圆弧路径,控制飞行器与预先设定的直线路径或/和圆弧路径的垂直距离越来越短,同时控制飞行器的飞行方向收敛到直线方向或/和圆弧切线方向上。
进一步地,其具体步骤包括:
S1步骤、分别设计飞行器跟踪直线和圆弧路径的侧向制导指令生成算法;
S2步骤、设定飞行器的期望路径,根据具体飞行任务要求设定期望路径;
S3步骤、飞行器测量自身的飞行姿态、速度和地理位置,通过导航系统测量自身的飞行姿态、速度和地理位置三维坐标信息;
S4步骤、信息比对后实时生成期望指令航线角,将飞行器自身位置信息与期望路径比对,按S1步骤设计的跟踪直线和圆弧路径的侧向制导指令生成算法,实时生成期望指令航线角(飞行速度与正北方向的夹角,图1中的χ),其中航线角为飞行器速度方向与正北方向的夹角;
S5步骤、导引飞行器到期望路径,通过生成的期望指令航线角导引飞行器到期望路径上,有效实现飞行器按期望路径跟随的目的。
更进一步地,所述S1步骤设计的跟踪直线和圆弧路径的侧向制导指令生成算法具体为一种航向指令的连续平滑矢量场方法,并通过李雅普诺夫稳定性定理证明算法的稳定性。
优选地,所述S2步骤的导航系统包括惯性传感器器件和卫星接收机。
具体地,所述航向指令的连续平滑矢量场方法及李雅普诺夫稳定性定理证明算法的稳定性具体方法步骤为:
飞行器相对地面惯性坐标系的姿态角信息通常由惯性传感器来测量,而三维世界位置和平移速度通常由卫星全球定位系统(GPS)来测量,当飞行器在执行巡航平飞跟踪航线路径任务时,飞行轨迹状态包括水平北—东平面坐标系的位置信息P(pn,pe),飞行器的飞行速度在水平面的投影为地速Vg,定义飞行速度方向与正北方向的夹角为航线角χ,在水平北—东平面中飞行器的运动微分方程如下:
S11步骤、生成跟踪直线路径的侧向航线角指令策略
如图1所示,期望飞行器在平飞时跟踪一条直线航线L,直线路径与正北方向的夹角为χq,飞行器实际的航线角为χ(参见图1),在路径坐标系中,定义在水平北—东平面中飞行器与直线航线相对水平误差表示为epx,相对垂直距离误差表示为epy(参见图1),epy也定义为飞行器距路径航线的侧偏距(参见图1);
设计的生成跟踪直线路径的侧向航线角指令策略是生成跟踪直线路径的侧向航线角指令χd(t),不断调节飞行航向,控制飞行器与设定的直线路径的垂直距离epy越来越短,并且当接近指定直线路径时,同时控制飞行器的飞行方向χ收敛到直线方向χq上,垂直距离即侧偏距epy的动态变化在路径坐标系中的转换方程表示为:
根据以上设计策略,构建航线角矢量场,使得当侧偏距epy相当大时,飞行器会直接以预设期望的相对直线路径需用航向角χ∞飞向直线路径,其中χ∞是在0度到90度之间的设计参数值,即χ∞∈(0,π/2);当侧偏距epy接近0时,相对直线路径需用航向为零度,此时飞行器实际的飞行航线角χ接近路径航线角χq,满足以上设计目标的相对直线路径需用航向角χd(epy)为:
其中,设计参数kpath满足kpath>0,是影响需用航向从χ∞变化到0之间的过渡速率的正常数;当设计参数χ∞被限制在(0,π/2)范围内时,对于所有的飞行侧偏距epy,有:
综上所述,设计跟踪直线路径的侧向航线角指令χd(t)策略如下:
最后,通过李雅普诺夫Lyapunov稳定性定理来证明当飞行器按照公式(5)设计的航线角指令χd(t)飞行时,系统稳定收敛,飞行轨迹距直线路径的侧偏距epy会逐渐趋向到0;选择李雅普诺夫函数V1如下:
由于函数arctan(x)是奇函数,而且在arctan(x)的值域内,函数sin(x)也是奇函数,而且由于地速Vg>0和参数χ∞>0,所以当侧偏距epy不为0时,无论侧偏距epy为正值或负值时,选定的李雅普诺夫函数及其导数都满足:
V1>0
根据李雅普诺夫稳定性定理,当李雅普诺夫函数正定大于零,李雅普诺夫函数的导数负定小于零时,系统稳定;公式(5)所设计航线角指令,会不断连续调节飞行航向,使得侧偏距epy收敛到零,飞行航向不断接近指定直线路径航线,满足直线路径跟踪制导的需求;
S12步骤、生成跟踪圆弧路径的侧向航线角指令策略
如图2所示,设需要跟踪的平面圆弧路径是中心在C=(pnc,pec)T点,半径为ρ,方向为λc∈{-1,1}的圆,圆的轨道为:
其中符号T表示转置符号,定义当λc=-1时,路径是逆时针轨迹,当λc=1时,路径是顺时针轨迹。
如图2所示,设d是飞行器相对圆轨道圆心C=(pnc,pec)T的相对横向距离,是飞行器相对圆轨道圆心C=(pnc,pec)T的相对正北方向的相对航线相位角,在水平北—东平面中,飞行器相对圆轨道的法线和切线方向上的运动方程为:
系统的极坐标描述的运动方程如下:
设计的圆弧路径跟踪制导策略的控制目标是生成跟踪圆弧路径的侧向航线角指令χC(d-ρ,λ),不断调节飞行航向,控制飞行器相对圆心的相对距离d逐渐收敛趋向圆半径ρ,同时使飞行器的航线角χ收敛趋向到圆弧路径与正北方向的夹角χC0上。
根据以上设计制导策略,类似于直线路径的跟踪策略,构造航向矢量场,当飞行器距离圆轨道圆心C的距离很大时,飞行器应该朝向圆心C飞行,即当d>>ρ时,相对圆弧路径需用飞行航向为λcπ/2,即飞行方向指向圆心,理想的飞行航线角χc为:
当飞行器距离圆轨道圆心C的距离相等时,即d=ρ时,相对圆弧路径需用飞行航向为0,理想的飞行航线角χc为:
综上所述,设计跟踪圆弧路径的侧向航线角指令χC(d-ρ,λ)策略如下:
其中,设计参数korbit满足korbit>0,表示相对圆弧路径需用飞行航线从λcπ/2变化到0的速率;
与直线路径跟踪制导策略类似,通过李雅普诺夫Lyapunov稳定性定理来证明当飞行器按照公式(15)设计的航线角指令χC(d-ρ,λ)飞行时,系统稳定收敛,对于所有相对圆心距离d≥0的情况,都满足使飞行器飞行轨迹逐渐趋向指令圆弧路径;选择李雅普诺夫函数V2如下:
由于函数arctan(x)是奇函数,而且在arctan(x)的值域内,函数sin(x)也是奇函数,并且设计参数korbit,地速Vg和圆轨迹半径ρ都大于零,系统沿选定航线角指令的轨迹时,选定的李雅普诺夫函数及其导数满足:
V2>0
根据李雅普诺夫稳定性定理,当李雅普诺夫函数正定大于零,李雅普诺夫函数的导数负定小于零时,系统稳定。
本发明针对小型飞行器在巡航平飞航线管理过程,设计跟踪预设航线路径的制导策略,本发明使飞行器的飞行路径逐渐趋向收敛到预先设定要经过的直线或圆弧路径,即控制飞行器与设定的直线路径或圆弧路径的垂直距离越来越短,同时控制飞行器的飞行方向收敛到直线方向或圆弧切线方向上,这样容易控制,而不要求飞行器在特定的时间飞过某一个点,从而能够很好的满足小型飞行器在巡航平飞时易受风等外界环境干扰的前提下,有效跟随预设路径的要求,为小型飞行器巡航平飞时完成预设任务提供了技术支持,提高系统的可靠性和准确性。
附图说明
图1为本发明(小型)飞行器、期望跟踪直线路径及水平北—东平面坐标系的关系图;
图2为本发明(小型)飞行器、期望跟踪圆弧路径及水平北—东平面坐标系的关系图。
具体实施方式
下面结合附图和具体实施方案对本发明作进一步详细说明。以下实施例仅是说明性的,并不构成对本发明的限制。
本发明方法中涉及到的飞行器(机体)、期望跟踪直线和圆弧路径及水平北—东平面坐标系的关系图分别如图1和图2所示,飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法,使飞行器的飞行路径逐渐趋向收敛到预先设定要经过的直线或圆弧路径,控制飞行器与预先设定的直线路径或/和圆弧路径的垂直距离越来越短,同时控制飞行器的飞行方向收敛到直线方向或/和圆弧切线方向上;
其具体步骤包括:
S1步骤、分别设计飞行器跟踪直线和圆弧路径的侧向制导指令生成算法,具体为一种航向指令的连续平滑矢量场方法,并通过李雅普诺夫稳定性定理证明算法的稳定性;
S2步骤、设定飞行器的期望路径,根据具体飞行任务要求设定期望路径;
S3步骤、飞行器测量自身的飞行姿态、速度和地理位置,通过导航系统测量自身的飞行姿态、速度和地理位置三维坐标信息;导航系统包括惯性传感器器件和卫星接收机;
S4步骤、信息比对实时生成期望指令航线角,将飞行器自身位置信息与期望路径比对,按S1步骤设计的跟踪直线和圆弧路径的侧向制导指令生成算法,实时生成期望指令航线角(飞行速度与正北方向的夹角,图1中的χ),其中航线角为飞行器速度方向与正北方向的夹角;
所述航向指令的连续平滑矢量场方法及李雅普诺夫稳定性定理证明算法的稳定性具体步骤为:
飞行器相对地面惯性坐标系的姿态角信息通常由惯性传感器来测量,而三维世界位置和平移速度通常由卫星全球定位系统(GPS)来测量,当飞行器在执行巡航平飞跟踪航线路径任务时,飞行轨迹状态包括水平北—东平面坐标系的位置信息P(pn,pe),飞行器的飞行速度在水平面的投影为地速Vg,定义飞行速度方向与正北方向的夹角为航线角χ,在水平北—东平面中飞行器的运动微分方程如下:
S11步骤、生成跟踪直线路径的侧向航线角指令策略
如图1所示,期望飞行器在平飞时跟踪一条直线航线L,直线路径与正北方向的夹角为χq,飞行器实际的航线角为χ(参见图1),在路径坐标系中,定义在水平北—东平面中飞行器与直线航线相对水平误差表示为epx,相对垂直距离误差表示为epy(参见图1),epy也定义为飞行器距路径航线的侧偏距(参见图1);
设计的生成跟踪直线路径的侧向航线角指令策略是生成跟踪直线路径的侧向航线角指令χd(t),不断调节飞行航向,控制飞行器与设定的直线路径的垂直距离epy越来越短,并且当接近指定直线路径时,同时控制飞行器的飞行方向χ收敛到直线方向χq上,垂直距离即侧偏距epy的动态变化在路径坐标系中的转换方程表示为:
根据以上设计策略,构建航线角矢量场,使得当侧偏距epy相当大时,飞行器会直接以预设期望的相对直线路径需用航向角χ∞飞向直线路径,其中χ∞是在0度到90度之间的设计参数值,即χ∞∈(0,π/2);当侧偏距epy接近0时,相对直线路径需用航向为零度,此时飞行器实际的飞行航线角χ接近路径航线角χq(直线路径与正北方向的夹角),满足以上设计目标的相对直线路径需用航向角χd(epy)为:
其中,设计参数kpath满足kpath>0,是影响需用航向从χ∞变化到0之间的过渡速率的正常数;当设计参数χ∞被限制在(0,π/2)范围内时,对于所有的飞行侧偏距epy,有:
综上所述,设计跟踪直线路径的侧向航线角指令χd(t)策略如下:
最后,通过李雅普诺夫Lyapunov稳定性定理来证明当飞行器按照公式(5)设计的航线角指令χd(t)飞行时,系统稳定收敛,飞行轨迹距直线路径的侧偏距epy会逐渐趋向到0;选择李雅普诺夫函数V1如下:
由于函数arctan(x)是奇函数,而且在arctan(x)的值域内,函数sin(x)也是奇函数,而且由于地速Vg>0和参数χ∞>0,所以当侧偏距epy不为0时,无论侧偏距epy为正值或负值时,选定的李雅普诺夫函数及其导数都满足:
V1>0
根据李雅普诺夫稳定性定理,当李雅普诺夫函数正定大于零,李雅普诺夫函数的导数负定小于零时,系统稳定;公式(5)所设计航线角指令,会不断连续调节飞行航向,使得侧偏距epy收敛到零,飞行航向不断接近指定直线路径航线,满足直线路径跟踪制导的需求;
S12步骤、生成跟踪圆弧路径的侧向航线角指令策略
如图2所示,设需要跟踪的平面圆弧路径是中心在C=(pnc,pec)T点,半径为ρ,方向为λc∈{-1,1}的圆,圆的轨道为:
其中符号T表示转置符号,定义当λc=-1时,路径是逆时针轨迹,当λc=1时,路径是顺时针轨迹。
如图2所示,设d是飞行器相对圆轨道圆心C=(pnc,pec)T的相对横向距离,是飞行器相对圆轨道圆心C=(pnc,pec)T的相对正北方向的相对航线相位角,在水平北—东平面中,飞行器相对圆轨道的法线和切线方向上的运动方程为:
系统的极坐标描述的运动方程如下:
设计的圆弧路径跟踪制导策略的控制目标是生成跟踪圆弧路径的侧向航线角指令χC(d-ρ,λ),不断调节飞行航向,控制飞行器相对圆心的相对距离d逐渐收敛趋向圆半径ρ,即控制飞行器质心到圆周(圆半径ρ)上,同时使飞行器的航线角χ收敛趋向到圆弧路径与正北方向的夹角χC0(即圆弧(圆半径ρ)切线方向与正北向夹角)上。
根据以上设计制导策略,类似于直线路径的跟踪策略,构造航向矢量场,当飞行器距离圆轨道圆心C的距离很大时,飞行器应该朝向圆心C飞行,即当d>>ρ时,相对圆弧路径需用飞行航向为λcπ/2,即飞行方向指向圆心,理想的飞行航线角χc为:
当飞行器距离圆轨道圆心C的距离相等时,即d=ρ时,相对圆弧路径需用飞行航向为0,理想的飞行航线角χc为:
综上所述,设计跟踪圆弧路径的侧向航线角指令χC(d-ρ,λ)策略如下:
其中,设计参数korbit满足korbit>0,表示相对圆弧路径需用飞行航线从λcπ/2变化到0的速率;
与直线路径跟踪制导策略类似,通过李雅普诺夫Lyapunov稳定性定理来证明当飞行器按照公式(15)设计的航线角指令χC(d-ρ,λ)飞行时,系统稳定收敛,对于所有相对圆心距离d≥0的情况,都满足使飞行器飞行轨迹逐渐趋向指令圆弧路径;选择李雅普诺夫函数V2如下:
由于函数arctan(x)是奇函数,而且在arctan(x)的值域内,函数sin(x)也是奇函数,并且设计参数korbit,地速Vg和圆轨迹半径ρ都大于零,系统沿选定航线角指令的轨迹时,选定的李雅普诺夫函数及其导数满足:
V2>0
根据李雅普诺夫稳定性定理,当李雅普诺夫函数正定大于零,李雅普诺夫函数的导数负定小于零时,系统稳定;
S5步骤、导引飞行器到期望路径:通过生成的期望指令航线角导引飞行器到期望路径上,有效实现飞行器按期望路径跟随的目的。即公式(15)所设计航线角指令,会不断连续调节飞行航向,使得飞行器相对圆弧圆心的距离收敛到圆弧半径,飞行器飞行轨迹逐渐趋向指令圆弧路径,满足圆弧路径跟踪制导的需求。
Claims (1)
1.飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法,其特征在于使飞行器的飞行路径逐渐趋向收敛到预先设定要经过的直线或圆弧路径,控制飞行器与预先设定的直线路径或/和圆弧路径的垂直距离越来越短,同时控制飞行器的飞行方向收敛到直线方向或/和圆弧切线方向上;
具体步骤包括:
S1步骤、分别设计飞行器跟踪直线和圆弧路径的侧向制导指令生成算法;
S2步骤、设定飞行器的期望路径,根据具体飞行任务要求设定期望路径;
S3步骤、飞行器测量自身的飞行姿态、速度和地理位置,通过导航系统测量自身的飞行姿态、速度和地理位置三维坐标信息;
S4步骤、信息比对后实时生成期望指令航线角,将飞行器自身位置信息与期望路径比对,按S1步骤设计的跟踪直线和圆弧路径的侧向制导指令生成算法,实时生成期望指令航线角,其中航线角为飞行器速度方向与正北方向的夹角;
S5步骤、导引飞行器到期望路径,通过生成的期望指令航线角导引飞行器到期望路径上,有效实现飞行器按期望路径跟随的目的;
所述S1步骤设计的跟踪直线和圆弧路径的侧向制导指令生成算法具体为一种航向指令的连续平滑矢量场方法,并通过李雅普诺夫稳定性定理证明算法的稳定性;
所述S3步骤的导航系统包括惯性传感器器件和卫星接收机;
所述S1步骤的航向指令的连续平滑矢量场方法及李雅普诺夫稳定性定理证明算法的稳定性具体方法步骤为:
飞行器相对地面惯性坐标系的姿态角信息由惯性传感器测量,而三维世界位置和平移速度由卫星全球定位系统GPS测量,当飞行器在执行巡航平飞跟踪航线路径任务时,飞行轨迹状态包括水平北—东平面坐标系的位置信息P(pn,pe),飞行器的飞行速度在水平面的投影为地速Vg,定义飞行速度方向与正北方向的夹角为航线角χ,在水平北—东平面中飞行器的运动微分方程如下:
S11步骤、生成跟踪直线路径的侧向航线角指令策略
期望飞行器在平飞时跟踪一条直线航线L,直线路径与正北方向的夹角为χq,飞行器实际的航线角为χ,在路径坐标系中,定义在水平北—东平面中飞行器与直线航线相对水平误差表示为epx,相对垂直距离误差表示为epy,epy也定义为飞行器距路径航线的侧偏距;
设计的生成跟踪直线路径的侧向航线角指令策略是生成跟踪直线路径的侧向航线角指令χd(t),不断调节飞行航向,控制飞行器与设定的直线路径的垂直距离epy越来越短,并且当接近指定直线路径时,同时控制飞行器的飞行方向χ收敛到直线方向χq上,垂直距离即侧偏距epy的动态变化在路径坐标系中的转换方程表示为:
根据以上设计策略,构建航线角矢量场,使得当侧偏距epy相当大时,飞行器会直接以预设期望的相对直线路径需用航向角χ∞飞向直线路径,其中χ∞是在0度到90度之间的设计参数值,即χ∞∈(0,π/2);当侧偏距epy接近0时,相对直线路径需用航向为零度,此时飞行器实际的飞行航线角χ接近路径航线角χq,满足以上设计目标的相对直线路径需用航向角χd(epy)为:
其中,设计参数kpath满足kpath>0,是影响需用航向从χ∞变化到0之间的过渡速率的正常数;当设计参数χ∞被限制在(0,π/2)范围内时,对于所有的飞行侧偏距epy,有:
综上所述,设计跟踪直线路径的侧向航线角指令χd(t)策略如下:
最后,通过李雅普诺夫Lyapunov稳定性定理来证明当飞行器按照公式(5)设计的航线角指令χd(t)飞行时,系统稳定收敛,飞行轨迹距直线路径的侧偏距epy会逐渐趋向到0;选择李雅普诺夫函数V1如下:
由于函数arctan(x)是奇函数,而且在arctan(x)的值域内,函数sin(x)也是奇函数,而且由于地速Vg>0和参数χ∞>0,所以当侧偏距epy不为0时,无论侧偏距epy为正值或负值时,选定的李雅普诺夫函数及其导数都满足:
根据李雅普诺夫稳定性定理,当李雅普诺夫函数正定大于零,李雅普诺夫函数的导数负定小于零时,系统稳定;公式(5)所设计航线角指令,会不断连续调节飞行航向,使得侧偏距epy收敛到零,飞行航向不断接近指定直线路径航线,满足直线路径跟踪制导的需求;
S12步骤、生成跟踪圆弧路径的侧向航线角指令策略
设需要跟踪的平面圆弧路径是中心在C=(pnc,pec)T点,半径为ρ,方向为λc∈{-1,1}的圆,圆的轨道为:
其中符号T表示转置符号,定义当λc=-1时,路径是逆时针轨迹,当λc=1时,路径是顺时针轨迹;
设d是飞行器相对圆轨道圆心C=(pnc,pec)T的相对横向距离,是飞行器相对圆轨道圆心C=(pnc,pec)T的相对正北方向的相对航线相位角,在水平北—东平面中,飞行器相对圆轨道的法线和切线方向上的运动方程为:
系统的极坐标描述的运动方程如下:
设计的圆弧路径跟踪制导策略的控制目标是生成跟踪圆弧路径的侧向航线角指令χC(d-ρ,λ),不断调节飞行航向,控制飞行器相对圆心的相对距离d逐渐收敛趋向圆半径ρ,同时使飞行器的航线角χ收敛趋向到圆弧路径与正北方向的夹角χC0上;
根据以上设计制导策略,类似于直线路径的跟踪策略,构造航向矢量场,当飞行器距离圆轨道圆心C的距离很大时,飞行器应该朝向圆心C飞行,即当d>>ρ时,相对圆弧路径需用飞行航向为λcπ/2,即飞行方向指向圆心,理想的飞行航线角χc为:
当飞行器距离圆轨道圆心C的距离相等时,即d=ρ时,相对圆弧路径需用飞行航向为0,理想的飞行航线角χc为:
综上所述,设计跟踪圆弧路径的侧向航线角指令χC(d-ρ,λ)策略如下:
其中,设计参数korbit满足korbit>0,表示相对圆弧路径需用飞行航线从λcπ/2变化到0的速率;
与直线路径跟踪制导策略类似,通过李雅普诺夫Lyapunov稳定性定理来证明当飞行器按照公式(15)设计的航线角指令χC(d-ρ,λ)飞行时,系统稳定收敛,对于所有相对圆心距离d≥0的情况,都满足使飞行器飞行轨迹逐渐趋向指令圆弧路径;选择李雅普诺夫函数V2如下:
由于函数arctan(x)是奇函数,而且在arctan(x)的值域内,函数sin(x)也是奇函数,并且设计参数korbit,地速Vg和圆轨迹半径ρ都大于零,系统沿选定航线角指令的轨迹时,选定的李雅普诺夫函数及其导数满足:
根据李雅普诺夫稳定性定理,当李雅普诺夫函数正定大于零,李雅普诺夫函数的导数负定小于零时,系统稳定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811491434.0A CN109708639B (zh) | 2018-12-07 | 2018-12-07 | 飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811491434.0A CN109708639B (zh) | 2018-12-07 | 2018-12-07 | 飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109708639A CN109708639A (zh) | 2019-05-03 |
CN109708639B true CN109708639B (zh) | 2022-11-22 |
Family
ID=66254017
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811491434.0A Active CN109708639B (zh) | 2018-12-07 | 2018-12-07 | 飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109708639B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110307847B (zh) * | 2019-06-25 | 2023-04-28 | 江苏理工学院 | 一种固定翼无人机应急返航航线规划及横侧向制导方法 |
CN111650958B (zh) * | 2019-12-15 | 2023-11-03 | 湖北航天飞行器研究所 | 一种固定翼无人机起飞段切入航路点的在线路径规划方法 |
CN111240362B (zh) * | 2020-01-20 | 2023-04-28 | 湖北三江航天红峰控制有限公司 | 一种智能引导飞行器转弯的控制方法及装置 |
CN112947517B (zh) * | 2021-02-03 | 2022-11-01 | 湖北三江航天红峰控制有限公司 | 一种可装订任意航迹点的飞行器航迹规划方法及装置 |
CN113176788B (zh) * | 2021-04-27 | 2022-08-16 | 北京理工大学 | 一种基于变前向距离los制导律的飞行器路径跟踪方法 |
CN113495571B (zh) * | 2021-07-26 | 2024-02-27 | 中国人民解放军63629部队 | 飞行器路径跟踪方法、装置、设备和介质 |
CN116203992B (zh) * | 2023-04-28 | 2023-08-01 | 北京航空航天大学 | 一种多模态飞行控制的尾座式无人机高动态目标追踪方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102163057A (zh) * | 2011-04-14 | 2011-08-24 | 北京航空航天大学 | 一种自治飞艇平面路径跟踪控制方法 |
CN104199303A (zh) * | 2014-09-18 | 2014-12-10 | 北京航空航天大学 | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 |
CN105045284A (zh) * | 2015-09-21 | 2015-11-11 | 北京天航华创科技股份有限公司 | 一种抗干扰无人飞行器路径跟踪控制方法 |
CN106444822A (zh) * | 2016-03-30 | 2017-02-22 | 北京航空航天大学 | 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法 |
CN107992069A (zh) * | 2017-11-29 | 2018-05-04 | 上海无线电设备研究所 | 一种无人机路径跟踪控制的制导律设计方法 |
-
2018
- 2018-12-07 CN CN201811491434.0A patent/CN109708639B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102163057A (zh) * | 2011-04-14 | 2011-08-24 | 北京航空航天大学 | 一种自治飞艇平面路径跟踪控制方法 |
CN104199303A (zh) * | 2014-09-18 | 2014-12-10 | 北京航空航天大学 | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 |
CN105045284A (zh) * | 2015-09-21 | 2015-11-11 | 北京天航华创科技股份有限公司 | 一种抗干扰无人飞行器路径跟踪控制方法 |
CN106444822A (zh) * | 2016-03-30 | 2017-02-22 | 北京航空航天大学 | 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法 |
CN107992069A (zh) * | 2017-11-29 | 2018-05-04 | 上海无线电设备研究所 | 一种无人机路径跟踪控制的制导律设计方法 |
Non-Patent Citations (2)
Title |
---|
"Vector Field Path Following for Miniature Air Vehicles";Derek R. Nelson;《IEEE TRANSACTIONS ON ROBOTICS》;20070625;正文第519-529页 * |
无动力无人机进场阶段三维Dubins路径跟踪方法;黄得刚等;《系统工程与电子技术》;20160331(第03期);正文第629-637页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109708639A (zh) | 2019-05-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109708639B (zh) | 飞行器平飞跟踪直线和圆弧路径的侧向制导指令生成方法 | |
CN110262553B (zh) | 基于位置信息的固定翼无人机编队飞行方法 | |
CN111103890B (zh) | 一种高精度强鲁棒的进场着陆引导控制方法 | |
Nemra et al. | Robust INS/GPS sensor fusion for UAV localization using SDRE nonlinear filtering | |
US7228227B2 (en) | Bezier curve flightpath guidance using moving waypoints | |
WO2016197986A1 (zh) | 一种无人机高精度自主避障飞行方法 | |
CN102426457B (zh) | 一种微型扑翼飞行器飞控导航系统 | |
CN111650958B (zh) | 一种固定翼无人机起飞段切入航路点的在线路径规划方法 | |
Iscold et al. | Development of a hand-launched small UAV for ground reconnaissance | |
Oliveira et al. | Ground target tracking control system for unmanned aerial vehicles | |
Frew et al. | Cooperative stand-off tracking of moving targets by a team of autonomous aircraft | |
CN103728981A (zh) | 一种无人机的非线性导航寻迹控制方法 | |
CN112198886B (zh) | 一种跟踪机动目标的无人机控制方法 | |
Park | Circling over a target with relative side bearing | |
CN101266150B (zh) | 一种无人机侧向领航方法 | |
CN104199303B (zh) | 一种基于矢量场制导的平流层卫星平面路径跟踪控制方法 | |
CN113295162A (zh) | 基于无人机状态信息的广义因子图融合导航方法 | |
CN110488875A (zh) | 基于动态逆的无人机跟踪目标初始段航向误差修正方法 | |
Yamasaki et al. | Sliding mode based pure pursuit guidance for UAV rendezvous and chase with a cooperative aircraft | |
CN109084760A (zh) | 一种楼宇间导航系统 | |
CN110398242A (zh) | 一种高旋高过载条件飞行器的姿态角确定方法 | |
CN112684810B (zh) | 一种固定翼无人机环绕飞行的导航方法 | |
Sedlmair et al. | Design and experimental validation of UAV control laws-3D spline-path-following and easy-handling remote control | |
Hong et al. | Applications of adaptive neural network control to an unmanned airship | |
Chen et al. | UAVs formation flight control based on following of the guidance points |
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 |